A simple line following program
Revision 3:7f077cf1d755, committed 2010-11-07
- Comitter:
- chris
- Date:
- Sun Nov 07 10:41:55 2010 +0000
- Parent:
- 2:f3f0843285e2
- Child:
- 4:93843695a895
- Commit message:
- Updated to latest m3pi library
Changed in this revision
| main.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- a/main.cpp Tue Nov 02 16:58:25 2010 +0000
+++ b/main.cpp Sun Nov 07 10:41:55 2010 +0000
@@ -2,10 +2,11 @@
#include "m3pi.h"
BusOut leds(LED1,LED2,LED3,LED4);
-m3pi m3pi (p27,p9,p10); //nRST, TX, RX
+m3pi m3pi(p23,p9,p10);
int main() {
+
m3pi.locate(0,1);
m3pi.printf("Line Flw");
@@ -18,26 +19,14 @@
// -1.0 is far left, 1.0 is far right
position_of_line = m3pi.line_position();
- // Line is more than 75% to the left
- if (position_of_line < -0.25) {
- m3pi.left_motor(speed + 0.3);
- m3pi.right_motor(speed - 0.3);
- leds = 0xc;
- }
// Line is more than 25% to the left
- else if (position_of_line < -0.10) {
+ if (position_of_line < -0.50) {
m3pi.left_motor(speed);
m3pi.right_motor(speed - 0.3);
leds = 0x4;
}
// Line is more than 75% to the right
- else if (position_of_line > 0.25) {
- m3pi.right_motor(speed + 0.3);
- m3pi.left_motor(speed - 0.3);
- leds = 0x3;
- }
- // Line is more than 75% to the right
- else if (position_of_line > 0.10) {
+ else if (position_of_line > 0.50) {
m3pi.right_motor(speed);
m3pi.left_motor(speed - 0.3);
leds = 0x2;