Invention Grant
- Patent Title: 一种基于图优化的UWB/IMU的室内移动机器人协同定位方法
-
Application No.: CN202110421274.8Application Date: 2021-04-19
-
Publication No.: CN113324544BPublication Date: 2023-02-28
- Inventor: 李智卿 , 王馨悦 , 马书根 , 刘智锋
- Applicant: 北京化工大学
- Applicant Address: 北京市朝阳区北三环东路15号
- Assignee: 北京化工大学
- Current Assignee: 北京化工大学
- Current Assignee Address: 北京市朝阳区北三环东路15号
- Agency: 北京思海天达知识产权代理有限公司
- Agent 沈波
- Main IPC: G01C21/20
- IPC: G01C21/20 ; G01C21/16 ; G01S5/10
Abstract:
本发明公开了一种基于图优化的UWB/IMU的室内移动机器人定位方法,包括机器人运动控制系统,机器人通讯系统,UWB系统,IMU惯性测量单元,所述UWB系统包括2个及以上标签与IMU,4个及以上基站,所述标签将接收基站所发送的信号,通过TOF的方法测得标签与基站之间的距离。所述标签与IMU皆搭设于机器人。本发明利用UWB系统,IMU惯性测量单元,通过IMU数据初步校验UWB数据,判断数据是否受到NLOS影响,使用柯西鲁棒核函数,列文伯格‑马夸尔特算法优化机器人当前时刻的位姿。大大提高了使用UWB在非视距情况下,进行机器人定位时机器人定位位姿不准的问题。得到在视距情况下比单一UWB定位更加精确的定位效果。
Public/Granted literature
- CN113324544A 一种基于图优化的UWB/IMU的室内移动机器人协同定位方法 Public/Granted day:2021-08-31
Information query
IPC分类: