ARES / Mbed 2 deprecated Robot 2015

Robot's source code

Dependencies:   mbed

Diff: main.cpp

Revision:
0:41149573d577
Child:
3:573a0dc8383f
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Sun Sep 28 19:53:31 2014 +0000
@@ -0,0 +1,20 @@
+#include "mbed.h"
+#include "QEI.h"
+#include "Odometry.h"
+
+
+int main()
+{
+    QEI qei_left(p15,p16,NC,1024,QEI::X4_ENCODING);
+    QEI qei_right(p17,p18,NC,1024,QEI::X4_ENCODING);
+    
+    Odometry odometry(&qei_left,&qei_right,0.07,0.07,0.26);
+    
+    Serial pc(USBTX, USBRX); // tx, rx
+    
+    while(1)
+    {
+        wait(1);
+        pc.printf("%f : %f : %f\n",odometry.getX()*100,odometry.getY()*100,odometry.getTheta()*180/3.14);
+    }
+}