发明公开
- 专利标题: 一种面向障碍遮挡场景的超宽带UWB实时定位方法和系统
-
申请号: CN202411147729.1申请日: 2024-08-21
-
公开(公告)号: CN119110244A公开(公告)日: 2024-12-10
- 发明人: 陈鑫磊 , 郑盛涛 , 翦卓著
- 申请人: 清华大学深圳国际研究生院
- 申请人地址: 广东省深圳市南山区桃源街道丽水路2279号
- 专利权人: 清华大学深圳国际研究生院
- 当前专利权人: 清华大学深圳国际研究生院
- 当前专利权人地址: 广东省深圳市南山区桃源街道丽水路2279号
- 代理机构: 深圳新创友知识产权代理有限公司
- 代理商 王震宇
- 主分类号: H04W4/02
- IPC分类号: H04W4/02 ; G01S17/89 ; G01C21/16 ; H04W4/029
摘要:
一种面向障碍遮挡场景的超宽带UWB实时定位方法和系统,该超宽带UWB实时定位方法包括初始化定位系统、收集UWB测距及IMU数据、执行多边定位和初步定位解算、构建雅可比矩阵、迭代优化位置参数、更新无人车位姿、状态预测和误差校正、鲁棒性融合UWB和IMU数据,以及综合处理结果输出精确位置。该方法通过融合IMU数据和UWB测距数据,利用误差状态卡尔曼滤波器和Levenberg‑Marquardt算法优化位置参数,实现高精度定位,同时具备对UWB测距误差和IMU测量噪声的鲁棒性。