Turning function

Dependencies:   mbed-rtos mbed

main.cpp

Committer:
vceyssens3
Date:
2017-05-01
Revision:
0:84070c2a9436

File content as of revision 0:84070c2a9436:

#include "mbed.h"
#include "rtos.h"

Serial pc(USBTX, USBRX);
DigitalOut start(p30,1);
DigitalOut right(p29,1);
DigitalOut left(p28,1);
DigitalOut up(p27,1);
DigitalOut down(p26,1);
DigitalOut on_switch(p25,0);
DigitalOut myled(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);
DigitalIn encoder(p20);


void starting_commands(){ // toggles the button to start the cop car
    start = 0;
    wait(0.1);
    start = 1;
    wait(0.1);
    }


void start_func() // sequence that gets the cop car into no noise run mode
{
    on_switch =1;
    starting_commands();
    starting_commands();
    starting_commands();
    starting_commands();
    starting_commands();
}

int first_time = 0;
int last_time = 0;

void drive(){
    
       
        right = 0;
        wait(0.1);
        up = 0;
        wait(0.4);
        up = right = 1;
        wait(0.2);
        
}

void reverse(){
    
        left = 0;
        wait(0.1);
        down = 0;
        wait(0.4);
        down= left=1;
        wait(0.2);
}

int main() {
   start_func();
   drive();
   reverse();
   drive();
   reverse();
   drive();
   reverse();
   drive();
   reverse();
   drive();
   reverse();
   drive();
   reverse();
   drive();
   reverse();
   drive();
   reverse();
   drive();
   reverse();
   
   
}