Nikolay Sergeev
/
Nucleo_printf
sertwer
main.cpp@0:a2f2d5b2bb5e, 2014-12-09 (annotated)
- Committer:
- Sergeev
- Date:
- Tue Dec 09 16:50:57 2014 +0000
- Revision:
- 0:a2f2d5b2bb5e
hvbpui
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Sergeev | 0:a2f2d5b2bb5e | 1 | #include "mbed.h" |
Sergeev | 0:a2f2d5b2bb5e | 2 | |
Sergeev | 0:a2f2d5b2bb5e | 3 | Serial pc(USBTX, USBRX); |
Sergeev | 0:a2f2d5b2bb5e | 4 | |
Sergeev | 0:a2f2d5b2bb5e | 5 | DigitalOut pc_activity(LED1); |
Sergeev | 0:a2f2d5b2bb5e | 6 | DigitalOut uart_activity(LED2); |
Sergeev | 0:a2f2d5b2bb5e | 7 | |
Sergeev | 0:a2f2d5b2bb5e | 8 | int state = 0; |
Sergeev | 0:a2f2d5b2bb5e | 9 | |
Sergeev | 0:a2f2d5b2bb5e | 10 | int main() { |
Sergeev | 0:a2f2d5b2bb5e | 11 | |
Sergeev | 0:a2f2d5b2bb5e | 12 | |
Sergeev | 0:a2f2d5b2bb5e | 13 | // set pc baud 115200 |
Sergeev | 0:a2f2d5b2bb5e | 14 | pc.baud(115200); |
Sergeev | 0:a2f2d5b2bb5e | 15 | |
Sergeev | 0:a2f2d5b2bb5e | 16 | |
Sergeev | 0:a2f2d5b2bb5e | 17 | int packet_state = 0; // STATE OF PACKET, ZERO = WAIT FOR 'snp' |
Sergeev | 0:a2f2d5b2bb5e | 18 | |
Sergeev | 0:a2f2d5b2bb5e | 19 | while(packet_state == 0) { |
Sergeev | 0:a2f2d5b2bb5e | 20 | // pc.putc(uart.getc()); // Serial pass thru |
Sergeev | 0:a2f2d5b2bb5e | 21 | |
Sergeev | 0:a2f2d5b2bb5e | 22 | |
Sergeev | 0:a2f2d5b2bb5e | 23 | // READ 'snp' (START NEW PACKET) FROM UM6 AHRS |
Sergeev | 0:a2f2d5b2bb5e | 24 | |
Sergeev | 0:a2f2d5b2bb5e | 25 | if (pc.getc() == 0x73 ) { |
Sergeev | 0:a2f2d5b2bb5e | 26 | // pc.putc(0x73); |
Sergeev | 0:a2f2d5b2bb5e | 27 | pc.putc('s'); |
Sergeev | 0:a2f2d5b2bb5e | 28 | state = 1; |
Sergeev | 0:a2f2d5b2bb5e | 29 | } |
Sergeev | 0:a2f2d5b2bb5e | 30 | |
Sergeev | 0:a2f2d5b2bb5e | 31 | if (pc.getc() == 0x6E ) { |
Sergeev | 0:a2f2d5b2bb5e | 32 | // pc.putc(0x6E); |
Sergeev | 0:a2f2d5b2bb5e | 33 | pc.putc('n'); |
Sergeev | 0:a2f2d5b2bb5e | 34 | state ++; |
Sergeev | 0:a2f2d5b2bb5e | 35 | // uart_activity = !uart_activity; |
Sergeev | 0:a2f2d5b2bb5e | 36 | } |
Sergeev | 0:a2f2d5b2bb5e | 37 | |
Sergeev | 0:a2f2d5b2bb5e | 38 | |
Sergeev | 0:a2f2d5b2bb5e | 39 | if (pc.getc() == 0x70 ) { |
Sergeev | 0:a2f2d5b2bb5e | 40 | // pc.putc(0x70); |
Sergeev | 0:a2f2d5b2bb5e | 41 | pc.putc('p'); |
Sergeev | 0:a2f2d5b2bb5e | 42 | state ++; |
Sergeev | 0:a2f2d5b2bb5e | 43 | // uart_activity = !uart_activity; |
Sergeev | 0:a2f2d5b2bb5e | 44 | } |
Sergeev | 0:a2f2d5b2bb5e | 45 | |
Sergeev | 0:a2f2d5b2bb5e | 46 | |
Sergeev | 0:a2f2d5b2bb5e | 47 | // PT (packet type) |
Sergeev | 0:a2f2d5b2bb5e | 48 | if (pc.getc() == 0xC8 ) { |
Sergeev | 0:a2f2d5b2bb5e | 49 | state = 0; |
Sergeev | 0:a2f2d5b2bb5e | 50 | pc.putc('P'); |
Sergeev | 0:a2f2d5b2bb5e | 51 | pc.putc('T'); |
Sergeev | 0:a2f2d5b2bb5e | 52 | state ++; |
Sergeev | 0:a2f2d5b2bb5e | 53 | } |
Sergeev | 0:a2f2d5b2bb5e | 54 | |
Sergeev | 0:a2f2d5b2bb5e | 55 | } |
Sergeev | 0:a2f2d5b2bb5e | 56 | } |