Atsumi Toda
/
twe_lite_rpm
twe-kiteを用いた回転数側のプログラム
main.cpp@0:25af5436ac17, 2018-02-23 (annotated)
- Committer:
- Joeatsumi
- Date:
- Fri Feb 23 04:21:22 2018 +0000
- Revision:
- 0:25af5436ac17
2018/2/23
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Joeatsumi | 0:25af5436ac17 | 1 | #include "mbed.h" |
Joeatsumi | 0:25af5436ac17 | 2 | //Serial twe(p9, p10); // tx, rx |
Joeatsumi | 0:25af5436ac17 | 3 | Serial pc(USBTX,USBRX); |
Joeatsumi | 0:25af5436ac17 | 4 | DigitalOut myled(LED1); |
Joeatsumi | 0:25af5436ac17 | 5 | |
Joeatsumi | 0:25af5436ac17 | 6 | #define DATA_SIZE 10 |
Joeatsumi | 0:25af5436ac17 | 7 | |
Joeatsumi | 0:25af5436ac17 | 8 | char dam; |
Joeatsumi | 0:25af5436ac17 | 9 | int rpm=76; |
Joeatsumi | 0:25af5436ac17 | 10 | struct{ |
Joeatsumi | 0:25af5436ac17 | 11 | char highbyte; |
Joeatsumi | 0:25af5436ac17 | 12 | char lowbyte; |
Joeatsumi | 0:25af5436ac17 | 13 | short intdat; |
Joeatsumi | 0:25af5436ac17 | 14 | }data; |
Joeatsumi | 0:25af5436ac17 | 15 | |
Joeatsumi | 0:25af5436ac17 | 16 | void rec(){ |
Joeatsumi | 0:25af5436ac17 | 17 | char DATA[DATA_SIZE] = {':', '0', '4', '0', '1', '3', '9', 'X', '\r', '\n'}; |
Joeatsumi | 0:25af5436ac17 | 18 | //04 |
Joeatsumi | 0:25af5436ac17 | 19 | /*:は送信時に必要なヘッダー。78は相手のID(0x78)。01は送信コマンドとして必要。 |
Joeatsumi | 0:25af5436ac17 | 20 | 39は任意の値。Xはチェックサムの省略形。 \r\nは改行コマンド*/ |
Joeatsumi | 0:25af5436ac17 | 21 | |
Joeatsumi | 0:25af5436ac17 | 22 | for (int i = 0 ; i < DATA_SIZE ; i++){ |
Joeatsumi | 0:25af5436ac17 | 23 | pc.putc(DATA[i]); |
Joeatsumi | 0:25af5436ac17 | 24 | myled=1; |
Joeatsumi | 0:25af5436ac17 | 25 | |
Joeatsumi | 0:25af5436ac17 | 26 | } |
Joeatsumi | 0:25af5436ac17 | 27 | |
Joeatsumi | 0:25af5436ac17 | 28 | } |
Joeatsumi | 0:25af5436ac17 | 29 | int main() { |
Joeatsumi | 0:25af5436ac17 | 30 | pc.baud(115200); |
Joeatsumi | 0:25af5436ac17 | 31 | |
Joeatsumi | 0:25af5436ac17 | 32 | while(1) { |
Joeatsumi | 0:25af5436ac17 | 33 | //pc.putc(twe.getc()); |
Joeatsumi | 0:25af5436ac17 | 34 | if(pc.getc()==':'){ |
Joeatsumi | 0:25af5436ac17 | 35 | if(pc.getc()=='0'){ |
Joeatsumi | 0:25af5436ac17 | 36 | if(pc.getc()=='4'){ |
Joeatsumi | 0:25af5436ac17 | 37 | dam=pc.getc(); |
Joeatsumi | 0:25af5436ac17 | 38 | dam=pc.getc(); |
Joeatsumi | 0:25af5436ac17 | 39 | if(pc.getc()=='3'){ |
Joeatsumi | 0:25af5436ac17 | 40 | if(pc.getc()=='9'){ |
Joeatsumi | 0:25af5436ac17 | 41 | |
Joeatsumi | 0:25af5436ac17 | 42 | rec(); |
Joeatsumi | 0:25af5436ac17 | 43 | |
Joeatsumi | 0:25af5436ac17 | 44 | } |
Joeatsumi | 0:25af5436ac17 | 45 | }//if(twe.getc()=='9') |
Joeatsumi | 0:25af5436ac17 | 46 | }//if(twe.getc()=='4') |
Joeatsumi | 0:25af5436ac17 | 47 | }//0 |
Joeatsumi | 0:25af5436ac17 | 48 | |
Joeatsumi | 0:25af5436ac17 | 49 | |
Joeatsumi | 0:25af5436ac17 | 50 | }//: |
Joeatsumi | 0:25af5436ac17 | 51 | }//while |
Joeatsumi | 0:25af5436ac17 | 52 | |
Joeatsumi | 0:25af5436ac17 | 53 | } |