UCR Robosub manual control / PID tuning interface

Dependencies:   mbed HMC5883L

Revision:
1:3f291f2f80d3
Parent:
0:048a74dd7c3a
--- a/Sensors/IMU.h	Sat Jul 22 05:58:03 2017 +0000
+++ b/Sensors/IMU.h	Thu Jul 27 05:45:10 2017 +0000
@@ -117,7 +117,7 @@
     gz *= PI/180.0f;
     
     // Calculate position if time
-    mpu6050.getDisplacement(ax,ay);
+    //mpu6050.getDisplacement(ax,ay);
 
     // Pass gyro rate as rad/s
     mpu6050.MadgwickQuaternionUpdate(ax, ay, az, gx, gy, gz, magdata[0], magdata[1], magdata[2]);