Gps 四旋翼直升机航向值的计算

Gps 四旋翼直升机航向值的计算,gps,pid,haversine,control-theory,Gps,Pid,Haversine,Control Theory,我正在建造一架自主的四架直升机,我正在尝试将四架直升机移动到目标GPS坐标,我正在使用哈弗森公式计算目标的距离,现在我想计算航向 例如,我希望四边形转向目标的方向并向前移动,直到到达目标(这部分已经完成) 如何计算偏航,使其转向目标方向? 仅使用GPS坐标计算它是非常不准确的。如果我使用磁强计,磁偏角会随着位置的变化而变化 我该怎么计算呢?ardu飞行员是如何计算的 开发处理不准确度量的控制算法的一种方法是通过某种过滤组合不同的度量。从这个意义上讲,您的设定点参考是基于GPS和磁强计测量建立的

我正在建造一架自主的四架直升机,我正在尝试将四架直升机移动到目标GPS坐标,我正在使用哈弗森公式计算目标的距离,现在我想计算航向

例如,我希望四边形转向目标的方向并向前移动,直到到达目标(这部分已经完成)

如何计算偏航,使其转向目标方向? 仅使用GPS坐标计算它是非常不准确的。如果我使用磁强计,磁偏角会随着位置的变化而变化


我该怎么计算呢?ardu飞行员是如何计算的

开发处理不准确度量的控制算法的一种方法是通过某种过滤组合不同的度量。从这个意义上讲,您的设定点参考是基于GPS和磁强计测量建立的

有几种方法可以完成这项任务。许多应用使用基于卡尔曼滤波器的数据融合。总体思路是使用预测器(或状态观测器)来更好地估计航向。我建议对这些主题进行一些研究:数据融合、卡尔曼滤波

以下是一个例子:


您拥有的GPS信息在您看来并不准确。但对于任何位置的磁强计磁偏角信息来说,这应该足够好了。您可以将其制作为表格,并根据GPS当前的原始位置信息进行查找。您是否有
atan2(
)或
arctan()