bio robot

Dependencies:   MPU6050-DMP QEI_hw mbed-rpc mbed

Fork of MPU6050_Example by Shundo Kishi

Revision:
15:d88f10b3b5f8
Parent:
13:64d337c5114e
Child:
16:5b19be27f08a
--- a/Controls/Dynamics.h	Wed Dec 09 03:40:38 2015 +0000
+++ b/Controls/Dynamics.h	Thu Dec 10 09:46:56 2015 +0000
@@ -9,11 +9,8 @@
 
 float calcTau(volatile float z[4], float p[10], Gains *gains, Target *target, Serial *pc);
 float thetaDesiredForSwingUp(float rangeMin, float rangeMax, volatile float z[4]);
-float thetaDesiredForTargeting(volatile float z[4]);
+float obstacleAvoidance(volatile float z[4], float p[10], float theta);
 int fix(float val);//round toward zero
 
 
-
-
-
 #endif
\ No newline at end of file