naoki nishii
/
Roomba_Hack
ルンバハック用.
cmd_Transmitter.cpp@0:ac1e1657002a, 2016-06-24 (annotated)
- Committer:
- naoki_westwell
- Date:
- Fri Jun 24 07:33:46 2016 +0000
- Revision:
- 0:ac1e1657002a
Roomba Hack
Who changed what in which revision?
User | Revision | Line number | New 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 |