main.cpp

00001 /*
00002  * Copyright (c) 2015 - 2016, Freescale Semiconductor, Inc.
00003  * Copyright 2016-2017 NXP
00004  *
00005  * Redistribution and use in source and binary forms, with or without modification,
00006  * are permitted provided that the following conditions are met:
00007  *
00008  * o Redistributions of source code must retain the above copyright notice, this list
00009  *   of conditions and the following disclaimer.
00010  *
00011  * o Redistributions in binary form must reproduce the above copyright notice, this
00012  *   list of conditions and the following disclaimer in the documentation and/or
00013  *   other materials provided with the distribution.
00014  *
00015  * o Neither the name of the copyright holder nor the names of its
00016  *   contributors may be used to endorse or promote products derived from this
00017  *   software without specific prior written permission.
00018  *
00019  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
00020  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
00021  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
00022  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
00023  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
00024  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
00025  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
00026  * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
00027  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
00028  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
00029  */
00030 #include "FXAS21002.h"
00031 #include "FXOS8700.h"  
00032 #include "MPL3115.h" 
00033 #include "mbed.h"
00034 
00035 // Initialize Serial port
00036 Serial pc(USBTX, USBRX);
00037 
00038 // Initialize pins for I2C communication for sensors. Set jumpers J6,J7 in FRDM-STBC-AGM01 board accordingly.
00039 FXOS8700 accel(PTC2,PTC1);
00040 FXOS8700 mag(PTC2,PTC1);
00041 FXAS21002 gyro(PTC2,PTC1);
00042 MPL3115 mpl3115(PTC2,PTC1);
00043 
00044 
00045     
00046 int main()
00047 {
00048 
00049 // Configure Accelerometer FXOS8700, Magnetometer FXOS8700 & Gyroscope FXAS21002
00050     accel.accel_config();
00051     mag.mag_config();
00052     gyro.gyro_config();
00053     mpl3115.MPL3115_config();
00054  
00055     
00056     float accel_data[3]; float accel_rms=0.0;
00057     float mag_data[3];   float mag_rms=0.0;
00058     float gyro_data[3];  float gyro_rms=0.0;
00059     float alt_data[3];  float alt_rms=0.0;
00060        
00061     printf("Begin Data Acquisition....\r\n\r\n");
00062     wait(0.5);
00063     
00064     while(1)
00065     {
00066       accel.acquire_accel_data_g(accel_data);
00067       accel_rms = sqrt(((accel_data[0]*accel_data[0])+(accel_data[1]*accel_data[1])+(accel_data[2]*accel_data[2]))/3);
00068       printf("%4.2f,%4.2f,%4.2f,\t",accel_data[0],accel_data[1],accel_data[2]);
00069       wait(0.005);
00070       
00071          
00072       mag.acquire_mag_data_uT(mag_data);
00073       printf("%4.2f,%4.2f,%4.2f,\t",mag_data[0],mag_data[1],mag_data[2]);
00074       mag_rms = sqrt(((mag_data[0]*mag_data[0])+(mag_data[1]*mag_data[1])+(mag_data[2]*mag_data[2]))/3);
00075       wait(0.005);
00076 
00077      
00078       gyro.acquire_gyro_data_dps(gyro_data);
00079       printf("%4.2f,%4.2f,%4.2f,",gyro_data[0],gyro_data[1],gyro_data[2]);
00080       gyro_rms = sqrt(((gyro_data[0]*gyro_data[0])+(gyro_data[1]*gyro_data[1])+(gyro_data[2]*gyro_data[2]))/3);
00081       wait(0.005);
00082       
00083       mpl3115.acquire_MPL3115_data_Altitude_in_m(alt_data);
00084       printf("\t%f",alt_data[0]);
00085       alt_rms = sqrt(((alt_data[0]*alt_data[0])+(alt_data[1]*alt_data[1])+(alt_data[2]*alt_data[2]))/3);
00086       wait(0.005);
00087     
00088       wait(1);  
00089       printf("\n\r");
00090    
00091       
00092      }
00093       
00094 }