|
|
@@ -52,9 +52,12 @@
|
|
|
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) {
|
|
|
if(Slave_Ports_Status_A[i].Exp_state_ttl == Exp_state_ttl_TO_REFRESH ) {
|
|
|
+ #ifdef DEBUG
|
|
|
+ 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("] ");
|
|
|
-
|
|
|
+ }
|
|
|
+ #endif
|
|
|
|
|
|
if(Slave_Ports_Status_A[i].I2C_driver == I2C_driver_Adafruit_PWMServoDriver) {
|
|
|
if(Slave_Ports_Status_A[i].Address == I2C_ADDRESS_0x40 ) {
|
|
|
@@ -68,41 +71,54 @@
|
|
|
|
|
|
}
|
|
|
*/
|
|
|
-
|
|
|
-
|
|
|
- if(Slave_Ports_Status_A[i].Exp_state == Exp_state_ON ) {
|
|
|
- Adafruit_PWMServoDriver_0X40.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("] ");
|
|
|
- } else if(Slave_Ports_Status_A[i].Exp_state == Exp_state_OFF ){
|
|
|
- Adafruit_PWMServoDriver_0X40.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("] ");
|
|
|
-
|
|
|
- Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(180, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
- delay(1500);
|
|
|
- Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(0, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
- delay(1500);
|
|
|
- Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(180, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
-
|
|
|
- } else if(Slave_Ports_Status_A[i].Exp_state == Exp_state_BLINK ){
|
|
|
- Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,2000);
|
|
|
- delay(1000);
|
|
|
- Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,1000);
|
|
|
+ if(Slave_Ports_Status_A[i].PortTypes | PortTypes_SERVO) {
|
|
|
+ Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(180, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
+ delay(1500);
|
|
|
+ Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(0, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
+ delay(1500);
|
|
|
+ Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(180, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
+ Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state + Exp_state_SET;
|
|
|
+ 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("] ");
|
|
|
- }
|
|
|
-
|
|
|
+ if(Slave_Ports_Status_A[i].Exp_state == Exp_state_ON ) {
|
|
|
+ Adafruit_PWMServoDriver_0X40.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("] ");
|
|
|
+ Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state + Exp_state_SET;
|
|
|
+ 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_0X40.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("] ");
|
|
|
+ Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state + Exp_state_SET;
|
|
|
+ } else if(Slave_Ports_Status_A[i].Exp_state == Exp_state_BLINK ){
|
|
|
+ Adafruit_PWMServoDriver_0X40.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,2000);
|
|
|
+ delay(1000);
|
|
|
+ Adafruit_PWMServoDriver_0X40.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;
|
|
|
+ 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;
|
|
|
+ Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
+ }
|
|
|
+ }
|
|
|
|
|
|
} else if(Slave_Ports_Status_A[i].Address == I2C_ADDRESS_0x41 ) {
|
|
|
-
|
|
|
+ Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state + Exp_state_SET + Exp_state_ERROR;
|
|
|
+ Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
} else {
|
|
|
Serial.print("#6699 I2C_driver ADDRES "); Serial.print(Slave_Ports_Status_A[i].Address); Serial.println("] ");
|
|
|
+ Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state + Exp_state_SET + Exp_state_ERROR;
|
|
|
+ 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("] ");
|
|
|
+ Slave_Ports_Status_A[i].Exp_state = Slave_Ports_Status_A[i].Exp_state + Exp_state_SET + Exp_state_ERROR;
|
|
|
+ Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
}
|
|
|
|
|
|
|