航姿参考系统姿态算法性能优化仿真研究

发布时间：2020-11-09 19:59

　　 航姿参考系统(AHRS)利用重力及地磁场矢量观测值估计载体姿态,但采用加速度计测量重力会受到载体运动加速度的干扰而造成姿态估计误差。提出一种对运动加速度进行估计和补偿的新方法,上述方法在AHRS姿态算法外部实现运动加速度的估计与补偿,因而无需改动AHRS原有滤波器结构设计,几乎不需增加存储空间及计算量。仿真及结果表明,所提出的新方法能与各种常用AHRS姿态滤波算法相配合,能有效地消除运动加速度对姿态估计精度的影响,从而有助于提升AHRS在动态环境下的性能。
【部分图文】：

差，取遗忘因子为〇．?９。?函数，参数设定为：比例环节ＫＰ?＝?０．?５，积分环节Ｋ，?＝?０．?１．??假定载体沿ｘ轴作变速运动，加速度变化曲线如图１所?ＵＫＦ及ＣＦ仿真结果分别见图３与图４。俯仰角误差??示，各算法滤波后的俯仰角误差变化曲线示于图２，俯仰角平（均方根）统计结果见表２，表中还列出了?ＥＫＦ的仿真结果以??均误差见表１。?便对比。??？?３「?８「?一无补偿一有补偿??，Ｉ：??＿３?■?１?１?＊?＊?＊?Ｉ?＿ｇ?ｉ?ｉ?ｉ?ｉ?ｉ?ｉ?ｉ??０?２?４?６?８?１０?１２?０?２?４?６?８?１０?１２??时间／ｓ?时间／ｓ??图１仿真中的载体运动加速度?图３?ＵＫＦ仿真结果??表１各算法俯仰角均方根误差?８??？卜帛?冑彳卜肖??加速度抑制算法?俯仰角误差（均方根）?４?＼?Ａ??切换滤波法?０．?１９８。?｜?Ｖ?＼?／?Ｖ?ｆ?Ｙ?Ｉ?＼Ｊ??估计－补偿法?０．４１７°?Ｉ＂１?■?＼Ｊ?＼ｊ＼ｊ??Ｓａｇｅ?－?Ｈｕｓａ?滤波?０．?４４９°?＿８??１?？??ｉ?ｉ?ｉ??．＾?＿?〇?２?４?６?８?１０?１２???本艾方法???时间６??图４互补滤波仿真结果???无补偿??切换滤波法??ａ??估计补偿法??Ｓａｇｅ－Ｈｕｓａ滤波??ｒ?—本文方法?表２不同姿态滤波算法仿真对比??４?■??姿态滤波算法?俯仰角误差（均方根）??？?０?丄士—?—?Ｖ—每决〕．?ＥＫＦ（无补偿）?１．５２５。??Ｌ?＾＇?Ｖ?Ｖ?酬有补偿）?〇．１９８。??ＵＫＦ（

差，取遗忘因子为〇．?９。?函数，参数设定为：比例环节ＫＰ?＝?０．?５，积分环节Ｋ，?＝?０．?１．??假定载体沿ｘ轴作变速运动，加速度变化曲线如图１所?ＵＫＦ及ＣＦ仿真结果分别见图３与图４。俯仰角误差??示，各算法滤波后的俯仰角误差变化曲线示于图２，俯仰角平（均方根）统计结果见表２，表中还列出了?ＥＫＦ的仿真结果以??均误差见表１。?便对比。??？?３「?８「?一无补偿一有补偿??，Ｉ：??＿３?■?１?１?＊?＊?＊?Ｉ?＿ｇ?ｉ?ｉ?ｉ?ｉ?ｉ?ｉ?ｉ??０?２?４?６?８?１０?１２?０?２?４?６?８?１０?１２??时间／ｓ?时间／ｓ??图１仿真中的载体运动加速度?图３?ＵＫＦ仿真结果??表１各算法俯仰角均方根误差?８??？卜帛?冑彳卜肖??加速度抑制算法?俯仰角误差（均方根）?４?＼?Ａ??切换滤波法?０．?１９８。?｜?Ｖ?＼?／?Ｖ?ｆ?Ｙ?Ｉ?＼Ｊ??估计－补偿法?０．４１７°?Ｉ＂１?■?＼Ｊ?＼ｊ＼ｊ??Ｓａｇｅ?－?Ｈｕｓａ?滤波?０．?４４９°?＿８??１?？??ｉ?ｉ?ｉ??．＾?＿?〇?２?４?６?８?１０?１２???本艾方法???时间６??图４互补滤波仿真结果???无补偿??切换滤波法??ａ??估计补偿法??Ｓａｇｅ－Ｈｕｓａ滤波??ｒ?—本文方法?表２不同姿态滤波算法仿真对比??４?■??姿态滤波算法?俯仰角误差（均方根）??？?０?丄士—?—?Ｖ—每决〕．?ＥＫＦ（无补偿）?１．５２５。??Ｌ?＾＇?Ｖ?Ｖ?酬有补偿）?〇．１９８。??ＵＫＦ（

