Carte esclave gros robot

Dependencies:   mbed Herkulex_Library_2019 ident_crac actions_Pr

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();