Yoichi Nagashima / Mbed 2 deprecated CQ_nagasm_04_AD_test

NucleoF401RE A/D test. 5msec sampling (by timer interrupt), transmit via XBee with 7 bytes message format.

Dependencies:   mbed

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?

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