Question

I currently have a robot with some sensors, like a GPS, an accelerometer and a compass. The thing I would like to do is my robot to reach a GPS coordinate that I enter. I wondered if any algorithm to do that already existed. I don’t want a source code, which wouldn’t have any point, just the procedure to follow for my robot to do so, for me to be able to understand what I do… At the moment, let’s imagine that I can access the GPS coordinate everytime, so no need of a Kalman filter. I know it’s unrealistic, but I would like to programm it step by step, and Kalman is the next step.

If anyone has an idea…

Answer 1

To get a bearing (positive angle east of north) between two lat-long points use:

bearing=mod(atan2(sin(lon2-lon1)*cos(lat2),(lat1)*sin(lat2)-sin(lat1)*cos(lat2)*cos(lon2-lon1)),2*pi)

Note – angles probably have to be in radians depending on your math package.

But for small distances you can just calculate how many meters in one degree of lat and long at your position and then treat them as flat X,Y coords.

For typical 45deg latitudes it’s around 111.132 km/deg lat, 78.847 km/deg lon.