Robot's source code

Dependencies:   mbed

Committer:
Jagang
Date:
Sun Sep 28 19:53:31 2014 +0000
Revision:
0:41149573d577
Child:
3:573a0dc8383f
New

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jagang 0:41149573d577 1 #include "mbed.h"
Jagang 0:41149573d577 2 #include "QEI.h"
Jagang 0:41149573d577 3 #include "Odometry.h"
Jagang 0:41149573d577 4
Jagang 0:41149573d577 5
Jagang 0:41149573d577 6 int main()
Jagang 0:41149573d577 7 {
Jagang 0:41149573d577 8 QEI qei_left(p15,p16,NC,1024,QEI::X4_ENCODING);
Jagang 0:41149573d577 9 QEI qei_right(p17,p18,NC,1024,QEI::X4_ENCODING);
Jagang 0:41149573d577 10
Jagang 0:41149573d577 11 Odometry odometry(&qei_left,&qei_right,0.07,0.07,0.26);
Jagang 0:41149573d577 12
Jagang 0:41149573d577 13 Serial pc(USBTX, USBRX); // tx, rx
Jagang 0:41149573d577 14
Jagang 0:41149573d577 15 while(1)
Jagang 0:41149573d577 16 {
Jagang 0:41149573d577 17 wait(1);
Jagang 0:41149573d577 18 pc.printf("%f : %f : %f\n",odometry.getX()*100,odometry.getY()*100,odometry.getTheta()*180/3.14);
Jagang 0:41149573d577 19 }
Jagang 0:41149573d577 20 }