chagned pid_velocity to update pid each time through loop