发明公开
- 专利标题: 一种欠驱动水下航行器编队控制方法及系统
-
申请号: CN202211098949.0申请日: 2022-09-07
-
公开(公告)号: CN115576334A公开(公告)日: 2023-01-06
- 发明人: 王锐 , 郝程鹏 , 马慧 , 司昌龙 , 解玮 , 侯朝焕
- 申请人: 中国科学院声学研究所
- 申请人地址: 北京市海淀区北四环西路21号
- 专利权人: 中国科学院声学研究所
- 当前专利权人: 中国科学院声学研究所
- 当前专利权人地址: 北京市海淀区北四环西路21号
- 代理机构: 北京方安思达知识产权代理有限公司
- 代理商 陈琳琳; 张红生
- 主分类号: G05D1/06
- IPC分类号: G05D1/06
摘要:
本发明提供了一种欠驱动水下航行器编队控制方法及系统,所述方法包括:建立水下航行器模型;利用图论知识建立通信拓扑式,引入辅助变量构建编队控制器;计算虚拟控制律,并将结果用于控制器的设计中,计算出控制推力输入与理想姿态指令;计算输入力矩使水下航行器的姿态跟踪理想姿态指令,使得一组航行器可以实现编队航行。本发明的优势在于:利用单位四元数对姿态进行描述,提高运算效率并可以避免奇点;通过一个积分型辅助变量结合双曲正切饱和函数构建编队控制器,增加了编队集群过程中的平稳性。
公开/授权文献
- CN115576334B 一种欠驱动水下航行器编队控制方法及系统 公开/授权日:2023-05-02