main

Dependencies:   TextLCD mbed PID

usart.cpp

Committer:
com3
Date:
2014-03-17
Revision:
5:6604ec9044a0
Parent:
4:536cd493a337

File content as of revision 5:6604ec9044a0:

#include "mbed.h"
#include "common.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])
#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])
#define DATA_NUM 11
#define CHECK (DATA_NUM - 1)
#define ALL_IR 11


extern Serial xbee;
extern Serial sensor;
extern Serial pc;
extern DigitalOut myled[4];

extern uint8_t value_ir, ir_num, ir_dis, ball_on;
extern uint8_t ping[4];
extern uint8_t line[4];
extern uint8_t ir_max, ir_num;
extern int compass;

int count = 0;
void xbee_tx(){
    xbee.putc(1);
}

void xbee_rx(){
    if(xbee.readable()){
        count = xbee.getc();
    } else {
        count = 0;
    }
    //pc.printf("%d\n", count);
}

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){
            value_ir = 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_dis = rx_data[9];
            //ball_on = rx_data[10];
/*            line[FRONT] = rx_data[7];
            line[LEFT] = rx_data[8];
            line[BACK] = rx_data[9];
            line[RIGHT] = rx_data[10];
*/          
            //pc.printf("%d %d\n", rx_data[1], rx_data[2]); 
            //pc.printf("%d %d %d %d\n", rx_data[3], rx_data[4], rx_data[5], rx_data[6]);
            //pc.printf("%d %d %d %d\n", rx_data[7], rx_data[8], rx_data[9], rx_data[10]);
            //pc.printf("%d %d %d\n", rx_data[7], rx_data[8], compass);
            //pc.printf("%d\n", rx_data[7]);
            //pc.printf("%d\t%d\t%d\t%d\n", ping[FRONT], ping[LEFT], ping[BACK], ping[RIGHT]);
            //pc.printf("%d %d  %d\n", ping[LEFT], ping[RIGHT], ping[LEFT] + ping[RIGHT]);
            //pc.printf("%d\t%d\t%d\t%d\n", ir_dis, ball_on, value_ir, ir_num);
        }
     rx = 0;   
    }
    //pc.printf("%d\n", rx_data[rx]);
}

/*
void micon_tx(){
    
    static uint8_t tx;
    static uint8_t tx_data[DATA_NUM];
    
    if(tx >= DATA_NUM){
        tx_data[0] = KEYCODE;
        tx_data[1] = KEYCODE;
        tx_data[2] = KEYCODE;
        tx_data[3] = KEYCODE;
        tx_data[4] = KEYCODE;
        tx_data[5] = KEYCODE;
        tx_data[6] = KEYCODE;
        tx_data[7] = KEYCODE;
        tx_data[8] = KEYCODE;
        tx_data[9] = KEYCODE;
        tx_data[10] = KEYCODE;
        tx_data[11] = TX_CHECKCODE;
        
        tx = 0;
    }
    
    sensor.putc(tx_data[tx]);
    tx++;
}
*/