Project Paint / Mbed 2 deprecated arm_control

Dependencies:   mbed QEI biquadFilter

Revision:
2:fc869e45e672
Parent:
0:494acf21d3bc
Child:
7:a80cb6b06320
--- a/geometry.cpp	Mon Oct 31 13:05:53 2016 +0000
+++ b/geometry.cpp	Wed Nov 02 08:51:12 2016 +0000
@@ -1,22 +1,5 @@
-#include "math.h"
-
-/*
-    Constants
-*/
-
-const float L_max = 50.0;   // Max arm length
-const float L_min = 30.0;   // Min arm length
-
-const float d = 30.0;       // Distance between arm centres of rotation 
-const float h = 30.0;       // Height of lower arm centre of rotation                       TODO -- Determine
-
-const float reach = 2*sqrt(pow(L_max,2)-pow(L_min,2))-d;    // Total length of wall that can be covered
-
-const float y_max = (2*h + d)/2 + reach/2;
-const float y_min = (2*h + d)/2 - reach/2;
-
-const float x_min = L_min;
-const float x_max = 0;                                                                          // TODO
+#include "math.h" 
+#include "geometry.h"  
 
 /*
     Methods