
FRDM-FXS-MULTI2-B-Stream sensor data using FRDM-KL25Z
Dependencies: FXOS8700_FXAS21002 mbed MAG3110 MMA8652FC MPL3115A2
Fork of FRDM-FXS-MULTI2-B_SensorShield_HelloWorld by
main.cpp@3:d44d1be939db, 2017-04-26 (annotated)
- Committer:
- AswinSivakumar
- Date:
- Wed Apr 26 00:21:22 2017 +0000
- Revision:
- 3:d44d1be939db
- Parent:
- 1:d8ca07afb3ec
updated
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
AswinSivakumar | 3:d44d1be939db | 1 | /* |
AswinSivakumar | 3:d44d1be939db | 2 | * Copyright (c) 2015 - 2016, Freescale Semiconductor, Inc. |
AswinSivakumar | 3:d44d1be939db | 3 | * Copyright 2016-2017 NXP |
AswinSivakumar | 3:d44d1be939db | 4 | * |
AswinSivakumar | 3:d44d1be939db | 5 | * Redistribution and use in source and binary forms, with or without modification, |
AswinSivakumar | 3:d44d1be939db | 6 | * are permitted provided that the following conditions are met: |
AswinSivakumar | 3:d44d1be939db | 7 | * |
AswinSivakumar | 3:d44d1be939db | 8 | * o Redistributions of source code must retain the above copyright notice, this list |
AswinSivakumar | 3:d44d1be939db | 9 | * of conditions and the following disclaimer. |
AswinSivakumar | 3:d44d1be939db | 10 | * |
AswinSivakumar | 3:d44d1be939db | 11 | * o Redistributions in binary form must reproduce the above copyright notice, this |
AswinSivakumar | 3:d44d1be939db | 12 | * list of conditions and the following disclaimer in the documentation and/or |
AswinSivakumar | 3:d44d1be939db | 13 | * other materials provided with the distribution. |
AswinSivakumar | 3:d44d1be939db | 14 | * |
AswinSivakumar | 3:d44d1be939db | 15 | * o Neither the name of the copyright holder nor the names of its |
AswinSivakumar | 3:d44d1be939db | 16 | * contributors may be used to endorse or promote products derived from this |
AswinSivakumar | 3:d44d1be939db | 17 | * software without specific prior written permission. |
AswinSivakumar | 3:d44d1be939db | 18 | * |
AswinSivakumar | 3:d44d1be939db | 19 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
AswinSivakumar | 3:d44d1be939db | 20 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
AswinSivakumar | 3:d44d1be939db | 21 | * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
AswinSivakumar | 3:d44d1be939db | 22 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR |
AswinSivakumar | 3:d44d1be939db | 23 | * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
AswinSivakumar | 3:d44d1be939db | 24 | * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
AswinSivakumar | 3:d44d1be939db | 25 | * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON |
AswinSivakumar | 3:d44d1be939db | 26 | * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
AswinSivakumar | 3:d44d1be939db | 27 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
AswinSivakumar | 3:d44d1be939db | 28 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
AswinSivakumar | 3:d44d1be939db | 29 | */ |
AswinSivakumar | 0:6b858a805a38 | 30 | #include "FXAS21002.h" |
AswinSivakumar | 0:6b858a805a38 | 31 | #include "FXOS8700.h" |
AswinSivakumar | 1:d8ca07afb3ec | 32 | #include "MAG3110.h" |
AswinSivakumar | 1:d8ca07afb3ec | 33 | #include "MMA8652.h" |
AswinSivakumar | 1:d8ca07afb3ec | 34 | #include "MPL3115.h" |
AswinSivakumar | 0:6b858a805a38 | 35 | #include "mbed.h" |
AswinSivakumar | 0:6b858a805a38 | 36 | |
AswinSivakumar | 0:6b858a805a38 | 37 | // Initialize Serial port |
AswinSivakumar | 0:6b858a805a38 | 38 | Serial pc(USBTX, USBRX); |
AswinSivakumar | 0:6b858a805a38 | 39 | |
AswinSivakumar | 0:6b858a805a38 | 40 | // Initialize pins for I2C communication for sensors. Set jumpers J6,J7 in FRDM-STBC-AGM01 board accordingly. |
AswinSivakumar | 0:6b858a805a38 | 41 | FXOS8700 accel(D14,D15); |
AswinSivakumar | 0:6b858a805a38 | 42 | FXOS8700 mag(D14,D15); |
AswinSivakumar | 0:6b858a805a38 | 43 | FXAS21002 gyro(D14,D15); |
AswinSivakumar | 1:d8ca07afb3ec | 44 | MAG3110 mag3110(D14,D15); |
AswinSivakumar | 1:d8ca07afb3ec | 45 | MMA8652 mma8652(D14,D15); |
AswinSivakumar | 1:d8ca07afb3ec | 46 | MPL3115 mpl3115(D14,D15); |
AswinSivakumar | 0:6b858a805a38 | 47 | |
AswinSivakumar | 1:d8ca07afb3ec | 48 | |
AswinSivakumar | 1:d8ca07afb3ec | 49 | |
AswinSivakumar | 0:6b858a805a38 | 50 | int main() |
AswinSivakumar | 0:6b858a805a38 | 51 | { |
AswinSivakumar | 1:d8ca07afb3ec | 52 | |
AswinSivakumar | 1:d8ca07afb3ec | 53 | // Configure Accelerometer FXOS8700, Magnetometer FXOS8700 & Gyroscope FXAS21002 |
AswinSivakumar | 0:6b858a805a38 | 54 | accel.accel_config(); |
AswinSivakumar | 0:6b858a805a38 | 55 | mag.mag_config(); |
AswinSivakumar | 0:6b858a805a38 | 56 | gyro.gyro_config(); |
AswinSivakumar | 1:d8ca07afb3ec | 57 | mag3110.MAG3110_config(); |
AswinSivakumar | 1:d8ca07afb3ec | 58 | mma8652.MMA8652_config(); |
AswinSivakumar | 1:d8ca07afb3ec | 59 | mpl3115.MPL3115_config(); |
AswinSivakumar | 1:d8ca07afb3ec | 60 | |
AswinSivakumar | 1:d8ca07afb3ec | 61 | |
AswinSivakumar | 0:6b858a805a38 | 62 | float accel_data[3]; float accel_rms=0.0; |
AswinSivakumar | 0:6b858a805a38 | 63 | float mag_data[3]; float mag_rms=0.0; |
AswinSivakumar | 0:6b858a805a38 | 64 | float gyro_data[3]; float gyro_rms=0.0; |
AswinSivakumar | 1:d8ca07afb3ec | 65 | float alt_data[3]; float alt_rms=0.0; |
AswinSivakumar | 0:6b858a805a38 | 66 | |
AswinSivakumar | 1:d8ca07afb3ec | 67 | printf("Begin Data Acquisition....\r\n\r\n"); |
AswinSivakumar | 0:6b858a805a38 | 68 | wait(0.5); |
AswinSivakumar | 0:6b858a805a38 | 69 | |
AswinSivakumar | 0:6b858a805a38 | 70 | while(1) |
AswinSivakumar | 0:6b858a805a38 | 71 | { |
AswinSivakumar | 0:6b858a805a38 | 72 | accel.acquire_accel_data_g(accel_data); |
AswinSivakumar | 0:6b858a805a38 | 73 | accel_rms = sqrt(((accel_data[0]*accel_data[0])+(accel_data[1]*accel_data[1])+(accel_data[2]*accel_data[2]))/3); |
AswinSivakumar | 1:d8ca07afb3ec | 74 | printf("%4.2f,%4.2f,%4.2f,\t",accel_data[0],accel_data[1],accel_data[2]); |
AswinSivakumar | 0:6b858a805a38 | 75 | wait(0.005); |
AswinSivakumar | 0:6b858a805a38 | 76 | |
AswinSivakumar | 1:d8ca07afb3ec | 77 | // mma8652.acquire_MMA8652_data_g(accel_data); |
AswinSivakumar | 1:d8ca07afb3ec | 78 | // accel_rms = sqrt(((accel_data[0]*accel_data[0])+(accel_data[1]*accel_data[1])+(accel_data[2]*accel_data[2]))/3); |
AswinSivakumar | 1:d8ca07afb3ec | 79 | // printf("%4.2f,%4.2f,%4.2f,\t",accel_data[0],accel_data[1],accel_data[2]); |
AswinSivakumar | 1:d8ca07afb3ec | 80 | // wait(0.005); |
AswinSivakumar | 1:d8ca07afb3ec | 81 | |
AswinSivakumar | 1:d8ca07afb3ec | 82 | // mag.acquire_mag_data_uT(mag_data); |
AswinSivakumar | 1:d8ca07afb3ec | 83 | // printf("%4.2f,\t%4.2f,\t%4.2f,\t",mag_data[0],mag_data[1],mag_data[2]); |
AswinSivakumar | 1:d8ca07afb3ec | 84 | // mag_rms = sqrt(((mag_data[0]*mag_data[0])+(mag_data[1]*mag_data[1])+(mag_data[2]*mag_data[2]))/3); |
AswinSivakumar | 1:d8ca07afb3ec | 85 | // wait(0.005); |
AswinSivakumar | 1:d8ca07afb3ec | 86 | |
AswinSivakumar | 1:d8ca07afb3ec | 87 | mag3110.acquire_MAG3110_data_uT(mag_data); |
AswinSivakumar | 1:d8ca07afb3ec | 88 | printf("%f,%f,%f,\t",mag_data[0],mag_data[1],mag_data[2]); |
AswinSivakumar | 0:6b858a805a38 | 89 | mag_rms = sqrt(((mag_data[0]*mag_data[0])+(mag_data[1]*mag_data[1])+(mag_data[2]*mag_data[2]))/3); |
AswinSivakumar | 0:6b858a805a38 | 90 | wait(0.005); |
AswinSivakumar | 0:6b858a805a38 | 91 | |
AswinSivakumar | 0:6b858a805a38 | 92 | gyro.acquire_gyro_data_dps(gyro_data); |
AswinSivakumar | 1:d8ca07afb3ec | 93 | printf("%4.2f,%4.2f,%4.2f,",gyro_data[0],gyro_data[1],gyro_data[2]); |
AswinSivakumar | 0:6b858a805a38 | 94 | gyro_rms = sqrt(((gyro_data[0]*gyro_data[0])+(gyro_data[1]*gyro_data[1])+(gyro_data[2]*gyro_data[2]))/3); |
AswinSivakumar | 0:6b858a805a38 | 95 | wait(0.005); |
AswinSivakumar | 0:6b858a805a38 | 96 | |
AswinSivakumar | 1:d8ca07afb3ec | 97 | mpl3115.acquire_MPL3115_data_Altitude_in_m(alt_data); |
AswinSivakumar | 1:d8ca07afb3ec | 98 | printf("\t%f",alt_data[0]); |
AswinSivakumar | 1:d8ca07afb3ec | 99 | alt_rms = sqrt(((alt_data[0]*alt_data[0])+(alt_data[1]*alt_data[1])+(alt_data[2]*alt_data[2]))/3); |
AswinSivakumar | 1:d8ca07afb3ec | 100 | wait(0.005); |
AswinSivakumar | 1:d8ca07afb3ec | 101 | |
AswinSivakumar | 1:d8ca07afb3ec | 102 | printf("\n\r"); |
AswinSivakumar | 1:d8ca07afb3ec | 103 | |
AswinSivakumar | 1:d8ca07afb3ec | 104 | |
AswinSivakumar | 0:6b858a805a38 | 105 | } |
AswinSivakumar | 0:6b858a805a38 | 106 | |
AswinSivakumar | 0:6b858a805a38 | 107 | } |