Implement sensor fusion algorithm based on LSM9DS1 IMU.
Fork of LSM9DS1_project by
main.cpp
- Committer:
- beanmachine44
- Date:
- 2015-10-19
- Revision:
- 0:9632b831b6c1
- Child:
- 1:b1562831bbaf
File content as of revision 0:9632b831b6c1:
// LSM9DS91 Demo #include "mbed.h" #include "LSM9DS1.h" // refresh time. set to 500 for part 2 and 50 for part 4 #define REFRESH_TIME_MS 1000 // Verify that the pin assignments below match your breadboard LSM9DS1 imu(p9, p10); Serial pc(USBTX, USBRX); //Init Serial port and LSM9DS1 chip void setup() { // Use the begin() function to initialize the LSM9DS0 library. // You can either call it with no parameters (the easy way): uint16_t status = imu.begin(); //Make sure communication is working pc.printf("LSM9DS1 WHO_AM_I's returned: 0x%X\r\n", status); pc.printf("Should be 0x683D\r\n"); } int main() { setup(); //Setup sensor and Serial pc.printf("------ LSM9DS1 Demo -----------\r\n"); while (true) { imu.readAccel(); pc.printf("A: %2f, %2f, %2f\r\n", imu.ax, imu.ay, imu.az); imu.readGyro(); pc.printf("G: %2f, %2f, %2f\r\n", imu.gx, imu.gy, imu.gz); imu.readMag(); pc.printf("M: %2f, %2f, %2f\r\n\r\n", imu.mx, imu.my, imu.mz); wait_ms(REFRESH_TIME_MS); } }