Jim Carver / FXAS21000

Basic component library for the FXAS21000 gyro from Freescale

Dependents:   Hello_FXAS21000 Multi-Sensor Freescale_Multi-Sensor_Shield FRDM-STBC-AGM01 ... more

FXAS21000.cpp@3:a8f83b52f4df, 2014-06-02 (annotated)

Committer:
screamer
Date:
Mon Jun 02 17:36:38 2014 +0000
Revision:
3:a8f83b52f4df
Parent:
2:cd21ef326977 
Documentation fixes

Who changed what in which revision?

UserRevisionLine numberNew contents of line
JimCarver 0:4cfc774d6d85 1 #include "FXAS21000.h"
JimCarver 0:4cfc774d6d85 2
JimCarver 0:4cfc774d6d85 3 FXAS21000::FXAS21000(PinName sda, PinName scl) : _i2c(sda, scl) {
JimCarver 0:4cfc774d6d85 4
JimCarver 0:4cfc774d6d85 5 begin();
JimCarver 0:4cfc774d6d85 6 }
JimCarver 0:4cfc774d6d85 7
JimCarver 0:4cfc774d6d85 8 void FXAS21000::RegRead( char reg, char * d, int len)
JimCarver 0:4cfc774d6d85 9 {
JimCarver 0:4cfc774d6d85 10 char cmd[1];
JimCarver 0:4cfc774d6d85 11 cmd[0] = reg;
JimCarver 0:4cfc774d6d85 12 char i2c_addr = FXAS21000_SLAVE_ADDR;
JimCarver 0:4cfc774d6d85 13 _i2c.write( i2c_addr, cmd, 1, true);
JimCarver 0:4cfc774d6d85 14 _i2c.read ( i2c_addr, d, len);
JimCarver 0:4cfc774d6d85 15 }
JimCarver 0:4cfc774d6d85 16
JimCarver 0:4cfc774d6d85 17 void FXAS21000::begin(void)
JimCarver 0:4cfc774d6d85 18 {
JimCarver 0:4cfc774d6d85 19 char data[2];
JimCarver 0:4cfc774d6d85 20 // write 0000 1000 = 0x08 to gyro control register 1 to place FXAS21000 into
JimCarver 0:4cfc774d6d85 21 // standby
JimCarver 0:4cfc774d6d85 22 // [7-1] = 0000 000
JimCarver 0:4cfc774d6d85 23 // [0]: active=0
JimCarver 0:4cfc774d6d85 24 data[0] = FXAS21000_CTRL_REG1;
JimCarver 0:4cfc774d6d85 25 data[1] = 0x08;
JimCarver 0:4cfc774d6d85 26 _i2c.write( FXAS21000_SLAVE_ADDR, data, 2);
JimCarver 0:4cfc774d6d85 27
JimCarver 0:4cfc774d6d85 28 // write 0001 1011 to CRTL_REG0 register
JimCarver 0:4cfc774d6d85 29 data[0] = FXAS21000_CTRL_REG0;
JimCarver 0:4cfc774d6d85 30 data[1] = 0x1B;
JimCarver 0:4cfc774d6d85 31 _i2c.write( FXAS21000_SLAVE_ADDR, data, 2);
JimCarver 0:4cfc774d6d85 32
JimCarver 0:4cfc774d6d85 33 // write 0000 1001 to gyro control register 1
JimCarver 0:4cfc774d6d85 34 data[0] = FXAS21000_CTRL_REG1;
JimCarver 0:4cfc774d6d85 35 data[1] = 0x0A;
JimCarver 0:4cfc774d6d85 36 _i2c.write( FXAS21000_SLAVE_ADDR, data, 2);
JimCarver 0:4cfc774d6d85 37 }
JimCarver 0:4cfc774d6d85 38
JimCarver 0:4cfc774d6d85 39 char FXAS21000::getWhoAmI(void)
JimCarver 0:4cfc774d6d85 40 {
JimCarver 0:4cfc774d6d85 41 char d;
JimCarver 0:4cfc774d6d85 42 RegRead( FXAS21000_WHOAMI, &d, 1);
JimCarver 0:4cfc774d6d85 43 return(d);
JimCarver 0:4cfc774d6d85 44 }
JimCarver 0:4cfc774d6d85 45
JimCarver 0:4cfc774d6d85 46 void FXAS21000::ReadXYZ(float * a)
JimCarver 0:4cfc774d6d85 47 {
JimCarver 0:4cfc774d6d85 48 char d[7];
JimCarver 0:4cfc774d6d85 49 int16_t t[6];
JimCarver 0:4cfc774d6d85 50
JimCarver 0:4cfc774d6d85 51 RegRead( FXAS21000_STATUS, d, 7);
JimCarver 0:4cfc774d6d85 52 t[0] = ((d[1] * 256) + ((unsigned short) d[2]));
JimCarver 0:4cfc774d6d85 53 t[1] = ((d[3] * 256) + ((unsigned short) d[4]));
JimCarver 0:4cfc774d6d85 54 t[2] = ((d[5] * 256) + ((unsigned short) d[6]));
JimCarver 0:4cfc774d6d85 55 //printf("%X\r\n", (int) d[0]);
JimCarver 0:4cfc774d6d85 56
JimCarver 0:4cfc774d6d85 57 a[0] = (float) t[0] * 0.003125;
JimCarver 0:4cfc774d6d85 58 a[1] = (float) t[1] * 0.003125;
JimCarver 0:4cfc774d6d85 59 a[2] = (float) t[2] * 0.003125;
JimCarver 0:4cfc774d6d85 60
JimCarver 0:4cfc774d6d85 61 }
JimCarver 0:4cfc774d6d85 62
JimCarver 0:4cfc774d6d85 63 void FXAS21000::ReadXYZraw(int16_t * t)
JimCarver 0:4cfc774d6d85 64 {
JimCarver 0:4cfc774d6d85 65 char d[7];
JimCarver 0:4cfc774d6d85 66
JimCarver 0:4cfc774d6d85 67 RegRead( FXAS21000_STATUS, d, 7);
JimCarver 0:4cfc774d6d85 68 t[0] = ((d[1] * 256) + ((unsigned short) d[2]));
JimCarver 0:4cfc774d6d85 69 t[1] = ((d[3] * 256) + ((unsigned short) d[4]));
JimCarver 0:4cfc774d6d85 70 t[2] = ((d[5] * 256) + ((unsigned short) d[6]));
JimCarver 0:4cfc774d6d85 71 }