
Calibration program for my port of FreeIMU library. Use it with the FreeIMU Cube program or the python calibration program.
Dependencies: FreeIMU mbed-rtos mbed
Diff: main.cpp
- Revision:
- 5:d21e84d6f5a1
- Parent:
- 4:145d1eb8a15d
--- a/main.cpp Wed Mar 28 21:07:33 2018 +0000 +++ b/main.cpp Wed Mar 28 21:24:12 2018 +0000 @@ -92,7 +92,7 @@ if(cmd=='v') { char str[256]; - sprintf(str, "FreeIMU library by %s, FREQ:%s, LIB_VERSION: %s, IMU: %s", FREEIMU_DEVELOPER, 0x10000000, FREEIMU_LIB_VERSION, 0); + sprintf(str, "FreeIMU library by %s, FREQ:%d, LIB_VERSION: %s, IMU: %d", FREEIMU_DEVELOPER, 0x10000000, FREEIMU_LIB_VERSION, 0); pc.printf("%s", str); pc.printf("\r\n"); } @@ -132,12 +132,11 @@ uint8_t count = pc.getc(); for(uint8_t i=0; i<count; i++) { - imu.accgyro->getMotion6(&raw_values[0], &raw_values[1], &raw_values[2], &raw_values[3], &raw_values[4], &raw_values[5]); + imu.accgyro->getMotion9(&raw_values[0], &raw_values[1], &raw_values[2], &raw_values[3], &raw_values[4], &raw_values[5], &raw_values[6], &raw_values[7], &raw_values[8]); writeArr(raw_values, 6, sizeof(int16_t)); // writes accelerometer and gyro values - imu.magn->getValues(&raw_values[0], &raw_values[1], &raw_values[2]); - writeArr(raw_values, 3, sizeof(int16_t)); // write magnetometer values + writeArr(&raw_values[6], 3, sizeof(int16_t)); // write magnetometer values pc.printf("\r\n"); Thread::wait(4);