Carlo Collodi / kangaroo

Dependencies:   QEI mbed

Revision:
28:21773a6fb6df
Parent:
26:53b793b7a82f
Child:
29:33c5c61f1068
Child:
35:a4e89e78d034
--- a/Master.cpp	Sun Nov 24 06:02:47 2013 +0000
+++ b/Master.cpp	Sun Nov 24 19:04:01 2013 +0000
@@ -10,15 +10,16 @@
 Motor m1(p15,p17,p18,p21,mEnc1);//hip
 Motor m2(p16,p19,p20,p22,mEnc2);//knee
 
-QEI bEnc1(p25, p26, p27, 1200, QEI::X4_ENCODING);//change pins!!!!!!!!!!!!!!!!!!!!!!!
+QEI bEnc1(p27, p28, p29, 1200, QEI::X4_ENCODING);//change pins!!!!!!!!!!!!!!!!!!!!!!!
 QEI bEnc2(p8, p9, p10, 1200, QEI::X4_ENCODING);//these too
 
-Kangaroo kankan(m1,m2,bEnc1,bEnc2);
+//Kangaroo kankan(m1,m2,bEnc1,bEnc2);
 
 int main() {
     
     while(1){
-        kankan.testEncoders(pc);
-        wait(2);
+        //kankan.testEncoders(pc);
+        pc.printf("m1: %i, enc1:  %i\n",m1.getPos(), mEnc1.getPulses());
+        wait(.5);
     }
 }