一种核设施退役机器人避障轨迹规划方法

本发明公开了一种核设施退役机器人避障轨迹规划方法，该方法通过固态激光雷达和双目相机采集环境数据，基于三维建图与定位算法，建立三维点云地图；通过机器人前部双目相机基于SGBM算法，确定障碍物到机器人当前质心的距离；转换全局笛卡尔坐标系下，提取所有点云的二维平面坐标，以两条线性方程为边界，筛选出在边界内的障碍物点云；生成当前时刻的障碍物有效边界曲线；通过撒点采样和五次多项式轨迹拟合，生成机器人局部候选轨迹；动态求解出每一时刻的障碍物有效边界，从而规划出当前时刻的最佳运动轨迹，直到机器人绕过障碍物。该方法解决了目前核退役机器人在避障过程中需依赖人工通过监控视频远程操作时，机器人与周围环境的距离难以确定问题，不仅减轻了人工操纵的负担，也提高了避障的效率与准确性。