基于车载标定相机的道路平面法线计算技术问询

嘿，这个问题我之前做车载视觉的时候也碰到过——在没有外参（旋转/平移）先验的情况下，从单目图像里恢复道路平面的法线，核心其实是利用同一平面内多条直线的投影约束，我给你梳理几个落地的思路：

既然L1、L2、L3在同一个3D平面上，它们的图像投影必然满足平面诱导的投影约束——最关键的就是消失线（Vanishing Line）：同一平面内所有直线的消失点，都会落在这条消失线上。而消失线和平面法线直接可以通过相机内参建立数学关系。

步骤1：求解道路平面的消失线 #

你已经能检测车道线的消失点了，那这一步就很顺：

• 如果L1、L2、L3是不平行的车道线（比如岔路口的车道线），那它们各自的消失点V1、V2、V3肯定共线，用这三个点拟合出的直线就是道路平面的消失线l；
• 如果L1、L2、L3是平行的车道线（比如高速直道），那它们的消失点是同一个，这时候你需要找到平面内另一条不平行的直线（比如横向停止线、道路边缘线），获取它的消失点，两个消失点连线就是消失线。

步骤2：从消失线推导平面法线 #

因为你的相机已经标定过，内参矩阵K是已知的。消失线和相机坐标系下的平面法线n有直接的推导公式：
假设消失线在图像平面的齐次坐标是l = [l_x, l_y, l_z]^T，那么相机坐标系下的平面法线满足：

n = K^{-T} * l

这里的K^{-T}是内参矩阵K的逆矩阵的转置。

简单解释下原理 #

相机坐标系中，3D平面的方程是n^T X + d = 0（X是平面上的3D点，d是平面到相机光心的距离）。而消失点是平面上无穷远点的投影，无穷远点的齐次坐标满足X = [x, y, z, 0]^T，代入平面方程得n^T X = 0。结合单目投影关系x_img = K * X（x_img是图像齐次坐标），推导后就能得到上面的法线计算公式。

额外验证小技巧 #

得到法线n后，可以找几个图像上车道线的特征点，用相机内参反投影到3D空间（可以先假设一个深度，或者用单目深度估计的结果），然后代入平面方程n^T X + d = 0（d可以用其中一个点求解），如果所有点的误差都很小，说明你的推导是正确的。

内容的提问来源于stack exchange，提问作者Pm22