2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

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:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

manualMode.h

Committer:
DeguNaoto
Date:
2015-09-27
Revision:
52:d9e1629da852
Parent:
51:cb430192b28b
Child:
53:51ee40cf3d74

File content as of revision 52:d9e1629da852:

#ifndef MANUALMODE_H
#define MANUALMODE_H

void manualMoveIM920()
{
    if(Y>6) {
        Move_l(-0.4);
        Move_r(0.4);
    } 
    else if(Y<2) {
        Move_l(0.4);
        Move_r(-0.4);
    } 
    else {
        if(X>6) {
            Move_l(0.4);
            Move_r(0.4);
        } else if(X<2) {
            Move_l(-0.4);
            Move_r(-0.4);
        } else {
            Move_l(0.0);
            Move_r(0.0);
        }
    }
}
void manualIM920()
{
    if(b==7){  /*mode change*/
        if(edge7){
            edge7=0;
            autoflag=1;
            Indicator4=1;
            IndicatorAuto=0;
        }
    }
    else if(b==6){
        targSwingRadVelocity = swingspeed;
    }
    else if(b==5){
        if(edge5){
            edge5=0;
            sendData(1,6);
        }
    }
    else if(b==9){
        targSwingRadVelocity = 0.0;
        contSwing.reset();
    }
    else if(b==2){
        sendData(1,5);
    }
    else if(b==4){
        sendData(1,4);
    }
    if(b!=7) edge7=1;
    if(b!=1) edge1=1;
    if(b!=2) edge2=1;
    if(b!=3) edge3=1;
    if(b!=4) edge4=1;
    if(b!=5) edge5=1;
    /*if(circle) {
        if(edge_circle) edge_circle=0,autoflag=1,Indicator4=1,IndicatorAuto=0;
    } 
    else if(triangle) targSwingRadVelocity = swingspeed;
    else if(square) {
        if(edge_square) {
            edge_square=0;
            sendData(1,6);
        }
    }
    else if(cross){
        targSwingRadVelocity = 0.0;
        contSwing.reset();
    }
    else if(r1) sendData(1,4);
    else if(l1) sendData(1,5);*/
}

#endif /*manualMode.h*/