Yea sorry I was in a hurry and drew it kind of fast. It the + and - are backward and the colors are off on the diagram. I thought about putting the low pass filter on the output of the controller 29 but since it will reverse the polarities to move the motor the other direction I did not know if that would work.