2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

manualMode.h

Committer:
DeguNaoto
Date:
2015-09-18
Revision:
23:5c56747bcc43
Parent:
22:3996c3f41922
Child:
24:271da6144a02

File content as of revision 23:5c56747bcc43:

#ifndef MANUALMODE_H
#define MANUALMODE_H

void manualMovePs3(){
    if(analog_lx>10){
        if(analog_ly>10){
            Move_l(0.4);
            Move_r(0.0);
        }
        else if(analog_ly<-10){
            Move_l(-0.4);
            Move_r(0.0);
        }
        else{
            Move_l(0.4);
            Move_r(-0.4);   
        }
    }
    else if(analog_lx<-10){
        if(analog_ly>10){
            Move_l(0.0);
            Move_r(0.4);
        }
        else if(analog_ly<-10){
            Move_l(0.0);
            Move_r(-0.4);
        }
        else{
            Move_l(-0.4);
            Move_r(0.4);
        }
    }
    else{
        if(analog_ly>10){
            Move_l(0.4);
            Move_r(0.4);
        }
        else if(analog_ly<-10){
            Move_l(-0.4);
            Move_r(-0.4);
        }
    }
}



#endif /*manualMode.h*/