Communication for reciever
Dependencies: Fork_Boss_Communication_Robot
Dependents: BEAR_Motion BEAR_Motion_Editing4Betago
Fork of BEAR_Protocol by
Diff: Receiver.cpp
- Revision:
- 22:894bca54ae1a
- Parent:
- 17:774eec1470d8
diff -r 2a7476156519 -r 894bca54ae1a Receiver.cpp --- a/Receiver.cpp Tue Feb 02 01:30:13 2016 +0000 +++ b/Receiver.cpp Wed Feb 03 14:39:08 2016 +0000 @@ -154,17 +154,19 @@ -uint8_t Bear_Receiver::sendUpMargin(uint8_t id,uint8_t *Margin) +uint8_t Bear_Receiver::sendUpMargin(uint8_t id,float Margin) { + uint8_t Int[2],Float[2]; + FloatSep(Margin,Int,Float); ANDANTE_PROTOCOL_PACKET package; package.robotId = id; package.length = 6; package.instructionErrorId = WRITE_DATA; - package.parameter[0]=Margin[0]; - package.parameter[1]=Margin[1]; - package.parameter[2]=Margin[2]; - package.parameter[3]=Margin[3]; + package.parameter[0]=Int[0]; + package.parameter[1]=Int[1]; + package.parameter[2]=Float[0]; + package.parameter[3]=Float[1]; rs485_dirc=1; wait_us(RS485_DELAY); @@ -172,22 +174,23 @@ } -uint8_t Bear_Receiver::sendLowMargin(uint8_t id,uint8_t *Margin) +uint8_t Bear_Receiver::sendLowMargin(uint8_t id,float Margin) { + uint8_t Int[2],Float[2]; + FloatSep(Margin,Int,Float); ANDANTE_PROTOCOL_PACKET package; package.robotId = id; package.length = 6; package.instructionErrorId = WRITE_DATA; - package.parameter[0]=Margin[0]; - package.parameter[1]=Margin[1]; - package.parameter[2]=Margin[2]; - package.parameter[3]=Margin[3]; + package.parameter[0]=Int[0]; + package.parameter[1]=Int[1]; + package.parameter[2]=Float[0]; + package.parameter[3]=Float[1]; rs485_dirc=1; wait_us(RS485_DELAY); return com->sendCommunicatePacket(&package); - } uint8_t Bear_Receiver::sendHeight(uint8_t id,uint8_t *Height)