[发明专利]一种轨迹规划方法、装置、存储介质及电子设备有效
| 申请号: | 202110502885.5 | 申请日: | 2021-05-10 |
| 公开(公告)号: | CN112987762B | 公开(公告)日: | 2021-09-07 |
| 发明(设计)人: | 夏华夏;陈国胜;田润;邢学韬;王志超;陈鸿帅;张杨宇;颜诗涛;任冬淳;樊明宇 | 申请(专利权)人: | 北京三快在线科技有限公司 |
| 主分类号: | G05D1/02 | 分类号: | G05D1/02 |
| 代理公司: | 北京曼威知识产权代理有限公司 11709 | 代理人: | 方志炜 |
| 地址: | 100080 北京市海*** | 国省代码: | 北京;11 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 轨迹 规划 方法 装置 存储 介质 电子设备 | ||
1.一种轨迹规划方法,其特征在于,包括:
确定在目标时刻时,目标设备的预参考轨迹点,以及各指定障碍物的预测轨迹点;
针对每个指定障碍物,根据该指定障碍物的速度以及目标设备的速度,确定出该指定障碍物与目标设备之间的相对速度;
判断在该指定障碍物与目标设备之间的相对速度的作用下,该指定障碍物与目标设备之间的距离是否具有缩小的趋势;
若是,确定以垂直该指定障碍物速度方向的向量为法向量的超平面,作为该指定障碍物对应的候选超平面;若否,确定以垂直目标设备速度方向的向量为法向量的超平面,作为该指定障碍物对应的候选超平面;
从该指定障碍物对应的各候选超平面中选择该指定障碍物对应的约束界,其中,所述约束界将目标设备和指定障碍物所在的空间划分为不相交的两部分,该指定障碍物被对应的约束界划分至与目标设备不同的部分;
确定出由至少部分指定障碍物对应的约束界所围成的包含目标设备的空间,并将该空间作为目标时刻对应的约束集;
在该目标时刻的约束集的约束下,调整目标设备的预参考轨迹,并将调整后的预参考轨迹作为参考轨迹。
2.如权利要求1所述的方法,其特征在于,确定各指定障碍物的预测轨迹点之前,所述方法还包括:
确定各障碍物的预测轨迹点;
根据目标设备的预参考轨迹点,从障碍物中选择出满足第一距离条件的障碍物作为指定障碍物,其中,满足第一距离条件的障碍物为预测轨迹点与目标设备的预参考轨迹点之间的距离小于预设的第一距离的障碍物。
3.如权利要求1所述的方法,其特征在于,针对每个指定障碍物,根据该指定障碍物的速度,以及目标设备的速度,为该指定障碍物确定出对应的约束界之前,所述方法还包括:
根据目标设备的预参考轨迹点,确定出以目标设备的预参考轨迹点为中心,由各初始约束界所围成的包含目标设备的空间,作为初始约束集;
确定出由至少部分指定障碍物对应的约束界所围成的包含目标设备的空间,并将该空间作为目标时刻对应的约束集,具体包括:
确定出由初始约束界以及各指定障碍物对应的约束界中的至少部分约束界所围成的包含目标设备的空间,并将该空间作为目标时刻对应的约束集。
4.如权利要求1所述的方法,其特征在于,从该指定障碍物对应的各候选超平面中选择该指定障碍物对应的约束界,具体包括:
针对该指定障碍物对应的每个候选超平面,根据目标设备的预参考轨迹点,确定出该候选超平面与目标设备的预参考轨迹点之间的距离;
从该指定障碍物对应的各候选超平面中选择与所述目标设备的预参考轨迹点之间的距离最远的候选超平面,作为该指定障碍物对应的约束界。
5.如权利要求1所述的方法,其特征在于,确定在目标时刻各指定障碍物的预测轨迹点之后,所述方法还包括:
确定禁忌表,并将禁忌表初始化为空集;
针对每个指定障碍物,根据该指定障碍物的速度,以及目标设备的速度,为该指定障碍物确定出对应的约束界,具体包括:
针对每个指定障碍物,将该指定障碍物作为目标障碍物,判断该目标障碍物是否在禁忌表中;
若是,重新选择作为目标障碍物的指定障碍物,直到禁忌表中包括所有指定障碍物;
若否,根据目标障碍物的速度,以及目标设备的速度,为目标障碍物确定出对应的约束界,并将各与目标设备不位于同一空间的指定障碍物加入禁忌表,并重新选择作为目标障碍物的指定障碍物。
6.如权利要求5所述的方法,其特征在于,针对每个指定障碍物,将该指定障碍物作为目标障碍物,具体包括:
根据目标设备的参考轨迹点,以及各指定障碍物的预测轨迹点,确定出各指定障碍物与目标设备之间的距离;
以各指定障碍物与目标设备之间的距离由小到大对各指定障碍物排序,并按照顺序依次从指定障碍物中选取目标障碍物。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京三快在线科技有限公司,未经北京三快在线科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110502885.5/1.html,转载请声明来源钻瓜专利网。
- 上一篇:抛物面卫星天线冲孔器
- 下一篇:基于多系统多源定位数据融合的海上目标定位方法





