Debug ServoController