Problems with compilation of MODSERIAL

Dependencies:   mbed PwmIn

Committer:
kinemax
Date:
Fri Apr 08 20:03:33 2011 +0000
Revision:
0:177adc0899a6
Starting test for PwmIn and MODSERIAL libraries

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kinemax 0:177adc0899a6 1 // Example PwmIn class to detect PWM inputs, sford
kinemax 0:177adc0899a6 2 // - Note: uses InterruptIn, so not available on p19/p20
kinemax 0:177adc0899a6 3
kinemax 0:177adc0899a6 4 #include "mbed.h"
kinemax 0:177adc0899a6 5 #include "PwmIn.h"
kinemax 0:177adc0899a6 6 #include "MODSERIAL.h"
kinemax 0:177adc0899a6 7
kinemax 0:177adc0899a6 8 #define BAUD 115200
kinemax 0:177adc0899a6 9 #define TX_PIN p9
kinemax 0:177adc0899a6 10 #define RX_PIN p10
kinemax 0:177adc0899a6 11
kinemax 0:177adc0899a6 12 DigitalOut led1(LED1);
kinemax 0:177adc0899a6 13 DigitalOut led2(LED2);
kinemax 0:177adc0899a6 14 DigitalOut led3(LED3);
kinemax 0:177adc0899a6 15 DigitalOut led4(LED4);
kinemax 0:177adc0899a6 16
kinemax 0:177adc0899a6 17 Serial pc(USBTX, USBRX);
kinemax 0:177adc0899a6 18 MODSERIAL uart(TX_PIN, RX_PIN);
kinemax 0:177adc0899a6 19
kinemax 0:177adc0899a6 20 bool newpacket = false;
kinemax 0:177adc0899a6 21
kinemax 0:177adc0899a6 22 PwmIn a(p21);
kinemax 0:177adc0899a6 23 PwmIn b(p22), c(p23), d(p24), e(p25);
kinemax 0:177adc0899a6 24
kinemax 0:177adc0899a6 25 int yaw=0,pitch=0,roll=0, Dyaw=0,Dpitch=0,Droll=0,chk=0;
kinemax 0:177adc0899a6 26
kinemax 0:177adc0899a6 27 int main()
kinemax 0:177adc0899a6 28 { char ileB=0,kan1=0,kan2=0;
kinemax 0:177adc0899a6 29 pc.baud(BAUD);
kinemax 0:177adc0899a6 30 uart.baud(BAUD);
kinemax 0:177adc0899a6 31 // uart.attach(&rxCallback, MODSERIAL::RxIrq);
kinemax 0:177adc0899a6 32 pc.printf("Start\n\r");
kinemax 0:177adc0899a6 33
kinemax 0:177adc0899a6 34 while(1)
kinemax 0:177adc0899a6 35 { while( uart.rxBufferGetCount() < 21);
kinemax 0:177adc0899a6 36
kinemax 0:177adc0899a6 37 { led1 = 1; // Show start of sending with LED1.
kinemax 0:177adc0899a6 38 if(uart.getc()=='s')
kinemax 0:177adc0899a6 39 { led2 =1;
kinemax 0:177adc0899a6 40 if(uart.getc()=='n')
kinemax 0:177adc0899a6 41 if(uart.getc()=='p')
kinemax 0:177adc0899a6 42 if(uart.getc()==0xB7)
kinemax 0:177adc0899a6 43 { uart.scanf("%c%c%c%2d%2d%2d%2d%2d%2d%2d", ileB,kan1,kan2, yaw,pitch,roll, Dyaw,Dpitch,Droll,chk);
kinemax 0:177adc0899a6 44 led3=1; newpacket=1;
kinemax 0:177adc0899a6 45 }
kinemax 0:177adc0899a6 46 }
kinemax 0:177adc0899a6 47 }
kinemax 0:177adc0899a6 48 pc.printf("Bajty= %2d, YPR = %5d %5d %5d Delty = %5d %5d %5d Chk %3d\n\r", ileB, yaw,pitch,roll, Dyaw,Dpitch,Droll,chk);
kinemax 0:177adc0899a6 49 pc.printf("Kanaly= %5.3f %5.3f %5.3f %5.3f %5.3f\n\r", a.pulsewidth()*1000, a.pulsewidth()*1000, b.pulsewidth()*1000, c.pulsewidth()*1000, d.pulsewidth()*1000, e.pulsewidth()*1000);
kinemax 0:177adc0899a6 50 wait(1);
kinemax 0:177adc0899a6 51
kinemax 0:177adc0899a6 52 }
kinemax 0:177adc0899a6 53 }
kinemax 0:177adc0899a6 54
kinemax 0:177adc0899a6 55 // higher than "uart" baud rate below.