1、等式中h是一个常量--》摄像头与激光发射器之间的垂直距离--》直接测量获得。如下
2、实现头文件的方法代码如下
3、实现cpp文件方法代码如下
4、处理下一帧前最大像素值清零的方法代码如下
5、实现调用的测试函数如下
6、测试效果如下