Line follower robot code Llenard Gonzalo

Dependencies:   mbed SRF05

Committer:
Llenard
Date:
Sat Oct 30 18:14:38 2021 +0000
Revision:
0:4bb3dfde1219
Submission

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Llenard 0:4bb3dfde1219 1 #include "mbed.h"
Llenard 0:4bb3dfde1219 2 #include "SRF05.h"
Llenard 0:4bb3dfde1219 3
Llenard 0:4bb3dfde1219 4 #define fulldrive 0.0115
Llenard 0:4bb3dfde1219 5 #define halfdrive 0.6
Llenard 0:4bb3dfde1219 6
Llenard 0:4bb3dfde1219 7
Llenard 0:4bb3dfde1219 8 Serial pc(SERIAL_TX, SERIAL_RX);
Llenard 0:4bb3dfde1219 9
Llenard 0:4bb3dfde1219 10 AnalogIn ir1(PA_1);
Llenard 0:4bb3dfde1219 11 AnalogIn ir2(PA_4);
Llenard 0:4bb3dfde1219 12 AnalogIn ir3(PB_0);
Llenard 0:4bb3dfde1219 13 AnalogIn ir4(PC_1);
Llenard 0:4bb3dfde1219 14 AnalogIn ir5(PC_0);
Llenard 0:4bb3dfde1219 15
Llenard 0:4bb3dfde1219 16 DigitalOut turnLeft(PA_10); //left turn
Llenard 0:4bb3dfde1219 17 DigitalOut turnRight(PA_8); //right turn
Llenard 0:4bb3dfde1219 18 DigitalOut back(PA_9); //reverse
Llenard 0:4bb3dfde1219 19 DigitalOut drive(PA_6); //forward
Llenard 0:4bb3dfde1219 20
Llenard 0:4bb3dfde1219 21 bool setupFlag = false;
Llenard 0:4bb3dfde1219 22 SRF05 srf(PA_2, PA_3);
Llenard 0:4bb3dfde1219 23
Llenard 0:4bb3dfde1219 24
Llenard 0:4bb3dfde1219 25 enum direction{forward, backward, left = 77, right = 99, center = 88};
Llenard 0:4bb3dfde1219 26 enum trackersensor{sen1_left, sen2_left, sen3_mid, sen4_right, sen5_right};