基于单向车道的智能驾驶车辆出行调度方法技术

技术编号:33655515 阅读:14 留言:0更新日期:2022-06-02 20:35
本发明专利技术公开了一种基于单向车道的智能驾驶车辆出行调度方法,涉及物流调度领域,本发明专利技术的技术方案包括如下步骤:S1路线采集与绘制;S2位置投影计算;S3航向角计算;S4用户投影坐标;S5可用车辆投影坐标;S6寻找距离最短车辆进行调度。在运营范围内,对可用车辆集合的距离与航向进行拟合计算,精确分析与预测,对最合适的车辆进行调度,提升调度效率,解决单向车道智能驾驶的精确调度的问题。向车道智能驾驶的精确调度的问题。

【技术实现步骤摘要】
基于单向车道的智能驾驶车辆出行调度方法


[0001]本专利技术涉及一种基于单向车道的智能驾驶车辆出行调度方法,主要涉及物流调度领域。

技术介绍

[0002]现有智能驾驶示范运营车辆依赖于单车智能,在单向车道的调度上,容易调度混乱,导致车道堵塞,不能很好的管控车辆调度次序。
[0003]在单车道的示范运营路况下,采取现有智能驾驶车辆的单车智能模式,前车未驶离的情况下,后车无法绕行,如果前车空闲未被调度离开,则会导致后车无法响应调度目标,导致车道堵塞。

技术实现思路

[0004]针对以上现有技术的不足,本专利技术提出一种基于单向车道的智能驾驶车辆出行调度方法,在运营范围内,对可用车辆集合的距离与航向进行拟合计算,精确分析与预测,对最合适的车辆进行调度,提升调度效率,解决单向车道智能驾驶的精确调度的问题。
[0005]为达到上述目的,本专利技术的技术方案是:基于单向车道的智能驾驶车辆出行调度方法,其特征在于,包括如下步骤:
[0006]S1路线采集与绘制;
[0007]S2位置投影计算;
[0008]S3航向角计算;
[0009]S4用户投影坐标;
[0010]S5可用车辆投影坐标;
[0011]S6寻找距离最短车辆进行调度。
[0012]优选地,其中步骤S1,在地图上采集与绘制运营线路,通过手机应用按实际线路的顺序,采集运营区域的线路。
[0013]根据权利要求1所述的基于单向车道的智能驾驶车辆出行调度方法,其特征在于:其中步骤S2,
[0014]设定寻点半径递增值:drs;
[0015]设定寻点半径终止值:dre;
[0016]以drs为递增层级,通过余弦定理能够获取到示范运营区线路点的集合,同时对获取到的盲区线路点进行经纬度距离的计算,并新增进投影点集合;
[0017]对投影点集合里的对象按距离进行升序排列,得出最近的两个距离不一样的点;
[0018]对正斜杠与反斜杠两种位置进行差分处理:
[0019](lon1

lon2)
÷
n=ca
[0020]Lon1+n
×
ca=lon1_ca
[0021]|(lat1

lat2)|
÷
n=cb
[0022]Lat1+n
×
cb=lat1_cb
[0023]lon1:第一点的经度;
[0024]lat1:第一点的纬度;
[0025]lon2:第二点的经度;
[0026]lat2:第二点的纬度;
[0027]ca:经度插值;
[0028]lon1_ca:2个点之间的插值后点集;
[0029]cb:纬度插值;
[0030]lat1_cb:2个点之间的插值后点集;
[0031]n:差分数量;
[0032]由location_n(lon1_ca,lat1_cb)组成新的坐标点队列;再通过余弦定理获取车辆标准位置与location_n的经纬度距离,并新增进距离线路点集合,对距离线路点集合的距离进行升序排序,并获取最优距离点。
[0033]优选地,其中步骤S3:计算两点坐标连成的直线与正北方的夹角;
[0034]Δφ=ln(tan(latB/2+π/4)/tan(latA/2+π/4))
[0035]Δlon=abs(lonA

lonB)
[0036]航向角度:θ=atan2(Δlon,Δφ)。
[0037]优选地,其中步骤S4:根据手机获取用车用户的经纬度坐标,以此为圆心,通过步骤S2位置投影计算,设定寻点半径递增值drs进行计算,获取用户在运营线路的投影坐标用户投影纬度和用户投影经度。
[0038]优选地,其中步骤S5:以用户投影坐标为圆心用户投影纬度和用户投影经度,通过步骤S2位置投影计算,设定寻点半径递增值drs进行计算,寻点半径终止值dre,进行可用车辆的遍历寻找,加入可用车辆集合。
[0039]优选地,根据可用车辆集合,通过车辆的tbox实时轨迹计算,获取车辆的航向角carθ_n,通过已绘制的线路获取车辆对该线路的投影车辆投影纬度和车辆投影经度,通过顺序取得用户投影坐标到车辆投影坐标的顺序点集,获取距离车辆投影坐标最近的若干个点,依次通过步骤S3计算每个点到车辆投影点的航向角,并取得这若干个点的航向角的平均值routeθ_n,取|routeθ_n

