一种基于相机和雷达的融合测距方法及系统

本发明提供一种基于相机和雷达的融合测距方法及系统，包括：分别利用相机与雷达对预设目标测距，并基于获得的时间对齐的测距数据对相机与雷达进行跨模态目标匹配；在跨模态目标匹配一致的前提下，构建预设目标的状态转移矩阵；基于相机测距误差模型与雷达测距误差模型，结合状态转移矩阵，计算相机与雷达的模糊隶属度；基于模糊隶属度计算相机与雷达各自的权重，结合状态转移矩阵，采用扩展卡尔曼滤波器，获得对预设目标的融合测距结果。本发明实施步骤简单，能够根据目标的运动状态变化从而自适应的调整系统自身的参数，提高传感器测量距离的精度。