test
FXOS8700.cpp@3:d6a5dcde8ed9, 2017-04-24 (annotated)
- Committer:
- AswinSivakumar
- Date:
- Mon Apr 24 19:07:44 2017 +0000
- Revision:
- 3:d6a5dcde8ed9
- Parent:
- 2:98ea52282575
- Child:
- 5:38ace6067c7d
updated
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
AswinSivakumar | 3:d6a5dcde8ed9 | 1 | /* |
AswinSivakumar | 3:d6a5dcde8ed9 | 2 | * Copyright (c) 2015 - 2016, Freescale Semiconductor, Inc. |
AswinSivakumar | 3:d6a5dcde8ed9 | 3 | * Copyright 2016-2017 NXP |
AswinSivakumar | 3:d6a5dcde8ed9 | 4 | * |
AswinSivakumar | 3:d6a5dcde8ed9 | 5 | * Redistribution and use in source and binary forms, with or without modification, |
AswinSivakumar | 3:d6a5dcde8ed9 | 6 | * are permitted provided that the following conditions are met: |
AswinSivakumar | 3:d6a5dcde8ed9 | 7 | * |
AswinSivakumar | 3:d6a5dcde8ed9 | 8 | * o Redistributions of source code must retain the above copyright notice, this list |
AswinSivakumar | 3:d6a5dcde8ed9 | 9 | * of conditions and the following disclaimer. |
AswinSivakumar | 3:d6a5dcde8ed9 | 10 | * |
AswinSivakumar | 3:d6a5dcde8ed9 | 11 | * o Redistributions in binary form must reproduce the above copyright notice, this |
AswinSivakumar | 3:d6a5dcde8ed9 | 12 | * list of conditions and the following disclaimer in the documentation and/or |
AswinSivakumar | 3:d6a5dcde8ed9 | 13 | * other materials provided with the distribution. |
AswinSivakumar | 3:d6a5dcde8ed9 | 14 | * |
AswinSivakumar | 3:d6a5dcde8ed9 | 15 | * o Neither the name of the copyright holder nor the names of its |
AswinSivakumar | 3:d6a5dcde8ed9 | 16 | * contributors may be used to endorse or promote products derived from this |
AswinSivakumar | 3:d6a5dcde8ed9 | 17 | * software without specific prior written permission. |
AswinSivakumar | 3:d6a5dcde8ed9 | 18 | * |
AswinSivakumar | 3:d6a5dcde8ed9 | 19 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
AswinSivakumar | 3:d6a5dcde8ed9 | 20 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
AswinSivakumar | 3:d6a5dcde8ed9 | 21 | * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
AswinSivakumar | 3:d6a5dcde8ed9 | 22 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR |
AswinSivakumar | 3:d6a5dcde8ed9 | 23 | * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
AswinSivakumar | 3:d6a5dcde8ed9 | 24 | * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
AswinSivakumar | 3:d6a5dcde8ed9 | 25 | * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON |
AswinSivakumar | 3:d6a5dcde8ed9 | 26 | * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
AswinSivakumar | 3:d6a5dcde8ed9 | 27 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
AswinSivakumar | 3:d6a5dcde8ed9 | 28 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
AswinSivakumar | 3:d6a5dcde8ed9 | 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 |