IMU and knee angle. No servo yet

Dependencies:   mbed

Fork of FYDP_Final2 by Dave Lu

Revision:
6:b3baf0fe5b73
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/robot.cpp	Wed Mar 25 11:40:32 2015 +0000
@@ -0,0 +1,14 @@
+#include "robot.h"
+
+DigitalOut led(LED_PIN);
+
+MPU6050 mpu;
+MPU6051 mpu2;
+DigitalOut imuSwitch(IMU_POWER_PIN);
+DigitalOut imu2Switch(IMU2_POWER_PIN);
+IMU_DATA imu_data;
+IMU_DATA imu2_data;
+
+Timer t;
+
+float getTime() { return (float)(t.read_us())/1000000; }
\ No newline at end of file