[发明专利]一种生成几何路网的方法、装置、设备及存储介质有效
申请号: | 202111582093.X | 申请日: | 2021-12-22 |
公开(公告)号: | CN114281915B | 公开(公告)日: | 2022-10-14 |
发明(设计)人: | 全冬兵;李忠恩 | 申请(专利权)人: | 广州小鹏自动驾驶科技有限公司 |
主分类号: | G06F16/29 | 分类号: | G06F16/29;G06F16/23 |
代理公司: | 深圳市智圈知识产权代理事务所(普通合伙) 44351 | 代理人: | 苗燕 |
地址: | 510640 广东省广州市*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 生成 几何 路网 方法 装置 设备 存储 介质 | ||
1.一种生成几何路网的方法,其特征在于,所述方法包括:
获取第一行车轨迹;
获取第一行车轨迹中的两个端点,将该两个端点连接形成第一直线;
获取所述第一行车轨迹中到所述第一直线距离最远的第一轨迹点,计算所述第一轨迹点与所述第一直线之间的第一距离;
获取所述第一轨迹点与所述两个端点分别连接后与所述第一直线形成的两个夹角;
若所述第一距离大于预设距离偏差阈值,或存在一个夹角大于预设角度偏差阈值,则满足预设划分条件,将所述第一轨迹点作为一个第一分段节点;
将该第一分段节点与所述两个端点之间的行车轨迹作为新的第一行车轨迹并返回执行获取所述第一行车轨迹中的两个端点,将该两个端点连接形成第一直线的步骤,直至所述第一距离不大于所述预设距离偏差阈值且不存在夹角大于所述预设角度偏差阈值时,得到多个第一分段节点;
根据各所述第一分段节点,获得所述第一行车轨迹的几何路网;
获取第二行车轨迹:
若所述第二行车轨迹与所述几何路网匹配,根据所述第二行车轨迹以及所述预设划分条件对所述几何路网进行更新。
2.根据权利要求1所述的生成几何路网的方法,其特征在于,所述根据各所述第一分段节点,获得所述第一行车轨迹的几何路网,包括:
按照各所述第一分段节点对应在第一行车轨迹上的行进顺序,依次连接各所述第一分段节点,得到所述第一行车轨迹的几何路网。
3.根据权利要求1所述的生成几何路网的方法,其特征在于,所述若所述第二行车轨迹与所述几何路网匹配,根据所述第二行车轨迹、该第二行车轨迹的轨迹点以及所述预设划分条件对所述几何路网进行更新,包括:
若所述第二行车轨迹中存在与所述几何路网的第一分段节点之间的距离小于预设距离阈值的轨迹点,所述第二行车轨迹与所述几何路网匹配;
根据预设划分条件和所述第二行车轨迹,获得所述第二行车轨迹的多个第二分段节点;
根据所述第二分段节点中的目标分段节点对所述几何路网进行更新,所述目标分段节点为所述多个第二分段节点中到所述几何路网的各第一分段节点的最小距离大于预设距离阈值的第二分段节点。
4.根据权利要求3所述的生成几何路网的方法,其特征在于,所述根据预设划分条件和所述第二行车轨迹,获得所述第二行车轨迹的多个第二分段节点,包括:
获取第二行车轨迹中的两个端点,将该两个端点连接形成第二直线;
获取所述第二行车轨迹中到所述第二直线距离最远的第二轨迹点,计算所述第二轨迹点与所述第二直线之间的第二距离;
获取所述第二轨迹点与所述两个端点分别连接后与所述第二直线形成的两个夹角;
若所述第二距离大于预设距离偏差阈值,或存在一个夹角大于预设角度偏差阈值,则满足预设划分条件,将所述第二轨迹点作为一个第二分段节点;
将该第二分段节点与所述两个端点之间的行车轨迹作为新的第二行车轨迹并返回执行获取第二行车轨迹中的两个端点,将该两个端点连接形成第二直线的步骤,直至所述第二距离不大于所述预设距离偏差阈值且不存在夹角大于所述预设角度偏差阈值时,得到多个第二分段节点。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广州小鹏自动驾驶科技有限公司,未经广州小鹏自动驾驶科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111582093.X/1.html,转载请声明来源钻瓜专利网。