_ROTTARY_SW_loop.h 1.2 KB

12345678910111213141516171819202122232425262728
  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 * 5);
  7. DISPLAY__print(
  8. DISPLAY_A ,
  9. DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
  10. DISPLAY_PHYSICAL_CHAR_A,
  11. DISPLAY_pos_seq_A_NEXT,
  12. DISPLAY_array16_I( "OUT I2C 0X40[2]" + encoderPos * 5 , 2), //message,
  13. DISPLAY_TARGET_DISPLAY128,
  14. millis() , // time_seq_id_T time_seq_id_A;
  15. millis(), //time_min_run_T time_min_run_A;
  16. //queue
  17. Slave_Ports_Status_QUEUE_A,
  18. TASK_TYPE_T_Slave_Ports_broadcast____ , //TASK_TYPE_A,
  19. { } //TASK_PORT_ASSOC_A Slave_Ports_Status_A[i].Port_ID
  20. );
  21. }