|
|
@@ -5,27 +5,29 @@
|
|
|
|
|
|
Serial.print(" ROT_SW["); Serial.print(encoderPos); Serial.print("] ");
|
|
|
oldEncPos = encoderPos;
|
|
|
-
|
|
|
+ int pwmVal = encoderPos * 5 ;
|
|
|
+ if (pwmVal == 0 ) pwmVal = 1;
|
|
|
if(not(I2C_INDEX_DRIVER_A > 0)) {
|
|
|
- I2C_INDEX_DRIVER_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T(Adafruit_PWMServoDriver_A, I2C_ADDRESS_0x40) ;
|
|
|
+ //I2C_INDEX_DRIVER_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T(Adafruit_PWMServoDriver_A, I2C_ADDRESS_0x40) ;
|
|
|
+ I2C_INDEX_DRIVER_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T( Adafruit_PWMServoDriver_A,Adafruit_PWMServoDriver_ATTR_ARRAY_A , 0x40);
|
|
|
}
|
|
|
Serial.print("#550 CLK_AAdafruit_PWMServoDriver: #["); Serial.print(encoderPos);
|
|
|
Serial.print("] I2C_INDEX_DRIVER_A ["); Serial.print(I2C_INDEX_DRIVER_A);
|
|
|
Serial.println(" ] ");
|
|
|
//Adafruit_PWMServoDriver_0X40.setPWM(1, 0, map(encoderPos, 0, 180, SERVOMIN, SERVOMAX));
|
|
|
// Adafruit_PWMServoDriver_0X40.setPWM(2, encoderPos * 5, encoderPos * 50);
|
|
|
- Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(2, encoderPos * 5, encoderPos * 50);
|
|
|
+ if(I2C_INDEX_DRIVER_A>0) Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(2, pwmVal, pwmVal * 10);
|
|
|
|
|
|
|
|
|
//DISPLAY_DEV.print("#550 CLK_AAdafruit_PWMServoD");
|
|
|
|
|
|
|
|
|
DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A,
|
|
|
- DISPLAY_CURSOR_Y_CHARS_DEBUG);
|
|
|
+ DISPLAY_CURSOR_Y_CHARS_ROTTARY_SW_DEBUG);
|
|
|
DISPLAY_array16_T DISPLAY_array16_AA="" ;
|
|
|
//( "OUT I2C 0X40[2]" + encoderPos * 5 , 2), //message,
|
|
|
String message = "OUT I2C 0X40[2] V:";
|
|
|
- message.concat(String(encoderPos * 5));
|
|
|
+ message.concat(String(pwmVal));
|
|
|
message.toCharArray(DISPLAY_array16_AA, message.length());
|
|
|
DISPLAY__print(
|
|
|
DISPLAY_A ,
|
|
|
@@ -34,8 +36,8 @@ DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A,
|
|
|
DISPLAY_pos_seq_A_NEXT | DISPLAY_pos_seq_A_IMMEDIATE,
|
|
|
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;
|
|
|
+ time, // time_seq_id_T time_seq_id_A;
|
|
|
+ time+5000, //time_min_run_T time_min_run_A;
|
|
|
//queue
|
|
|
Slave_Ports_Status_QUEUE_A,Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
|
|
|
TASK_TYPE_T_Slave_Ports_broadcast____ , //TASK_TYPE_A,
|