NagaokaRoboticsClub_mbedTeam / ikarashiCAN

Dependencies:   DataControl

Revision:
5:664bd71935c3
Parent:
2:05d0790d0fc6
Child:
6:503b975c3c8e
diff -r d4c9f57a98c6 -r 664bd71935c3 ikarashiCAN.cpp
--- a/ikarashiCAN.cpp	Fri Sep 30 04:30:33 2022 +0000
+++ b/ikarashiCAN.cpp	Sat Oct 01 16:20:05 2022 +0000
@@ -2,7 +2,7 @@
 #include "ikarashiCAN.h"
 
 ikarashiCAN::ikarashiCAN(PinName rd, PinName td, int msgID, int frequency):
-    can(rd, td, frequency), msg(msgID, reciever, 4)
+    can(rd, td, frequency), msg(msgID, reciever, 5)
 {
     _msgID = msgID;
     sended_msgID = 0;
@@ -12,7 +12,7 @@
 }
 
 ikarashiCAN::ikarashiCAN(PinName rd, PinName td, int msgID):
-    can(rd, td, 50000), msg(msgID, reciever, 4)
+    can(rd, td, 50000), msg(msgID, reciever, 5)
 {
     _msgID = msgID;
     sended_msgID = 0;
@@ -34,7 +34,7 @@
 void ikarashiCAN::send()
 {
     can_s = 0;
-    if(can.write(CANMessage(_msgID, sender, separated_data_size))) {
+    if(can.write(CANMessage(_msgID, sender, separated_data_size + 1))) {
         can_s = 1;
     }
 }
@@ -97,14 +97,22 @@
     return msg.len;
 }
 
+void ikarashiCAN::originalSet(unsigned short free_num){
+    sender[separated_data_size] = free_num;
+}
+
+int ikarashiCAN::originalGet(){
+    return msg.data[msg.len-1];   
+}
+
 void ikarashiCAN::sender_reset()
 {
-    for(int i=0; i<4; i++) sender[i] = 0;
+    for(int i=0; i<5; i++) sender[i] = 0;
 }
 
 void ikarashiCAN::reciever_reset()
 {
-    for(int i=0; i<4; i++) reciever[i] = 0;
+    for(int i=0; i<5; i++) reciever[i] = 0;
 }