I'm working on a path following vehicle. I have a matrix with the coordinates of the path and I have the actual position of the car. And I want to know what is the next point of the path closest to the actual position. How do I do that?

1 view (last 30 days)
Basically, I want to know what is the point of the path closer to the point of the actual position.
  3 Comments

Sign in to comment.

Answers (1)

Image Analyst
Image Analyst on 25 Dec 2012
Wouldn't you just use the Pythagorean theorem to get the closest distance?
distances = sqrt(pathX - actualX).^2 + (pathY - actualY).^2);
[closestDistance, indexOfClosestPoint] = min(distances);
closestPathX = pathX(indexOfClosestPoint);
closestPathY = pathY(indexOfClosestPoint);

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!