双矢量定姿算法提高海参捕捞装置捷联惯导系统粗对准精度
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

国家国际科技合作专项项目(2013DFA11320);中央高校基本科研业务费专项资金资助项目(2016XD001)


Double-vector attitude determination algorithm improving coarse alignment accuracy of strapdown inertial navigation system for sea cucumber fishing device
Author:
Affiliation:

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    针对传统解析粗对准算法中水平对准精度同时受陀螺仪和加速度计测量误差影响的问题,提出一种双矢量定姿粗对准算法,该算法在选定重力矢量为主参考矢量的前提下,预先对参与姿态解算的矢量作单位正交化处理。理论分析表明,所述算法使得水平对准精度只受加速度计水平测量误差影响,提高了捷联惯导系统粗对准精度;实测数据的试验结果表明,所述粗对准算法的水平误差角的大小不超过1°,方位误差角的大小不超过3°,在粗对准所要求的误差范围之内,为后续利用滤波方法进行精对准提供了有效的初始条件。

    Abstract:

    Abstract: Autonomous navigation is one of the key technologies for an intelligent agricultural equipment, which has been widely used in modern agricultural production. Sea cucumber production and consumption are very large in China. At present, the sea cucumber harvest mainly relies on trawl or artificial fishing, which will cause a potential hazard to the health of divers and the marine ecology. Therefore, in order to overcome the shortcomings of traditional sea cucumber fishing methods, it is necessary to develop a sea cucumber fishing device with autonomous navigation and positioning functions. Strapdown inertial navigation system (SINS) is suitable for the navigation of the autonomous sea cucumber fishing device because of its autonomy, passivity and complete navigation parameters. For the SINS, initial alignment must be completed before starting a navigation mission. The purpose of the initial alignment is to determine the initial position of the carrier coordinate system relative to the navigation coordinate system, that is, to determine the initial value of the attitude matrix. Initial alignment is one of the key technologies of SINS, which is divided into coarse alignment and fine alignment, and the coarse alignment accuracy will directly determine the performance of the initial alignment. Therefore, it is of practical value to study a coarse alignment scheme with simple algorithm and high alignment precision. The traditional analytical coarse alignment algorithm directly utilizes the earth gravity vector and the earth rotation angular velocity vector to estimate the initial attitude matrix. In view of the problem that the horizontal alignment accuracy of SINS is affected by the measurement errors of gyroscope and accelerometer in the traditional analytical coarse alignment algorithm, a novel coarse alignment algorithm based on double-vector attitude determination is proposed. In general, the measurement error of the accelerometer is much smaller than that of the gyroscope, so the earth gravity vector in the proposed algorithm is chosen as the main reference vector. Then, 3 unit orthogonal vectors are constructed based on the earth gravity vector and the earth rotation angular velocity vector, and the resulting attitude matrix is a unit orthogonal matrix. The theoretical analysis shows that horizontal misalignment angles of SINS are only related to the accelerometer level measurement errors in the case of using the proposed algorithm, however, using the conventional algorithm, the horizontal misalignment angles are related to the accelerometer measurement errors and the gyroscope drift error. Therefore, the coarse alignment accuracy of SINS using the aforementioned algorithm is significantly improved. Based on the same measured data from an inertial measurement unit, the simulation experiment was carried out for 30 times using the conventional coarse alignment algorithm and the proposed algorithm, respectively. Simulation curves demonstrated that the variation of the horizontal attitude angles using the algorithm proposed was smoother. To further verify the effectiveness of the algorithm, the attitude angles calculated from the measured values of the inertial measurement unit were compared with the measured value of a high-precision three-dimensional electronic compass, and the experimental results showed that the horizontal error angles of the aforementioned coarse alignment algorithm did not exceed 1° and the azimuth error angle did not exceed 3°. The results can meet the accuracy requirement of coarse alignment and will provide an effective initial condition for the subsequent fine alignment using filtering methods.

    参考文献
    相似文献
    引证文献
引用本文

包建华,乔 曦,李道亮.双矢量定姿算法提高海参捕捞装置捷联惯导系统粗对准精度[J].农业工程学报,2017,33(12):286-292. DOI:10.11975/j. issn.1002-6819.2017.12.037

Bao Jianhua, Qiao Xi, Li Daoliang. Double-vector attitude determination algorithm improving coarse alignment accuracy of strapdown inertial navigation system for sea cucumber fishing device[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE),2017,33(12):286-292. DOI:10.11975/j. issn.1002-6819.2017.12.037

复制
分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2016-12-29
  • 最后修改日期:2017-03-27
  • 录用日期:
  • 在线发布日期: 2017-07-01
  • 出版日期:
文章二维码
您是第位访问者
ICP:京ICP备06025802号-3
农业工程学报 ® 2024 版权所有
技术支持:北京勤云科技发展有限公司