1、构建激光雷达传感器参数
SetLidarParameters_2d.m

2、模拟目标和轨迹
目标:拟设为长方形,长为6,宽为4。
轨迹:以倒8字轨迹进行运动
main.m

3、模拟激光雷达思想
激光雷达位置处于(0,0)向坐标轴的第一象限发射线束,当线束与目标相交时产生量测点。
这里通过光束直线方程与长方形的四条直线方程相交,求出交点再加以判断点是否处于长方形边上。
最后再考虑长方形遮挡问题,则每条线束发出只可能与长方形有一个交点,若不止一个,需要判断交点到激光雷达位置(0,0)的距离,取最小的一个点。
4、效果


具体代码下载