面向复杂地形的四足机器人运动规划方法

摘要

本发明提供一种面向复杂地形的四足机器人运动规划方法，根据四足机器人的运动目标与传感器检测到的局部环境信息和地形信息确定四足机器人在当前时刻的运动方向，生成四足机器人在笛卡尔空间的局部运动目标；根据四足机器人在笛卡尔空间的局部运动目标与传感器检测到的地形信息，利用快速随机扩展树算法，在四足机器人构型空间生成运动路径序列，依照该运动路径序列运动，直至四足机器人到达局部运动目标；重复以上步骤，直至四足机器人到达设定目标点。本发明通过将笛卡尔空间内的机体运动规划与构型空间内的各关节构型规划相结合，根据四足机器人当前环境，生成四足机器人各关节的运动路径序列，保证四足机器人在复杂地形上安全平稳的自主运动。