![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Robot's source code
Dependencies: mbed
main.cpp@0:41149573d577, 2014-09-28 (annotated)
- Committer:
- Jagang
- Date:
- Sun Sep 28 19:53:31 2014 +0000
- Revision:
- 0:41149573d577
- Child:
- 3:573a0dc8383f
New
Who changed what in which revision?
User | Revision | Line number | New 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 | } |