煤矿井下探测作业机器人轨迹粒子群规划方法研究

针对煤矿井下非结构化、不确定和复杂的未知环境作业轨迹规划问题,提出了一种基于粒子群算法的机器人轨迹规划与优化方法。建立机器人动力学模型,通过将机器人运动学约束转化为三次样条插值曲线的控制关键点约束的非线性约束优化问题,利用三次多项式插值拟合曲线,通过粒子群算法和惩罚函数法相结合,采用自适应函数控制插值收敛速度,得到一条满足实际工况要求的最优时间轨迹。研究结果表明,该方法有效地解决了煤矿井下复杂环境的机器人时间最优轨迹优化问题。