ok

Fork of HMC5843 by Jose R Padron

HMC5843.cpp

Committer:
rulla
Date:
2017-10-03
Revision:
3:7f74d68580c3
Parent:
0:ae7d06398888
Child:
1:65e41eb3c291

File content as of revision 3:7f74d68580c3:

/**
 * @author Jose R. Padron
 *@author Used HMCHMC6352 library  developed by Aaron Berk as template
 * @section LICENSE
 *
 * Copyright (c) 2010 ARM Limited
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 *
 * @section DESCRIPTION
 *
 * Honeywell HMC5843digital compass.
 *
 * Datasheet:
 *
 * http://www.ssec.honeywell.com/magnetic/datasheets/HMC5843.pdf
 */

/**
 * Includes
 */
#include "HMC5843.h"

HMC5843::HMC5843(PinName sda, PinName scl) {

    i2c_ = new I2C(sda, scl);
    //100KHz, as specified by the datasheet.
    i2c_->frequency(100000);


}


void HMC5843::write(int address, int data) {
   
    char tx[2];
   
    tx[0]=address;
    tx[1]=data;

    i2c_->write(HMC5843_I2C_WRITE,tx,2);
   
    wait_ms(100);

}


void HMC5843::setSleepMode() {
    
    write(HMC5843_MODE, HMC5843_SLEEP);
}

void HMC5843::setDefault(void) {
   
   write(HMC5843_CONFIG_A,HMC5843_10HZ_NORMAL);
   write(HMC5843_CONFIG_B,HMC5843_1_0GA);
   write(HMC5843_MODE,HMC5843_CONTINUOUS);
   wait_ms(100);
}

//void HMC5843::SelfTest() {

    //Future

//}


void HMC5843::getAddress(char *buffer) {
    
   char rx[3];
   char tx[1];
   tx[0]=HMC5843_IDENT_A;
    
       
    i2c_->write(HMC5843_I2C_WRITE, tx,1);
   
    wait_ms(1);
    
    i2c_->read(HMC5843_I2C_READ,rx,3);
    
    buffer[0]=rx[0];
    buffer[1]=rx[1];
    buffer[2]=rx[2];
}



void HMC5843::setOpMode(int mode, int ConfigA, int ConfigB) {
    
    
    write(HMC5843_CONFIG_A,ConfigA);
    write(HMC5843_CONFIG_B,ConfigB);
    write(HMC5843_MODE,mode);
    

}




void HMC5843::readData(int* readings) {

  
    char tx[1];
    char rx[2];
    
    
    tx[0]=HMC5843_X_MSB;
    i2c_->write(HMC5843_I2C_READ,tx,1);
    i2c_->read(HMC5843_I2C_READ,rx,2);
    readings[0]= (int)rx[0]<<8|(int)rx[1];

     
    tx[0]=HMC5843_Y_MSB;
    i2c_->write(HMC5843_I2C_READ,tx,1);
    i2c_->read(HMC5843_I2C_READ,rx,2);
    readings[1]= (int)rx[0]<<8|(int)rx[1];
     
    tx[0]=HMC5843_Z_MSB;
    i2c_->write(HMC5843_I2C_READ,tx,1);
    i2c_->read(HMC5843_I2C_READ,rx,2);
    readings[2]= (int)rx[0]<<8|(int)rx[1];
    

    //readings[0] = (int)buffer[0] << 8 | (int)buffer[1];
    //readings[1] = (int)buffer[2] << 8 | (int)buffer[3];
    //readings[2] = (int)buffer[4] << 8 | (int)buffer[5];
    
   // readings[0]=buffer[0];
     //readings[1]=buffer[1];
     // readings[2]=buffer[2]; 
       // readings[3]=buffer[3];
         // readings[4]=buffer[4];
           // readings[5]=buffer[5];
}