自动驾驶车辆及其运动轨迹的动态规划方法及系统与流程

文档序号:22672162发布日期:2020-10-28 12:23阅读:来源:国知局

技术特征:

1.一种自动驾驶车辆运动轨迹的动态规划方法,其特征在于,所述动态规划方法包括:

获取当前时刻自动驾驶车辆的位置;

感知所述自动驾驶车辆周围环境的环境数据;

从所述环境数据中提取关于车道的车道信息,其中,所述车道信息包括车道线的位置;

根据所述自动驾驶车辆当前时刻的位置、高清地图和所述车道信息获取所述自动驾驶车辆的第一可行驶区域,所述第一可行驶区域包括设置于两条车道边缘线之间的车道区、以及设置于每条所述车道边缘线与相邻路牙之间的路肩;

从所述环境数据中提取关于静态物体的静态信息,其中,所述静态信息包括所述静态物体的位置、以及所述静态物体占据的静态区域;

从所述环境数据中提取关于动态物体的动态信息,并根据所述动态信息预测所述动态物体的运动轨迹;

根据所述第一可行驶区域、所述静态信息、所述运动轨迹、以及所述车道信息规划出第二可行驶区域。

2.如权利要求1所述的自动驾驶车辆运动轨迹的动态规划方法,其特征在于,根据所述第一可行驶区域、所述静态信息、所述运动轨迹、以及所述车道信息规划出第二可行驶区域具体包括:

将所述静态区域、所述运动轨迹所占据的动态区域从所述第一可行驶区域中剔除以形成第三可行驶区域;

根据所述第三可行驶区域和所述车道信息规划出所述第二可行驶区域。

3.如权利要求1所述的自动驾驶车辆运动轨迹的动态规划方法,其特征在于,感知所述自动驾驶车辆周围环境的环境数据具体包括:

通过设置于所述自动驾驶车辆的感测设备检测所述自动驾驶车辆周围的环境以获得感测数据;

根据前融合感知算法或者后融合感知算法对所述感测数据进行感知处理得到所述环境数据。

4.如权利要求3所述的自动驾驶车辆运动轨迹的动态规划方法,其特征在于,从所述环境数据中提取关于静态物体的静态信息具体包括:

判断所述静态物体是否为无法识别的物体;

当所述静态物体为无法识别的物体时,利用所述感测数据构建占位栅格地图;

从所述占位栅格地图中获取所述静态物体占据的静态区域。

5.如权利要求1所述的自动驾驶车辆运动轨迹的动态规划方法,其特征在于,从所述环境数据中提取关于静态物体的静态信息具体包括:

判断所述静态物体是否为静止状态下的可动物体;

当所述静态物体为静止状态下的可动物体时,沿所述静态物体的外轮廓线向外延伸预设距离形成拓展区域;

从所述拓展区域中获取所述静态物体占据的静态区域。

6.如权利要求1所述的自动驾驶车辆运动轨迹的动态规划方法,其特征在于,所述动态规划方法还包括:

将所述第二可行驶区域划分为若干可行驶路线,并将所述若干可行驶路线按预设规则进行排序;

从所述若干可行驶路线中选择最优可行驶路线并执行所述最优可行驶路线。

7.一种自动驾驶车辆运动轨迹的动态规划系统,其特征在于,所述动态规划系统包括:

定位模块,用于获取当前时刻自动驾驶车辆的位置;

感测设备,用于感知所述自动驾驶车辆周围环境的环境数据;

第一提取模块,用于从所述环境数据中提取关于车道的车道信息,其中,所述车道信息包括车道线的位置;

获取模块,用于根据所述自动驾驶车辆当前时刻的位置、高清地图和所述车道信息获取所述自动驾驶车辆的第一可行驶区域,所述第一可行驶区域包括设置于两条车道边缘线之间的车道区、以及设置于每条所述车道边缘线与相邻路牙之间的路肩;

第二提取模块,用于从所述环境数据中提取关于静态物体的静态信息,其中,所述静态信息包括所述静态物体的位置、以及所述静态物体占据的静态区域;

第三提取模块,用于从所述环境数据中提取关于动态物体的动态信息,并根据所述动态信息预测所述动态物体的运动轨迹;

规划模块,用于根据所述第一可行驶区域、所述静态信息、所述运动轨迹、以及所述车道信息规划出第二可行驶区域。

8.如权利要求7所述的自动驾驶车辆运动轨迹的动态规划系统,其特征在于,所述规划模块用于将所述静态物体占据的静态区域、所述运动轨迹所占据的动态区域从所述第一可行驶区域中剔除并根据所述车道信息规划出所述第二可行驶区域。

9.如权利要求7所述的自动驾驶车辆运动轨迹的动态规划系统,其特征在于,所述规划模块还用于将所述第二可行驶区域划分为若干可行驶路线,并将所述若干可行驶路线按预设规则进行排序;所述动态规划系统还包括:

执行模块,用于从所述若干可行驶路线中选择最优可行驶路线并执行所述最优可行驶路线。

10.一种自动驾驶车辆,所述自动驾驶车辆包括车身,其特征在于,所述自动驾驶车辆还包括设置于所述车身的感测设备、以及数据处理设备,所述数据处理设备包括处理器和存储器,所述存储器用于存储自动驾驶车辆运动轨迹的动态规划程序指令,所述处理器用于执行所述自动驾驶车辆运动轨迹的动态规划程序指令以实现如权利要求1~6任意一项所述的自动驾驶车辆运动轨迹的动态规划方法。


技术总结
本发明提供了一种自动驾驶车辆运动轨迹的动态规划方法,动态规划方法包括:获取当前时刻自动驾驶车辆的位置;感知自动驾驶车辆周围环境的环境数据;从环境数据中提取关于车道的车道信息;根据自动驾驶车辆当前时刻的位置、高清地图和车道信息获取自动驾驶车辆的第一可行驶区域;从环境数据中提取关于静态物体的静态信息;从环境数据中提取关于动态物体的动态信息,并根据动态信息预测动态物体的运动轨迹;根据第一可行驶区域、静态信息、运动轨迹、以及车道信息规划出第二可行驶区域。此外,本发明还提供了一种自动驾驶车辆及运动轨迹的动态规划系统。本发明技术方案有效解决了如何合理规划自动驾驶车辆运动轨迹的问题。

技术研发人员:肖健雄
受保护的技术使用者:深圳裹动智驾科技有限公司
技术研发日:2020.09.16
技术公布日:2020.10.27
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1