ルンバハック用.

Dependencies:   mbed

Committer:
naoki_westwell
Date:
Fri Jun 24 07:33:46 2016 +0000
Revision:
0:ac1e1657002a
Roomba Hack

Who changed what in which revision?

UserRevisionLine numberNew contents of line
naoki_westwell 0:ac1e1657002a 1 #include "mbed.h"
naoki_westwell 0:ac1e1657002a 2 #include <System_Select.h>
naoki_westwell 0:ac1e1657002a 3
naoki_westwell 0:ac1e1657002a 4 #ifdef CMD_TRANSMITTER
naoki_westwell 0:ac1e1657002a 5
naoki_westwell 0:ac1e1657002a 6 Serial Device(p9, p10);
naoki_westwell 0:ac1e1657002a 7 DigitalIn SW(p17);
naoki_westwell 0:ac1e1657002a 8 //Serial pc(USBTX, USBRX); // tx, rx
naoki_westwell 0:ac1e1657002a 9
naoki_westwell 0:ac1e1657002a 10 void send_cmd(char commnad);
naoki_westwell 0:ac1e1657002a 11
naoki_westwell 0:ac1e1657002a 12 int main() {
naoki_westwell 0:ac1e1657002a 13 Device.baud(115200);
naoki_westwell 0:ac1e1657002a 14 int cnt1 = 0, cnt2 = 0;
naoki_westwell 0:ac1e1657002a 15
naoki_westwell 0:ac1e1657002a 16 while(1){
naoki_westwell 0:ac1e1657002a 17 if(cnt1==1){
naoki_westwell 0:ac1e1657002a 18 send_cmd(START); // OI ON and start cleaning
naoki_westwell 0:ac1e1657002a 19 //send_cmd(SAFE);
naoki_westwell 0:ac1e1657002a 20 send_cmd(CLEAN);
naoki_westwell 0:ac1e1657002a 21 cnt2 = 0;
naoki_westwell 0:ac1e1657002a 22 }
naoki_westwell 0:ac1e1657002a 23 if(cnt2==1){
naoki_westwell 0:ac1e1657002a 24 send_cmd(BUTTONS); //
naoki_westwell 0:ac1e1657002a 25 send_cmd(0x01); //
naoki_westwell 0:ac1e1657002a 26 cnt1 = 0;
naoki_westwell 0:ac1e1657002a 27 }
naoki_westwell 0:ac1e1657002a 28
naoki_westwell 0:ac1e1657002a 29 if(SW) cnt1++;
naoki_westwell 0:ac1e1657002a 30 else cnt2++;
naoki_westwell 0:ac1e1657002a 31 }
naoki_westwell 0:ac1e1657002a 32 }
naoki_westwell 0:ac1e1657002a 33
naoki_westwell 0:ac1e1657002a 34 void send_cmd(char command){
naoki_westwell 0:ac1e1657002a 35 Device.putc(command);
naoki_westwell 0:ac1e1657002a 36 }
naoki_westwell 0:ac1e1657002a 37
naoki_westwell 0:ac1e1657002a 38 #endif