Yoichi Nagashima / Mbed 2 deprecated CQ_nagasm_05_detection

NucleoF401RE A/D Envelope detection with Moving average, transfer via XBww

Dependencies:   mbed

sub.hpp@0:14c6afea35c7, 2014-12-09 (annotated)

Committer:
nagasm
Date:
Tue Dec 09 00:51:38 2014 +0000
Revision:
0:14c6afea35c7
NucleoF401RE A/D Envelope detection with Moving average, transfer via XBww

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nagasm 0:14c6afea35c7 1 unsigned char rxFIFO[256], txFIFO[256], raw_data[6];
nagasm 0:14c6afea35c7 2 unsigned char rx_top, rx_end, tx_top, tx_end, phase;
nagasm 0:14c6afea35c7 3 int timer_value[6];
nagasm 0:14c6afea35c7 4
nagasm 0:14c6afea35c7 5 RawSerial xbee(PA_2, PA_3);
nagasm 0:14c6afea35c7 6 Ticker timer_setup;
nagasm 0:14c6afea35c7 7 AnalogIn analog_value0(A0);
nagasm 0:14c6afea35c7 8 AnalogIn analog_value1(A1);
nagasm 0:14c6afea35c7 9 AnalogIn analog_value2(A2);
nagasm 0:14c6afea35c7 10 AnalogIn analog_value3(A3);
nagasm 0:14c6afea35c7 11 DigitalOut myled(LED1);
nagasm 0:14c6afea35c7 12
nagasm 0:14c6afea35c7 13 void common_setup(){
nagasm 0:14c6afea35c7 14 rx_top = rx_end = tx_top = tx_end = phase = 0;
nagasm 0:14c6afea35c7 15 }
nagasm 0:14c6afea35c7 16
nagasm 0:14c6afea35c7 17 void timer_interrupt(){
nagasm 0:14c6afea35c7 18 int i;
nagasm 0:14c6afea35c7 19 for (i=0; i<6; i++) ++timer_value[i] &= 65535;
nagasm 0:14c6afea35c7 20 }
nagasm 0:14c6afea35c7 21
nagasm 0:14c6afea35c7 22 void tx_fifo_check(){
nagasm 0:14c6afea35c7 23 if(xbee.writeable() == 1){
nagasm 0:14c6afea35c7 24 if(tx_top != tx_end){
nagasm 0:14c6afea35c7 25 xbee.putc(txFIFO[tx_end]);
nagasm 0:14c6afea35c7 26 ++tx_end &= 255;
nagasm 0:14c6afea35c7 27 }
nagasm 0:14c6afea35c7 28 }
nagasm 0:14c6afea35c7 29 }
nagasm 0:14c6afea35c7 30
nagasm 0:14c6afea35c7 31 int rx_fifo_check(){
nagasm 0:14c6afea35c7 32 unsigned char data;
nagasm 0:14c6afea35c7 33 if(rx_top != rx_end){
nagasm 0:14c6afea35c7 34 data = rxFIFO[rx_end];
nagasm 0:14c6afea35c7 35 ++rx_end &= 255;
nagasm 0:14c6afea35c7 36 if (data < 33){
nagasm 0:14c6afea35c7 37 phase = 0;
nagasm 0:14c6afea35c7 38 return(1);
nagasm 0:14c6afea35c7 39 }
nagasm 0:14c6afea35c7 40 raw_data[phase] = data;
nagasm 0:14c6afea35c7 41 if(++phase > 5) phase = 0;
nagasm 0:14c6afea35c7 42 return(0);
nagasm 0:14c6afea35c7 43 }
nagasm 0:14c6afea35c7 44 return(0);
nagasm 0:14c6afea35c7 45 }
nagasm 0:14c6afea35c7 46
nagasm 0:14c6afea35c7 47 void rx_fifoset(void){
nagasm 0:14c6afea35c7 48 rxFIFO[rx_top] = xbee.getc();
nagasm 0:14c6afea35c7 49 ++rx_top &= 255;
nagasm 0:14c6afea35c7 50 }
nagasm 0:14c6afea35c7 51
nagasm 0:14c6afea35c7 52 void tx_fifoset(unsigned char data){
nagasm 0:14c6afea35c7 53 txFIFO[tx_top] = data;
nagasm 0:14c6afea35c7 54 ++tx_top &= 255;
nagasm 0:14c6afea35c7 55 }
nagasm 0:14c6afea35c7 56
nagasm 0:14c6afea35c7 57 unsigned char hex_conv(unsigned char data){
nagasm 0:14c6afea35c7 58 data &= 15;
nagasm 0:14c6afea35c7 59 if(data < 10) return(data+48);
nagasm 0:14c6afea35c7 60 else return(data+55);
nagasm 0:14c6afea35c7 61 }
nagasm 0:14c6afea35c7 62
nagasm 0:14c6afea35c7 63 unsigned char conv_hex(unsigned char data){
nagasm 0:14c6afea35c7 64 if((data > 47) && (data < 58)) return(data-48);
nagasm 0:14c6afea35c7 65 else if((data > 64) && (data < 71)) return(data-55);
nagasm 0:14c6afea35c7 66 return(0);
nagasm 0:14c6afea35c7 67 }
nagasm 0:14c6afea35c7 68
nagasm 0:14c6afea35c7 69 void tx_message(int data){
nagasm 0:14c6afea35c7 70 int i;
nagasm 0:14c6afea35c7 71 for (i=0; i<6; i++) tx_fifoset(hex_conv((data>>(4*(5-i))) & 15));
nagasm 0:14c6afea35c7 72 tx_fifoset(13);
nagasm 0:14c6afea35c7 73 }