Implemented method used in driving to point.