矿区无人运输的基于车、电铲、云融合的泊车停靠方法与流程

1.本发明涉及自动驾驶领域，具体涉及一种面向露天矿区无人运输的基于车、电铲、云融合的泊车停靠方法。


背景技术：

2.露天矿的停靠点具有易变，不规则，航向要求高，位置要求准，边界不规则等特点，而这些特点限制车辆不能使用规则化的泊车方案，必须针对特殊作业场景提出特殊解决方案。现有技术中最接近的技术方案为停车场自主泊车方案，设计方案为在规则停车场内，将车辆行驶到停车位前，打开程序，确认启动自动泊车，车辆寻找车位，按照固定方案进行垂直泊车或者平行泊车。
3.现有技术方案若应用到矿用车辆上，往往执行条件不满足，矿用车辆要求全自动驾驶策略，矿用车辆在采集作业过程中，周围环境往往是易变且不规则的，现有技术方案会出现碰撞挡墙，泊车效率低下，针对复杂场景，处理过程均在车载ecu上，会造成反应速度慢等问题。


技术实现要素：

4.本发明的目的在于克服现有技术的不足，提供一种面向露天矿区无人运输的基于车、电铲、云融合的泊车停靠方法，节省停车等待时间，提高运行效率。
5.本发明的技术方案如下：一种矿区无人运输的基于车、电铲、云融合的泊车停靠方法，包括如下步骤：第一步：矿用车辆进入装载区；第二步：矿用车辆向电铲发送驶入申请；第三步：电铲制定停靠位置和停靠方向，发给云端平台；第四步：云端平台根据已采集的边界信息、主路径信息和停靠位置方向，规划出前进路径和倒车路径；第五步：云端平台将前进路径和倒车路径通过云端方式发送给矿用车辆；第六步：矿用车辆依据下发轨迹进行泊车停靠；第七步：矿用车辆停靠完成后将状态反馈给电铲，电铲进行装货。
6.所述第四步具体为：车辆在行驶之前，云端平台存储有采集的边界信息和车辆行驶的主路径信息，此时根据停靠点的位置和航向信息，规划出一条适配矿用车辆行驶的轨迹路径；以停靠点航向为基准，前方10m~30m，左右
‑
15~15m范围内，以1m
×
1m的间距建立网格数据，网格的每个交点都是倒车点，每个交点的航向角范围不同，网格数据来源于车辆模型仿真得出的结果；根据边界信息，将落入边界外围的网格点剔除掉；结合主路径实际情况，将根本无法驶入的网格点滤除。
7.所述主路径网格点滤除方式为：根据车辆位置确定搜索起点，针对每一个网格点，遍历主路径，将从主路径上无法
驶入的一些网格点滤除掉；选取主路径上一个坐标已知的路径点a，其航向角方向为，p1为其航向角方向上一点，选取网格上的一个坐标已知的网格数据b，其理想航向角方向介于与之间，p3‑1为上的一点， p3‑2为上的一点；首先，计算的航向p
ab
，计算弦切角∠p1ab；其次，根据弦切角∠p1ab是弦所对应圆心角∠aob的一半，得到：∠aob = 2∠p1ab然后，求ab的距离dis
ab
，单位为米；接着，求转弯半径r，单位为米，得r = dis
ab
/2/sin(∠aob/2)继而，求b点航向角b
head
，得b
head = a
head + 2∠p1ab其中a
head
为a点航向角；最后，判断b点是否适合主路径行驶，判断依据为转弯半径大于车辆最小转弯半径并且计算得到的b点航向角方向在与之间，p2为上一点；若不在，说明此主路径点不适合这个网格点，继续按照此方式搜索下一个主路径点，如果遍历所有主路径均不适合，则说明此网格点不适合作为一个倒车点，同时，根据所有的主路径遍历的结果，进一步缩小与之间的范围；遍历主路径，若产生符合条件的转弯点a，就生成弧线ab，将主路径上a点之后的数据删除，b点作为前进最终停车点，生成前进行驶路线，否则，更换倒车点为b点附近的点，进行再一次遍历求解。
8.所述根据车辆位置确定搜索起点的方式具体为：在程序内部首先定义了两个最优解，分别为(
‑
5，21)和(5，21)；从等待点到最后搜索剩余主路径，找到距离停靠点最近的主路径的点a，判断其航向与停靠点的航向角偏差的正负，若为正值，则选取(5，21)作为最优搜索起点；若为负值，则选取(
‑
5，21)作为最优搜索起点。
9.优选地，所述第一步中的装载区是车辆进行装载作业时，执行掉头、驶向装载点的可行驶区域，由高精地图产生，人为根据作业环境进行划分。
10.优选地，所述第二步中，矿用车辆向电铲发送驶入申请采取车间通信（v2v）或车对网络通信（v2n）的方式，所述第七步中，将状态反馈给电铲，采取车间通信（v2v）或车对网络通信（v2n）的方式。
11.优选地，所述第六步具体为：矿用车辆根据前向行驶的轨迹信息前向行驶到倒车点，然后进行档位切换，进行倒车。
12.与现有技术相比，本发明的一种矿区无人运输的基于车、电铲、云融合的泊车停靠方法优势如下：本发明的面向露天矿区无人运输的基于车、电铲、云融合的泊车停靠方法，综合考虑泊车周围环境特征、云端高速处理，平台下发；平台针对铲端进行轨迹规划，一旦确定装载点位置和航向，即使在矿用车辆未到达装载区，平台端均可以进行异步规划，节省停车等待时间，提高运行效率。
附图说明
13.图1为本发明面向露天矿区无人运输的基于车、电铲、云融合的泊车停靠方法流程图；图2为本发明面向露天矿区无人运输的基于车、电铲、云融合的泊车停靠方法主路径滤除网格点示意图；图3为本发明面向露天矿区无人运输的基于车、电铲、云融合的泊车停靠方法主路径航向角为正时的倒车点搜索示意图；图4为本发明面向露天矿区无人运输的基于车、电铲、云融合的泊车停靠方法主路径航向角为负时的倒车点搜索示意图。
具体实施方式
14.下面将结合本发明实施方式中的附图，对本发明实施方式中的技术方案进行清楚、完整的描述，显然，所描述的实施方式仅仅是作为例示，并非用于限制本发明。
15.本发明提出一种矿区无人运输的基于车、电铲、云融合的泊车停靠方法，如图1所示，主要步骤如下：第一步：矿用车辆进入装载区；第二步：矿用车辆向电铲发送驶入申请；第三步：电铲制定停靠位置和停靠方向，发给云端平台；第四步：云端平台根据已采集的边界信息、主路径信息和停靠位置方向，规划出前进路径和倒车路径；第五步：云端平台将前进路径和倒车路径通过云端方式发送给矿用车辆；第六步：矿用车辆依据下发轨迹进行泊车停靠；第七步：矿用车辆停靠完成后将状态反馈给电铲，电铲进行装货。
16.下面通过一个具体的实施例对本发明提供的矿区无人运输的基于车、电铲、云融合的泊车停靠方法的具体实施进行详细说明。
17.实施例1：第一步：矿用车辆进入装载区。装载区的定义是由高精地图所产生的，是人为根据作业环境进行划分，装载区是车辆进行装载作业时，执行掉头、驶向装载点的可行驶区域。
18.第二步：矿用车辆向电铲发送驶入申请。矿用车辆向电铲发送可驶入申请通过两种方式发送，车间通信（v2v）或车对网络通信（v2n），两者之一将消息送达即可。
19.第三步：电铲制定停靠位置和停靠方向，发给云端平台。电铲根据当前实际作业环境，将最佳停靠位置和航向信息通过网络形式，上传云端平台。
20.第四步：云端平台根据已采集的边界信息、主路径信息和停靠位置方向，规划出前进路径和倒车路径。车辆在行驶之前，云端平台存储有采集的边界信息和车辆行驶的主路径信息，此时根据停靠点的位置和航向信息，规划出一条适配矿用车辆行驶的轨迹路径。
21.具体路径规划的方案为：以停靠点航向为基准，前方10m~30m，左右
‑
15~15m范围内，以1m
×
1m的间距建立网格数据，网格的每个交点都是倒车点，每个交点的航向角范围不同，网格数据来源于车辆模型仿真得出的结果。根据边界信息，将落入边界外围的网格点剔除掉；结合主路径实际情况，将根本无法驶入的网格点滤除。
22.其中，根据主路径滤除网格点的方法具体为：针对每一个网格点，遍历主路径（为了减少计算量，每1m取一个点），将从主路径上无法驶入的一些网格点滤除掉。如图2所示，a为主路径上一个路径点（坐标已知），其航向角方向为，p1为其航向角方向上一点，b为网格上的一个网格数据（坐标已知），其理想航向角方向介于与之间，p3‑1为上的一点， p3‑2为上的一点(已知)。首先，计算的航向p
ab
，计算∠p1ab；其次，根据弦切角是弦所对应圆心角的一半，得到：∠aob = 2∠p1ab然后，求ab的距离dis
ab
（单位：m）；接着，求转弯半径r（单位：m），得r = dis
ab
/2/sin(∠aob/2)继而，求b点航向角，得b
head = a
head + 2∠p1ab其中a
head
为a点航向角。最后，判断b点是否适合主路径行驶，判断依据为转弯半径大于车辆最小转弯半径并且计算得到的在与之间，p2为上一点，若不在，只能说明此主路径点不适合这个网格点，继续按照此方式搜索下一个主路径点，如果遍历所有主路径均不适合，则说明此网格点不适合作为一个倒车点，同时，根据所有的主路径遍历的结果，能够进一步缩小与之间的范围。
23.遍历主路径，若产生符合条件的转弯点a，就生成弧线ab，将主路径上a点之后的数据删除，b点作为前进最终停车点。生成前进行驶路线。否则的话，更换倒车点为b点附近的点，进行再一次遍历求解。
24.倒车点搜索的方式具体为：会根据车辆位置优先确定搜索起点，起点定义规则如下：在程序内部首先定义了两个最优解，分别为(
‑
5，21)和(5，21)，首先确定最优解。搜索剩余主路径(从等待点到最后)，找到距离停靠点最近的主路径的点a，判断其航向与停靠点的航向角偏差的正负，若为正值，则选取(5，21)作为最优点，如图3所示；若为负值，则选取(
‑
5，21)作为最优点，如图4所示。
25.第五步：云端平台将前进路径和倒车路径通过云端方式发送给矿用车辆。云端平台将前进行驶的路径和倒车轨迹发送给矿用车辆，矿用车辆加载前向轨迹。
26.第六步：矿用车辆依据下发轨迹进行泊车停靠。矿用车辆根据前向行驶的轨迹信息前向行驶到倒车点，然后进行档位切换，进行倒车。
27.第七步：矿用车辆停靠完成后将状态反馈给电铲，电铲进行装货。矿用车辆使用车间通信（v2v）或车对网络通信（v2n）两种形式分别向电铲反馈停靠到位，电铲进行装货。
28.以上所述之实施例仅为本发明的较佳实施例，并非对本发明做任何形式上的限制。任何熟悉本领域的技术人员，在不脱离本发明技术方案范围情况下，利用上述揭示的技术内容对本发明技术方案作出更多可能的变动和润饰，或修改均为本发明的等效实施例。故凡未脱离本发明技术方案的内容，依据本发明之思路所作的等同等效变化，均应涵盖于本发明的保护范围内。