Added the motor encoder to the feedback loop