$B%j%9%H(B2-4-1.txt

$B"#%j%9%H(B2-4-1$B"#(B

$B!|%a%$%s!!(Bmain.cpp

#include "mbed.h"
#include "sub.hpp"		// $B6&DLDj5AItJ,$r!V(Bsub.hpp$B!W$K@Z$jJ,$1(B

float mean_sum, ad_data[201];				// $B0\F0J?6Q$N7k2L$H!":GBg(B200$BCJ$N0\F0J?6QMQ(BFIFO$B%P%C%U%!(B
int average_mode, max_count, ad_pointer[5];	// $B@_Dj%Q%i%a!<%?(B : $BA4GH@0N.(BON/OFF$B!"0\F0J?6QCJ?t(B

void sum_clear(){
    int i;
    for (i=0; i<5; i++) ad_pointer[i] = 0;
    for (i=0; i<201; i++) ad_data[i] = 0;
    mean_sum = 0;
}

float move_mean_calc(float data){						// $B0\F0J?6Q$N7W;;(B
    mean_sum = mean_sum - ad_data[ad_pointer[0]] + data;		// $B:G?7CM$r2C;;$7$F:G8ECM$r8:;;$9$k(B
    ad_data[ad_pointer[0]] = data;								// $B:G?7CM$r(BFIFO$B$K@Q$`(B
    ad_pointer[0]++;											// FIFO$B$N%]%$%s%?$r(B1$B$D?J$a$k(B
    if(ad_pointer[0] == max_count) ad_pointer[0] = 0;
    return(mean_sum / (float)max_count);						// $B0\F0J?6Q$NCJ?t$G3d$C$?7k2L$rJV$9(B
}

int main(){
    int i, detection, sum, gain;
    i = 0;
    detection = 0;
    gain = 1;
    average_mode = 0;
    for (i=0; i<5; i++) timer_value[i] = 0;
    sum_clear();
    xbee.baud(38400);
    xbee.attach(&rx_fifoset, xbee.RxIrq);
    timer_setup.attach_us(&timer_interrupt, 50); // 50usec
    while(1){
        if(timer_value[2] > 99){ 							// 5msec$B$N%5%s%W%j%s%0<~4|$4$H$N=hM}(B
            timer_value[2] = 0;
            float data = (float)gain * (analog_value3.read() - 0.5f);
			// A/D$BF~NO%G!<%?$rF@$FA}I}$9$k!"$3$3$G$O<#6q$J$N$G!V(B3$B!W!#6ZEE$J$i!V(B0$B!W$+!V(B1$B!W$K$9$k(B
            if(detection == 1){									// $BA4GH@0N.$,(BON$B$G$"$l$P(B
                if (data < 0) data = -data;							// $B%^%$%J%9$J$iId9f$rJQ$($k(B
            }
            if(average_mode != 0) data = move_mean_calc(data);	// $B0\F0J?6Q$N=hM}(B
            tx_message((uint16_t)((data + 1.0f) * 2047)<<4);		// $B%[%9%H$K7k2L$r(BXBee$B$GAw?.(B
        }
        if(timer_value[0] > 9999){ // 500msec
            timer_value[0] = 0;
            myled = !myled;
        }
        tx_fifo_check();
        if(rx_fifo_check() == 1){
            sum = 0;
            for (i=0; i<6; i++) sum += conv_hex(raw_data[i])<<(4*(5-i));
            tx_message(sum); /* Echo Back */
            if(sum>>16 == 0x80){
                switch((sum & 0xff00)>>8){
                    case 0x00:
                        detection = sum & 0x01;		// $B%[%9%H$+$i$N%3%^%s%I$GA4GH@0N.$N(BON/OFF$B$rJQ99(B
                        break;
                    case 0x01:
                        gain = sum & 0x0f;				// $B%[%9%H$+$i$N%3%^%s%I$G(BA/D$BF~NO$NA}I}%2%$%s$rJQ99(B
                        break;
                    case 0x02:
                        average_mode = sum & 0x07;	// $B%[%9%H$+$i$N%3%^%s%I$G0\F0J?6Q$NCJ?t$rJQ99(B
                            max_count = 5;
                            switch(average_mode){
                                case(2):
                                    max_count = 10;
                                    break;
                                case(3):
                                    max_count = 20;
                                    break;
                                case(4):
                                    max_count = 50;
                                    break;
                                case(5):
                                    max_count = 100;
                                    break;
                                case(6):
                                    max_count = 200;
                                    break;
                            }
                        sum_clear();
                        break;
                }
            }
        }
    }
}

$B!|%5%V(B sub.hpp

unsigned char rxFIFO[256], txFIFO[256], raw_data[6];
unsigned char rx_top, rx_end, tx_top, tx_end, phase;
int timer_value[6];

RawSerial xbee(PA_2, PA_3);
Ticker timer_setup;
AnalogIn analog_value0(A0);
AnalogIn analog_value1(A1);
AnalogIn analog_value2(A2);
AnalogIn analog_value3(A3);
DigitalOut myled(LED1);

void common_setup(){
    rx_top = rx_end = tx_top = tx_end = phase = 0; 
}

void timer_interrupt(){
    int i;
    for (i=0; i<6; i++) ++timer_value[i] &= 65535;
}

void tx_fifo_check(){
    if(xbee.writeable() == 1){
        if(tx_top != tx_end){
            xbee.putc(txFIFO[tx_end]);
            ++tx_end &= 255;
        }
    }
}

int rx_fifo_check(){
    unsigned char data;
    if(rx_top != rx_end){
        data = rxFIFO[rx_end];
        ++rx_end &= 255;
        if (data < 33){
            phase = 0;
            return(1);
        }
        raw_data[phase] = data;
        if(++phase > 5) phase = 0;
        return(0);
    }
    return(0);
}

void rx_fifoset(void){
    rxFIFO[rx_top] = xbee.getc();
    ++rx_top &= 255;
}

void tx_fifoset(unsigned char data){
    txFIFO[tx_top] = data;
    ++tx_top &= 255;
}

unsigned char hex_conv(unsigned char data){
    data &= 15;
    if(data < 10) return(data+48);
    else return(data+55);
}

unsigned char conv_hex(unsigned char data){
    if((data > 47) && (data < 58)) return(data-48);
    else if((data > 64) && (data < 71)) return(data-55);
    return(0);
}

void tx_message(int data){
    int i;
    for (i=0; i<6; i++) tx_fifoset(hex_conv((data>>(4*(5-i))) & 15));
    tx_fifoset(13);
}

========================
mbed$B%5%$%H(B
http://developer.mbed.org/users/nagasm/code/CQ_nagasm_05_detection/
$B$K$F8x3+Cf(B
========================
