一种无人车运行路径规划方法、装置及设备制造方法及图纸

本申请公开了一种无人车运行路径规划方法、装置及设备，方法包括：基于无人车运行环境的环境点云数据从线点和面点的角度估计激光雷达的姿态变换，得到姿态变换矩阵；根据姿态变换矩阵将环境点云数据映射至全局点云地图后，基于预设离散动力学模型计算下一时刻的姿态，得到姿态采样点集合；通过预设代价函数在姿态采样点集合中选取最优采样点，预设代价函数包括势力场函数和启发函数；以最优采样点为圆心，根据预置半径进行圆安全空间拓展操作，得到拓展圆；根据拓展圆和最优采样点生成无人车在运行环境中的运行路径。本申请能解决现有技术点云地图生成过程计算量太大，且不适用于未知环境，导致实际的无人车集群路径规划效率很差的技术问题。很差的技术问题。很差的技术问题。

【技术实现步骤摘要】
一种无人车运行路径规划方法、装置及设备


[0001]本申请涉及无人车
，尤其涉及一种无人车运行路径规划方法、装置及设备。

技术介绍

[0002]物流无人车在货物搬运、巡航安检等服务业邻域得到了广泛的应用，利用无人车进行救援、补给、探索等任务一直是研究的热点，基于无人车组成无人车集群，通过通信系统配合协同，可充分发挥无人车的优势以满足复杂多样的任务需求。但这也对无人车的单体控制提出了更高的要求，在多无人车集群在协同执行任务的过程中某台无人车的碰撞可能会导致无人车集群工作系统的瘫痪，所以单体无人车的安全行使是整个无人车集群完成工作的重要前提。
[0003]在其中，无人车的可行安全空间的构建是研究的重点。为了构建无人车的安全行使空间，通常做法是获取周围环境的点云分布，并在此基础上构建行驶区域周围的环境的地图，后在生成的地图中采用路径搜索算法，通过对搜索到的路径进行膨胀就可以得到安全可行的空间。但在实际的运行中，由点云信息生成地图的过程会耗费大量的算力，倘若减少迭代的时间会极大地降低地图的精度，由此算得的安全区域可靠性不高；单无人车计算资本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种无人车运行路径规划方法，其特征在于，包括：基于无人车运行环境的环境点云数据从线点和面点的角度估计激光雷达的姿态变换，得到姿态变换矩阵；根据所述姿态变换矩阵将所述环境点云数据映射至全局点云地图后，基于预设离散动力学模型计算下一时刻的姿态，得到姿态采样点集合；通过预设代价函数在所述姿态采样点集合中选取最优采样点，所述预设代价函数包括势力场函数和启发函数；以所述最优采样点为圆心，根据预置半径进行圆安全空间拓展操作，得到拓展圆；根据所述拓展圆和所述最优采样点生成无人车在运行环境中的运行路径，所述运行路径包括运行安全区域。2.根据权利要求1所述的无人车运行路径规划方法，其特征在于，所述基于无人车运行环境的环境点云数据从线点和面点的角度估计激光雷达的姿态变换，得到姿态变换矩阵，包括：通过预设特征提取函数在无人车运行环境的环境点云数据中提取线点和面点；基于不同时刻的两组所述线点和面点计算激光雷达的相对姿态变换，所述相对姿态变换包括相对变换线点和相对变换面点；根据所述相对变换线点和相对变换面点构建非线性函数，并求解出激光雷达的姿态变换矩阵。3.根据权利要求1所述的无人车运行路径规划方法，其特征在于，所述基于无人车运行环境的环境点云数据从线点和面点的角度估计激光雷达的姿态变换，得到姿态变换矩阵，之前还包括：通过激光雷达获取无人车运行环境的点云信息，得到环境点云数据。4.根据权利要求1所述的无人车运行路径规划方法，其特征在于，所述通过预设代价函数在所述姿态采样点集合中选取最优采样点，所述预设代价函数包括势力场函数和启发函数，包括：基于所述姿态采样点集合中采样点产生的势力场构建势力场函数；根据所述势力场函数和启发函数构建采样点的代价函数，得到预设代价函数；以所述预设函数求解最小值为依据，在所述姿态采样点集合中选取最优采样点。5.根据权利要求1所述的无人车运行路径规划方法，其特征在于，所述以所述最优采样点为圆心，根据预置半径进行圆安全空间拓展操作，得到拓展圆，之前还包括：采用KD
‑
tree算法搜索所述最优采样点的近邻点，确定最邻近采样点；根据所述最优采样点与所述最邻近采样点计算预置半径。6.一种无人车运行路径规划装置，其特征...

【专利技术属性】
技术研发人员：孟伟，陈龙生，郭创鹏，
申请(专利权)人：广东工业大学，
类型：发明
国别省市：