Added a dividing factor to the error terms

This will prevent error values of +/-1000 from being written to the
motors