carθ_n|的绝对值,如果大于90
°
说明方向不一致,遍历完范围内所有可用车辆,取得方向一致,距离最短的车辆进行调度。。
[0040]本专利技术的技术原理及有益效果如下:
[0041]在运营范围内,对可用车辆集合的距离与航向进行拟合计算,精确分析与预测,对最合适的车辆进行调度,提升调度效率,解决单向车道智能驾驶的精确调度的问题。基于智能驾驶车辆,采用用户与车辆的投影算法,加上航向角拟合算法,得出示范运营单向车道上的车辆调度次序,提升调度效率,解决单向车道智能驾驶的精确调度的问题。
具体实施方式
[0042]下面对本专利技术中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本专利技术的较佳实施例,而不是全部的实施例。基于本专利技术中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本专利技术保护的范围。
[0043]实施例
[0044]本专利技术实施例包括智能驾驶车辆(L4级别)基于交通法则,在单向车道上是无法绕行、倒车、逆行的。在单向双车道的示范运营环境下,对多台智能驾驶车辆进行调度的优化与预测。
[0045]技术原理,主要包括:
[0046]1.路线的采集与绘制
[0047]在地图上采集与绘制运营线路,可以通过手机应用按实际线路的顺序,采集运营区域的线路,设置频率:0.5HZ,eg.根据实际盲区与采集需要,避免过度采集造成算力需求过大。
[0048]2.位置投影计算方法
[0049]设定寻点半径递增值:drs=*米
[0050]设定寻点半径终止值:dre=*米
[0051]以drs为递增层级,通过余弦定理能够获取到示范运营区线路点的集合,同时对获取到的盲区线路点进行经纬度距离的计算,并新增进投影点集合dis_route_points(距离线路点的投影距离集合)。
[0052]对dis_route_points里的对象按距离进行升序排列,得出最近的两个距离不一样的点。
[0053]对正斜杠\与反斜杠类型/两种位置进行差分处理
[0054]lon1第一点的经度
[0055]lat1第一点的纬度
[0056]lon2第二点的经度
[0057]lat2第二点的纬度
[0058]n差分数量
[0059](lon1

...

【技术保护点】

【技术特征摘要】
1.基于单向车道的智能驾驶车辆出行调度方法,其特征在于,包括如下步骤:S1路线采集与绘制;S2位置投影计算;S3航向角计算;S4用户投影坐标;S5可用车辆投影坐标;S6寻找距离最短车辆进行调度。2.根据权利要求1所述的基于单向车道的智能驾驶车辆出行调度方法,其特征在于:其中步骤S1,在地图上采集与绘制运营线路,通过手机应用按实际线路的顺序,采集运营区域的线路。3.根据权利要求1所述的基于单向车道的智能驾驶车辆出行调度方法,其特征在于:其中步骤S2,设定寻点半径递增值:drs;设定寻点半径终止值:dre;以drs为递增层级,通过余弦定理能够获取到示范运营区线路点的集合,同时对获取到的盲区线路点进行经纬度距离的计算,并新增进投影点集合;对投影点集合里的对象按距离进行升序排列,得出最近的两个距离不一样的点;对正斜杠与反斜杠两种位置进行差分处理:(lon1

lon2)
÷
n=caLon1+n
×
ca=lon1_ca|(lat1

lat2)|
÷
n=cbLat1+n
×
cb=lat1_cblon1:第一点的经度;lat1:第一点的纬度;lon2:第二点的经度;lat2:第二点的纬度;ca:经度插值;lon1_ca:2个点之间的插值后点集;cb:纬度插值;lat1_cb:2个点之间的插值后点集;n:差分数量;由location_n(lon1_ca,lat1_cb)组成新的坐标点队列;再通过余弦定理获取车辆标准位置与location_n的经纬度距离,并新增进距离线路点集合,对距离线路点集合的距离进行升序排序,...

【专利技术属性】
技术研发人员:李平安余东伟张晓松谭魏
申请(专利权)人:重庆长安车联科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1