一种水下航行器轨迹发生器的设计与仿真

基金项目: 部级国防科技预研基金项目(08J4.2.2)

Design and Simulation of a Trajectory Generator for Autonomous Underwater Vehicle

College of Marine Engineering, Northwestern Polytechnical University, Xi’an 710072, China

摘要: 为了减少水下航行器(AUV)导航系统算法开发过程中跑车试验及半实物仿真等所耗费的资金和时间, 提出一种水下航行器轨迹发生器的设计方法。利用所给出的轨迹微分方程, 反推得出生成轨迹参数公式和惯性信息公式, 同时给出水下航行器在直航、转弯和爬潜等常见的运动状态下轨迹发生器的具体输入, 并将生成的惯性量测值(加速度和陀螺值) 输入捷联式惯性导航算法。验证结果表明, 利用所设计的轨迹发生器可以为研究导航算法提供模拟的数据, 具有工程实际意义。
- 自主水下航行器 /
- 轨迹发生器 /
- 导航算法 /
- 半实物仿真
Abstract: To reduce the cost of hybrid simulation in development of navigation system for autonomous underwater vehicle (AUV), we design a trajectory generator for AUV, and present an algorithm of the trajectory generator. A general equation for generating trajectory parameters and inertial information is deduced, the control regulation is analyzed, and the input of the trajectory generator for AUV’s straight-running, turning, climbing and diving conditions is offered. Verification results show that the proposed trajectory generator can generate data for simulation in developing navigation algorithms.
- autonomous underwater vehicle(AUV) /
- trajectory generator /
- navigation algorithm /
- hybrid simulation

[1]	严卫生, 徐德民, 李俊, 张福斌. 自主水下航行器导航技术[J] . 火力与指挥控制, 2004, 29( 6) : 11??17.YanW e i??sheng, Xu De??m in, Li Jun, et a.l Surv er o fNav??igation Technology for Au tonm ous Unde rw ater V eh ic le[J]. Fire Contro l& Command Contro,l 2004, 29( 6): 11??17.
[2]	全伟, 房建成. SINS /CNS组合导航半实物仿真系统及其试验研究[J]. 系统仿真学报, 2007, 19( 15): 3414??3418.QuanW e,i Fang Jian??cheng. Rea liza tion and Expe rim en??tal Research forH ybrid Sim ulation System of S INS /CNSIntegrated Nav iga tion[J]. Journal o f System Sim ulation,2007, 19( 15): 3414??3418.
[3]	程慧俐, 以光衢, 张洪铖. 捷联惯导系统仿真器设计[J] . 系统仿真学报, 1993, 6( 4): 41??48.Cheng H u i??l,i Y i Guang??qu, Zhang H ong??cheng. Des igno f Strapdown Inertia l System??s Emu lator [J]. Journa l o fSystem Sim ulation, 1993, 6( 4): 41??48.
[4]	王保锋. 大圆轨迹发生器的设计[J] . 航空计算技术,2006, 36( 3): 119??121.W ang Bao??feng. Design o f C ircular Tra jectory Genera to rfor S trapdown Iner tia lNav iga tion System [J]. Aeronauti??ca l Compu ting Techn ique, 2006, 36( 3): 119??121.
[5]	秦永元. 惯性导航[M ]. 北京: 科学出版社, 2006.
[6]	Savag e P G. S trapdown Inertia l Navigation System A lgo??rithm Design, Part 1: AttitudeA lgor ithm s[J] A IAA Jour??na l o f Guidance, Contro l and Dynam ics 1998, 21 ( 1 ):208??221.