version 3 通信方式,マイコン等に変更あり

Dependencies:   AQM0802A PID Servo mbed

usart.cpp

Committer:
ryuna
Date:
2015-03-10
Revision:
2:e84bb87eea71

File content as of revision 2:e84bb87eea71:

#include "mbed.h"


#define KEYCODE 0xAA
#define TX_CHECKCODE (tx_data[1]^tx_data[2]^tx_data[3]^tx_data[4]^tx_data[5]^tx_data[6]^tx_data[7]^tx_data[8]^tx_data[9]^tx_data[10])
#define RX_CHECKCODE (rx_data[1]^rx_data[2]^rx_data[3]^rx_data[4]^rx_data[5]^rx_data[6]^rx_data[7]^rx_data[8]^rx_data[9]^tx_data[10])
#define DATA_NUM 11
#define CHECK (DATA_NUM - 1)


extern Serial sensor;
extern Serial pc;

extern uint8_t ping[4];



void micon_rx(){
    
    static uint8_t rx;
    static int rx_data[DATA_NUM];
    
    rx_data[rx] = sensor.getc();
    
    if(rx_data[0] == KEYCODE){
        rx++;
    }
    
    if(rx >= DATA_NUM){
        if(rx_data[CHECK] == RX_CHECKCODE){
            ir_min = rx_data[1];
            ir_num = rx_data[2];
            ping[FRONT] = rx_data[3];
            ping[LEFT] = rx_data[4];
            ping[BACK] = rx_data[5];
            ping[RIGHT] = rx_data[6];
            compass = rx_data[7] + rx_data[8];
            ir_main = rx_data[9];
            //pc.printf("compass: %d\n",compass);
 
        } 
     rx = 0;   
    }
    
    //pc.printf("%d\n", rx_data[rx]);
}