FRDM-KL46Z board sLCD demo code
Fork of FRDM-KL46Z LCD rtc Demo by
MAG3110.cpp
00001 00002 #include "MAG3110.h" 00003 #include "mbed.h" 00004 00005 /****************************************************************************** 00006 * Constructors 00007 ******************************************************************************/ 00008 MAG3110::MAG3110(PinName sda, PinName scl): _i2c(sda, scl), 00009 _i2c_address(0x1D), _pc(NULL), _debug(false) 00010 { 00011 begin(); 00012 } 00013 00014 MAG3110::MAG3110(PinName sda, PinName scl, Serial *pc): _i2c(sda, scl), 00015 _i2c_address(0x1D), _pc(pc), _debug(true) 00016 { 00017 begin(); 00018 } 00019 00020 void MAG3110::begin() 00021 { 00022 char cmd[2]; 00023 00024 cmd[0] = MAG_CTRL_REG2; 00025 cmd[1] = 0x80; 00026 _i2c.write(_i2c_address, cmd, 2); 00027 00028 cmd[0] = MAG_CTRL_REG1; 00029 cmd[1] = MAG_3110_SAMPLE80+MAG_3110_OVERSAMPLE2+MAG_3110_ACTIVE; 00030 _i2c.write(_i2c_address, cmd, 2); 00031 00032 // No adjustment initially 00033 _avgX = 0; 00034 _avgY = 0; 00035 } 00036 00037 // Read a single byte form 8 bit register, return as int 00038 int MAG3110::readReg(char regAddr) 00039 { 00040 char cmd[1]; 00041 00042 cmd[0] = regAddr; 00043 _i2c.write(_i2c_address, cmd, 1); 00044 00045 cmd[0] = 0x00; 00046 _i2c.read(_i2c_address, cmd, 1); 00047 return (int)( cmd[0]); 00048 } 00049 00050 // read a register per, pass first reg value, reading 2 bytes increments register 00051 // Reads MSB first then LSB 00052 int MAG3110::readVal(char regAddr) 00053 { 00054 char cmd[2]; 00055 00056 cmd[0] = regAddr; 00057 _i2c.write(_i2c_address, cmd, 1); 00058 00059 cmd[0] = 0x00; 00060 cmd[1] = 0x00; 00061 _i2c.read(_i2c_address, cmd, 2); 00062 return (int)( (cmd[1]|(cmd[0] << 8))); //concatenate the MSB and LSB 00063 } 00064 00065 float MAG3110::getHeading() 00066 { 00067 int xVal = readVal(MAG_OUT_X_MSB); 00068 int yVal = readVal(MAG_OUT_Y_MSB); 00069 return (atan2((double)(yVal - _avgY),(double)(xVal - _avgX)))*180/PI; 00070 } 00071 00072 void MAG3110::getValues(int *xVal, int *yVal, int *zVal) 00073 { 00074 *xVal = readVal(MAG_OUT_X_MSB); 00075 *yVal = readVal(MAG_OUT_Y_MSB); 00076 *zVal = readVal(MAG_OUT_Z_MSB); 00077 } 00078 00079 void MAG3110::setCalibration(int minX, int maxX, int minY, int maxY ) 00080 { 00081 _avgX=(maxX+minX)/2; 00082 _avgY=(maxY+minY)/2; 00083 }
Generated on Fri Jul 15 2022 16:32:49 by 1.7.2