发明公开
- 专利标题: 一种小型空投水下航行器导航控制系统及方法
-
申请号: CN202410200232.5申请日: 2024-02-23
-
公开(公告)号: CN118192644A公开(公告)日: 2024-06-14
- 发明人: 李璟璟 , 姜春晓 , 刘金胜 , 陈双 , 万胜伟 , 吴德祥 , 宫超林
- 申请人: 山东航天电子技术研究所
- 申请人地址: 山东省烟台市高新区航天路513号
- 专利权人: 山东航天电子技术研究所
- 当前专利权人: 山东航天电子技术研究所
- 当前专利权人地址: 山东省烟台市高新区航天路513号
- 代理机构: 青岛橡胶谷知识产权代理事务所
- 代理商 韩静
- 主分类号: G05D1/485
- IPC分类号: G05D1/485 ; G05D101/10
摘要:
本发明涉及海工装备技术领域,提供一种小型空投水下航行器导航控制系统及方法,其包括检测航行器姿态的MEMS姿态测量模块;对航行器入水前的位置进行定位的卫星定位模块;对航行器进行入水检测、加电条件判断、初始位置推算等的中央控制模块;设置有推进器、若干方向舵,并根据中央控制模块的指令通过推进器、方向舵对航行器进行姿态调整的执行机构模块。本发明一方面不断检测MEMS姿态测量模块给出的横滚角和俯仰角,另一方面不断检测入水传感器给出的入水状态,准确控制推进器的上电时间,可有效避免航行器触碰海底或冲出水面,保障航行器安全稳定运行;此外,本发明实现了对入水初始位置的修正,能够获得更精确的稳定初始位置。