Updated MotorController and DofHandler