|
|
@@ -30,7 +30,7 @@
|
|
|
int i;
|
|
|
for(i=ARDUINO_ARRAY_INDEX_FIRST;i<=Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_CURRENT_A;i++) {
|
|
|
if(Slave_Ports_Status_A[i].Broadcast_state == Broadcast_state_TO_REFRESH and Slave_Ports_Status_A[i].IS_Local_A == IS_Local_TRUE) {
|
|
|
- #if defined(DEBUG)
|
|
|
+ #ifdef DEBUG || DEBUG_CAN
|
|
|
if(DEBUG > 4) {
|
|
|
Serial.print(" ind:"); Serial.print(i); Serial.print("] IS_Local_A:");
|
|
|
Serial.print(Slave_Ports_Status_A[i].IS_Local_A);
|
|
|
@@ -49,11 +49,13 @@
|
|
|
//message.concat(Slave_Ports_Status_A[i].Port_ID);
|
|
|
//DISPLAY_array16_T DISPLAY_array16_AAT ;
|
|
|
//message.toCharArray(DISPLAY_array16_AAT, message.length());
|
|
|
+ DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A,
|
|
|
+ DISPLAY_CURSOR_Y_CHARS_CAN_DEBUG);
|
|
|
DISPLAY__print(
|
|
|
DISPLAY_A ,
|
|
|
DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
|
|
|
DISPLAY_PHYSICAL_CHAR_A,
|
|
|
- DISPLAY_pos_seq_A_NEXT,
|
|
|
+ DISPLAY_pos_seq_A_NEXT + DISPLAY_pos_seq_A_IMMEDIATE,
|
|
|
DISPLAY_array16_I( "#53 BCAST " + char( Slave_Ports_Status_A[i].Port_ID ) , 2), //message,
|
|
|
DISPLAY_TARGET_DISPLAY128,
|
|
|
millis() , // time_seq_id_T time_seq_id_A;
|
|
|
@@ -80,16 +82,68 @@
|
|
|
Serial.print("#303 byte data[8] 1["); Serial.print(Slave_Ports_Status_A[i].Address); Serial.print("] 2["); Serial.print(0x04); Serial.print("] 3[");
|
|
|
Serial.print(Slave_Ports_Status_A[i].LocalPort); Serial.print("] 4["); Serial.print(Slave_Ports_Status_A[i].PortTypes); Serial.print("] 5["); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] 6[");
|
|
|
Serial.print( Slave_Ports_Status_A[i].Exp_state_ttl); Serial.print("] 7["); Serial.print(0x07); Serial.println("] ");
|
|
|
- byte sndStat = CAN0.sendMsgBuf(Slave_Ports_Status_A[i].Port_ID, 0, 8, data);
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A,
|
|
|
+ DISPLAY_CURSOR_Y_CHARS_CAN_DEBUG);
|
|
|
+ DISPLAY_array16_T DISPLAY_array16_AA="" ;
|
|
|
+ //( "OUT I2C 0X40[2]" + encoderPos * 5 , 2), //message,
|
|
|
+ _Slave_Ports_Protocol_CAN_broadcast_T CAN_broadcast_A={};
|
|
|
+ // CAN_broadcast_A._CAN_REMOTE_ID = _CAN_REMOTE_ID_BROADCAST ;
|
|
|
+ // CAN_broadcast_A._CAN_SENDER_ID = Active_ControllerID ;
|
|
|
+ CAN_broadcast_A.Port_ID = Slave_Ports_Status_A[i].Port_ID ;
|
|
|
+ CAN_broadcast_A.PortTypes = Slave_Ports_Status_A[i].PortTypes ;
|
|
|
+ CAN_broadcast_A.Exp_state = Slave_Ports_Status_A[i].Exp_state ;
|
|
|
+ CAN_broadcast_A.Exp_state_ttl = Slave_Ports_Status_A[i].Exp_state_ttl ;
|
|
|
+ CAN_broadcast_A.Broadcast_state = Slave_Ports_Status_A[i].Broadcast_state ;
|
|
|
+
|
|
|
+ // CAN_broadcast_A._CAN_8 = _CAN_8_EMPTY ;
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ String message = "CAN BCAST "; message.concat(i); message.concat("."); message.concat(Slave_Ports_Status_A[i].Port_ID); message.concat(" >>>");
|
|
|
+
|
|
|
+ message.toCharArray(DISPLAY_array16_AA, message.length());
|
|
|
+ DISPLAY__print(
|
|
|
+ DISPLAY_A ,
|
|
|
+ DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
|
|
|
+ DISPLAY_PHYSICAL_CHAR_A,
|
|
|
+ DISPLAY_pos_seq_A_NEXT,
|
|
|
+ DISPLAY_array16_AA,
|
|
|
+ DISPLAY_TARGET_DISPLAY128,
|
|
|
+ millis() , // time_seq_id_T time_seq_id_A;
|
|
|
+ millis()+5000, //time_min_run_T time_min_run_A;
|
|
|
+ //queue
|
|
|
+ Slave_Ports_Status_QUEUE_A,
|
|
|
+ TASK_TYPE_T_Slave_Ports_broadcast____ , //TASK_TYPE_A,
|
|
|
+ { } //TASK_PORT_ASSOC_A Slave_Ports_Status_A[i].Port_ID
|
|
|
+
|
|
|
+ );
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ // byte sndStat = CAN0.sendMsgBuf(Slave_Ports_Status_A[i].Port_ID, 0, 8, data);
|
|
|
+ //byte CAN_broadcast_A8[8];
|
|
|
+ byte CAN_broadcast_A8 = CAN_broadcast_to_data(CAN_broadcast_A);
|
|
|
+
|
|
|
+ byte sndStat = CAN0.sendMsgBuf(Active_ControllerID, 0, 8, CAN_broadcast_A8);
|
|
|
// byte sndStat ;
|
|
|
if(sndStat == CAN_OK){
|
|
|
Serial.println("#921 Message Sent Successfully!");
|
|
|
//String LCDarray1 = "Message Sent";
|
|
|
//String LCDarray2 = "Successfully";
|
|
|
+ DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A,
|
|
|
+ DISPLAY_CURSOR_Y_CHARS_CAN_DEBUG);
|
|
|
DISPLAY__print( DISPLAY_A ,
|
|
|
DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
|
|
|
DISPLAY_PHYSICAL_CHAR_A,
|
|
|
- DISPLAY_pos_seq_A_NEXT,
|
|
|
+ DISPLAY_pos_seq_A_NEXT + DISPLAY_pos_seq_A_IMMEDIATE,
|
|
|
DISPLAY_array16_I( "#92MSG Sent OK " + char( Slave_Ports_Status_A[i].Port_ID ) , 2), //message,
|
|
|
DISPLAY_TARGET_DISPLAY128,
|
|
|
millis() , // time_seq_id_T time_seq_id_A;
|
|
|
@@ -100,11 +154,11 @@
|
|
|
{ Slave_Ports_Status_A[i].Port_ID } //TASK_PORT_ASSOC_A
|
|
|
);
|
|
|
} else {
|
|
|
- Serial.println("Error Sending Message...");
|
|
|
+ Serial.print("Error Sending Message... ["); Serial.print(sndStat); Serial.println("] ");
|
|
|
DISPLAY__print( DISPLAY_A ,
|
|
|
DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
|
|
|
DISPLAY_PHYSICAL_CHAR_A,
|
|
|
- DISPLAY_pos_seq_A_NEXT,
|
|
|
+ DISPLAY_pos_seq_A_NEXT + DISPLAY_pos_seq_A_IMMEDIATE,
|
|
|
DISPLAY_array16_I( "#107MSG ERROR " + char( Slave_Ports_Status_A[i].Port_ID ) , 2), //message,
|
|
|
DISPLAY_TARGET_DISPLAY128,
|
|
|
millis() , // time_seq_id_T time_seq_id_A;
|