Amanda Ghassaei / Mbed 2 deprecated Bracky-MPU6050-DMP

bio robot

Dependencies:   MPU6050-DMP QEI_hw mbed-rpc mbed

Fork of MPU6050_Example by Shundo Kishi

Diff: Controls/Target.h

Revision:
15:d88f10b3b5f8
Parent:
12:49813131dd15
Child:
16:5b19be27f08a
--- a/Controls/Target.h	Wed Dec 09 03:40:38 2015 +0000
+++ b/Controls/Target.h	Thu Dec 10 09:46:56 2015 +0000
@@ -22,6 +22,7 @@
         }
     
         void setPosition(int position, float p[10]){
+            if (position != 4 && position != 6) position = 6;
             _position = position;
             _th1Final = finalAngleTh1(position, p[0]);//p[0] = linkLength
             _th2Final = finalAngleTh2(position, p[0]);