RainbowTeam / Mbed 2 deprecated ProjectTheseus

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

AutoDrive.cpp@5:695c5531f65e, 2018-04-29 (annotated)

Committer:
Alexander_Zuest
Date:
Sun Apr 29 11:48:33 2018 +0000
Revision:
5:695c5531f65e
Parent:
2:cb6bae534500
Child:
14:0caa7b93af7a
V.0.3

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Alexander_Zuest 2:cb6bae534500 1 #include "mbed.h"
Alexander_Zuest 2:cb6bae534500 2 #include "MotorDriver.h"
Alexander_Zuest 2:cb6bae534500 3 #include "ReadFinalLine.h"
Alexander_Zuest 2:cb6bae534500 4 #include "ReadSensor.h"
Alexander_Zuest 2:cb6bae534500 5 #include "Mapping.h"
Alexander_Zuest 2:cb6bae534500 6 #include "AutoDrive.h"
Alexander_Zuest 2:cb6bae534500 7 #include "RouteCalculation.h"
Alexander_Zuest 2:cb6bae534500 8
Alexander_Zuest 0:4a0b987c5c94 9 int action = 0;
Alexander_Zuest 0:4a0b987c5c94 10 int speed = 3;
Alexander_Zuest 2:cb6bae534500 11 int placeholder = 1;
Alexander_Zuest 5:695c5531f65e 12 void AutoDrive(const int route[]){
Alexander_Zuest 0:4a0b987c5c94 13
Alexander_Zuest 5:695c5531f65e 14 while(route[action] != 100){
Alexander_Zuest 0:4a0b987c5c94 15
Alexander_Zuest 5:695c5531f65e 16 switch(route[action]){
Alexander_Zuest 0:4a0b987c5c94 17 case 1: // Fulldrive
Alexander_Zuest 5:695c5531f65e 18 driveOne(speed,route[action+1]);
Alexander_Zuest 0:4a0b987c5c94 19 break;
Alexander_Zuest 0:4a0b987c5c94 20
Alexander_Zuest 0:4a0b987c5c94 21 case 2: // turn Right
Alexander_Zuest 2:cb6bae534500 22 turnRight(placeholder);
Alexander_Zuest 0:4a0b987c5c94 23 break;
Alexander_Zuest 0:4a0b987c5c94 24
Alexander_Zuest 0:4a0b987c5c94 25 case 3: // turn Left
Alexander_Zuest 2:cb6bae534500 26 turnLeft(placeholder);
Alexander_Zuest 0:4a0b987c5c94 27 break;
Alexander_Zuest 0:4a0b987c5c94 28
Alexander_Zuest 0:4a0b987c5c94 29 case 4: // turn right on spot
Alexander_Zuest 2:cb6bae534500 30 turnRight(placeholder);
Alexander_Zuest 0:4a0b987c5c94 31 break;
Alexander_Zuest 0:4a0b987c5c94 32
Alexander_Zuest 0:4a0b987c5c94 33 default: printf("Error: route could not be red!");
Alexander_Zuest 0:4a0b987c5c94 34 }
Alexander_Zuest 0:4a0b987c5c94 35
Alexander_Zuest 0:4a0b987c5c94 36 action = action + 1;
Alexander_Zuest 0:4a0b987c5c94 37 }
Alexander_Zuest 0:4a0b987c5c94 38 printf("The target destination has been sucessfully reached!");
Alexander_Zuest 0:4a0b987c5c94 39
Alexander_Zuest 0:4a0b987c5c94 40 }