goTo method now is implemented with a PID control, instead of turning and moving