Full servo support for MotorPiTx Servo1 and Servo2 variables used