|
|
@@ -47,7 +47,7 @@
|
|
|
|
|
|
);
|
|
|
|
|
|
- Serial.print("#200 Slave_Ports_I2C_POP #COUNT_A"); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_COUNT_A);
|
|
|
+ Serial.print("#200 Slave_Ports_I2C_POP #COUNT_A["); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_COUNT_A);
|
|
|
Serial.print("] INDEX_LAST["); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_LAST_A);
|
|
|
Serial.print("] INDEX_CURRENT["); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_CURRENT_A);
|
|
|
Serial.print("] INDEX_NEXT["); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_NEXT_A);
|
|
|
@@ -64,10 +64,10 @@
|
|
|
for(i=ARDUINO_ARRAY_INDEX_FIRST;i <= (ARDUINO_ARRAY_INDEX_FIRST + Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_COUNT_A) ;i++) {
|
|
|
if(Slave_Ports_Status_A[i].PortTypes & PortTypes_I2C) { //BIN TEST
|
|
|
if(Slave_Ports_Status_A[i].Exp_state_ttl == Exp_state_ttl_TO_REFRESH ) {
|
|
|
- #ifdef DEBUG
|
|
|
+ #ifdef DEBUG || DEBUG_CAN
|
|
|
if(DEBUG > 4) {
|
|
|
Serial.print("#311 ttl min i2c for: I2C_port["); Serial.print(Slave_Ports_Status_A[i].I2C_port); Serial.print("] ttl["); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl);
|
|
|
- Serial.print(" Port_ID["); Serial.print(Slave_Ports_Status_A[i].Port_ID); Serial.println("] "); Serial.print(" id["); Serial.print(i); Serial.println("] ");
|
|
|
+ Serial.print(" Port_ID["); Serial.print(Slave_Ports_Status_A[i].Port_ID); Serial.println("] "); Serial.print(" #["); Serial.print(i); Serial.println("] ");
|
|
|
}
|
|
|
#endif
|
|
|
|
|
|
@@ -77,12 +77,12 @@
|
|
|
//find port status
|
|
|
if(ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_ADD == Adafruit_PWMServoDriver__get_DRIVER_STATUS_T(
|
|
|
Adafruit_PWMServoDriver_A, Adafruit_PWMServoDriver_ATTR_ARRAY_A, Slave_Ports_Status_A[i].Address)) {
|
|
|
- Serial.println("#80 I2C ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_ADD ");
|
|
|
+ Serial.println("#80 I2C [ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_ADD] ");
|
|
|
|
|
|
ARDUINO_ARRAY_INDEX_DRIVER_STATUS_T Adafruit_PWMServoDriver__add_A = Adafruit_PWMServoDriver__add(Adafruit_PWMServoDriver_A,Adafruit_PWMServoDriver_ATTR_ARRAY_A,Slave_Ports_Status_A[i].Address, ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_SETVAL_A) ;
|
|
|
|
|
|
if(ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_SETVAL_A == Adafruit_PWMServoDriver__add_A) {
|
|
|
- Serial.println("#83 I2C ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_SETVAL_A ");
|
|
|
+ Serial.println("#83 I2C [ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_SETVAL_A] ");
|
|
|
|
|
|
// ARDUINO_ARRAY_PRIMARY_KET_T I2C_INDEX_DRIVER_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T(Adafruit_PWMServoDriver_A,Adafruit_PWMServoDriver_ATTR_ARRAY_A,Slave_Ports_Status_A[i].Address);
|
|
|
|
|
|
@@ -109,13 +109,14 @@
|
|
|
}
|
|
|
*/
|
|
|
|
|
|
- Serial.print("#112 I2C ADD OK id:"); Serial.print(I2C_INDEX_DRIVER_A); Serial.println(" ] ");
|
|
|
+ Serial.print("#112 I2C [ADD] [OK[ #"); Serial.print(I2C_INDEX_DRIVER_A); Serial.println(" ] ");
|
|
|
|
|
|
|
|
|
|
|
|
- #ifdef DEBUG_CAN || DEBUG
|
|
|
- Serial.print("#154 before PWM Exp_state_ttl[");
|
|
|
- Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state_ttl)); Serial.print("] Exp_state[");
|
|
|
+ #if DEBUG > 7
|
|
|
+ Serial.print("#["); Serial.print(i); Serial.print("] ");Serial.print("#154 before PWM Exp_state_ttl[");
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state_ttl)); Serial.print("] PortTypes[");
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].PortTypes)); Serial.print("] Broadcast_state[");
|
|
|
Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.print("] Broadcast_state[");
|
|
|
Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Broadcast_state)); Serial.println("] ");
|
|
|
Serial.print("#121 Exp_state[ ");
|
|
|
@@ -134,7 +135,7 @@
|
|
|
if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_OFF )) Serial.print(" [ + OFF ] ");
|
|
|
if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111111 ) ^ Exp_state_OFF )) Serial.print(" [ # OFF ] ");
|
|
|
if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111110 ) ^ B00000001 )) Serial.print(" [ < OFF ] ");
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000001 ) ^ B11111110 )) Serial.print(" [ > OFF ] ");
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000001 ) ^ B11111110 )) Serial.println(" [ > OFF ] ");
|
|
|
#endif
|
|
|
|
|
|
// Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
@@ -143,29 +144,36 @@
|
|
|
|
|
|
|
|
|
if(Slave_Ports_Status_A[i].PortTypes & PortTypes_SERVO) {
|
|
|
+ Serial.print("#147 [PortTypes_SERVO] ");
|
|
|
if(Slave_Ports_Status_A[i].Exp_state & Exp_state_ON) {
|
|
|
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(90, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
+ Serial.print("#149 I2C_driver PortTypes_SERVO->ON Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET; //TODO TEST
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
} else if(Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF) {
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(0, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
+ Serial.print("#155 I2C_driver PortTypes_SERVO->OFF Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET; //TODO TEST
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
}
|
|
|
} else {
|
|
|
-
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state == Exp_state_ON ) {
|
|
|
+ Serial.print("#163 [PortTypes*] ");
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state & Exp_state_ON ) { //TODO BINTEST
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 3000, 3000);
|
|
|
- Serial.print("#77 I2C_driver Exp_state [ON]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.println("] ");
|
|
|
+ Serial.print("#149 I2C_driver ->ON Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET; //TODO BITTEST
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
- } else if(Slave_Ports_Status_A[i].Exp_state == Exp_state_OFF ){
|
|
|
+ } else if(Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ){ //TODO BINTEST
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, 0);
|
|
|
- Serial.print("#77 I2C_driver Exp_state [OFF]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.println("] ");
|
|
|
+ Serial.print("#149 I2C_driver ->OFF Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET; //TODO BITTEST
|
|
|
- } else if(Slave_Ports_Status_A[i].Exp_state == Exp_state_BLINK ){
|
|
|
- Serial.print("#168 I2C_driver [Exp_state_ERROR] before]"); Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] after [");
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
+ } else if(Slave_Ports_Status_A[i].Exp_state & Exp_state_BLINK ){ //TODO BINTEST
|
|
|
+ Serial.print("#168 I2C_driver ->BLINK [Exp_state_ERROR] before]"); Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] after [");
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,2000);
|
|
|
// delay(1000);
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,1000);
|
|
|
@@ -174,14 +182,15 @@
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
} else {
|
|
|
|
|
|
- Serial.print("#7555 unsupp I2C_driver Exp_state "); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.println("] ");
|
|
|
- Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET | Exp_state_ERROR; //TODO BITTEST
|
|
|
+ Serial.print("#183 I2C_driver [UNSUPP] [Exp_state_ERROR] before]"); Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] after [");
|
|
|
+ Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET | Exp_state_ERROR; //TODO BITTEST
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
|
|
|
- #ifdef DEBUG_CAN || DEBUG
|
|
|
+ #if DEBUG > 6
|
|
|
Serial.println(""); Serial.println(i); Serial.print(" #126 after PWM Exp_state_ttl[");
|
|
|
Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state_ttl)); Serial.print("] Exp_state[");
|
|
|
Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.print("] Broadcast_state[");
|
|
|
@@ -210,27 +219,30 @@
|
|
|
|
|
|
Serial.println("] ");
|
|
|
#endif
|
|
|
-
|
|
|
-
|
|
|
+ #ifdef DEBUG_CAN || DEBUG
|
|
|
+ Serial.println(" [#222] "); Serial.println(" [#222] "); Serial.println(" [#222] ");
|
|
|
+ #endif
|
|
|
} else {
|
|
|
- Serial.print("#6699 UNPLANNED I2C_driver ADDRES "); Serial.print(Slave_Ports_Status_A[i].Address); Serial.println("] ");
|
|
|
+ Serial.print("#183 I2C_driver [UNPLANNED][ADDRES] +[Exp_state_ERROR] +[Exp_state_SET] before]"); Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] after [");
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET | Exp_state_ERROR; //TODO BITTEST
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
} else {
|
|
|
- Serial.print("#61122 I2C_driver unsupported "); Serial.print(Slave_Ports_Status_A[i].I2C_driver); Serial.println("] ");
|
|
|
+ Serial.print("#232 I2C_driver [unsupported] +[Exp_state_ERROR] +[Exp_state_SET] before]"); Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] after [");
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET | Exp_state_ERROR; //TODO BITTEST
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
}
|
|
|
|
|
|
-
|
|
|
- }
|
|
|
-
|
|
|
- }
|
|
|
- }
|
|
|
+
|
|
|
+ } else { Serial.print(" #249 #i["); Serial.print(i); Serial.println("] ");}
|
|
|
+
|
|
|
+ } else { Serial.print(" #242 #i["); Serial.print(i); Serial.println("] ");}
|
|
|
+ }
|
|
|
|
|
|
}
|
|
|
//#endif
|