RainbowTeam / Mbed 2 deprecated ProjectTheseus

Dependencies:   mbed

AutoDrive.cpp

Committer:
Alexander_Zuest
Date:
2018-04-27
Revision:
0:4a0b987c5c94
Child:
2:cb6bae534500

File content as of revision 0:4a0b987c5c94:

    int action = 0;
    int speed = 3;
    autoDrive(const int route[][]){
        
    while(route[action][0] != 0){
        
        switch(route[action][0]){
            case 1: // Fulldrive
                driveOne(speed,route[action][1]);
                break;
                
            case 2: // turn Right
                turnRight();
                break;
                
            case 3: // turn Left
                turnLeft();
                break;
                
            case 4: // turn right on spot
                trunRight();
                break;
                
            default: printf("Error: route could not be red!");
        }
        
    action = action + 1;    
    }
    printf("The target destination has been sucessfully reached!");
    
    }