AGV如何实现自主避障

下面按“传感器→建模→算法→安全机制→工程实现”的顺序把AGV自主避障讲清楚。一、整体架构概览AGV要“自己绕开障碍”至少要做三件事1感知知道“我在哪”“周围有什么”2规划算出一条安全的局部轨迹3控制与安全执行轨迹并在任何层级触发制动/减速。典型技术栈示意偏AMR/智能AGV二、用什么传感器“看”障碍1. 常见传感器组合12D LiDAR核心360°或270°扫描测距十几米到几十米用于SLAM建图、障碍物检测与局部避障是AGV最主流的环境感知传感器。23D LiDAR/固态雷达得到点云能识别高度方向的障碍托盘伸出一块、低矮挡板等适合人车混行、复杂3D场景但成本较高。3视觉3D/深度相机、立体视觉检测小障碍、悬空障碍、地面坑洞、反光物体某些LiDAR不敏感常用于语义识别人/车/托盘和颜色/二维码识别等辅助功能。4超声波/红外/防撞触边近距离探测、防撞最后防线成本低适合补盲区例如底部盲区、边缘窄缝。5安全级传感器安全LiDAR、安全雷达、安全区域扫描器、安全光幕/相机满足PLd/SIL2等安全等级输出安全信号给安全PLC设置“预警区保护区”预警减速、保护区停车是AGV/AMR的“强制刹车系统”。2. 多传感器融合把不同传感器统一到“本体坐标系”下的点云/栅格/3D体素中常用框架ROS/ROS2的sensor_fusion、EKF/UKF、卡尔曼滤波、图优化等提高鲁棒性并减少漏检/误检。三、先有“地图 定位 代价图”1. SLAM 建图与定位使用2D/3D LiDAR里程计IMU轮速做Gmapping/Cartographer/LIO-SAM等建图实时定位让AGV知道自己在“哪一块地砖”以及障碍相对自身的精确位置。2. 代价地图Costmap把传感器检测到的障碍投射到栅格并为每个栅格打分0可通行253~254潜在危险255致命/障碍物。代价图会随时间自动“老化”旧障碍避免人走过后的“鬼影”全局代价图static map长时障碍 局部代价图实时滚动窗口共同作用。四、全局路径 局部避障算法层1. 全局路径规划静态环境在静态地图上用 A* / Dijkstra / JPS 等找一条“拓扑上无障碍”的路径路径由一系列waypoints组成仅作“宏观导航指引”不直接执行。2. 局部避障算法动态环境这是“自主避障”的核心。常见方法1DWADynamic Window Approach在速度空间 (v, ω) 中采样多组候选速度对每个速度前向仿真轨迹考虑与障碍的距离代价图速度方向是否贴近目标是否超出运动学/动力学约束选取综合代价最小的一组 (v, ω) 输出给底盘ROS Navigation 默认局部规划器之一广泛用于AGV/AMR。2APFArtificial Potential Field目标产生“引力场”障碍产生“斥力场”合力决定运动方向优点计算简单实时性好缺点易陷入局部最小如U型墙。实际中会与全局规划或其他局部算法结合使用。3TEBTimed Elastic Band把轨迹看成弹性带在时间空间上优化考虑运动学约束和非完整约束适合需要平滑轨迹和更精确避障的场景窄通道、复杂人车混行。4VFHVector Field Histogram、RRT* 等变种VFH把局部障碍信息投影为极坐标直方图选择可行方向RRT*在状态空间中树状采样、重规划适合高维约束场景更多出现在复杂科研或无全局地图场景在工业AGV中多为辅助或备用方案。5学习/强化学习局部规划前沿使用强化学习RL训练局部策略对复杂动态人群场景更灵活仍需与传统算法结合以确保安全可解释性是近年热点方向之一。五、运动约束与轨迹执行对差速、麦克纳姆、舵轮等不同底盘把(v, ω)或(vx, vy, ω)映射到各轮转速限制加速度/减速度、转弯半径保证轨迹物理可行、不侧翻/不滑行通过闭环控制PID/MPC跟踪规划轨迹。六、安全系统哪怕算法“犯傻”硬件也能刹得住工业AGV普遍采用“软件规划 硬件安全”的双重架构1安全传感器安全LiDAR、安全区域扫描器、安全雷达等可设置多层防护区域预警区减速 保护区立即停车。2安全PLC / 安全模块独立于主控直接监控安全传感器和急停按钮满足相应PL/SIL等级一旦触发条件就切断驱动输出并抱闸制动。3硬线急停 触边/防撞条机械触边、前后保险杠开关任何层级算法或安全检测到碰撞风险时最终都会落到“切断动力 制动”。七、工程落地时的关键要点实践建议1分层防护远距离提前绕行局部避障中距离减速、停车等待近距离硬制动 急停避免任何碰撞。2“看不见”的地方更要防护悬空障碍如货架伸出一块板用3D LiDAR/深度相机地面坑洞/低矮障碍近地安装传感器或视觉盲区超声波/安全光幕补位。3参数调优代价地图参数膨胀半径、障碍阈值、衰减时间等DWA/TEB参数最大速度、加速度、轨迹评分权重安全区域减速距离与当前速度的关系要匹配车辆制动能力。4可靠性设计传感器冗余比如前向LiDAR安全激光雷达通信超时、心跳丢失、里程计异常时进入“停车/安全模式”定期标定传感器外参LiDAR、相机、IMU相对底盘的位姿。八、如果你要“动手实现”一个简单AGV避障路线建议1硬件差速底盘 2D LiDAR 里程计编码器IMU。2软件栈ROS/ROS2建图Cartographer/SLAM_toolbox导航Nav2包含Navfn全局规划、DWA/TEB局部规划、Costmap2D传感器LaserScan → Costmap → local planner → cmd_vel。3安全外加一对安全激光雷达或安全传感器接入安全PLC作为硬保护。