发明公开
- 专利标题: 基于多基站UWB和点线式视觉惯性的室内工厂无人机定位方法及系统
-
申请号: CN202311322791.5申请日: 2023-10-12
-
公开(公告)号: CN117433515A公开(公告)日: 2024-01-23
- 发明人: 张彦博 , 李冀 , 赵士斌
- 申请人: 桂林电子科技大学
- 申请人地址: 广西壮族自治区桂林市七星区金鸡路1号
- 专利权人: 桂林电子科技大学
- 当前专利权人: 桂林电子科技大学
- 当前专利权人地址: 广西壮族自治区桂林市七星区金鸡路1号
- 代理机构: 南京北辰联和知识产权代理有限公司
- 代理商 陆中丹
- 主分类号: G01C21/16
- IPC分类号: G01C21/16 ; G01C21/20
摘要:
本发明公开一种基于多基站UWB和点线式视觉惯性的室内工厂无人机定位方法及系统,步骤为:S1:测量UWB基站的位置,进行坐标转换与初始化;S2:对获得的原始图像进行灰度处理再提取点特征和线特征,求出相邻关键帧之间的位姿;S3:进行预积分计算获得相邻关键帧之间IMU传感器的姿态信息;S4:分别构建相机的重投影残差方程和IMU的预积分残差方程,并联合两残差方程建立非线性优化问题,求解得视觉惯性位姿信息;S5:获得当前无人机在世界坐标系下的空间位置信息;S6:获取当前时刻的视觉惯性位姿信息与UWB全局空间坐标信息,计算残差建立非线性优化方程求解得无人机的全局位置信息。该方法提高了系统的精确度和鲁棒性。
IPC分类: