主权项 |
一种用于融合摄影机和距离传感器数据以在车辆中追踪至少一个外部物体的方法,所述车辆具有包括摄影机和距离传感器的传感器子系统、以及车载计算机,所述方法包括:所述车载计算机确定可基于从车辆的传感器子系统接收的输入获得与该物体相应的新物体数据;其中,新物体数据包括:以相应于该物体的数据点形式来自距离传感器的雷达数据;以及以像素形式来自摄影机的图像;所述车载计算机记录新物体数据;其中记录所述新物体数据包括:获得雷达数据;以及投影雷达数据到来自摄影机的图像的平面;其中所述投影包括:根据包括矩阵乘法的线性投影计算在相应于该物体的底部的图像平面内构成摄影机图像的像素的基本像素;以及包括矩阵乘法的线性投影表示为:<img file="709580dest_path_image001.GIF" wi="182" he="145" />,其中:<img file="70154dest_path_image002.GIF" wi="83" he="26" />表示基本像素,<img file="394956dest_path_image004.GIF" wi="9" he="17" />表示基本像素的行指数和<img file="dest_path_image005.GIF" wi="15" he="17" />表示基本像素的列指数;<img file="951709dest_path_image006.GIF" wi="101" he="26" />表示该物体的接地点,<img file="779987dest_path_image007.GIF" wi="13" he="23" />表示距参考点的纵向偏移量,<img file="dest_path_image008.GIF" wi="16" he="21" />表示横向偏移量;α 表示车辆俯仰角;<img file="763993dest_path_image009.GIF" wi="20" he="18" />表示摄影机固有参数;<img file="dest_path_image010.GIF" wi="18" he="18" />表示旋转矩阵;以及<img file="310512dest_path_image011.GIF" wi="17" he="25" />表示在车辆框架中的摄影机位置;所述车载计算机根据预测算法估计该物体的预期位置和预期外观以产生与该物体相应的预测轨迹;以及所述车载计算机分析该物体的运动,包括将预测轨迹和与该物体相关联的并且存储在车载计算机的数据库中的任何现有轨迹进行比较。 |