|
|
@@ -62,12 +62,12 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
|
|
|
);
|
|
|
#if defined(DISABLE_LOOP) || defined(DEBUG) || defined(DEBUG_I2C) || defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- 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);
|
|
|
- Serial.print("] time_min_run_MIN["); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_time_min_run_MIN_A);
|
|
|
- Serial.print("] INDEX_time_min_run_MIN["); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_time_min_run_MIN_A);
|
|
|
+ Serial.print(F("#200 Slave_Ports_I2C_POP #COUNT_A[")); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_COUNT_A);
|
|
|
+ Serial.print(F("] INDEX_LAST[")); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_LAST_A);
|
|
|
+ Serial.print(F("] INDEX_CURRENT[")); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_CURRENT_A);
|
|
|
+ Serial.print(F("] INDEX_NEXT[")); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_NEXT_A);
|
|
|
+ Serial.print(F("] time_min_run_MIN[")); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_time_min_run_MIN_A);
|
|
|
+ Serial.print(F("] INDEX_time_min_run_MIN[")); Serial.print(Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A.ARDUINO_ARRAY_INDEX_time_min_run_MIN_A);
|
|
|
#endif
|
|
|
|
|
|
// if(Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_PORT_ASSOC_A[1].Port_ID > 0 ) {
|
|
|
@@ -91,7 +91,7 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
|
|
|
for(i=i_first;i <= i_max ;i++) {
|
|
|
#if defined(DEBUG) || defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#69PWC [i["); Serial.print(i); Serial.print("] I2CP["); Serial.print(Slave_Ports_Status_A[i].I2C_port); Serial.print("]TTL["); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl); Serial.println("] ");
|
|
|
+ Serial.print(F("#69PWC [i[")); Serial.print(i); Serial.print(F("] I2CP[")); Serial.print(Slave_Ports_Status_A[i].I2C_port); Serial.print(F("]TTL[")); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl); Serial.println(F("] "));
|
|
|
#endif
|
|
|
|
|
|
//TASK_TYPE_T_Set_Ports_Status_LIMITS_A__ASSERT
|
|
|
@@ -101,14 +101,14 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
if(Slave_Ports_Status_A[i].PortTypes & PortTypes_I2C) { //{2 BIN TEST
|
|
|
if(Slave_Ports_Status_A[i].Exp_state_ttl > Exp_state_ttl_FRESH ) {
|
|
|
#if defined(DEBUG) || defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#71PWC["); Serial.print(Slave_Ports_Status_A[i].I2C_port); Serial.print("]TTL--["); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl);
|
|
|
+ Serial.print(F("#71PWC[")); Serial.print(Slave_Ports_Status_A[i].I2C_port); Serial.print(F("]TTL--[")); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl);
|
|
|
#endif
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Slave_Ports_Status_A[i].Exp_state_ttl - 10; //todo (TASK_TYPE_T_Slave_Ports_set_I2C______time_min_run_MIN_A_INCREMENT_A / 1000 )
|
|
|
} else if(1==1 ) { //{3//Slave_Ports_Status_A[i].Exp_state_ttl <= Exp_state_ttl_FRESH
|
|
|
#if defined(DEBUG) || defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
//if(DEBUG > 4) { //{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(" #["); Serial.print(i); Serial.println("] ");
|
|
|
+ Serial.print(F("#311 ttl min i2c for: I2C_port[")); Serial.print(Slave_Ports_Status_A[i].I2C_port); Serial.print(F("] ttl[")); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl);
|
|
|
+ Serial.print(F(" Port_ID[")); Serial.print(Slave_Ports_Status_A[i].Port_ID); Serial.println(F("] ")); Serial.print(F(" #[")); Serial.print(i); Serial.println(F("] "));
|
|
|
//} //{4
|
|
|
#endif
|
|
|
if(Slave_Ports_Status_A[i].I2C_driver == I2C_driver_PCF8574) {
|
|
|
@@ -122,20 +122,20 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
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)) {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.println("#80 I2C [ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_ADD] ");
|
|
|
+ Serial.println(F("#80 I2C [ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_ADD] "));
|
|
|
#endif
|
|
|
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) {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.println("#83 I2C [ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_SETVAL_A] ");
|
|
|
+ Serial.println(F("#83 I2C [ARDUINO_ARRAY_INDEX_DRIVER_STATUS_TO_SETVAL_A] "));
|
|
|
#endif
|
|
|
// 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);
|
|
|
|
|
|
|
|
|
} else {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#83E I2C ADD else "); Serial.print(Adafruit_PWMServoDriver__add_A, BIN); Serial.println(" ] ");
|
|
|
+ Serial.print(F("#83E I2C ADD else ")); Serial.print(Adafruit_PWMServoDriver__add_A, BIN); Serial.println(F(" ] "));
|
|
|
#endif
|
|
|
}
|
|
|
|
|
|
@@ -157,33 +157,33 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
}
|
|
|
*/
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#112 I2C [ADD] [OK[ #"); Serial.print(I2C_INDEX_DRIVER_A); Serial.println(" ] ");
|
|
|
+ Serial.print(F("#112 I2C [ADD] [OK[ #")); Serial.print(I2C_INDEX_DRIVER_A); Serial.println(" ] ");
|
|
|
#endif
|
|
|
|
|
|
|
|
|
#if defined(DEBUG) > 7 || defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- 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[ ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state | Exp_state_SET ) Serial.print(" [ | SET ] ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) Serial.print(" [ & SET ] ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state | Exp_state_ERROR ) Serial.print(" [ | ERR ] ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state & Exp_state_ERROR ) Serial.print(" [ & ERR ] ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state | Exp_state_OFF ) Serial.print(" [ | OFF ] ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) Serial.print(" [ & OFF ] ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state == Exp_state_OFF ) Serial.print(" [ = OFF ] ");
|
|
|
+ Serial.print(F("#[")); Serial.print(i); Serial.print(F("] "));Serial.print(F("#154 before PWM Exp_state_ttl["));
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state_ttl)); Serial.print(F("] PortTypes["));
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].PortTypes)); Serial.print(F("] Broadcast_state["));
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.print(F("] Broadcast_state["));
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Broadcast_state)); Serial.println(F("] "));
|
|
|
+ Serial.print(F("#121 Exp_state[ "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state | Exp_state_SET ) Serial.print(F(" [ | SET ] "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) Serial.print(F(" [ & SET ] "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state | Exp_state_ERROR ) Serial.print(F(" [ | ERR ] "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state & Exp_state_ERROR ) Serial.print(F(" [ & ERR ] "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state | Exp_state_OFF ) Serial.print(F(" [ | OFF ] "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) Serial.print(F(" [ & OFF ] "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state == Exp_state_OFF ) Serial.print(F(" [ = OFF ] "));
|
|
|
//if !( ( z & care_bits ) ^ match_bits )
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) ^ Exp_state_SET )) Serial.print(" [ ^ SET ] ");
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_SET )) Serial.print(" [ + SET ] ");
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111111 ) ^ Exp_state_SET )) Serial.print(" [ # SET ] ");
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) ^ Exp_state_OFF )) Serial.print(" [ ^ OFF ] ");
|
|
|
- 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.println(" [ > OFF ] ");
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) ^ Exp_state_SET )) Serial.print(F(" [ ^ SET ] "));
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_SET )) Serial.print(F(" [ + SET ] "));
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111111 ) ^ Exp_state_SET )) Serial.print(F(" [ # SET ] "));
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) ^ Exp_state_OFF )) Serial.print(F(" [ ^ OFF ] "));
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_OFF )) Serial.print(F(" [ + OFF ] "));
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111111 ) ^ Exp_state_OFF )) Serial.print(F(" [ # OFF ] "));
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111110 ) ^ B00000001 )) Serial.print(F(" [ < OFF ] "));
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000001 ) ^ B11111110 )) Serial.println(F(" [ > OFF ] "));
|
|
|
#endif
|
|
|
|
|
|
// Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
@@ -197,7 +197,7 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
Sprintln(F("[SERVO] [Exp_state_ON_USE_LEVEL]"));
|
|
|
#endif
|
|
|
- Serial.print("[SERVO]->[PORT["); Serial.print(Slave_Ports_Status_A[i].LocalPort); Serial.println("] ");
|
|
|
+ Serial.print(F("[SERVO]->[PORT[")); Serial.print(Slave_Ports_Status_A[i].LocalPort); Serial.println(F("] "));
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(Slave_Ports_Status_A[i].Exp_state_level_A , 0, 180, SERVOMIN, SERVOMAX));
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET; //TODO BITTEST
|
|
|
Slave_Ports_Status_A[i].Exp_state = ~ Exp_state_SET_REQ_SEND; //TODO BITTEST
|
|
|
@@ -206,7 +206,7 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
} else 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));
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#149 I2C_driver PortTypes_SERVO->ON Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
+ Serial.print(F("#149 I2C_driver PortTypes_SERVO->ON Exp_state [SET]")); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print(F("] after ["));
|
|
|
#endif
|
|
|
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("] ");
|
|
|
@@ -214,22 +214,22 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
} 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));
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#155 I2C_driver PortTypes_SERVO->OFF Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
+ Serial.print(F("#155 I2C_driver PortTypes_SERVO->OFF Exp_state [SET]")); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print(F("] after ["));
|
|
|
#endif
|
|
|
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("] ");
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println(F("] "));
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
}
|
|
|
} else {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#163 [PortTypes*] ");
|
|
|
+ Serial.print(F("#163 [PortTypes*] "));
|
|
|
#endif
|
|
|
|
|
|
if(Slave_Ports_Status_A[i].Exp_state & Exp_state_ON_USE_LEVEL ) { //TODO BINTEST
|
|
|
//Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, Slave_Ports_Status_A[i].Exp_state_level_A * 16, Slave_Ports_Status_A[i].Exp_state_level_A * 16); //todo Exp_state_ON_USE_LEVEL
|
|
|
Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, Slave_Ports_Status_A[i].Exp_state_level_A, Slave_Ports_Status_A[i].Exp_state_level_A * 16); //todo Exp_state_ON_USE_LEVEL
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#149 I2C_driver ->Exp_state_ON_USE_LEVEL Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
+ Serial.print(F("#149 I2C_driver ->Exp_state_ON_USE_LEVEL Exp_state [SET]")); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print(F("] after ["));
|
|
|
#endif
|
|
|
//Serial.print("[I2C_INDEX_DRIVER_A[");Serial.print(I2C_INDEX_DRIVER_A);Serial.print("] [LocalPort["); Serial.print(Slave_Ports_Status_A[i].LocalPort); Serial.print("] ");
|
|
|
//Serial.print("[D209]Bef[");Serial.print(Slave_Ports_Status_A[i].Exp_state, BIN);Serial.print("]");
|
|
|
@@ -240,7 +240,7 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
} else 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, 1000, 1000); //todo Exp_state_ON_USE_LEVEL
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#149 I2C_driver ->ON Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
+ Serial.print(F("#149 I2C_driver ->ON Exp_state [SET]")); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print(F("] after ["));
|
|
|
#endif
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET; //TODO BITTEST
|
|
|
Slave_Ports_Status_A[i].Exp_state = ~ Exp_state_SET_REQ_SEND; //TODO BITTEST
|
|
|
@@ -249,7 +249,7 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
} 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);
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#149 I2C_driver ->OFF Exp_state [SET]"); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print("] after [");
|
|
|
+ Serial.print(F("#149 I2C_driver ->OFF Exp_state [SET]")); Serial.print(Slave_Ports_Status_A[i].Exp_state); Serial.print(F("] after ["));
|
|
|
#endif
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET; //TODO BITTEST
|
|
|
Slave_Ports_Status_A[i].Exp_state = ~ Exp_state_SET_REQ_SEND; //TODO BITTEST
|
|
|
@@ -257,45 +257,45 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
} else if(Slave_Ports_Status_A[i].Exp_state & Exp_state_BLINK ){ //TODO BINTEST
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- 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 [");
|
|
|
+ Serial.print(F("#168 I2C_driver ->BLINK [Exp_state_ERROR] before]")); Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println(F("] after ["));
|
|
|
#endif
|
|
|
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);
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_ERROR; //TODO BITTEST
|
|
|
- Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println("] ");
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println(F("] "));
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
} else {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- 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 [");
|
|
|
+ Serial.print(F("#183 I2C_driver [UNSUPP] [Exp_state_ERROR] before]")); Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println(F("] after ["));
|
|
|
#endif
|
|
|
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("] ");
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.println(F("] "));
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
|
|
|
#if defined(DEBUG) > 6 || defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- 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[");
|
|
|
- Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Broadcast_state)); Serial.println("] ");
|
|
|
- Serial.print("#170 Exp_state[ ");
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state | Exp_state_SET ) Serial.print(" [ | SET ] ");//blad
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) Serial.print(" [ & SET ] ");//opcjonalnie set
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state | Exp_state_ERROR ) Serial.print(" [ | ERR ] ");//blad
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state & Exp_state_ERROR ) Serial.print(" [ & ERR ] "); //opcjonalnie err
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state | Exp_state_OFF ) Serial.print(" [ | OFF ] ");//blad
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) Serial.print(" [ & OFF ] "); //dziala opcjonalnie off
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state == Exp_state_OFF ) Serial.print(" [ = OFF ] "); //dziala only off
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) ^ Exp_state_SET )) Serial.print(" [ ^ SET ] ");//opcjonalnie ste
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_SET )) Serial.print(" [ + SET ] "); //not working
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) ^ Exp_state_OFF )) Serial.print(" [ ^ OFF ] ");//opcjonalnie off
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_OFF )) Serial.print(" [ + OFF ] "); //not working
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111111 ) ^ Exp_state_OFF )) Serial.print(" [ # OFF ] ");//only off
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111110 ) ^ B00000001 )) Serial.print(" [ < OFF ] "); //not working
|
|
|
- if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000001 ) ^ B11111110 )) Serial.print(" [ > OFF ] "); //not working
|
|
|
+ Serial.println(""); Serial.println(i); Serial.print(F(" #126 after PWM Exp_state_ttl["));
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state_ttl)); Serial.print(F("] Exp_state["));
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Exp_state)); Serial.print(F("] Broadcast_state["));
|
|
|
+ Serial.print(BIN8_to_STRING(Slave_Ports_Status_A[i].Broadcast_state)); Serial.println(F("] "));
|
|
|
+ Serial.print(F("#170 Exp_state[ "));
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state | Exp_state_SET ) Serial.print(F(" [ | SET ] "));//blad
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) Serial.print(F(" [ & SET ] "));//opcjonalnie set
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state | Exp_state_ERROR ) Serial.print(F(" [ | ERR ] "));//blad
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state & Exp_state_ERROR ) Serial.print(F(" [ & ERR ] ")); //opcjonalnie err
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state | Exp_state_OFF ) Serial.print(F(" [ | OFF ] "));//blad
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) Serial.print(F(" [ & OFF ] ")); //dziala opcjonalnie off
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state == Exp_state_OFF ) Serial.print(F(" [ = OFF ] ")); //dziala only off
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_SET ) ^ Exp_state_SET )) Serial.print(F(" [ ^ SET ] "));//opcjonalnie ste
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_SET )) Serial.print(F(" [ + SET ] ")); //not working
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & Exp_state_OFF ) ^ Exp_state_OFF )) Serial.print(F(" [ ^ OFF ] "));//opcjonalnie off
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000000 ) ^ Exp_state_OFF )) Serial.print(F(" [ + OFF ] ")); //not working
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111111 ) ^ Exp_state_OFF )) Serial.print(F(" [ # OFF ] "));//only off
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B11111110 ) ^ B00000001 )) Serial.print(F(" [ < OFF ] ")); //not working
|
|
|
+ if (!( ( Slave_Ports_Status_A[i].Exp_state & B00000001 ) ^ B11111110 )) Serial.print(F(" [ > OFF ] ")); //not working
|
|
|
|
|
|
|
|
|
//if ((Slave_Ports_Status_A[i].Exp_state & Exp_state_SET) == (x & 0x0f)) {
|
|
|
@@ -303,14 +303,14 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
//}
|
|
|
|
|
|
|
|
|
- Serial.println("] ");
|
|
|
+ Serial.println(F("] "));
|
|
|
#endif
|
|
|
#if defined(DEBUG_CAN) || defined(DEBUG) || defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.println(" [#222] "); Serial.println(" [#222] "); Serial.println(" [#222] ");
|
|
|
+ Serial.println(F(" [#222] ")); Serial.println(F(" [#222] ")); Serial.println(F(" [#222] "));
|
|
|
#endif
|
|
|
} else {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- 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 [");
|
|
|
+ Serial.print(F("#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(F("] after ["));
|
|
|
#endif
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET | Exp_state_ERROR; //TODO BITTEST
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
@@ -323,7 +323,7 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
|
|
|
} else {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- 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 [");
|
|
|
+ Serial.print(F("#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(F("] after ["));
|
|
|
#endif
|
|
|
Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state | Exp_state_SET | Exp_state_ERROR; //TODO BITTEST
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
@@ -335,7 +335,7 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
|
|
|
} else {
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print(" #249 #i["); Serial.print(i); Serial.println("] ");
|
|
|
+ Serial.print(F(" #249 #i[")); Serial.print(i); Serial.println(F("] "));
|
|
|
#endif
|
|
|
}
|
|
|
|
|
|
@@ -343,8 +343,8 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
|
|
|
|
|
|
|
|
|
#if defined(DEBUG_I2C_driver_Adafruit_PWMServoDriver)
|
|
|
- Serial.print("#242 #i["); Serial.print(i); Serial.println("] ");
|
|
|
- Serial.print("Exp_state_ttl"); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl);Serial.print("] ");
|
|
|
+ Serial.print(F("#242 #i[")); Serial.print(i); Serial.println(F("] "));
|
|
|
+ Serial.print(F("Exp_state_ttl")); Serial.print(Slave_Ports_Status_A[i].Exp_state_ttl);Serial.print(F("] "));
|
|
|
#endif
|
|
|
}//if 3
|
|
|
} //for 2
|