[发明专利]车道偏离预警方法和系统

摘要

本发明提供一种车道偏离预警方法和系统，其中，该方法包括通过安装在汽车尾部的倒车摄像头获取车道线图像中的车道线，确定图像坐标系与世界坐标系的映射关系，并根据获取到的车道线在图像坐标系中的第一坐标方程，确定车道线在世界坐标系中的第二坐标方程；根据第二坐标方程中的坐标方程参数，确定汽车的后车轮轴中心到车道线的距离之后，确定汽车的前车轮轴中心到车道线的距离；若汽车的前车轮轴中心到车道线的距离小于预设距离，并且确定未接收到打开转向灯信号，则开启仪表报警装置，以使仪表报警装置发出车道偏离预警信号。实现了提供一种车道偏离预警方法及系统，可以有效准确的判断汽车是否发送车道偏离，准确的进行汽车偏离预警。

主权项

一种车道偏离预警方法，其特征在于，包括：通过安装在汽车尾部的倒车摄像头获取车道线图像，确定所述车道线图像中所述车道线在所述倒车摄像头的图像坐标系中的宽度和高度；根据所述车道线在所述倒车摄像头的图像坐标系中的宽度和高度，以及所述倒车摄像头的标定参数，确定所述图像坐标系与世界坐标系的映射关系；获取所述车道线在所述图像坐标系中的第一坐标方程，并根据所述第一坐标方程以及所述图像坐标系与世界坐标系的映射关系，确定所述车道线在所述世界坐标系中的第二坐标方程；根据所述第二坐标方程中的坐标方程参数，确定所述汽车的后车轮轴中心到车道线的距离；根据所述汽车的后车轮轴中心到车道线的距离，确定所述汽车的前车轮轴中心到车道线的距离；若所述汽车的前车轮轴中心到所述车道线的距离小于预设距离，并且确定未接收到打开转向灯信号，则开启仪表报警装置，以使所述仪表报警装置发出车道偏离预警信号；其中，根据所述车道线在所述倒车摄像头的图像坐标系中的宽度和高度，以及所述倒车摄像头的标定参数，确定所述图像坐标系与世界坐标系的映射关系，包括：根据所述世界坐标系A(X,Y,Z)，以及所述倒车摄像头的光轴与所述世界坐标系的Z轴的夹角θ，确定所述倒车摄像头的摄像头坐标系B(Xc,Yc,Zc)，其中，Xc＝X，Yc＝Ycosθ‑Hsinθ，Zc＝‑(Hcosθ+Ysinθ)，H为所述倒车摄像头距离地面的高度；根据所述倒车摄像头的摄像头坐标系B(Xc,Yc,Zc)，以及所述倒车摄像头的焦距f，确定摄像头成像面O(x,y)，其中，x＝‑f·(Xc/Zc)，y＝‑f·(Yc/Zc)；根据所述摄像头成像面O(x,y)，所述摄像头成像面的宽度w和高度h，以及所述车道线在所述图像坐标系中的宽度WI和高度HI，确定所述图像坐标系O(u,v)与所述世界坐标系的A(X,Y,Z)映射关系为：u＝x·(w/WI)＝f·(w/WI)·(X/(Ysinθ+Hcosθ))，v＝y·(h/HI)＝f·(h/HI)·((Ycosθ‑H sinθ)/(Ysinθ+Hcosθ))。