- 专利标题: 一种基于4D毫米波雷达与IMU的融合定位方法及系统
-
申请号: CN202311750416.0申请日: 2023-12-19
-
公开(公告)号: CN117760417B公开(公告)日: 2024-06-21
- 发明人: 赵群河
- 申请人: 苏州尚同墨方智能科技有限公司
- 申请人地址: 江苏省苏州市高新区镇湖街道寺桥南街22号
- 专利权人: 苏州尚同墨方智能科技有限公司
- 当前专利权人: 苏州尚同墨方智能科技有限公司
- 当前专利权人地址: 江苏省苏州市高新区镇湖街道寺桥南街22号
- 代理机构: 苏州国诚专利代理有限公司
- 代理商 王会
- 主分类号: G01C21/16
- IPC分类号: G01C21/16 ; G01C21/00 ; G01S13/86 ; G01S13/88 ; G06F18/25 ; G06F17/16
摘要:
本发明公开一种基于4D毫米波雷达与IMU的融合定位方法及系统,该方法包括以下步骤:通过4D毫米波雷达获得周围环境的点云信息及每个点对应的速度信息,通过惯性测量单元获得当前机体的加速度信息和角速度信息;对4D毫米波雷达检测的信息进行处理,获取4D毫米波雷达的速度信息;判断是否进行系统初始化并作出响应;状态估计;将位置信息、速度信息和姿态信息输出至机体,同时将局部点云地图输出,作为机体的环境感知信息。本发明利用4D毫米波雷达获取的自速度信息和稀疏的点云信息对IMU预测的状态进行两次更新,可在GNSS缺失的情况下到达厘米级定位精度,可在恶劣环境中保证系统的正常运行,对计算资源要求较少,可低成本实现。
公开/授权文献
- CN117760417A 一种基于4D毫米波雷达与IMU的融合定位方法及系统 公开/授权日:2024-03-26
IPC分类: