简介一份基于激光雷达的机场停机坪监控仿真程序面向雷达感知、自动驾驶与目标跟踪方向的工程师和学生演示在复杂地勤场景中生成点云数据并追踪地面交通目标的完整流程。压缩包共四个文件包含三个脚本与一个实时脚本总大小约五点零六兆字节涵盖了场景构建、测量分割、扩展目标跟踪器调用与机场面板可视化显示。目前已有二百零六人学习。仿真中模拟飞机进入登机口、编组人员引导及停机坪周边车辆移动等典型环节利用“跟踪”几何属性定义飞机外形其他障碍物以长方体近似便于理解不同物体对激光雷达信号的影响。通过本程序可掌握扩展目标滤波的MATLAB实现方法并可直接修改场景参数开展进一步实验。1. 这个仿真的边界激光雷达模拟器与监控算法的分界线机场地面监控的难点不在传感器本身而在数据链条激光雷达给的是无结构的点云而监控系统要的是“哪架飞机、哪辆车、在哪个位置、怎么移动”。这段落差决定了仿真要做两层——先模拟出场站环境和带噪声的点云序列再在其上跑目标检测与跟踪算法。把这个流程在 MATLAB 里打通相当于把硬件采集、标定、算法评估三件事提前到了桌面上比真机推演便宜得多也适合先验证监控算法的参数边界。适用人群很明确做机场场面监视、智能安防的算法工程师以及需要毕设落地的研究生。它不解决雷达天线选型问题也不解决实际部署时的同步误差但能让你在真机数据进来之前先把聚类半径、跟踪门限这类参数摸清楚。“程序压缩包”只是载体真正有价值的是里面点云生成与目标状态估计之间的这层耦合验证。把仿真的边界划清后续所有调参才不会跑偏。2. 用 MATLAB 生成激光雷达点云从场景几何到噪声注入2.1 自建点云的理由真值可控错误可枚举真实激光雷达采集机场地面数据成本高在配套的真值获取。光学相机要标定外参毫米波雷达要处理多径最麻烦的是逐帧标注——飞机滑行、车辆靠近廊桥、人员穿行每一帧的 3D 包围框都要人工确认稍有不一致跟踪算法的评价就失真。自建点云时每个点来自你放置的几何体标签从生成函数里直接产出算法错在哪里一眼就能看出是欠分割、过分割还是航迹断链。另一个理由是参数可控。MATLAB 里能直接控制激光雷达的激光束数、垂直视场角、扫描频率、距离噪声标准差这些参数在真机上一改就得重做实验在仿真里只是一行命令的事。“激光雷达机场地面监控仿真”这个标题里传感器是激光雷达场景是机场地面两者结合后最需要控制的变量是“目标尺度跨度”——从翼展 60 米的宽体机到几米长的地勤车同一帧里出现两种尺度的目标是聚类参数最怕的输入。2.2 机场地面场景的最小几何集机场地面监控关心的不是整片跑道而是三个区域跑道入口与脱离道口、停机坪滑行通道、廊桥作业区。这三个区域的共同点是平面开阔、目标稀疏、遮挡主要来自建筑物和廊桥本身。建模不需要高精度 mesh用矩形体、圆柱体和平面组合就能把监控算法的训练数据撑起来。下面这段代码生成一个带跑道、停机位和两个运动目标的基础场景% 场景尺寸与坐标系x沿跑道方向y垂直跑道z朝上 runwayLen 1200; % 跑道长度截取一段即可 runwayWid 45; % 跑道宽度 xGrid -100 : 2 : runwayLen; % 2m 步长的跑道网格 yGrid -runwayWid/2 : 1 : runwayWid/2; groundZ zeros(numel(xGrid), numel(yGrid)); ground [repmat(xGrid, numel(yGrid),1), ... % 地面点云Nx3 reshape(repmat(yGrid, numel(xGrid),1), [], 1), ... zeros(numel(xGrid)*numel(yGrid),1)];这段代码先把地平面铺成均匀网格作为激光雷达打到地面时的理想返回。实际中地面点不会这么齐后面会加入高斯抖动。炮制地面网格时要注意一个原则监控算法通常会把地面点先剔掉如果仿真的地面过于“平整”拟合平面时残差会偏小后续加真实地面起伏后算法容易把坡度当目标。因此地面点最好每隔一段加一个小幅正弦起伏。飞机与车辆的轮廓用参数化几何体生成比读 CAD 文件轻量得多% 生成一个简化的飞机目标机身长方体 机翼扁长方体 function pts genAirplane(center, heading, span) % center: 机体中心坐标 [x,y] % heading: 机头朝向单位弧度 % span: 翼展单位米 bodyHalf 15; width 3.5; height 4; wingLen span/2; wingThick 0.5; R [cos(heading) -sin(heading); sin(heading) cos(heading)]; % 机身表面随机采样 nB 800; bx bodyHalf * (2*rand(nB,1)-1); by width * (2*rand(nB,1)-1); bz height * rand(nB,1); bLocal R * [bx; by] center(:); bodyPts [bLocal(1,:), bLocal(2,:), bz]; % 机翼表面采样放在机身中段 nW 600; wx 0.5 * (2*rand(nW,1)-1); wy wingLen * (2*rand(nW,1)-1); wLocal R * [wx; wy] center(:); wingPts [wLocal(1,:), wLocal(2,:), wingThick*ones(nW,1)]; pts [bodyPts; wingPts]; end函数返回的是目标表面的三维点。rand采样保证了点云分布不是规则的网格而是接近激光脚点的随机落点heading的旋转让目标可以沿任意方向滑行方便模拟脱离跑道转向停机位的机动。这里的span参数要细心设——翼展大、截面小的目标在聚类时很容易被切成长条形DBSCAN 的邻域半径需要按它的大小缩放。2.3 模拟单帧扫描与遮挡关系真实激光雷达是逐束扫描的垂直视场角通常只有 10° 到 40°水平视场 360°。机场地面监控用多线雷达时远处目标每束光线只能打到很少的点这个特性必须仿真出来。简单做法是把目标表面点从直角坐标转到以雷达为原点的球坐标再按角度分辨率做抽稀。function pts simulateScan(points, sensorPos, rangeRes) % points: 场景点云 Nx3 % sensorPos: 雷达位置常架在高 10m 的杆塔或塔台侧面 % rangeRes: 按距离衰减的点保留比例可传入形如 [maxR, prob] 的向量 dP points - sensorPos; [az, elev, r] cart2sph(dP(:,1), dP(:,2), dP(:,3)); azDeg rad2deg(az); elevDeg rad2deg(elev); % 水平分辨率 0.2°垂直 1°超出视场的点丢弃 azGrid floor(azDeg / 0.2); elevGrid floor(elevDeg / 1.0); keep (elevDeg -15 elevDeg 15) r 800; [~, uniqIdx] unique([azGrid(keep), elevGrid(keep)], rows); idx find(keep); pts points(idx(uniqIdx), :); end这段抽稀用unique保证同一角度格内只留一个点实际上把光束打在同一表面时的密集点云压成了扫描线效果。这里有个常见误用直接用unique去重会让近处目标的点数严重不足因为近处一个角度格对应的弧长可能超过目标尺寸。如果目标是飞机建议把近处 100m 内的点做一次随机采样而不是按角度格剔除保留密集点云的统计特性。2.4 噪声注入让“理想的点”变成“测出来的点”点云生成后有四个噪声源要分别处理距离噪声、强度波动、随机杂波、遮挡泄漏。机场地面开阔杂波主要来自地面本身的小起伏和候机楼玻璃幕墙的多次反射前者表现为贴近地面的短时噪点后者表现为与真实目标位置呈镜像关系的虚警仿真时不必刻意建模多次反射只要在离真实目标一定距离外撒随机点即可。噪声类型典型配置仿真中的实现方式距离噪声3cm ~ 10cm标准差在 r 上加高斯噪声强度波动反射率 0.1 ~ 0.8低于阈值时丢弃该点随机杂波每帧 20 ~ 200 点场景范围内均匀撒点遮挡泄漏目标边缘稀疏点边缘点按概率保留% 对一帧点云统一注入距离噪声与杂波 function noisyPts injectNoise(scenePts, cfg) % 1. 距离噪声沿径向加高斯扰动 d vecnorm(scenePts, 2, 2); dir scenePts ./ max(d, 1e-6); noiseR cfg.rangeSigma * randn(size(d)); noisyPts scenePts dir .* noiseR; % 2. 杂波在监控范围内随机撒点 nClut round(cfg.clutterPerFrame * (1 0.3*randn)); nClut max(nClut, 0); clutRange [cfg.xLim; cfg.yLim; 0, cfg.zMax]; clut clutRange(:,1) (clutRange(:,2)-clutRange(:,1)) .* rand(nClut,3); noisyPts [noisyPts; clut]; endcfg结构体集中的这些参数是后续算法调参的先验。我习惯把rangeSigma从 0.03 加到 0.10分别观察跟踪器在同类杂波下的表现机场场景里地勤车速度慢、滑行飞机速度快目标点数差异大杂波的密度直接决定聚类半径能不能同时保住两种目标。3. 地面监控的目标检测与跟踪杂波抑制才是命门3.1 地面点剔除不能只用一个平面激光雷达机场地面监控里地面点占比通常超过 70%。如果直接对全帧点云做聚类所有目标会和地面粘连成一个巨大的点簇。惯用做法是先用随机采样一致性拟合地平面并剔除但机场地面不是严格平面有小坡度和排水坡度单一平面模型会把树坑、减速带当目标。因此我建议分两级处理第一级用pcfitplane做全局粗剔除第二级用高程统计把“比局部地面高但又不够高”的点归为候选目标。下面是两级剔除的 MATLAB 代码% 第一级RANSAC 拟合最大地平面 maxDistance 0.3; % 点到平面距离阈值单位 m [~, inlierIdx, ~] pcfitplane(pointCloud(scenePts), maxDistance); groundRemoved scenePts(setdiff(1:size(scenePts,1), inlierIdx), :); % 第二级按体素格局部去掉低矮点 voxelSize 2.0; % 体素边长 2m对应一个小车长度的一半 gridIdx floor((groundRemoved - min(groundRemoved)) / voxelSize); gridIdx round(gridIdx); zs groundRemoved(:,3); lowMask false(size(zs)); for k 1:size(groundRemoved,1) key gridIdx(k,:); inSame all(gridIdx key, 2); if zs(k) - min(zs(inSame)) 0.2 lowMask(k) true; end end candidatePts groundRemoved(~lowMask, :);提示pcfitplane的maxDistance参数不能照抄路测场景。机场跑到面平整度比普通道路好但排水坡可能沿横向有 1° 左右的倾角0.3m 的阈值能适应这个坡度。若做的是停机坪区域地面常有机油污渍影响反射率导致拟合出的平面残差偏大此时阈值要放宽到 0.5m。第二级的体素循环在点云大时很慢实际工程中用discretize把三轴切成网格再做accumarray求局部最低点速度可以提升两个数量级。这里写直观循环是为了让参数voxelSize和0.2m的相对关系清晰——它们合起来定义了“多矮算地面”。3.2 用 DBSCAN 聚类拆出单目标剔除地面后剩余点主要来自飞机表面、车顶、人员和少量杂波。机场监控的难点在于同一帧里点的密度差异一辆地勤车在 100m 外可能只有 20 个有效点而 30m 内的飞机有 2000 个点。DBSCAN 的核心参数是邻域半径epsilon和最小点数minPoints固定值无法同时照顾稀疏和稠密目标。工程上我一般分两遍做先用较大的epsilon把稠密目标完整聚类再用较小epsilon在未聚类点中找稀疏目标。% 稠密目标第一次聚类 idx1 dbscan(candidatePts, 6.0, 8); % epsilon6m, minPoints8 unclustered candidatePts(idx1 -1, :); % 稀疏目标第二次聚类半径缩小到 2.5m idx2 dbscan(unclustered, 2.5, 5);dbscan是 MATLAB 统计与机器学习工具箱的函数输入是 Nx3 点云矩阵输出是每个点的簇编号-1 表示噪声。第一遍用 6m 半径不是因为目标有 6m 大而是因为近距离飞机机身点的法向间距可能达到 0.5~1m加上机翼的弧形过渡过小的半径会把机翼从机身处撕裂成三四个碎片。第二遍的 2.5m 对应一辆车的对角线长度的一半左右太大会把相邻车位的车辆并成一簇。若 MATLAB 版本较老没有dbscan用clusterDBSCAN需要 Lidar Toolbox也行它输入是pointCloud对象接口稍有差异但参数含义一致。无论用哪个函数都要先做一次pcdownsample把点云密度降到每平方米 50 点以内否则epsilon的取值会被近处目标的密集点主导。3.3 给聚类结果排序并建立目标量测聚类完成后每个簇只输出质心坐标还不够。机场地面目标有朝向而机头方向决定了滑行意图所以建议把每个簇的主方向也提出来function [centroid, heading] clusterStats(clusterPts) centroid mean(clusterPts, 1); % 对簇内点做 PCA第一主方向即目标朝向 coeff pca(clusterPts - centroid); heading atan2(coeff(2,1), coeff(1,1)); endPCA 求朝向在目标近似刚体时很稳但注意载物车辆或飞机加油车这类形状接近长方体的目标其第一主方向是沿车身的这个朝向正好是监控要输出的滑行角。问题在于目标被部分遮挡时点云只覆盖一侧朝向会被拉偏。遮挡严重时可以改用最小外接矩形的方法求朝向代价是计算量增大但更稳。3.4 用卡尔曼滤波与航迹生命周期处理“断点”检测出来的簇位置还要过一遍跟踪滤波器否则目标短暂遮挡或杂波点凑成簇时输出位置会抖动。实际监控里最常用的是匀速模型卡尔曼滤波状态向量取 $[x, y, v_x, v_y]^T$因为机场地面目标的速度变化不快加速度项可以在过程噪声里消化。MATLAB 里可以用trackingKF直接搭% 匀速模型卡尔曼滤波器状态 [x;y;vx;vy] kf trackingKF(MotionModel, 2D Constant Velocity, ... State, [x0; y0; 0; 0], ... MeasurementModel, eye(2), ... ProcessNoise, 0.5); % 过程噪声调大以应对转弯 % 每帧测量值为聚类质心的 x,y measurement [centroid(1); centroid(2)]; predict(kf); correct(kf, measurement);ProcessNoise是最值得调的参数。它设小了滤波器会过度相信模型飞机转弯时跟踪点长期贴在航迹内侧设大了位置噪声会被放大输出航迹出现锯齿。机场地面监控的分辨率要求通常在 1m 以内ProcessNoise调到 0.3~0.8 区间再用一辆真实滑行飞机的轨迹录了一段离线重放就测出合适值。跟踪层还需要一个航迹生命周期管理新簇出现时不能立刻建航迹要连续两帧都关联上才确认目标丢失后保留 5~10 帧外推航迹超过时间再删除。这套逻辑在trackerGNN里有现成的AssignmentThreshold和TrackToTrackFusionThreshold参数不展开但要知道仿真里跑出来的航迹断链八成是生命周期太短而不是滤波器本身的问题。4. 验证与调参让仿真结果不骗你4.1 离线重放与指标计算仿真最大的优势是有逐帧真值能同时算检测率和跟踪误差。我把点云序列保存成.pcd/.mat后用下面的脚本回放并输出指标% 用真值统计检测率与虚警率真值由场景生成函数直接导出 detected false(numel(trueTargets),1); for i 1:numel(tracks) [idx, dist] nearestNeighbor(... pointCloud(truePositions), tracks(i).Pos); if dist 5 detected(idx) true; end end detectionRate sum(detected) / numel(trueTargets); falseAlarms numel(tracks) - sum(detected);计算检测率时阈值的选取很有讲究。5m 的空间误差在停机坪场景里可能就跨了一个机位机位间距约 7.5m阈值定到 5m 会把邻近航迹误判成关联成功。我一般用目标几何尺寸的 1/3 自适应设阈值飞机取 8m小目标取 1m分别统计大小目标指标这样能暴露聚类参数在尺度上的偏置。4.2 三个必调参数参数所在环节调参方向失效表现rangeSigma点云噪声从 0.03 逐步加到 0.10聚类质心抖动、虚警率升高epsilonDBSCAN先给 6m 再给 2.5m 做两级飞机粉碎或邻近车辆粘连ProcessNoise卡尔曼滤波0.3~0.8 之间扫描航迹锯齿或转弯延迟这三个参数在仿真里的联调顺序很关键。先固定rangeSigma 0.05调聚类epsilon让检测率到 95% 以上再调ProcessNoise缩小跟踪误差最后回来加噪rangeSigma看指标退化幅度退化超过 20% 说明聚类半径过于依赖理想距离精度。反过来调会浪费时间。4.3 仿真结果 “好看” 但实车不行的排查法经常有人仿真时检测率 99%上实车掉到 80%原因多半是仿真没模拟距离相关的分辨率衰减。李达尔点间距随距离线性增大但我在点云生成时是把目标表面点均匀采样了导致远距离目标点密度和近距离一样等于给了算法作弊器。快速验证的办法是把点云按距离做一次二次抽稀每米距离的保留概率设为min(1, 0.5*(50/R))再看检测率是否明显下降。若下降明显说明算法的聚类参数只适配了近距目标。对跑得慢的脚本优先看两点。第一是pcfitplane每帧用的最大迭代次数机场地面平坦时迭代 200 次就够不要用默认的 1000。第二是 DBSCAN 的epsilon在点数上万后会引出大量近邻查询先用pcdownsample把点云降到每帧 3000 点聚类质量损失很有限但每帧耗时可以从 400ms 降到 50ms。这两个改动放进主循环离线重放一小时的场景数据也能在十分钟内跑完调参周期才撑得住。本文还有配套的精品资源点击获取