6、Pitch Angle Estimation Using a Vehicle Mounted Monocular Camera for Vehicle Target Range Measurement

计算特征点运动，由此得到自身摄像头运动，从其平移向量推出pitch angle。

上图可以计算出前方车的距离：

整个系统流程图如下：

下面就是从SFM的几何关系推理距离：

看下面的关系可以得到pitch angle：

角度计算公式为

*博客内容为网友个人发布，仅代表博主个人观点，如有侵权请联系工作人员删除。