リスト2-3-2.txt

■リスト2-3-2■

#include "mbed.h"

unsigned char rxFIFO[256], txFIFO[256], raw_data[6];	// FIFOバッファ等の定義
unsigned char rx_top, rx_end, tx_top, tx_end, phase;	// FIFOポインタ等の定義

RawSerial xbee(PA_2, PA_3);
DigitalOut myled(LED1);

void tx_fifo_check(){
    if(xbee.writeable() == 1){			// シリアル送信バッファが「空」であるか?
        if(tx_top != tx_end){			// FIFO送信バッファに送信データがあるか?
            xbee.putc(txFIFO[tx_end]);		// FIFO送信バッファから1バイトをXBee送信
            ++tx_end &= 255;			// FIFO送信読み出しポインタを1つ進める
        }
    }
    return;
}

int rx_fifo_check(){
    unsigned char data;
    if(rx_top != rx_end){				// FIFO受信バッファに受信データがあるか?
        data = rxFIFO[rx_end];			// 1バイトをFIFO受信バッファから受けとる
        ++rx_end &= 255;				// FIFO送信読み出しポインタを1つ進める
        if (data < 33){
            phase = 0;
            return(1);					// 有効データならメインに返す
        }
        raw_data[phase] = data;			// 7バイトフォーマットに積む
        if(++phase > 5) phase = 0;
        return(0);
    }
    return(0);
}

void rx_fifoset(void){
    rxFIFO[rx_top] = xbee.getc();		// 受信割り込みがあればデータをFIFO受信バッファに積む
    ++rx_top &= 255;					// FIFO受信書き込みポインタを1つ進める
    return;
}

void tx_fifoset(unsigned char data){
    txFIFO[tx_top] = data;				// データをFIFO送信バッファに積む
    ++tx_top &= 255;					// FIFO送信書き込みポインタを1つ進める
    return;
}

unsigned char hex_conv(unsigned char data){	// 受けとった数値(0-15)を16進文字に変換
    data &= 15;
    if(data < 10) return(data+48);
    else return(data+55);
}

unsigned char conv_hex(unsigned char data){	// 受けとった16進文字を数値(0-15)に変換
    if((data > 47) && (data < 58)) return(data-48);
    else if((data > 64) && (data < 71)) return(data-55);
    return(0);
}

void tx_message(int data){	// 受けとった24ビット数値を7バイトフォーマットのメッセージで送信FIFOに積む
    int i;
    for (i=0; i<6; i++){
        tx_fifoset(hex_conv((data>>(4*(5-i))) & 15));
    }
    tx_fifoset(13);
}

int main(){
    int i, j, k, sum;
    i = j = k = 0;
    rx_top = rx_end = tx_top = tx_end = phase = 0; 
    xbee.baud(38400);
    xbee.attach(&rx_fifoset, xbee.RxIrq);		// XBee受信割り込みの設定
    while(1){
        tx_fifo_check();						// 送信FIFOをチェック
        if(rx_fifo_check() == 1){				// 受信FIFOをチェック
            sum = 0;
            for (i=0; i<6; i++){
                sum += conv_hex(raw_data[i])<<(4*(5-i));
            }
            tx_message(sum); 				// 受信したメッセージを送信FIFOに積む(エコーバック)
        }
        if(++j > 1000000){
            j = 0;
            myled = !myled;
            k &= 8388607;
            tx_message(k++); 				// インクリメント値をメッセージとして送信FIFOに積む
        }
    }
}

========================
mbedサイト
http://developer.mbed.org/users/nagasm/code/CQ_nagasm_02_serialRXTX_FIFO/
にて公開中
========================
