NucleoF401RE A/D test. 5msec sampling (by timer interrupt), transmit via XBee with 7 bytes message format.
main.cpp@0:7cdedba0a5e6, 2014-12-06 (annotated)
- Committer:
- nagasm
- Date:
- Sat Dec 06 08:16:57 2014 +0000
- Revision:
- 0:7cdedba0a5e6
NucleoF401RE A/D test.; 5msec sampling (by timer interrupt), transmit via XBee with 7 bytes message format.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
nagasm | 0:7cdedba0a5e6 | 1 | #include "mbed.h" |
nagasm | 0:7cdedba0a5e6 | 2 | |
nagasm | 0:7cdedba0a5e6 | 3 | unsigned char rxFIFO[256], txFIFO[256], raw_data[6]; |
nagasm | 0:7cdedba0a5e6 | 4 | unsigned char rx_top, rx_end, tx_top, tx_end, phase; |
nagasm | 0:7cdedba0a5e6 | 5 | int timer_value[6]; |
nagasm | 0:7cdedba0a5e6 | 6 | |
nagasm | 0:7cdedba0a5e6 | 7 | RawSerial xbee(PA_2, PA_3); |
nagasm | 0:7cdedba0a5e6 | 8 | Ticker timer_setup; |
nagasm | 0:7cdedba0a5e6 | 9 | DigitalOut myled(LED1); |
nagasm | 0:7cdedba0a5e6 | 10 | AnalogIn analog_value0(A0); |
nagasm | 0:7cdedba0a5e6 | 11 | AnalogIn analog_value1(A1); |
nagasm | 0:7cdedba0a5e6 | 12 | AnalogIn analog_value2(A2); |
nagasm | 0:7cdedba0a5e6 | 13 | AnalogIn analog_value3(A3); |
nagasm | 0:7cdedba0a5e6 | 14 | |
nagasm | 0:7cdedba0a5e6 | 15 | void timer_interrupt(){ |
nagasm | 0:7cdedba0a5e6 | 16 | int i; |
nagasm | 0:7cdedba0a5e6 | 17 | for (i=0; i<6; i++) ++timer_value[i] &= 65535; |
nagasm | 0:7cdedba0a5e6 | 18 | } |
nagasm | 0:7cdedba0a5e6 | 19 | |
nagasm | 0:7cdedba0a5e6 | 20 | void tx_fifo_check(){ |
nagasm | 0:7cdedba0a5e6 | 21 | if(xbee.writeable() == 1){ |
nagasm | 0:7cdedba0a5e6 | 22 | if(tx_top != tx_end){ |
nagasm | 0:7cdedba0a5e6 | 23 | xbee.putc(txFIFO[tx_end]); |
nagasm | 0:7cdedba0a5e6 | 24 | ++tx_end &= 255; |
nagasm | 0:7cdedba0a5e6 | 25 | } |
nagasm | 0:7cdedba0a5e6 | 26 | } |
nagasm | 0:7cdedba0a5e6 | 27 | } |
nagasm | 0:7cdedba0a5e6 | 28 | |
nagasm | 0:7cdedba0a5e6 | 29 | int rx_fifo_check(){ |
nagasm | 0:7cdedba0a5e6 | 30 | unsigned char data; |
nagasm | 0:7cdedba0a5e6 | 31 | if(rx_top != rx_end){ |
nagasm | 0:7cdedba0a5e6 | 32 | data = rxFIFO[rx_end]; |
nagasm | 0:7cdedba0a5e6 | 33 | ++rx_end &= 255; |
nagasm | 0:7cdedba0a5e6 | 34 | if (data < 33){ |
nagasm | 0:7cdedba0a5e6 | 35 | phase = 0; |
nagasm | 0:7cdedba0a5e6 | 36 | return(1); |
nagasm | 0:7cdedba0a5e6 | 37 | } |
nagasm | 0:7cdedba0a5e6 | 38 | raw_data[phase] = data; |
nagasm | 0:7cdedba0a5e6 | 39 | if(++phase > 5) phase = 0; |
nagasm | 0:7cdedba0a5e6 | 40 | return(0); |
nagasm | 0:7cdedba0a5e6 | 41 | } |
nagasm | 0:7cdedba0a5e6 | 42 | return(0); |
nagasm | 0:7cdedba0a5e6 | 43 | } |
nagasm | 0:7cdedba0a5e6 | 44 | |
nagasm | 0:7cdedba0a5e6 | 45 | void rx_fifoset(void){ |
nagasm | 0:7cdedba0a5e6 | 46 | rxFIFO[rx_top] = xbee.getc(); |
nagasm | 0:7cdedba0a5e6 | 47 | ++rx_top &= 255; |
nagasm | 0:7cdedba0a5e6 | 48 | } |
nagasm | 0:7cdedba0a5e6 | 49 | |
nagasm | 0:7cdedba0a5e6 | 50 | void tx_fifoset(unsigned char data){ |
nagasm | 0:7cdedba0a5e6 | 51 | txFIFO[tx_top] = data; |
nagasm | 0:7cdedba0a5e6 | 52 | ++tx_top &= 255; |
nagasm | 0:7cdedba0a5e6 | 53 | } |
nagasm | 0:7cdedba0a5e6 | 54 | |
nagasm | 0:7cdedba0a5e6 | 55 | unsigned char hex_conv(unsigned char data){ |
nagasm | 0:7cdedba0a5e6 | 56 | data &= 15; |
nagasm | 0:7cdedba0a5e6 | 57 | if(data < 10) return(data+48); |
nagasm | 0:7cdedba0a5e6 | 58 | else return(data+55); |
nagasm | 0:7cdedba0a5e6 | 59 | } |
nagasm | 0:7cdedba0a5e6 | 60 | |
nagasm | 0:7cdedba0a5e6 | 61 | unsigned char conv_hex(unsigned char data){ |
nagasm | 0:7cdedba0a5e6 | 62 | if((data > 47) && (data < 58)) return(data-48); |
nagasm | 0:7cdedba0a5e6 | 63 | else if((data > 64) && (data < 71)) return(data-55); |
nagasm | 0:7cdedba0a5e6 | 64 | return(0); |
nagasm | 0:7cdedba0a5e6 | 65 | } |
nagasm | 0:7cdedba0a5e6 | 66 | |
nagasm | 0:7cdedba0a5e6 | 67 | void tx_message(int data){ |
nagasm | 0:7cdedba0a5e6 | 68 | int i; |
nagasm | 0:7cdedba0a5e6 | 69 | for (i=0; i<6; i++) tx_fifoset(hex_conv((data>>(4*(5-i))) & 15)); |
nagasm | 0:7cdedba0a5e6 | 70 | tx_fifoset(13); |
nagasm | 0:7cdedba0a5e6 | 71 | } |
nagasm | 0:7cdedba0a5e6 | 72 | |
nagasm | 0:7cdedba0a5e6 | 73 | int main(){ |
nagasm | 0:7cdedba0a5e6 | 74 | int i, sum; |
nagasm | 0:7cdedba0a5e6 | 75 | i = 0; |
nagasm | 0:7cdedba0a5e6 | 76 | rx_top = rx_end = tx_top = tx_end = phase = 0; |
nagasm | 0:7cdedba0a5e6 | 77 | for (i=0; i<5; i++) timer_value[i] = 0; |
nagasm | 0:7cdedba0a5e6 | 78 | xbee.baud(38400); |
nagasm | 0:7cdedba0a5e6 | 79 | xbee.attach(&rx_fifoset, xbee.RxIrq); |
nagasm | 0:7cdedba0a5e6 | 80 | timer_setup.attach_us(&timer_interrupt, 50); |
nagasm | 0:7cdedba0a5e6 | 81 | while(1){ |
nagasm | 0:7cdedba0a5e6 | 82 | if(timer_value[2] > 99){ |
nagasm | 0:7cdedba0a5e6 | 83 | timer_value[2] = 0; |
nagasm | 0:7cdedba0a5e6 | 84 | uint16_t data = analog_value3.read_u16(); |
nagasm | 0:7cdedba0a5e6 | 85 | tx_message(data); |
nagasm | 0:7cdedba0a5e6 | 86 | } |
nagasm | 0:7cdedba0a5e6 | 87 | if(timer_value[0] > 9999){ |
nagasm | 0:7cdedba0a5e6 | 88 | timer_value[0] = 0; |
nagasm | 0:7cdedba0a5e6 | 89 | myled = !myled; |
nagasm | 0:7cdedba0a5e6 | 90 | } |
nagasm | 0:7cdedba0a5e6 | 91 | tx_fifo_check(); |
nagasm | 0:7cdedba0a5e6 | 92 | if(rx_fifo_check() == 1){ |
nagasm | 0:7cdedba0a5e6 | 93 | sum = 0; |
nagasm | 0:7cdedba0a5e6 | 94 | for (i=0; i<6; i++) sum += conv_hex(raw_data[i])<<(4*(5-i)); |
nagasm | 0:7cdedba0a5e6 | 95 | tx_message(sum); /* Echo Back */ |
nagasm | 0:7cdedba0a5e6 | 96 | } |
nagasm | 0:7cdedba0a5e6 | 97 | } |
nagasm | 0:7cdedba0a5e6 | 98 | } |