_ROTTARY_SW_loop.h 2.0 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243
  1. if(oldEncPos != encoderPos) {
  2. static I2C_INDEX_DRIVER_T I2C_INDEX_DRIVER_A ;
  3. Serial.print(" ROT_SW["); Serial.print(encoderPos); Serial.print("] ");
  4. oldEncPos = encoderPos;
  5. if(not(I2C_INDEX_DRIVER_A > 0)) {
  6. I2C_INDEX_DRIVER_A = Adafruit_PWMServoDriver__get_PRIMARY_KET_T(Adafruit_PWMServoDriver_A, I2C_ADDRESS_0x40) ;
  7. }
  8. Serial.print("#550 CLK_AAdafruit_PWMServoDriver: #["); Serial.print(encoderPos);
  9. Serial.print("] I2C_INDEX_DRIVER_A ["); Serial.print(I2C_INDEX_DRIVER_A);
  10. Serial.println(" ] ");
  11. //Adafruit_PWMServoDriver_0X40.setPWM(1, 0, map(encoderPos, 0, 180, SERVOMIN, SERVOMAX));
  12. // Adafruit_PWMServoDriver_0X40.setPWM(2, encoderPos * 5, encoderPos * 50);
  13. Adafruit_PWMServoDriver_A[I2C_INDEX_DRIVER_A].Adafruit_PWMServoDriver_V.setPWM(2, encoderPos * 5, encoderPos * 50);
  14. DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A,
  15. DISPLAY_CURSOR_Y_CHARS_DEBUG);
  16. DISPLAY_array16_T DISPLAY_array16_AA="" ;
  17. //( "OUT I2C 0X40[2]" + encoderPos * 5 , 2), //message,
  18. String message = "OUT I2C 0X40[2] V:";
  19. message.concat(String(encoderPos * 5));
  20. message.toCharArray(DISPLAY_array16_AA, message.length());
  21. DISPLAY__print(
  22. DISPLAY_A ,
  23. DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
  24. DISPLAY_PHYSICAL_CHAR_A,
  25. DISPLAY_pos_seq_A_NEXT,
  26. DISPLAY_array16_AA,
  27. DISPLAY_TARGET_DISPLAY128,
  28. millis() , // time_seq_id_T time_seq_id_A;
  29. millis(), //time_min_run_T time_min_run_A;
  30. //queue
  31. Slave_Ports_Status_QUEUE_A,
  32. TASK_TYPE_T_Slave_Ports_broadcast____ , //TASK_TYPE_A,
  33. { } //TASK_PORT_ASSOC_A Slave_Ports_Status_A[i].Port_ID
  34. );
  35. }