我现在有一个机器人，有一些传感器，像GPS，加速计和指南针。我想做的是我的机器人到达我输入的GPS坐标。我想知道是否有任何算法已经存在。我不想要一个没有任何意义的源代码，只要我的机器人按照程序来做，让我能够理解我做了什么……现在，让我们想象一下，我每次都可以访问GPS坐标，所以不需要卡尔曼滤波器我知道这是不现实的，但我想一步一步地编程，而Kalman是下一步。
如果有人有主意…
最佳答案
要在两个平行长点之间获得方位角（北面正角），请使用：bearing=mod(atan2(sin(lon2-lon1)*cos(lat2),(lat1)*sin(lat2)-sin(lat1)*cos(lat2)*cos(lon2-lon1)),2*pi)
注意-角度可能必须是弧度，这取决于你的数学包。
但对于小距离，你只需计算出你所在位置的纬度和经度的米数，然后把它们当作平面的x，y坐标。
在典型的45度纬度地区，纬度约为111.132公里/度，经度为78.847公里/度。