Microduino的cube小车。

Dependencies:   mbed-rtos mbed

Committer:
lixianyu
Date:
Sat May 28 05:09:18 2016 +0000
Revision:
4:0670023d3f36
Parent:
3:e4ac7c1a14de
??work????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lixianyu 3:e4ac7c1a14de 1 #include "Microduino_Protocol_HardSer.h"
lixianyu 1:758ccab13947 2
lixianyu 1:758ccab13947 3 //BLE//////////////////////
lixianyu 3:e4ac7c1a14de 4 Serial pc(P0_4,P0_0);
lixianyu 4:0670023d3f36 5 //Serial pc(P0_0, P0_4);
lixianyu 3:e4ac7c1a14de 6 Protocol bleProtocol(&pc, TYPE_NUM); //软串口,校验数据类
lixianyu 1:758ccab13947 7
lixianyu 1:758ccab13947 8 #define this_node 1 //设置本机ID
lixianyu 1:758ccab13947 9 #define other_node 0
lixianyu 1:758ccab13947 10 struct send_a { //发送
lixianyu 1:758ccab13947 11 uint32_t node_ms; //节点运行时间
lixianyu 1:758ccab13947 12 };
lixianyu 1:758ccab13947 13 struct receive_a { //接收
lixianyu 1:758ccab13947 14 uint32_t ms;
lixianyu 1:758ccab13947 15 uint16_t rf_CH[CHANNEL_NUM];
lixianyu 1:758ccab13947 16 };
lixianyu 1:758ccab13947 17
lixianyu 1:758ccab13947 18 //Mode//////////////////////
lixianyu 1:758ccab13947 19 enum _Mode {
lixianyu 1:758ccab13947 20 NRF,
lixianyu 1:758ccab13947 21 BLE
lixianyu 1:758ccab13947 22 };
lixianyu 1:758ccab13947 23
lixianyu 3:e4ac7c1a14de 24 bool protocolSetup(void)
lixianyu 1:758ccab13947 25 {
lixianyu 3:e4ac7c1a14de 26 bleProtocol.begin(BLE_SPEED);
lixianyu 3:e4ac7c1a14de 27 return BLE;
lixianyu 1:758ccab13947 28 }
lixianyu 1:758ccab13947 29
lixianyu 1:758ccab13947 30 bool protocolRead(uint16_t *_channel, bool _mode)
lixianyu 1:758ccab13947 31 {
lixianyu 3:e4ac7c1a14de 32 switch (bleProtocol.parse(_channel, MODE_WHILE)) {
lixianyu 3:e4ac7c1a14de 33 case P_NONE: //DATA NONE
lixianyu 3:e4ac7c1a14de 34 break;
lixianyu 3:e4ac7c1a14de 35 case P_FINE: //DATA OK
lixianyu 3:e4ac7c1a14de 36 return true;
lixianyu 3:e4ac7c1a14de 37 break;
lixianyu 3:e4ac7c1a14de 38 case P_ERROR: //DATA ERROR
lixianyu 1:758ccab13947 39 #ifdef BLE_SoftSerial
lixianyu 3:e4ac7c1a14de 40 mySerial.stopListening();
lixianyu 3:e4ac7c1a14de 41 mySerial.listen();
lixianyu 1:758ccab13947 42 #endif
lixianyu 3:e4ac7c1a14de 43 break;
lixianyu 3:e4ac7c1a14de 44 case P_TIMEOUT: //DATA TIMEOUT
lixianyu 1:758ccab13947 45 #ifdef BLE_SoftSerial
lixianyu 3:e4ac7c1a14de 46 mySerial.stopListening();
lixianyu 3:e4ac7c1a14de 47 mySerial.listen();
lixianyu 1:758ccab13947 48 #endif
lixianyu 3:e4ac7c1a14de 49 break;
lixianyu 1:758ccab13947 50 }
lixianyu 1:758ccab13947 51 return false;
lixianyu 1:758ccab13947 52 }