Carte esclave gros robot
Dependencies: mbed Herkulex_Library_2019 ident_crac actions_Pr
Diff: Asservissement/Asservissement.cpp
- Revision:
- 45:11614fc23e53
- Parent:
- 39:124575240d09
- Child:
- 47:ced7758fb2ce
--- a/Asservissement/Asservissement.cpp Sun May 26 10:51:35 2019 +0000 +++ b/Asservissement/Asservissement.cpp Fri May 31 20:53:19 2019 +0000 @@ -49,6 +49,20 @@ can.write(msgTx); } +void Send2Char(unsigned short id, unsigned char d1, unsigned char d2) +{ + CANMessage msgTx=CANMessage(); + msgTx.id=id; + msgTx.len=2; + msgTx.format=CANStandard; + msgTx.type=CANData; + // from sur 2 octets + msgTx.data[0]=(unsigned char)d1; + msgTx.data[1]=(unsigned char)d2; + + can.write(msgTx); +} + void SendMsgCan(unsigned short id, unsigned char* data, int len) { CANMessage msgTx=CANMessage();