Impact-Echo
/
Magnetometer_FXOS8700Q
working magnetometer and accelerometer
Fork of Hello_FXOS8700Q by
Embed:
(wiki syntax)
Show/hide line numbers
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 }
Generated on Thu Jul 14 2022 21:27:19 by 1.7.2