main.cpp

00001 
00002 
00003 #include "mbed.h"
00004 #include "FXOS8700Q.h"
00005 
00006 Serial pc(USBTX, USBRX);
00007 I2C i2c(PTE25, PTE24);
00008 //FXOS8700Q fxos(i2c, FXOS8700CQ_SLAVE_ADDR1);
00009 FXOS8700QAccelerometer acc(i2c, FXOS8700CQ_SLAVE_ADDR1);    // Configured for the FRDM-K64F with onboard sensors
00010 FXOS8700QMagnetometer mag(i2c, FXOS8700CQ_SLAVE_ADDR1);
00011 //FXOS8700QAccelerometer acc(i2c, FXOS8700CQ_SLAVE_ADDR0);    // Configured for use with the FRDM-MULTI shield
00012 //FXOS8700QMagnetometer mag(i2c, FXOS8700CQ_SLAVE_ADDR0);
00013 
00014 
00015 int main(void)
00016 {
00017     motion_data_units_t acc_data, mag_data;
00018     motion_data_counts_t acc_raw, mag_raw;
00019     float faX, faY, faZ, fmX, fmY, fmZ, tmp_float;
00020     int16_t raX, raY, raZ, rmX, rmY, rmZ, tmp_int;
00021 
00022     acc.enable();
00023     mag.enable();
00024     printf("FXOS8700QAccelerometro = %X\r\n", acc.whoAmI());
00025     printf("FXOS8700QMagnetometro = %X\r\n", acc.whoAmI());
00026     while (true) {
00027         
00028         acc.getAxis(acc_raw);
00029         mag.getAxis(mag_raw);
00030         printf("ACC: X=%06dd Y=%06dd Z=%06dd \t MAG: X=%06dd Y=%06dd Z=%06dd\r\n", acc_raw.x, acc_raw.y, acc_raw.z, mag_raw.x, mag_raw.y, mag_raw.z);
00031         acc.getX(raX);
00032         acc.getY(raY);
00033         acc.getZ(raZ);
00034         mag.getX(rmX);
00035         mag.getY(rmY);
00036         mag.getZ(rmZ);
00037         printf("ACC: X=%06dd Y=%06dd Z=%06dd \t MAG: X=%06dd Y=%06dd Z=%06dd\r\n", raX, raY, raZ, rmX, rmY, rmZ);
00038         printf("ACC: X=%06dd Y=%06dd Z=%06dd \t MAG: X=%06dd Y=%06dd Z=%06dd\r\n", acc.getX(tmp_int), acc.getY(tmp_int), acc.getZ(tmp_int), mag.getX(tmp_int), mag.getY(tmp_int), mag.getZ(tmp_int));
00039         
00040         acc.getAxis(acc_data);
00041         mag.getAxis(mag_data);
00042         printf("ACC: X=%1.4ff Y=%1.4ff Z=%1.4ff \t MAG: X=%4.1ff Y=%4.1ff Z=%4.1ff\r\n", acc_data.x, acc_data.y, acc_data.z, mag_data.x, mag_data.y, mag_data.z);
00043         acc.getX(faX);
00044         acc.getY(faY);
00045         acc.getZ(faZ);
00046         mag.getX(fmX);
00047         mag.getY(fmY);
00048         mag.getZ(fmZ);
00049         printf("ACC: X=%1.4ff Y=%1.4ff Z=%1.4ff \t MAG: X=%4.1ff Y=%4.1ff Z=%4.1ff\r\n", faX, faY, faZ, fmX, fmY, fmZ);
00050         printf("ACC: X=%1.4ff Y=%1.4ff Z=%1.4ff \t MAG: X=%4.1ff Y=%4.1ff Z=%4.1ff\r\n", acc.getX(tmp_float), acc.getY(tmp_float), acc.getZ(tmp_float), mag.getX(tmp_float), mag.getY(tmp_float), mag.getZ(tmp_float));
00051         puts("");
00052         //wait(5.0f);
00053     }
00054 }