Carlo Collodi / kangaroo

Dependencies:   QEI mbed

Revision:
57:dfea5d24d650
Parent:
56:7015e2e79ea7
Child:
58:c0b09adb2997
--- a/src/kangaroo.cpp	Tue Dec 03 02:49:30 2013 +0000
+++ b/src/kangaroo.cpp	Tue Dec 03 10:01:18 2013 +0000
@@ -64,7 +64,9 @@
     //pc.printf("hello world\n");
     //pc.printf("x: %f   y: %f\n", getPoint().x, getPoint().y);
     
-    pc.printf("m1: %f  m2:  %f\n",dt1, dt2);
+    pc.printf("t1: %f  t2: %f b1: %f  b2: %f \n",m1.getAngle(), m2.getAngle(), getAngle1(), getAngle2());
+    
+    //pc.printf("m1: %f  m2:  %f\n",dt1, dt2);
 }
 
 int Kangaroo::landDetection(){
@@ -86,7 +88,7 @@
 }
 
 float Kangaroo::getAngle2(){
-    return (enc2.getAngle())-1.65;
+    return (enc2.getAngle())-1.65;//-1.65
 }