C语言实现Lagrange插值（用于插值组合导航结果）

十八与她

于 2022-11-14 15:50:45 发布

阅读量1k

点赞数

CC 4.0 BY-SA版权

分类专栏：组合导航程序RTKLC代码集文章标签： c语言开发语言 Lagrange插值组合导航

本文链接：https://blog.youkuaiyun.com/absll/article/details/127848986

组合导航程序RTKLC代码集专栏收录该内容

27 篇文章 ¥49.90 ¥99.00

订阅专栏

超级会员免费看

本文介绍了如何使用C语言实现Lagrange插值方法，以解决在组合导航中，由于GNSS观测值和参考值更新频率不同导致的数据同步问题。通过插值，可以将组合导航结果调整到与参考值相同的频率，便于进行误差分析和统计。

功能说明

我们知道一般情况下，GNSS观测值得更新频率是低于惯导数据得输出频率的，而组合导航计算结果的输出频率取决于惯导的数据频率以及所使用的姿态优化方法（单子样、双子样等）。对于组合导航的参考值来说，其更新频率也低于惯导和组合导航结果，因此，若要将组合导航结果与参考值作比较，进而求出误差等一系列统计数据，就需要对计算的组合导航结果进行插值，插值到和参考值相同的频率，即使两者的时间对应相同。

源码

/* Lagrange's interpolation function -----------------------------------------------------------
* Lagrange's interpolation
* args   : double*  avp1         I   RTKLC's avp information 
*		   double*  avp0         I   Reference's avp information 
*		   int		m			 O   row number of avp1
*		   int		n			 O   row number of avp0
* return : avp information after lagrange's interpolation 
*-----------------------------------------------------------------------------*/</