updates to motor, to get it to not stop too early
fixed minor typo in motor angle control