sertwer

Dependencies:   mbed

Committer:
Sergeev
Date:
Tue Dec 09 16:50:57 2014 +0000
Revision:
0:a2f2d5b2bb5e
hvbpui

Who changed what in which revision?

UserRevisionLine numberNew 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 }