sensor

Dependencies:   HMC6352 mbed

Fork of program_SensorBlock by Fumiya Fujisawa

usart.cpp

Committer:
com3
Date:
2014-03-12
Revision:
8:f547b66f3c43
Parent:
6:97015325107b

File content as of revision 8:f547b66f3c43:

#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])
#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 12
#define CHECK (DATA_NUM - 1)
#define ALL_IR 12
#define ALL_PING 4
#define ALL_LINE 4



extern Serial sensor;
extern Serial pc;
extern unsigned int value_ping[ALL_PING];
extern unsigned int value_ir[ALL_IR];
extern unsigned int value_ir_min;
extern unsigned int ir_min_num;
extern unsigned int value_line[ALL_LINE];
extern unsigned int value_compass[2];
/*
void micon_rx(){
    
    static uint8_t rx;
    static uint8_t 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){
             pc.printf("%d %d %d %d %d\n", rx_data[1], rx_data[2], rx_data[3], rx_data[4], rx_data[5]);
        }  
     rx = 0;   
    }

}
*/

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] = value_ir_min;
        tx_data[2] = ir_min_num;
        tx_data[3] = value_ping[0];
        tx_data[4] = value_ping[1];
        tx_data[5] = value_ping[2];
        tx_data[6] = value_ping[3];
/*        tx_data[7] = value_line[0];
        tx_data[8] = value_line[1];
        tx_data[9] = value_line[2];
        tx_data[10] = value_line[3];
*/
        tx_data[7] = value_compass[0];
        tx_data[8] = value_compass[1];
        tx_data[9] = value_ir[10];
        tx_data[10] = value_ir[11];
        tx_data[11] = TX_CHECKCODE;
        
        tx = 0;
    }
    
    
    sensor.putc(tx_data[tx]);
    //pc.printf("%d\n", tx_data[tx]);
    tx++;
    //wait(0.1);
}