摘要
本申请实施例提供了一种轨迹规划方法、装置及介质,用以解决传统轨迹算法在非结构化环境中难以同时满足轨迹平滑性、连续性和快速响应的问题。该方法包括:基于栅格地图中各第一目标栅格对应的第一轨迹点与障碍物之间的距离进行轨迹规划,得到从目标位置到终点位置的初始轨迹,基于初始轨迹、当前速度、当前朝向角速度和预设的轨迹终点速度进行二次规划,确定目标函数的闭式解,得到平滑轨迹;基于多个第二轨迹点分别与障碍物之间的距离,使用顺序二次规划算法对平滑轨迹进行轨迹优化,得到规划轨迹。进一步地,对规划轨迹进行动力学检查,逐点检查并调整轨迹速度、转角速度和加速度,确保轨迹可行且安全。
技术关键词
终点
误差函数
障碍物
轨迹规划方法
栅格地图
加速度
机器人
轨迹规划装置
轨迹算法
计算机
可读存储介质
轨迹误差
规划算法
线性
矩阵
系统为您推荐了相关专利信息
生成虚拟边界
轮廓
感知周围环境
移动机器人建图
生成特征
路径规划方法
构建电子地图
终点
浮点随机数
路径规划技术