4輪ロボットのプログラム

Dependencies:   Motor mbed

main.cpp

Committer:
kikoaac
Date:
2016-08-07
Revision:
0:843dd155e1ed

File content as of revision 0:843dd155e1ed:

#include "mbed.h"
#include "Motor.h"

#define check() 1
DigitalOut myled(LED1);
Serial pc(USBTX,USBRX);
Serial esp(p28,p27);
#define end "\r\n"


Motor motor[2] = {Motor(p20,p25,p19),Motor(p17,p18,p21)};
int main()
{

    pc.baud(115200);
    esp.baud(115200);
    int data = 0;
    for(int i = 0 ;i < 2 ; i++)motor[i] = 0;
    while(1) {
        if(esp.readable()) {
            data = esp.getc();
        }
        printf("%d\r\n",data);
        if(data == 1)
            for(int i= 0; i< 2; i++) {
                motor[i] = 1;
            }
        else if(data == 2)
            for(int i= 0; i< 2; i++) {
                motor[i] = -1;
            }
        else if(data == 3) {
            motor[0] = 1;
            motor[1] = -1;
        } else if(data == 4) {
            motor[0] = -1;
            motor[1] = 1;
        } else
            for(int i= 0; i< 2; i++) {
                motor[i] = 0;
            }
    }
}