/*
 * Copyright (C) 2012 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */
#define ADK_INTERNAL
#include "fwk.h"
#include "mag.h"
#include "I2C.h"


char magInit(void){  //1->success, 0->fail

    if(i2cSingleRead(1, 0x1E, 0x0A) != 0x48) return 0; //not found
    if(i2cSingleRead(1, 0x1E, 0x0B) != 0x34) return 0; //not found
    if(i2cSingleRead(1, 0x1E, 0x0C) != 0x33) return 0; //not found

    i2cSingleWrite(1, 0x1E, 0x00, 0x14); // No temp sensor
    i2cSingleWrite(1, 0x1E, 0x01, 0x20); // Gain setting of 1.3 gauss
    i2cSingleWrite(1, 0x1E, 0x02, 0x00); // Continuous conversion mode 

    return 1;
}

void magRead(int16_t* x, int16_t* y, int16_t* z) {

    while(!(i2cSingleRead(1, 0x1E, 0x09) & 1)); //wait

    if(x) *x = (int16_t)(((uint16_t)i2cSingleRead(1, 0x1E, 0x03) << 8) | (uint16_t)i2cSingleRead(1, 0x1E, 0x04));
    if(y) *y = (int16_t)(((uint16_t)i2cSingleRead(1, 0x1E, 0x05) << 8) | (uint16_t)i2cSingleRead(1, 0x1E, 0x06));
    if(z) *z = (int16_t)(((uint16_t)i2cSingleRead(1, 0x1E, 0x07) << 8) | (uint16_t)i2cSingleRead(1, 0x1E, 0x08));
}