蛙人运载器导航与控制系统关键技术研究

摘要

蛙人运载器是实现秘密运输蛙人到指定海域进行作战的一种装置,将在未来局部海战中发挥着重要作用。同时,它还是人们探索海洋、开发海洋的重要工具之一。它具有机动性强、成本低、维修容易等特点,因此,在现阶段,蛙人运载器也更多承担着军事以外的任务,例如:水下救援作业、水下管道铺设、港口探测清淤、船底检查等。而要实施上述活动,装备在蛙人运载器的导航与控制系统便显得尤为重要,这也是实现这些水下活动的基本保证。
　　 本文主要就蛙人运载器的导航与控制系统关键技术展开了几方面的研究实验。在导航系统方面,研究实验采用了研究所自行研制的光纤陀螺捷联导航系统作为蛙人运载器导航装置,对惯性测量组件、基于SOPC的嵌入式系统构成、捷联矩阵求解、算法仿真等关键点进行了研究;在控制硬件系统设计方面,则设计了以飞思卡尔公司的HCS12系列芯片为蛙人运载器核心处理器的主控制板和串行通讯模块,实现了光纤陀螺捷联惯导系统、核心控制器、深度传感器三者的通讯功能;还设计了蛙人运载器水中动力装置、驱动模块以及接口模块,其中,动力装置采用自主研制的防水电动机与六叶桨直接连接构成。蛙人运载器的主控制板能够实现导航数据和深度数据与期望值比较,输出控制信号到驱动模块,从而控制防水电动机转动,最终达到控制运载器在水中的状态。
　　 在控制软件系统设计方面,研究实验设计了基于μC/OS-Ⅱ操作系统的控制系统,并利用CodeWarrior4.7应用软件编写程序,实现了PID算法,输出PWM控制信号控制防水电动机。论文还根据实际情况和相关资料,简化了蛙人运载器在水中的运动,建立了运动控制的数学模型,并且利用了MATLAB7.0仿真软件对蛙人运载器在垂直面运动和水平面运动做了适当的仿真。仿真结果表明,所设计的控制系统稳定,可以控制蛙人运载器实现的简单运动。
　　 系统经过调试试验,硬件设备之间协调情况良好,能够输出控制信号控制防水电动机良好的转动,基本达到预期效果。