一种融合车辆特性的三维越野路径规划方法和装置

本发明实施例公开了一种融合车辆特性的三维越野路径规划方法和装置。该方法包括：步骤一，将包括初始点和目标点的三维点云环境地图的数据结构转化为八叉树结构；步骤二，设置车辆的初始姿态和目标姿态，其中姿态信息包括水平横纵坐标以及竖直坐标、横摆角、侧倾角和俯仰角；步骤三，根据偏置采样概率法确定下一路径节点Xi处车辆的控制输入速度；步骤四，通过迭代公式得到下一节点处车辆的位置信息和横摆角；步骤五，根据地形信息确定节点处车辆的高度、侧倾角和俯仰角；步骤六，通过预设约束条件排除障碍节点；重复步骤三至六，直到得到全部路径节点以及每一路径点处车辆的姿态信息。本发明实施例提供的方案能够适应复杂越野环境下的路径规划。