main.cpp

00001 #include "mbed.h"
00002 #include "FXOS8700Q.h"
00003 
00004 
00005 //FXOS8700Q acc( A4, A5, FXOS8700CQ_SLAVE_ADDR0); // Proper Ports and I2C address for Freescale Multi Axis shield
00006 //FXOS8700Q mag( A4, A5, FXOS8700CQ_SLAVE_ADDR0); // Proper Ports and I2C address for Freescale Multi Axis shield
00007 //FXOS8700Q_acc acc( PTE25, PTE24, FXOS8700CQ_SLAVE_ADDR1); // Proper Ports and I2C Address for K64F Freedom board
00008 FXOS8700Q_mag mag( PTE25, PTE24, FXOS8700CQ_SLAVE_ADDR1); // Proper Ports and I2C Address for K64F Freedom board
00009 
00010 Serial pc(USBTX, USBRX);
00011 
00012 MotionSensorDataUnits mag_data;
00013 //MotionSensorDataUnits acc_data;
00014 
00015 MotionSensorDataCounts mag_raw;
00016 //MotionSensorDataCounts acc_raw;
00017 
00018 
00019 int main() {
00020 //float faX, faY, faZ;
00021 float fmX, fmY, fmZ;
00022 //int16_t raX, raY, raZ;
00023 int16_t rmX, rmY, rmZ;
00024 pc.baud(230400);
00025 mag.enable();
00026 //printf("\r\n\nFXOS8700Q Who Am I= %X\r\n", acc.whoAmI());
00027     while (true) {
00028         //acc.getAxis(acc_data);
00029         mag.getAxis(mag_data);
00030         //printf("FXOS8700Q ACC: X=%1.4f Y=%1.4f Z=%1.4f  ", acc_data.x, acc_data.y, acc_data.z);
00031         printf("MAG: X=%4.1f Y=%4.1f Z=%4.1f\r\n", mag_data.x, mag_data.y, mag_data.z);
00032         /*
00033         acc.getX(&faX);
00034         acc.getY(&faY);
00035         acc.getZ(&faZ);
00036         */
00037         mag.getX(&fmX);
00038         mag.getY(&fmY);
00039         mag.getZ(&fmZ);
00040         //printf("FXOS8700Q ACC: X=%1.4f Y=%1.4f Z=%1.4f  ", faX, faY, faZ);
00041         printf("MAG: X=%4.1f Y=%4.1f Z=%4.1f\r\n", fmX, fmY, fmZ);
00042         //acc.getAxis(acc_raw);
00043         mag.getAxis(mag_raw);
00044         //printf("FXOS8700Q ACC: X=%d Y=%d Z=%d  ", acc_raw.x, acc_raw.y, acc_raw.z);
00045         printf("MAG: X=%d Y=%d Z=%d\r\n", mag_raw.x, mag_raw.y, mag_raw.z);
00046         /*
00047         acc.getX(&raX);
00048         acc.getY(&raY);
00049         acc.getZ(&raZ);
00050         */
00051         mag.getX(&rmX);
00052         mag.getY(&rmY);
00053         mag.getZ(&rmZ);                
00054         //printf("FXOS8700Q ACC: X=%d Y=%d Z=%d  ", raX, raY, raZ);
00055         printf("MAG: X=%d Y=%d Z=%d\r\n\n", rmX, rmY, rmZ);    
00056         wait(1.0);
00057     }
00058 }