Accel
Fork of FXOS8700 by
FXOS8700.cpp@0:a4ffc3c3e770, 2015-12-07 (annotated)
- Committer:
- AswinSivakumar
- Date:
- Mon Dec 07 08:15:07 2015 +0000
- Revision:
- 0:a4ffc3c3e770
- Child:
- 1:66ff36d0d1b1
Initial commit
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
AswinSivakumar | 0:a4ffc3c3e770 | 1 | #include "FXOS8700.h" |
AswinSivakumar | 0:a4ffc3c3e770 | 2 | #include "mbed.h" |
AswinSivakumar | 0:a4ffc3c3e770 | 3 | |
AswinSivakumar | 0:a4ffc3c3e770 | 4 | FXOS8700::FXOS8700(PinName sda, PinName scl) : accelmagi2c(sda,scl) |
AswinSivakumar | 0:a4ffc3c3e770 | 5 | { |
AswinSivakumar | 0:a4ffc3c3e770 | 6 | |
AswinSivakumar | 0:a4ffc3c3e770 | 7 | } |
AswinSivakumar | 0:a4ffc3c3e770 | 8 | |
AswinSivakumar | 0:a4ffc3c3e770 | 9 | void FXOS8700::accel_config(void) |
AswinSivakumar | 0:a4ffc3c3e770 | 10 | { |
AswinSivakumar | 0:a4ffc3c3e770 | 11 | char d[2]; |
AswinSivakumar | 0:a4ffc3c3e770 | 12 | d[0] = FXOS8700_CTRL_REG1; //Puts device in Standby mode |
AswinSivakumar | 0:a4ffc3c3e770 | 13 | d[1] = 0x00; |
AswinSivakumar | 0:a4ffc3c3e770 | 14 | accelmagi2c.write(FXOS8700_I2C_ADDRESS, d,2); |
AswinSivakumar | 0:a4ffc3c3e770 | 15 | |
AswinSivakumar | 0:a4ffc3c3e770 | 16 | |
AswinSivakumar | 0:a4ffc3c3e770 | 17 | d[0] = FXOS8700_CTRL_REG1; //Puts device in Active mode |
AswinSivakumar | 0:a4ffc3c3e770 | 18 | d[1] = 0x01; |
AswinSivakumar | 0:a4ffc3c3e770 | 19 | accelmagi2c.write(FXOS8700_I2C_ADDRESS, d, 2); |
AswinSivakumar | 0:a4ffc3c3e770 | 20 | |
AswinSivakumar | 0:a4ffc3c3e770 | 21 | } |
AswinSivakumar | 0:a4ffc3c3e770 | 22 | |
AswinSivakumar | 0:a4ffc3c3e770 | 23 | void FXOS8700::mag_config(void) |
AswinSivakumar | 0:a4ffc3c3e770 | 24 | { |
AswinSivakumar | 0:a4ffc3c3e770 | 25 | char d[2]; |
AswinSivakumar | 0:a4ffc3c3e770 | 26 | d[0] = FXOS8700_CTRL_REG1; //Puts device in Standby mode |
AswinSivakumar | 0:a4ffc3c3e770 | 27 | d[1] = 0x00; |
AswinSivakumar | 0:a4ffc3c3e770 | 28 | accelmagi2c.write(FXOS8700_I2C_ADDRESS, d,2); |
AswinSivakumar | 0:a4ffc3c3e770 | 29 | |
AswinSivakumar | 0:a4ffc3c3e770 | 30 | |
AswinSivakumar | 0:a4ffc3c3e770 | 31 | d[0] = FXOS8700_M_CTRL_REG1; //Puts device in hybrid mode (both accel and mag are active) |
AswinSivakumar | 0:a4ffc3c3e770 | 32 | d[1] = 0x03; |
AswinSivakumar | 0:a4ffc3c3e770 | 33 | accelmagi2c.write(FXOS8700_I2C_ADDRESS, d, 2); |
AswinSivakumar | 0:a4ffc3c3e770 | 34 | |
AswinSivakumar | 0:a4ffc3c3e770 | 35 | |
AswinSivakumar | 0:a4ffc3c3e770 | 36 | d[0] = FXOS8700_CTRL_REG1; //Puts device in Active mode |
AswinSivakumar | 0:a4ffc3c3e770 | 37 | d[1] = 0x01; |
AswinSivakumar | 0:a4ffc3c3e770 | 38 | accelmagi2c.write(FXOS8700_I2C_ADDRESS, d,2); |
AswinSivakumar | 0:a4ffc3c3e770 | 39 | |
AswinSivakumar | 0:a4ffc3c3e770 | 40 | } |
AswinSivakumar | 0:a4ffc3c3e770 | 41 | |
AswinSivakumar | 0:a4ffc3c3e770 | 42 | void FXOS8700::acquire_accel_data_g(float * a_data) |
AswinSivakumar | 0:a4ffc3c3e770 | 43 | { |
AswinSivakumar | 0:a4ffc3c3e770 | 44 | |
AswinSivakumar | 0:a4ffc3c3e770 | 45 | char data_bytes[7]; |
AswinSivakumar | 0:a4ffc3c3e770 | 46 | char d[1]; |
AswinSivakumar | 0:a4ffc3c3e770 | 47 | d[0]=FXOS8700_STATUS; |
AswinSivakumar | 0:a4ffc3c3e770 | 48 | accelmagi2c.write(FXOS8700_I2C_ADDRESS,d,1,true); // Read the 6 data bytes - LSB and MSB for X, Y and Z Axes. |
AswinSivakumar | 0:a4ffc3c3e770 | 49 | accelmagi2c.read(FXOS8700_I2C_ADDRESS,data_bytes,7); |
AswinSivakumar | 0:a4ffc3c3e770 | 50 | |
AswinSivakumar | 0:a4ffc3c3e770 | 51 | a_data[0] = ((float)((int16_t)(((data_bytes[1]*256) + (data_bytes[2])))>> 2) * 0.000244); |
AswinSivakumar | 0:a4ffc3c3e770 | 52 | a_data[1] = ((float)((int16_t)(((data_bytes[3]*256) + (data_bytes[4])))>> 2) * 0.000244); |
AswinSivakumar | 0:a4ffc3c3e770 | 53 | a_data[2] = ((float)((int16_t)(((data_bytes[5]*256) + (data_bytes[6])))>> 2) * 0.000244); |
AswinSivakumar | 0:a4ffc3c3e770 | 54 | |
AswinSivakumar | 0:a4ffc3c3e770 | 55 | } |
AswinSivakumar | 0:a4ffc3c3e770 | 56 | |
AswinSivakumar | 0:a4ffc3c3e770 | 57 | void FXOS8700::acquire_mag_data_uT(float * m_data) |
AswinSivakumar | 0:a4ffc3c3e770 | 58 | { |
AswinSivakumar | 0:a4ffc3c3e770 | 59 | |
AswinSivakumar | 0:a4ffc3c3e770 | 60 | char data_bytes[7]; |
AswinSivakumar | 0:a4ffc3c3e770 | 61 | char d[1]; |
AswinSivakumar | 0:a4ffc3c3e770 | 62 | d[0]=FXOS8700_MDR_STATUS; |
AswinSivakumar | 0:a4ffc3c3e770 | 63 | accelmagi2c.write(FXOS8700_I2C_ADDRESS,d,1,true); // Read the 6 data bytes - LSB and MSB for X, Y and Z Axes. |
AswinSivakumar | 0:a4ffc3c3e770 | 64 | accelmagi2c.read(FXOS8700_I2C_ADDRESS,data_bytes,7); |
AswinSivakumar | 0:a4ffc3c3e770 | 65 | |
AswinSivakumar | 0:a4ffc3c3e770 | 66 | m_data[0] = (float)((int16_t)((data_bytes[1]*256) + (data_bytes[2]))) * 0.1; |
AswinSivakumar | 0:a4ffc3c3e770 | 67 | m_data[1] = (float)((int16_t)((data_bytes[3]*256) + (data_bytes[4]))) * 0.1; |
AswinSivakumar | 0:a4ffc3c3e770 | 68 | m_data[2] = (float)((int16_t)((data_bytes[5]*256) + (data_bytes[6]))) * 0.1; |
AswinSivakumar | 0:a4ffc3c3e770 | 69 | |
AswinSivakumar | 0:a4ffc3c3e770 | 70 | } |
AswinSivakumar | 0:a4ffc3c3e770 | 71 | |
AswinSivakumar | 0:a4ffc3c3e770 | 72 |