Kiko Ishimoto
/
FourSicleRobot
4輪ロボットのプログラム
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; } } }