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

Dependencies:   Motor mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 #include "Motor.h"
00003 
00004 #define check() 1
00005 DigitalOut myled(LED1);
00006 Serial pc(USBTX,USBRX);
00007 Serial esp(p28,p27);
00008 #define end "\r\n"
00009 
00010 
00011 Motor motor[2] = {Motor(p20,p25,p19),Motor(p17,p18,p21)};
00012 int main()
00013 {
00014 
00015     pc.baud(115200);
00016     esp.baud(115200);
00017     int data = 0;
00018     for(int i = 0 ;i < 2 ; i++)motor[i] = 0;
00019     while(1) {
00020         if(esp.readable()) {
00021             data = esp.getc();
00022         }
00023         printf("%d\r\n",data);
00024         if(data == 1)
00025             for(int i= 0; i< 2; i++) {
00026                 motor[i] = 1;
00027             }
00028         else if(data == 2)
00029             for(int i= 0; i< 2; i++) {
00030                 motor[i] = -1;
00031             }
00032         else if(data == 3) {
00033             motor[0] = 1;
00034             motor[1] = -1;
00035         } else if(data == 4) {
00036             motor[0] = -1;
00037             motor[1] = 1;
00038         } else
00039             for(int i= 0; i< 2; i++) {
00040                 motor[i] = 0;
00041             }
00042     }
00043 }