_ROTTARY_SW_loop.h 1.4 KB

12345678910111213141516171819202122232425262728293031
  1. if(oldEncPos != encoderPos) {
  2. Serial.print(" ROT_SW["); Serial.print(encoderPos); Serial.print("] ");
  3. oldEncPos = encoderPos;
  4. Serial.print("#550 CLK_AAdafruit_PWMServoDriver: #["); Serial.print(encoderPos); Serial.println(" ] ");
  5. //Adafruit_PWMServoDriver_0X40.setPWM(1, 0, map(encoderPos, 0, 180, SERVOMIN, SERVOMAX));
  6. Adafruit_PWMServoDriver_0X40.setPWM(2, encoderPos * 5, encoderPos * 50);
  7. DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A,
  8. DISPLAY_CURSOR_Y_CHARS_DEBUG);
  9. DISPLAY__print(
  10. DISPLAY_A ,
  11. DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
  12. DISPLAY_PHYSICAL_CHAR_A,
  13. DISPLAY_pos_seq_A_NEXT,
  14. DISPLAY_array16_I( "OUT I2C 0X40[2]" + encoderPos * 5 , 2), //message,
  15. DISPLAY_TARGET_DISPLAY128,
  16. millis() , // time_seq_id_T time_seq_id_A;
  17. millis(), //time_min_run_T time_min_run_A;
  18. //queue
  19. Slave_Ports_Status_QUEUE_A,
  20. TASK_TYPE_T_Slave_Ports_broadcast____ , //TASK_TYPE_A,
  21. { } //TASK_PORT_ASSOC_A Slave_Ports_Status_A[i].Port_ID
  22. );
  23. }