Aswin Sivakumar / FXAS21002

FXAS21002 library

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

FXAS21002.cpp@3:c9ebfc81e8b6, 2017-04-25 (annotated)

Committer:
AswinSivakumar
Date:
Tue Apr 25 23:40:38 2017 +0000
Revision:
3:c9ebfc81e8b6
Parent:
1:b774372b3913 
updated

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AswinSivakumar 3:c9ebfc81e8b6 1 /*
AswinSivakumar 3:c9ebfc81e8b6 2 * Copyright (c) 2015 - 2016, Freescale Semiconductor, Inc.
AswinSivakumar 3:c9ebfc81e8b6 3 * Copyright 2016-2017 NXP
AswinSivakumar 3:c9ebfc81e8b6 4 *
AswinSivakumar 3:c9ebfc81e8b6 5 * Redistribution and use in source and binary forms, with or without modification,
AswinSivakumar 3:c9ebfc81e8b6 6 * are permitted provided that the following conditions are met:
AswinSivakumar 3:c9ebfc81e8b6 7 *
AswinSivakumar 3:c9ebfc81e8b6 8 * o Redistributions of source code must retain the above copyright notice, this list
AswinSivakumar 3:c9ebfc81e8b6 9 * of conditions and the following disclaimer.
AswinSivakumar 3:c9ebfc81e8b6 10 *
AswinSivakumar 3:c9ebfc81e8b6 11 * o Redistributions in binary form must reproduce the above copyright notice, this
AswinSivakumar 3:c9ebfc81e8b6 12 * list of conditions and the following disclaimer in the documentation and/or
AswinSivakumar 3:c9ebfc81e8b6 13 * other materials provided with the distribution.
AswinSivakumar 3:c9ebfc81e8b6 14 *
AswinSivakumar 3:c9ebfc81e8b6 15 * o Neither the name of the copyright holder nor the names of its
AswinSivakumar 3:c9ebfc81e8b6 16 * contributors may be used to endorse or promote products derived from this
AswinSivakumar 3:c9ebfc81e8b6 17 * software without specific prior written permission.
AswinSivakumar 3:c9ebfc81e8b6 18 *
AswinSivakumar 3:c9ebfc81e8b6 19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
AswinSivakumar 3:c9ebfc81e8b6 20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
AswinSivakumar 3:c9ebfc81e8b6 21 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
AswinSivakumar 3:c9ebfc81e8b6 22 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
AswinSivakumar 3:c9ebfc81e8b6 23 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
AswinSivakumar 3:c9ebfc81e8b6 24 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
AswinSivakumar 3:c9ebfc81e8b6 25 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
AswinSivakumar 3:c9ebfc81e8b6 26 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
AswinSivakumar 3:c9ebfc81e8b6 27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
AswinSivakumar 3:c9ebfc81e8b6 28 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
AswinSivakumar 3:c9ebfc81e8b6 29 */
AswinSivakumar 0:9c9e8aaad4ff 30
AswinSivakumar 0:9c9e8aaad4ff 31 #include "FXAS21002.h"
AswinSivakumar 0:9c9e8aaad4ff 32 #include "mbed.h"
AswinSivakumar 0:9c9e8aaad4ff 33
AswinSivakumar 0:9c9e8aaad4ff 34 FXAS21002::FXAS21002(PinName sda, PinName scl) : gyroi2c(sda,scl)
AswinSivakumar 0:9c9e8aaad4ff 35 {
AswinSivakumar 0:9c9e8aaad4ff 36
AswinSivakumar 0:9c9e8aaad4ff 37 }
AswinSivakumar 0:9c9e8aaad4ff 38
AswinSivakumar 0:9c9e8aaad4ff 39 void FXAS21002::gyro_config(void)
AswinSivakumar 0:9c9e8aaad4ff 40 {
AswinSivakumar 0:9c9e8aaad4ff 41 char d[2];
AswinSivakumar 0:9c9e8aaad4ff 42 d[0] = FXAS21002_CTRL_REG1; //Puts device in standby mode
AswinSivakumar 0:9c9e8aaad4ff 43 d[1] = 0x08;
AswinSivakumar 0:9c9e8aaad4ff 44 gyroi2c.write(FXAS21002_I2C_ADDRESS, d,2);
AswinSivakumar 0:9c9e8aaad4ff 45
AswinSivakumar 0:9c9e8aaad4ff 46
AswinSivakumar 0:9c9e8aaad4ff 47 d[0] = FXAS21002_CTRL_REG0; //sets FS =+/- 2000 dps
AswinSivakumar 0:9c9e8aaad4ff 48 d[1] = 0x00;
AswinSivakumar 0:9c9e8aaad4ff 49 gyroi2c.write(FXAS21002_I2C_ADDRESS, d, 2);
AswinSivakumar 0:9c9e8aaad4ff 50
AswinSivakumar 0:9c9e8aaad4ff 51
AswinSivakumar 0:9c9e8aaad4ff 52 d[0] = FXAS21002_CTRL_REG1; //Puts device in active mode
AswinSivakumar 0:9c9e8aaad4ff 53 d[1] = 0x0A;
AswinSivakumar 0:9c9e8aaad4ff 54 gyroi2c.write(FXAS21002_I2C_ADDRESS, d,2);
AswinSivakumar 0:9c9e8aaad4ff 55
AswinSivakumar 0:9c9e8aaad4ff 56 }
AswinSivakumar 0:9c9e8aaad4ff 57
AswinSivakumar 0:9c9e8aaad4ff 58 void FXAS21002::acquire_gyro_data_dps(float * g_data)
AswinSivakumar 0:9c9e8aaad4ff 59 {
AswinSivakumar 0:9c9e8aaad4ff 60
AswinSivakumar 0:9c9e8aaad4ff 61 char data_bytes[7];
AswinSivakumar 0:9c9e8aaad4ff 62 gyroi2c.write(FXAS21002_I2C_ADDRESS,FXAS21002_STATUS,1,true); // Read the 6 data bytes - LSB and MSB for X, Y and Z Axes.
AswinSivakumar 0:9c9e8aaad4ff 63 gyroi2c.read(FXAS21002_I2C_ADDRESS,data_bytes,7);
AswinSivakumar 0:9c9e8aaad4ff 64
AswinSivakumar 0:9c9e8aaad4ff 65 g_data[0] = (float)((int16_t)((data_bytes[1]*256) + (data_bytes[2]))) * 0.0625;
AswinSivakumar 0:9c9e8aaad4ff 66 g_data[1] = (float)((int16_t)((data_bytes[3]*256) + (data_bytes[4]))) * 0.0625;
AswinSivakumar 0:9c9e8aaad4ff 67 g_data[2] = (float)((int16_t)((data_bytes[5]*256) + (data_bytes[6]))) * 0.0625;
AswinSivakumar 0:9c9e8aaad4ff 68
AswinSivakumar 0:9c9e8aaad4ff 69 }
AswinSivakumar 0:9c9e8aaad4ff 70
AswinSivakumar 0:9c9e8aaad4ff 71
AswinSivakumar 0:9c9e8aaad4ff 72
AswinSivakumar 0:9c9e8aaad4ff 73