基于改进运动原语生成的陆空两栖机器人Kinodynamic A^(*)算法

针对Kinodynamic A^(*)算法采用统一的运动原语生成,在陆空两栖机器人上应用时存在机动性无法充分发挥等问题,提出了基于改进运动原语生成的陆空两栖机器人Kinodynamic A^(*)算法。该算法从考虑陆、空模态运动能力差异出发,通过以下三个方法改进陆空两栖机器人Kinodynamic A^(*)算法性能。首先是基于动力边界决定状态空间加速度输入,差异化生成陆、空模态运动原语;其次是基于动力学约束剪枝,确保运动原语不超过速度边界;最后是构造轨迹优化代价函数优化轨迹平顺性、安全性及机动性。在仿真场景下的结果表明,所改进的算法在将空中平均速度提高了54.1%,平均路径总时间降低6.7 s,路径总代价降低22.00%,且算法运行时间降低0.069 s,充分发挥陆空两栖机器人上的强机动能力与高续航能力。