a
Dependencies: Roboter m3pi_js mbed
Fork of m3pi_LineFollower by
main.cpp
- Committer:
- chris
- Date:
- 2010-11-02
- Revision:
- 2:f3f0843285e2
- Parent:
- 1:5ddd3faed06d
- Child:
- 3:7f077cf1d755
File content as of revision 2:f3f0843285e2:
#include "mbed.h" #include "m3pi.h" BusOut leds(LED1,LED2,LED3,LED4); m3pi m3pi (p27,p9,p10); //nRST, TX, RX int main() { m3pi.locate(0,1); m3pi.printf("Line Flw"); float position_of_line = 0.0; m3pi.sensor_auto_calibrate(); float speed = 0.4; while (1) { // -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) { 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) { m3pi.right_motor(speed); m3pi.left_motor(speed - 0.3); leds = 0x2; } // Line is inthe middle else { m3pi.forward(speed); leds = 0x0; } } }