差，取遗忘因子为〇．?９。?函数，参数设定为：比例环节ＫＰ?＝?０．?５，积分环节Ｋ，?＝?０．?１．??假定载体沿ｘ轴作变速运动，加速度变化曲线如图１所?ＵＫＦ及ＣＦ仿真结果分别见图３与图４。俯仰角误差??示，各算法滤波后的俯仰角误差变化曲线示于图２，俯仰角平（均方根）统计结果见表２，表中还列出了?ＥＫＦ的仿真结果以??均误差见表１。?便对比。??？?３「?８「?一无补偿一有补偿??，Ｉ：??＿３?■?１?１?＊?＊?＊?Ｉ?＿ｇ?ｉ?ｉ?ｉ?ｉ?ｉ?ｉ?ｉ??０?２?４?６?８?１０?１２?０?２?４?６?８?１０?１２??时间／ｓ?时间／ｓ??图１仿真中的载体运动加速度?图３?ＵＫＦ仿真结果??表１各算法俯仰角均方根误差?８??？卜帛?冑彳卜肖??加速度抑制算法?俯仰角误差（均方根）?４?＼?Ａ??切换滤波法?０．?１９８。?｜?Ｖ?＼?／?Ｖ?ｆ?Ｙ?Ｉ?＼Ｊ??估计－补偿法?０．４１７°?Ｉ＂１?■?＼Ｊ?＼ｊ＼ｊ??Ｓａｇｅ?－?Ｈｕｓａ?滤波?０．?４４９°?＿８??１?？??ｉ?ｉ?ｉ??．＾?＿?〇?２?４?６?８?１０?１２???本艾方法???时间６??图４互补滤波仿真结果???无补偿??切换滤波法??ａ??估计补偿法??Ｓａｇｅ－Ｈｕｓａ滤波??ｒ?—本文方法?表２不同姿态滤波算法仿真对比??４?■??姿态滤波算法?俯仰角误差（均方根）??？?０?丄士—?—?Ｖ—每决〕．?ＥＫＦ（无补偿）?１．５２５。??Ｌ?＾＇?Ｖ?Ｖ?酬有补偿）?〇．１９８。??ＵＫＦ（
【相似文献】

相关期刊论文 前10条

1 高同跃;丁卫;高新闻;饶进军;龚振邦;罗均;;面向机载惯性稳定云台的微姿态参考系统的研究[J];传感技术学报;2009年09期

2 杨颖辉;;高考志愿填报参考系统[J];信息与电脑(理论版);2010年08期

3 田易;孙金海;李金海;阎跃鹏;;航姿参考系统中一种自适应卡尔曼滤波算法[J];西安电子科技大学学报;2011年06期

4 刘禹;;对航姿参考系统的滤波方法研究[J];舰船电子对抗;2013年05期

5 张知非;地球科学的书目参考系统[J];地球科学进展;1996年01期

6 桂智明 ,晏磊 ,严明;线性参考系统和动态分段在GIS-T中的应用[J];计算机工程与应用;2003年09期

7 张谦;裴海龙;罗沛;;一种捷联姿态航向参考系统信息融合算法应用[J];计算机工程与应用;2007年15期

8 徐尤南,宁莉,熊国良,王小明,黄耀明;一个可重用的 MIS 联机参考系统的开发[J];华东交通大学学报;1998年02期

9 张伟红;;基于线性参考系统的轨道数据模型[J];昆明理工大学学报(理工版);2006年01期

10 贾京林;荀向东;李楠;;姿态航向参考系统中磁罗盘安装误差补偿研究[J];海军航空工程学院学报;2011年03期

相关硕士学位论文 前10条

1 王家兵;基于嵌入式的捷联姿态参考系统设计与实现[D];重庆大学;2006年

2 胡平;市场基准参考系统设计和实现[D];上海交通大学;2011年

3 杨续伟;基于微惯性组合的嵌入式航姿参考系统研究[D];上海交通大学;2012年

4 孙章国;基于ARM的航姿参考系统研究[D];上海交通大学;2010年

5 魏萍;基于ARM的嵌入式航向姿态参考系统的研究[D];浙江大学;2006年

6 费洁;微型航姿参考系统的磁标定和误差补偿方法研究[D];上海交通大学;2014年

7 衣鹏飞;船舶动力定位位置参考系统信息融合方法研究[D];哈尔滨工程大学;2011年

8 郑健;基于9轴传感器的姿态参考系统研究与实现[D];电子科技大学;2013年

9 陈宇捷;基于MEMS的微小型嵌入式航姿参考系统研究[D];上海交通大学;2009年

10 盛庆轩;MIMU/磁强计航姿参考系统研究[D];国防科学技术大学;2009年

本文编号：2876900