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