J&W / Mbed 2 deprecated Rejestrator

Data loger, logs 3D acc/mag every 100ms on external flash drive, requires FRDM-KL46Z, copyrighted except libraries used

Dependencies:   mbed Rejestrator

Dependents:   Rejestrator

MAG3110/MAG3110.cpp@1:5ad44a4edff9, 2015-05-09 (annotated)

Committer:
Waldek
Date:
Sat May 09 15:06:38 2015 +0000
Revision:
1:5ad44a4edff9
Parent:
0:fa31f8461c63 
Correction in the magnetic measurement

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Waldek 0:fa31f8461c63 1
Waldek 0:fa31f8461c63 2 #include "MAG3110.h"
Waldek 0:fa31f8461c63 3 #include "mbed.h"
Waldek 1:5ad44a4edff9 4 /*
Waldek 1:5ad44a4edff9 5 Mag regs: FF FC 5B 02 8A 0C EA C4 02 00 00 00 00 00 00 00 19 00 5F FF .
Waldek 1:5ad44a4edff9 6 64601 650 3306
Waldek 1:5ad44a4edff9 7
Waldek 1:5ad44a4edff9 8 FF
Waldek 1:5ad44a4edff9 9 x FB B9
Waldek 1:5ad44a4edff9 10 y 01 21
Waldek 1:5ad44a4edff9 11 z 0D 44
Waldek 1:5ad44a4edff9 12 id C4
Waldek 1:5ad44a4edff9 13 System mode 02
Waldek 1:5ad44a4edff9 14 off x 00 00
Waldek 1:5ad44a4edff9 15 off y 00 00
Waldek 1:5ad44a4edff9 16 off z 00 00
Waldek 1:5ad44a4edff9 17 temp 00
Waldek 1:5ad44a4edff9 18 ctrl reg1 19
Waldek 1:5ad44a4edff9 19 ctrl reg2 00
Waldek 1:5ad44a4edff9 20 BF FF .
Waldek 1:5ad44a4edff9 21 */
Waldek 0:fa31f8461c63 22
Waldek 0:fa31f8461c63 23 /******************************************************************************
Waldek 0:fa31f8461c63 24 * Constructors
Waldek 0:fa31f8461c63 25 ******************************************************************************/
Waldek 0:fa31f8461c63 26 MAG3110::MAG3110(PinName sda, PinName scl, int i2c_adr): _i2c(sda, scl),
Waldek 0:fa31f8461c63 27 _i2c_address(i2c_adr<<1)
Waldek 0:fa31f8461c63 28 {
Waldek 0:fa31f8461c63 29 begin();
Waldek 0:fa31f8461c63 30 }
Waldek 0:fa31f8461c63 31
Waldek 1:5ad44a4edff9 32 void MAG3110::begin(void)
Waldek 0:fa31f8461c63 33 {
Waldek 0:fa31f8461c63 34 char cmd[2];
Waldek 0:fa31f8461c63 35
Waldek 0:fa31f8461c63 36 cmd[0] = MAG_CTRL_REG2;
Waldek 1:5ad44a4edff9 37 cmd[1] = MAG_3110_MAG_RST;
Waldek 0:fa31f8461c63 38 _i2c.write(_i2c_address, cmd, 2);
Waldek 0:fa31f8461c63 39
Waldek 0:fa31f8461c63 40 cmd[0] = MAG_CTRL_REG1;
Waldek 1:5ad44a4edff9 41 cmd[1] = MAG_3110_SAMPLE80 + MAG_3110_OVERSAMPLE3 + MAG_3110_ACTIVE;
Waldek 0:fa31f8461c63 42 _i2c.write(_i2c_address, cmd, 2);
Waldek 0:fa31f8461c63 43
Waldek 1:5ad44a4edff9 44 cmd[0] = MAG_WHO_AM_I;
Waldek 1:5ad44a4edff9 45 _i2c.write(_i2c_address, cmd, 1);
Waldek 1:5ad44a4edff9 46 cmd[0] = 0x00;
Waldek 1:5ad44a4edff9 47 _i2c.read(_i2c_address, cmd, 1);
Waldek 1:5ad44a4edff9 48 // if (cmd[0] == MAG_3110_WHO_AM_I_VALUE)
Waldek 1:5ad44a4edff9 49
Waldek 0:fa31f8461c63 50 // No adjustment initially
Waldek 0:fa31f8461c63 51 _avgX = 0;
Waldek 0:fa31f8461c63 52 _avgY = 0;
Waldek 0:fa31f8461c63 53 }
Waldek 0:fa31f8461c63 54
Waldek 0:fa31f8461c63 55 // Read a single byte form 8 bit register, return as int
Waldek 0:fa31f8461c63 56 int MAG3110::readReg(char regAddr)
Waldek 0:fa31f8461c63 57 {
Waldek 0:fa31f8461c63 58 char cmd[1];
Waldek 0:fa31f8461c63 59
Waldek 0:fa31f8461c63 60 cmd[0] = regAddr;
Waldek 0:fa31f8461c63 61 _i2c.write(_i2c_address, cmd, 1);
Waldek 0:fa31f8461c63 62
Waldek 0:fa31f8461c63 63 cmd[0] = 0x00;
Waldek 0:fa31f8461c63 64 _i2c.read(_i2c_address, cmd, 1);
Waldek 0:fa31f8461c63 65 return (int)( cmd[0]);
Waldek 0:fa31f8461c63 66 }
Waldek 0:fa31f8461c63 67
Waldek 0:fa31f8461c63 68
Waldek 0:fa31f8461c63 69 // read a register per, pass first reg value, reading 2 bytes increments register
Waldek 0:fa31f8461c63 70 // Reads MSB first then LSB
Waldek 1:5ad44a4edff9 71 int16_t MAG3110::readVal(char regAddr)
Waldek 0:fa31f8461c63 72 {
Waldek 0:fa31f8461c63 73 char cmd[2];
Waldek 0:fa31f8461c63 74
Waldek 0:fa31f8461c63 75 cmd[0] = regAddr;
Waldek 0:fa31f8461c63 76 _i2c.write(_i2c_address, cmd, 1);
Waldek 0:fa31f8461c63 77
Waldek 0:fa31f8461c63 78 cmd[0] = 0x00;
Waldek 0:fa31f8461c63 79 cmd[1] = 0x00;
Waldek 0:fa31f8461c63 80 _i2c.read(_i2c_address, cmd, 2);
Waldek 0:fa31f8461c63 81 return (int)( (cmd[1]|(cmd[0] << 8))); //concatenate the MSB and LSB
Waldek 0:fa31f8461c63 82 }
Waldek 0:fa31f8461c63 83
Waldek 0:fa31f8461c63 84
Waldek 1:5ad44a4edff9 85 int MAG3110::readAll(char *buffer)
Waldek 1:5ad44a4edff9 86 {
Waldek 1:5ad44a4edff9 87 char cmd[2];
Waldek 1:5ad44a4edff9 88
Waldek 1:5ad44a4edff9 89 cmd[0] = 0;
Waldek 1:5ad44a4edff9 90 _i2c.write(_i2c_address, cmd, 1);
Waldek 1:5ad44a4edff9 91
Waldek 1:5ad44a4edff9 92 _i2c.read(_i2c_address, buffer, 20);
Waldek 1:5ad44a4edff9 93 return (int)buffer[0]; //status
Waldek 1:5ad44a4edff9 94 }
Waldek 1:5ad44a4edff9 95
Waldek 0:fa31f8461c63 96 float MAG3110::getHeading()
Waldek 0:fa31f8461c63 97 {
Waldek 0:fa31f8461c63 98 int xVal = readVal(MAG_OUT_X_MSB);
Waldek 0:fa31f8461c63 99 int yVal = readVal(MAG_OUT_Y_MSB);
Waldek 1:5ad44a4edff9 100 return (atan2((double)(yVal - _avgY),(double)(xVal - _avgX)))*180./PI;
Waldek 0:fa31f8461c63 101 }
Waldek 0:fa31f8461c63 102
Waldek 0:fa31f8461c63 103 void MAG3110::getValues(int *xVal, int *yVal, int *zVal)
Waldek 0:fa31f8461c63 104 {
Waldek 0:fa31f8461c63 105 *xVal = readVal(MAG_OUT_X_MSB);
Waldek 0:fa31f8461c63 106 *yVal = readVal(MAG_OUT_Y_MSB);
Waldek 0:fa31f8461c63 107 *zVal = readVal(MAG_OUT_Z_MSB);
Waldek 0:fa31f8461c63 108 }
Waldek 0:fa31f8461c63 109
Waldek 0:fa31f8461c63 110
Waldek 0:fa31f8461c63 111 void MAG3110::setCalibration(int minX, int maxX, int minY, int maxY )
Waldek 0:fa31f8461c63 112 {
Waldek 0:fa31f8461c63 113 _avgX=(maxX+minX)/2;
Waldek 0:fa31f8461c63 114 _avgY=(maxY+minY)/2;
Waldek 0:fa31f8461c63 115 }
Waldek 0:fa31f8461c63 116
Waldek 0:fa31f8461c63 117
Waldek 0:fa31f8461c63 118 int8_t MAG3110::getTemperature(void)
Waldek 0:fa31f8461c63 119 {
Waldek 0:fa31f8461c63 120 return (int8_t)readVal(MAG_DIE_TEMP);
Waldek 0:fa31f8461c63 121 }