IMU and knee angle. No servo yet

Dependencies:   mbed

Fork of FYDP_Final2 by Dave Lu

Revision:
10:22c44650c7c1
Parent:
9:7a8fb72f9a93
Child:
11:425dff6a4af9
--- a/Control/control.cpp	Wed Mar 25 14:34:23 2015 +0000
+++ b/Control/control.cpp	Wed Mar 25 16:36:11 2015 +0000
@@ -3,6 +3,7 @@
 #include "State.hpp"
 #include "Sensor.hpp"
 #include "io.h"
+#include "rtos.h"
 
 State state;
 
@@ -24,7 +25,7 @@
    state.state = State::UNCALIBRATED;
    state.onSwing(&onStopToSwing);
    state.onMaybe(&onStopToMaybe);
-//   actuator.setPeriod(2);
+   actuator.setPeriod(2);
 }
 
 void process() {