![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
dad
Dependencies: mbed-os FXAS21000 LED_Bar FXOS8700Q
main.cpp
- Committer:
- mukundy8
- Date:
- 2022-03-07
- Revision:
- 1:7a49fd0692fd
- Parent:
- 0:838685d68d89
- Child:
- 2:d08625231a9f
File content as of revision 1:7a49fd0692fd:
#include "mbed.h" #include "FXOS8700Q.h" #include "FXAS21000.h" I2C i2c(PTE25, PTE24); Serial pc(USBTX,USBRX); FXOS8700QAccelerometer acc(i2c, FXOS8700CQ_SLAVE_ADDR1); // Configured for the FRDM-K64F with onboard sensors FXOS8700QMagnetometer mag(i2c, FXOS8700CQ_SLAVE_ADDR1); FXAS21000 gyro(D14,D15); int main(void) { float gyro_data[3]; motion_data_units_t acc_data, mag_data; motion_data_counts_t acc_raw, mag_raw; float faX, faY, faZ, fmX, fmY, fmZ, tmp_float; int16_t raX, raY, raZ, rmX, rmY, rmZ, tmp_int; acc.enable(); mag.enable(); DigitalOut Red(LED1); Red=1; DigitalOut Blue(LED3); DigitalOut Green(LED2); Blue=1; Green=1; while (true) { // counts based results acc.getAxis(acc_raw); mag.getAxis(mag_raw); acc.getX(raX); acc.getY(raY); acc.getZ(raZ); mag.getX(rmX); mag.getY(rmY); mag.getZ(rmZ); // unit based results acc.getAxis(acc_data); mag.getAxis(mag_data); acc.getX(faX); acc.getY(faY); acc.getZ(faZ); mag.getX(fmX); mag.getY(fmY); mag.getZ(fmZ); pc.printf("FXOSQ8700Q ACC: X=%1.4f Y=%1.4f Z=%1.4f", acc.getX(faX),acc.getY(faY),acc.getZ(faZ)); pc.printf(" MAG: X=%4.1f Y=%4.1f Z=%4.1f\r\n", mag.getX(fmX),mag.getY(fmY), mag.getZ(fmZ)); gyro.ReadXYZ(gyro_data); pc.printf("FXAS21000 Gyro: X=%6.2f Y=%6.2f Z=%6.2f\r\n", gyro_data[0],gyro_data[1], gyro_data[2]); if(abs(acc.getX(faX)) > 1.5 || abs(acc.getZ(faZ)) > 1.3 || abs(acc.getY(faY)) > 0.1) { Red = 0; Blue = 1; Green = 1; } else{ Red = 1; Green = 0; Blue = 1; }; wait(1.0f); } }