|
|
@@ -17,9 +17,16 @@
|
|
|
,TASK_TYPE_T TASK_TYPE_A,
|
|
|
TASK_PORT_ASSOC_T TASK_PORT_ASSOC_A ,
|
|
|
Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A
|
|
|
- ) {
|
|
|
-
|
|
|
-
|
|
|
+ ) {
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ I2C_INDEX_DRIVER_T I2C_INDEX_DRIVER_A ;
|
|
|
+ //auto I2C_INDEX_DRIVER_T I2C_INDEX_DRIVER_A ;
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
DISPLAY__print(
|
|
|
DISPLAY_A ,
|
|
|
DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
|
|
|
@@ -61,10 +68,11 @@
|
|
|
#endif
|
|
|
|
|
|
if(Slave_Ports_Status_A[i].I2C_driver == I2C_driver_Adafruit_PWMServoDriver) {
|
|
|
- ARDUINO_ARRAY_PRIMARY_KET_T Adafruit_PWMServoDriver__get_PRIMARY_KET_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T(
|
|
|
+ //ARDUINO_ARRAY_PRIMARY_KET_T Adafruit_PWMServoDriver__get_PRIMARY_KET_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T(
|
|
|
+ I2C_INDEX_DRIVER_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T(
|
|
|
Adafruit_PWMServoDriver_A, Slave_Ports_Status_A[i].Address);
|
|
|
|
|
|
- if(Adafruit_PWMServoDriver__get_PRIMARY_KET_A > 0 ) {//Slave_Ports_Status_A[i].Address == I2C_ADDRESS_0x40 ) {
|
|
|
+ if(I2C_INDEX_DRIVER_A > 0 ) {//Slave_Ports_Status_A[i].Address == I2C_ADDRESS_0x40 ) {
|
|
|
/* if(I2C_ADDRESS_0x40_A == ARDUINO_DRIVER_UNDEFINED) {
|
|
|
// Adafruit_PWMServoDriver Adafruit_PWMServoDriver_0X40 = Adafruit_PWMServoDriver(0x40);
|
|
|
I2C_ADDRESS_0x40_A = ARDUINO_DRIVER_INITIALIZED ;
|
|
|
@@ -78,29 +86,29 @@
|
|
|
if(Slave_Ports_Status_A[i].PortTypes | PortTypes_SERVO) {
|
|
|
if(Slave_Ports_Status_A[i].Exp_state | Exp_state_ON) {
|
|
|
|
|
|
- Adafruit_PWMServoDriver_A[Adafruit_PWMServoDriver__get_PRIMARY_KET_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(90, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
+ Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(90, 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 if(Slave_Ports_Status_A[i].Exp_state | Exp_state_OFF) {
|
|
|
- Adafruit_PWMServoDriver_A[Adafruit_PWMServoDriver__get_PRIMARY_KET_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(0, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
+ Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, map(0, 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 {
|
|
|
|
|
|
if(Slave_Ports_Status_A[i].Exp_state == Exp_state_ON ) {
|
|
|
- Adafruit_PWMServoDriver_A[Adafruit_PWMServoDriver__get_PRIMARY_KET_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 3000, 3000);
|
|
|
+ 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("] ");
|
|
|
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_A[Adafruit_PWMServoDriver__get_PRIMARY_KET_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0, 0);
|
|
|
+ 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("] ");
|
|
|
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_A[Adafruit_PWMServoDriver__get_PRIMARY_KET_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,2000);
|
|
|
+ Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,2000);
|
|
|
// delay(1000);
|
|
|
- Adafruit_PWMServoDriver_A[Adafruit_PWMServoDriver__get_PRIMARY_KET_A].Adafruit_PWMServoDriver_V.setPWM(Slave_Ports_Status_A[i].LocalPort, 0,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;
|
|
|
Slave_Ports_Status_A[i].Exp_state_ttl = Exp_state_ttl_IS_ACTIVE ;
|
|
|
} else {
|