- 专利标题: 多关节水下无人潜行器变基线三维空间定位方法
-
申请号: CN201910680198.5申请日: 2019-07-26
-
公开(公告)号: CN110441736B公开(公告)日: 2021-05-07
- 发明人: 卢奂采 , 刘祖斌 , 唐纳德·迈克尔·马克法兰德
- 申请人: 浙江工业大学
- 申请人地址: 浙江省杭州市下城区潮王路18号
- 专利权人: 浙江工业大学
- 当前专利权人: 浙江工业大学
- 当前专利权人地址: 浙江省杭州市下城区潮王路18号
- 代理机构: 杭州天正专利事务所有限公司
- 代理商 王兵; 黄美娟
- 主分类号: G01S5/22
- IPC分类号: G01S5/22 ; G01C21/00 ; G01C21/12
摘要:
多关节水下无人潜行器变基线三维空间定位方法,包括:步骤1,根据水听器阵列上阵元和潜标声源的信号,获得潜标声源发出的声波到达水听器的时间迟延,进而计算出多关节水下无人潜行器的水听器阵列上每个水听器至潜标声源的斜距;步骤2,根据步骤1得到的结果、多关节水下无人潜行器的尺寸、各关节的转角,计算得到多关节水下无人潜行器的基线的长度L、俯仰角α和偏航角γ;步骤3,根据步骤1和2得到的结果,以及几何坐标关系建立单潜标、变基线长度的多关节水下航行器上水听器位置求解的数学模型,计算得到每个水听器的三维坐标的两组解,再通过多解判别算法求出真解,得到水听器在大地坐标系下的真实坐标,即获得多关节水下无人潜行器的三维空间坐标。
公开/授权文献
- CN110441736A 多关节水下无人潜行器变基线三维空间定位方法 公开/授权日:2019-11-12