本发明涉及自动驾驶轨迹规划,具体地,涉及一种基于时空联合规划的自动驾驶走廊优化构建方法及系统。
背景技术:
1、自动驾驶作为未来交通的重要组成部分,相关的技术发展也被逐渐的重视。在自动驾驶中,轨迹规划承担着承上启下的作用,一条安全、合理、舒适且足够平滑的轨迹,是影响下游是否可以实现安全跟踪、用户体验是否满意的关键。
2、专利文献cn115416693a公开一种基于时空走廊的自动驾驶轨迹规划方法及系统,包括:实时获取自车的位姿信息和自车周围的障碍物;根据所述自车的位姿信息确定所述自车行驶的参考线并构建三维配置空间;在三维配置空间中标识障碍物并在每一目标时间点处截取s-l平面,得到二维凸子空间;对每相邻两个目标时间点处的所有二维凸子空间构建三维凸子空间;根据自车在所述规划时域内的粗略轨迹和所有三维凸子空间确定轨迹规划的时空走廊;根据时空走廊和所述粗略轨迹进行纵向轨迹的优化和横向轨迹的优化,并根据优化后的纵向轨迹和优化后的横向轨迹确定自动驾驶轨迹。该方法中每相邻两点均构建虽然缩小了可行驶区域,且空间数量直线上升,但导致后期优化产生不必要耗时。
3、因此,在基于时空联合规划的自动驾驶走廊优化构建中,保证空间完全包涵所有种子的前提下,降低生成空间个数,获取更大的可优化空间,减少后期优化耗时,是亟待解决的问题。
技术实现思路
1、针对现有技术中的缺陷,本发明的目的是提供一种基于时空联合规划的自动驾驶走廊优化构建方法及系统。
2、根据本发明提供的一种基于时空联合规划的自动驾驶走廊优化构建方法,包括:
3、步骤s1:获取当前规划初始位置、指引点种子和环境表征信息;
4、步骤s2:将所述指引点种子和环境表征信息投影到参考线坐标系,得到对应的frenet坐标,同时根据当前规划初始位置初始化语义地图;
5、步骤s3:将当前环境表征信息和指引点种子分别由frenet坐标转换为对应的语义地图坐标;
6、步骤s4:选取初始两个种子构成初始走廊空间并检查所述走廊覆盖的语义地图中是否包含障碍物,若是,则返回错误;若否,则执行步骤s5;
7、步骤s5:对所述初始走廊空间进行膨胀,进而得到可通行的语义走廊。
8、优选地,所述初始化语义地图包括以当前规划的初始位置为原点,分别根据s轴、l轴、t轴三个维度的分辨率及范围构建三维网格地图,并将三维网格地图中每个点的值初始化为0;
9、其中,s表示相对于参考线的纵向距离,l表示相对于参考线的横向距离,t表示以当前时刻为起始时刻的相对时间。
10、优选地,所述环境表征信息包括障碍物位姿随时间变化的动态语义信息、障碍物位姿在时间段内不变的静态语义信息;
11、将当前环境表征信息由frenet坐标转换为对应的语义地图坐标包括:
12、步骤s3.1:针对动态语义信息依次获取不同障碍物、不同时刻的角点位置,针对静态语义信息将静态障碍物所占位置扩展到每个时间点上,得到对应时间点的静态障碍物位置坐标;
13、步骤s3.2:根据实际的角点frenet坐标,将位置信息依据初始化语义地图所设定的分辨率转换为对应的语义地图坐标;
14、步骤s3.3:判断所述语义地图坐标是否在设定范围内,若是,则根据转换后的不同时刻的障碍物角点坐标,将对应的障碍物所占位置进行填充;若否,则排除该位置点。
15、优选地,步骤s5包括:
16、步骤s5.1:选取初始两个种子构建第一个初始空间;
17、步骤s5.2:判断当前初始空间是否与障碍物存在碰撞,若否,则依次对s轴、l轴的正负方向进行膨胀;若是,则返回错误并退出;
18、步骤s5.3:判断当前位置点是否属于上一个空间,若是,则压入对应空间包含的种子中,并取上一个空间中最后一个点以及不属于所述空间的第一个点进行膨胀;若否,则选取上一个点与当前点,生成新的一个初始空间,执行步骤s5.2;
19、步骤s5.4:将依次获得的空间压入对应的空间列表中,最终获得的可以通行的语义走廊。
20、优选地,所述膨胀是根据预设的膨胀步数,按照预设方向进行扩展;所述膨胀根据当前方向是否有障碍物决定,若有障碍物则膨胀结束,若无障碍物则膨胀继续;
21、当所有方向的膨胀结束时,对应空间膨胀结束。
22、根据本发明提供的一种基于时空联合规划的自动驾驶走廊优化构建系统,包括:
23、模块m1:获取当前规划初始位置、指引点种子和环境表征信息;
24、模块m2:将所述指引点种子和环境表征信息投影到参考线坐标系,得到对应的frenet坐标,同时根据当前规划初始位置初始化语义地图;
25、模块m3:将当前环境表征信息和指引点种子分别由frenet坐标转换为对应的语义地图坐标;
26、模块m4:选取初始两个种子构成初始走廊空间并检查所述走廊覆盖的语义地图中是否包含障碍物,若是,则返回错误;若否,则触发模块m5;
27、模块m5:对所述初始走廊空间进行膨胀,进而得到可通行的语义走廊。
28、优选地,所述初始化语义地图包括以当前规划的初始位置为原点,分别根据s轴、l轴、t轴三个维度的分辨率及范围构建三维网格地图,并将三维网格地图中每个点的值初始化为0;
29、其中,s表示相对于参考线的纵向距离,l表示相对于参考线的横向距离,t表示以当前时刻为起始时刻的相对时间。
30、优选地,所述环境表征信息包括障碍物位姿随时间变化的动态语义信息、障碍物位姿在时间段内不变的静态语义信息;
31、将当前环境表征信息由frenet坐标转换为对应的语义地图坐标包括:
32、模块m3.1:针对动态语义信息依次获取不同障碍物、不同时刻的角点位置,针对静态语义信息将静态障碍物所占位置扩展到每个时间点上,得到对应时间点的静态障碍物位置坐标;
33、模块m3.2:根据实际的角点frenet坐标,将位置信息依据初始化语义地图所设定的分辨率转换为对应的语义地图坐标;
34、模块m3.3:判断所述语义地图坐标是否在设定范围内,若是,则根据转换后的不同时刻的障碍物角点坐标,将对应的障碍物所占位置进行填充;若否,则排除该位置点。
35、优选地,模块m5包括:
36、模块m5.1:选取初始两个种子构建第一个初始空间;
37、模块m5.2:判断当前初始空间是否与障碍物存在碰撞,若否,则依次对s轴、l轴的正负方向进行膨胀;若是,则返回错误并退出;
38、模块m5.3:判断当前位置点是否属于上一个空间,若是,则压入对应空间包含的种子中,并取上一个空间中最后一个点以及不属于所述空间的第一个点进行膨胀;若否,则选取上一个点与当前点,生成新的一个初始空间,触发模块m5.2;
39、模块m5.4:将依次获得的空间压入对应的空间列表中,最终获得的可以通行的语义走廊。
40、优选地,所述膨胀是根据预设的膨胀步数,按照预设方向进行扩展;所述膨胀根据当前方向是否有障碍物决定,若有障碍物则膨胀结束,若无障碍物则膨胀继续;
41、当所有方向的膨胀结束时,对应空间膨胀结束。
42、与现有技术相比,本发明具有如下的有益效果:
43、1、本发明通过对时间和空间两个方面构建未来一定时间内可以通行的可行驶区域,在可行驶区域中得到一条横纵向均高阶可导的轨迹,提高了原始路径得到轨迹的合理性;
44、2、本发明依据参考线方向建立走廊可以更好的增强轨迹可通行空间与参考线的相关性,在道路存在较大曲率的情况下,相比于笛卡尔坐标系能更精确的获取可通行区域,减少为完全覆盖弯道区域所造成的冗余;
45、3、本发明将走廊以时间为基准拆分为横向和纵向两个层面主要是由于在城市路况所允许的车速下,在生成轨迹时以时间为基准分别考虑横向和纵向可以获得更平滑合理的横向速度以及加速度;
46、4、本发明采取膨胀的方式扩展初始空间,可以在合理的最大限度内获得较为精确的空间,提高后期轨迹优化的成功率。