Updated MotorPiTx servo handling