Invention Grant
- Patent Title: 一种基于4D毫米波雷达与IMU的融合定位方法及系统
-
Application No.: CN202311750416.0Application Date: 2023-12-19
-
Publication No.: CN117760417BPublication Date: 2024-06-21
- Inventor: 赵群河
- Applicant: 苏州尚同墨方智能科技有限公司
- Applicant Address: 江苏省苏州市高新区镇湖街道寺桥南街22号
- Assignee: 苏州尚同墨方智能科技有限公司
- Current Assignee: 苏州尚同墨方智能科技有限公司
- Current Assignee Address: 江苏省苏州市高新区镇湖街道寺桥南街22号
- Agency: 苏州国诚专利代理有限公司
- Agent 王会
- Main IPC: G01C21/16
- IPC: G01C21/16 ; G01C21/00 ; G01S13/86 ; G01S13/88 ; G06F18/25 ; G06F17/16

Abstract:
本发明公开一种基于4D毫米波雷达与IMU的融合定位方法及系统,该方法包括以下步骤:通过4D毫米波雷达获得周围环境的点云信息及每个点对应的速度信息,通过惯性测量单元获得当前机体的加速度信息和角速度信息;对4D毫米波雷达检测的信息进行处理,获取4D毫米波雷达的速度信息;判断是否进行系统初始化并作出响应;状态估计;将位置信息、速度信息和姿态信息输出至机体,同时将局部点云地图输出,作为机体的环境感知信息。本发明利用4D毫米波雷达获取的自速度信息和稀疏的点云信息对IMU预测的状态进行两次更新,可在GNSS缺失的情况下到达厘米级定位精度,可在恶劣环境中保证系统的正常运行,对计算资源要求较少,可低成本实现。
Public/Granted literature
- CN117760417A 一种基于4D毫米波雷达与IMU的融合定位方法及系统 Public/Granted day:2024-03-26
Information query
IPC分类: