if(oldEncPos != encoderPos) { Serial.print(" ROT_SW["); Serial.print(encoderPos); Serial.print("] "); oldEncPos = encoderPos; Serial.print("#550 CLK_AAdafruit_PWMServoDriver: #["); Serial.print(encoderPos); Serial.println(" ] "); //Adafruit_PWMServoDriver_0X40.setPWM(1, 0, map(encoderPos, 0, 180, SERVOMIN, SERVOMAX)); Adafruit_PWMServoDriver_0X40.setPWM(2, encoderPos * 5, encoderPos * 50); DISPLAY__CURSOR_Y_CHARS__SET(DISPLAY_PHYSICAL_CHAR_A, DISPLAY_CURSOR_Y_CHARS_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.toCharArray(DISPLAY_array16_AA, message.length()); DISPLAY__print( DISPLAY_A , DISPLAY_T_ARDUINO_ATTR_ARRAY_A , DISPLAY_PHYSICAL_CHAR_A, DISPLAY_pos_seq_A_NEXT, DISPLAY_array16_AA, DISPLAY_TARGET_DISPLAY128, millis() , // time_seq_id_T time_seq_id_A; millis(), //time_min_run_T time_min_run_A; //queue Slave_Ports_Status_QUEUE_A, TASK_TYPE_T_Slave_Ports_broadcast____ , //TASK_TYPE_A, { } //TASK_PORT_ASSOC_A Slave_Ports_Status_A[i].Port_ID ); }