Aswin Sivakumar / FXOS8700

FXOS8700 library

Dependents:   FRDM-STBC-AGMP01_SensorStream Hexi_Accelero_Magneto_Example A_Dragonfly_Freescale_Accel_Mag_Gyro_Sensor_AGM01 A_Dragonfly_BlueMix_QuickStart_NXP_Sensor ... more

FXOS8700.cpp@4:df2167370234, 2017-04-25 (annotated)

Committer:
AswinSivakumar
Date:
Tue Apr 25 23:40:50 2017 +0000
Revision:
4:df2167370234
Parent:
2:98ea52282575 
updated

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AswinSivakumar 4:df2167370234 1 /*
AswinSivakumar 4:df2167370234 2 * Copyright (c) 2015 - 2016, Freescale Semiconductor, Inc.
AswinSivakumar 4:df2167370234 3 * Copyright 2016-2017 NXP
AswinSivakumar 4:df2167370234 4 *
AswinSivakumar 4:df2167370234 5 * Redistribution and use in source and binary forms, with or without modification,
AswinSivakumar 4:df2167370234 6 * are permitted provided that the following conditions are met:
AswinSivakumar 4:df2167370234 7 *
AswinSivakumar 4:df2167370234 8 * o Redistributions of source code must retain the above copyright notice, this list
AswinSivakumar 4:df2167370234 9 * of conditions and the following disclaimer.
AswinSivakumar 4:df2167370234 10 *
AswinSivakumar 4:df2167370234 11 * o Redistributions in binary form must reproduce the above copyright notice, this
AswinSivakumar 4:df2167370234 12 * list of conditions and the following disclaimer in the documentation and/or
AswinSivakumar 4:df2167370234 13 * other materials provided with the distribution.
AswinSivakumar 4:df2167370234 14 *
AswinSivakumar 4:df2167370234 15 * o Neither the name of the copyright holder nor the names of its
AswinSivakumar 4:df2167370234 16 * contributors may be used to endorse or promote products derived from this
AswinSivakumar 4:df2167370234 17 * software without specific prior written permission.
AswinSivakumar 4:df2167370234 18 *
AswinSivakumar 4:df2167370234 19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
AswinSivakumar 4:df2167370234 20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
AswinSivakumar 4:df2167370234 21 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
AswinSivakumar 4:df2167370234 22 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
AswinSivakumar 4:df2167370234 23 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
AswinSivakumar 4:df2167370234 24 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
AswinSivakumar 4:df2167370234 25 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
AswinSivakumar 4:df2167370234 26 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
AswinSivakumar 4:df2167370234 27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
AswinSivakumar 4:df2167370234 28 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
AswinSivakumar 4:df2167370234 29 */
AswinSivakumar 1:66ff36d0d1b1 30
AswinSivakumar 1:66ff36d0d1b1 31 #include "FXOS8700.h"
AswinSivakumar 0:a4ffc3c3e770 32 #include "mbed.h"
AswinSivakumar 0:a4ffc3c3e770 33
AswinSivakumar 0:a4ffc3c3e770 34 FXOS8700::FXOS8700(PinName sda, PinName scl) : accelmagi2c(sda,scl)
AswinSivakumar 0:a4ffc3c3e770 35 {
AswinSivakumar 0:a4ffc3c3e770 36
AswinSivakumar 0:a4ffc3c3e770 37 }
AswinSivakumar 0:a4ffc3c3e770 38
AswinSivakumar 0:a4ffc3c3e770 39 void FXOS8700::accel_config(void)
AswinSivakumar 0:a4ffc3c3e770 40 {
AswinSivakumar 0:a4ffc3c3e770 41 char d[2];
AswinSivakumar 0:a4ffc3c3e770 42 d[0] = FXOS8700_CTRL_REG1; //Puts device in Standby mode
AswinSivakumar 0:a4ffc3c3e770 43 d[1] = 0x00;
AswinSivakumar 0:a4ffc3c3e770 44 accelmagi2c.write(FXOS8700_I2C_ADDRESS, d,2);
AswinSivakumar 0:a4ffc3c3e770 45
AswinSivakumar 0:a4ffc3c3e770 46
AswinSivakumar 0:a4ffc3c3e770 47 d[0] = FXOS8700_CTRL_REG1; //Puts device in Active mode
AswinSivakumar 0:a4ffc3c3e770 48 d[1] = 0x01;
AswinSivakumar 0:a4ffc3c3e770 49 accelmagi2c.write(FXOS8700_I2C_ADDRESS, d, 2);
AswinSivakumar 0:a4ffc3c3e770 50
AswinSivakumar 0:a4ffc3c3e770 51 }
AswinSivakumar 0:a4ffc3c3e770 52
AswinSivakumar 0:a4ffc3c3e770 53 void FXOS8700::mag_config(void)
AswinSivakumar 0:a4ffc3c3e770 54 {
AswinSivakumar 0:a4ffc3c3e770 55 char d[2];
AswinSivakumar 0:a4ffc3c3e770 56 d[0] = FXOS8700_CTRL_REG1; //Puts device in Standby mode
AswinSivakumar 0:a4ffc3c3e770 57 d[1] = 0x00;
AswinSivakumar 0:a4ffc3c3e770 58 accelmagi2c.write(FXOS8700_I2C_ADDRESS, d,2);
AswinSivakumar 0:a4ffc3c3e770 59
AswinSivakumar 0:a4ffc3c3e770 60
AswinSivakumar 0:a4ffc3c3e770 61 d[0] = FXOS8700_M_CTRL_REG1; //Puts device in hybrid mode (both accel and mag are active)
AswinSivakumar 0:a4ffc3c3e770 62 d[1] = 0x03;
AswinSivakumar 0:a4ffc3c3e770 63 accelmagi2c.write(FXOS8700_I2C_ADDRESS, d, 2);
AswinSivakumar 0:a4ffc3c3e770 64
AswinSivakumar 0:a4ffc3c3e770 65
AswinSivakumar 0:a4ffc3c3e770 66 d[0] = FXOS8700_CTRL_REG1; //Puts device in Active mode
AswinSivakumar 0:a4ffc3c3e770 67 d[1] = 0x01;
AswinSivakumar 0:a4ffc3c3e770 68 accelmagi2c.write(FXOS8700_I2C_ADDRESS, d,2);
AswinSivakumar 0:a4ffc3c3e770 69
AswinSivakumar 0:a4ffc3c3e770 70 }
AswinSivakumar 0:a4ffc3c3e770 71
AswinSivakumar 0:a4ffc3c3e770 72 void FXOS8700::acquire_accel_data_g(float * a_data)
AswinSivakumar 0:a4ffc3c3e770 73 {
AswinSivakumar 0:a4ffc3c3e770 74
AswinSivakumar 0:a4ffc3c3e770 75 char data_bytes[7];
AswinSivakumar 0:a4ffc3c3e770 76 char d[1];
AswinSivakumar 0:a4ffc3c3e770 77 d[0]=FXOS8700_STATUS;
AswinSivakumar 0:a4ffc3c3e770 78 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 79 accelmagi2c.read(FXOS8700_I2C_ADDRESS,data_bytes,7);
AswinSivakumar 0:a4ffc3c3e770 80
AswinSivakumar 0:a4ffc3c3e770 81 a_data[0] = ((float)((int16_t)(((data_bytes[1]*256) + (data_bytes[2])))>> 2) * 0.000244);
AswinSivakumar 0:a4ffc3c3e770 82 a_data[1] = ((float)((int16_t)(((data_bytes[3]*256) + (data_bytes[4])))>> 2) * 0.000244);
AswinSivakumar 0:a4ffc3c3e770 83 a_data[2] = ((float)((int16_t)(((data_bytes[5]*256) + (data_bytes[6])))>> 2) * 0.000244);
AswinSivakumar 0:a4ffc3c3e770 84
AswinSivakumar 0:a4ffc3c3e770 85 }
AswinSivakumar 0:a4ffc3c3e770 86
AswinSivakumar 0:a4ffc3c3e770 87 void FXOS8700::acquire_mag_data_uT(float * m_data)
AswinSivakumar 0:a4ffc3c3e770 88 {
AswinSivakumar 0:a4ffc3c3e770 89
AswinSivakumar 0:a4ffc3c3e770 90 char data_bytes[7];
AswinSivakumar 0:a4ffc3c3e770 91 char d[1];
AswinSivakumar 0:a4ffc3c3e770 92 d[0]=FXOS8700_MDR_STATUS;
AswinSivakumar 0:a4ffc3c3e770 93 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 94 accelmagi2c.read(FXOS8700_I2C_ADDRESS,data_bytes,7);
AswinSivakumar 0:a4ffc3c3e770 95
AswinSivakumar 0:a4ffc3c3e770 96 m_data[0] = (float)((int16_t)((data_bytes[1]*256) + (data_bytes[2]))) * 0.1;
AswinSivakumar 0:a4ffc3c3e770 97 m_data[1] = (float)((int16_t)((data_bytes[3]*256) + (data_bytes[4]))) * 0.1;
AswinSivakumar 0:a4ffc3c3e770 98 m_data[2] = (float)((int16_t)((data_bytes[5]*256) + (data_bytes[6]))) * 0.1;
AswinSivakumar 0:a4ffc3c3e770 99
AswinSivakumar 0:a4ffc3c3e770 100 }
AswinSivakumar 0:a4ffc3c3e770 101
AswinSivakumar 0:a4ffc3c3e770 102