IMU Kalman Filter

Dependencies:   mbed

Fork of frdm_serial_K64F by Mechatronics

Revision:
10:444b09c1798d
Parent:
9:3694ca4b48a7
--- a/main.cpp	Mon Dec 08 13:28:17 2014 +0000
+++ b/main.cpp	Fri Feb 06 13:36:54 2015 +0000
@@ -6,7 +6,7 @@
 //DigitalOut myled(LED_RED);
 Serial pc(USBTX, USBRX);
 
-IMU imu(PTE25,PTE24);
+IMU imu(PTC2,PTC1);
 
 KalmanFilter kf;
 
@@ -63,9 +63,9 @@
         // Then the float is encoded from the string and put into some array until all lines are processed.
         // The array elemnts are sent to the Waveform Chart to plot the data.
         // Using that syntax below, three series will be ploted.
-        // pc.printf("%f\n%f\n%f\r", D[3],D[4],D[5]); //accelerations [m/s^2] from accel
-        //pc.printf("%f\n%f\n%f\r", D[0],D[1],D[2]); //angular velocitites [rad/s] from gyro
-        //pc.printf("%f\n%f\n%f\r", D[6],D[7],D[8]); //angle [rad] from magneto
+        pc.printf("%f\n%f\n%f\r", D[3],D[4],D[5]); //accelerations [m/s^2] from accel
+        pc.printf("%f\n%f\n%f\r", D[0],D[1],D[2]); //angular velocitites [rad/s] from gyro
+        pc.printf("%f\n%f\n%f\r", D[6],D[7],D[8]); //angle [rad] from magneto
         //
         //myled = !myled; // toggle a led
     }