_ROTTARY_SW_loop.h 1.6 KB

12345678910111213141516171819202122232425262728293031323334
  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_array16_T DISPLAY_array16_AA="" ;
  10. //( "OUT I2C 0X40[2]" + encoderPos * 5 , 2), //message,
  11. String message = "OUT I2C 0X40[2] V:";
  12. message.concat(String(encoderPos * 5));
  13. message.toCharArray(DISPLAY_array16_AA, message.length());
  14. DISPLAY__print(
  15. DISPLAY_A ,
  16. DISPLAY_T_ARDUINO_ATTR_ARRAY_A ,
  17. DISPLAY_PHYSICAL_CHAR_A,
  18. DISPLAY_pos_seq_A_NEXT,
  19. DISPLAY_array16_AA,
  20. DISPLAY_TARGET_DISPLAY128,
  21. millis() , // time_seq_id_T time_seq_id_A;
  22. millis(), //time_min_run_T time_min_run_A;
  23. //queue
  24. Slave_Ports_Status_QUEUE_A,
  25. TASK_TYPE_T_Slave_Ports_broadcast____ , //TASK_TYPE_A,
  26. { } //TASK_PORT_ASSOC_A Slave_Ports_Status_A[i].Port_ID
  27. );
  28. }