用于矿山无人驾驶的待装车辆装载位生成方法和装置与流程

1.本发明涉及矿山无人驾驶技术领域，具体涉及一种用于矿山无人驾驶的待装车辆装载位生成方法和装置。


背景技术：

2.矿山无人驾驶车辆作业主要包含装载、运输、卸载等环节。车辆在装载作业过程中，如果有新的车辆到达装载区域，新到达的车辆需要在某处进行装载，即待装车辆的目标装载位。
3.由于实际作业的复杂性，没有现有技术能够智能的获取待装车辆的目标装载位。
4.因此如何为新到达的车辆指定合适的目标装载位是亟需解决的问题。


技术实现要素：

5.(一)解决的技术问题
6.针对现有技术的不足，本发明提供了一种用于矿山无人驾驶的待装车辆装载位生成方法和装置，解决了如何获取待装车辆的目标装载位的问题。
7.(二)技术方案
8.为实现以上目的，本发明通过以下技术方案予以实现：
9.第一方面，提供了一种用于矿山无人驾驶的待装车辆装载位生成方法，该方法包括：
10.获取挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向；
11.当历史装载位分布于挖机的两侧时，计算所有历史装载位的平均朝向作为目标装载位的朝向；
12.将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；
13.获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；
14.将非当前装载位所在的类的中心坐标作为目标装载位的坐标。
15.进一步的，所述将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在x'oy'坐标轴的坐标；包括：
16.将历史装载位的坐标轴xoy逆时针旋转得到新的坐标轴x'oy'；
17.基于所述平均朝向计算所有历史装载位和当前装载位在坐标轴x'oy'的坐标，且计算方法为：
18.19.其中，x'和y'为x'oy'中的坐标的两个分量，x和y为xoy中的坐标的两个分量。
20.进一步的，当所有历史装载位均位于挖机的一侧或没有历史装载位时，
21.计算当前装载位相对于挖机的所在侧，且装载位相对于挖机的所在侧包括装载位位于挖机的左侧或右侧；
22.以当前装载位为基准，向当前装载位相对于挖机的另一侧平移当前装载位，得到目标装载位的坐标；
23.若挖机与目标装载位朝向共线时，随机生成方向作为目标装载位的朝向，否则将当前装载位的朝向作为目标装载位的朝向。
24.进一步的，若当前装载位与历史装载位的间距或朝向偏差超过一定阈值时，清空历史装载位。
25.第二方面，提供了一种用于矿山无人驾驶的待装车辆装载位生成装置，该装置包括：
26.装载位信息获取模块，用于获取挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向；
27.历史平均朝向计算模块，用于当历史装载位分布于挖机的两侧时，计算所有历史装载位的平均朝向
28.坐标变换模块，用于将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；
29.聚类模块，用于获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；
30.目标装载位生成模块，用于将非当前装载位所在的类的中心坐标作为目标装载位的坐标，将平均朝向作为目标装载位的朝向。
31.进一步的，所述将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在x'oy'坐标轴的坐标，包括：
32.将历史装载位的坐标轴xoy逆时针旋转得到新的坐标轴x'oy'；
33.基于所述平均朝向计算所有历史装载位和当前装载位在坐标轴x'oy'的坐标，且计算方法为：
[0034][0035]
其中，x'和y'为x'oy'中的坐标的两个分量，x和y为xoy中的坐标的两个分量。
[0036]
进一步的，所述目标装载位生成模块还用于：
[0037]
当所有历史装载位均位于挖机的一侧或没有历史装载位时，
[0038]
计算当前装载位相对于挖机的所在侧，且装载位相对于挖机的所在侧包括装载位位于挖机的左侧或右侧；
[0039]
以当前装载位为基准，向当前装载位相对于挖机的另一侧平移当前装载位，得到目标装载位的坐标；
[0040]
若挖机与目标装载位朝向共线时，随机生成方向作为目标装载位的朝向，否则将
当前装载位的朝向作为目标装载位的朝向。
[0041]
进一步的，所述装置还包括：历史装载位清理模块，用于若当前装载位与历史装载位的间距或朝向偏差超过一定阈值时，清空历史装载位。
[0042]
第三方面，提供了一种计算机可读存储介质，其存储用于生成矿山无人驾驶的待装车辆装载位的计算机程序，其中，所述计算机程序使得计算机执行上述的用于矿山无人驾驶的待装车辆装载位生成方法。
[0043]
第四方面，一种电子设备，包括：
[0044]
一个或多个处理器；
[0045]
存储器；以及
[0046]
一个或多个程序，其中所述一个或多个程序被存储在所述存储器中，并且被配置成由所述一个或多个处理器执行，所述程序包括用于执行上述的用于矿山无人驾驶的待装车辆装载位生成方法。
[0047]
(三)有益效果
[0048]
本发明提供了一种用于矿山无人驾驶的待装车辆装载位生成方法和装置。与现有技术相比，具备以下有益效果：
[0049]
本发明将挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向作为输入，当历史装载位分布于挖机的两侧时，将所有历史装载位的平均朝向作为目标装载位的朝向；同时，将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；令非当前装载位所在的类的中心坐标作为目标装载位的坐标。本发明能根据挖机的装车特点和无人驾驶的特点，对历史装载位信息进行分析，预测出下一个装载位，以便保障车辆的有序装载。
附图说明
[0050]
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0051]
图1为本发明实施例的流程图；
[0052]
图2为本发明实施例的装载作业示意图；
[0053]
图3为本发明实施例的向当前装载位相对于挖机的另一侧平移当前装载位的示意图。
具体实施方式
[0054]
为使本发明实施例的目的、技术方案和优点更加清楚，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获
得的所有其他实施例，都属于本发明保护的范围。
[0055]
本申请实施例通过提供一种用于矿山无人驾驶的待装车辆装载位生成方法和装置，解决了如何对待装车辆进行装载位分配保证车辆安全有序的装载的问题。
[0056]
本申请实施例中的技术方案为解决上述技术问题，总体思路如下：
[0057]
将挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向作为输入，当历史装载位分布于挖机的两侧时，将所有历史装载位的平均朝向作为目标装载位的朝向；同时，将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；令非当前装载位所在的类的中心坐标作为目标装载位的坐标。
[0058]
为了更好的理解上述技术方案，下面将结合说明书附图以及具体的实施方式对上述技术方案进行详细的说明。
[0059]
实施例1：
[0060]
如图1所示，本发明提供了一种用于矿山无人驾驶的待装车辆装载位生成方法，该方法包括：
[0061]
获取挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向；
[0062]
当历史装载位分布于挖机的两侧时，计算所有历史装载位的平均朝向作为目标装载位的朝向；
[0063]
将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；
[0064]
获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；
[0065]
将非当前装载位所在的类的中心坐标作为目标装载位的坐标。
[0066]
本实施例的有益效果为：
[0067]
本发明实施例将挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向作为输入，当历史装载位分布于挖机的两侧时，将所有历史装载位的平均朝向作为目标装载位的朝向；同时，将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；令非当前装载位所在的类的中心坐标作为目标装载位的坐标。本发明能根据挖机的装车特点和无人驾驶的特点，对历史装载位信息进行分析，预测出下一个装载位，以便保障车辆的有序装载。
[0068]
下面对本发明实施例的实现过程进行详细说明：
[0069]
如图2所示的装载作业示意图，历史装载位的位置和朝向用圆点箭头表示，当前正在装车的装载位用方点箭头表示，一般车辆在挖机的右侧装车时，待装车辆是在挖机的左前方位置；车辆在挖机的左侧装车时，待装车辆在挖机的右前方位置。
[0070]
但是，由于实际作业的复杂性，无法方便的获取车辆的装载位，例如左侧和右侧的
横向间隔距离无法通过固定的参数指定。
[0071]
而挖机进行装载是一个连续的作业过程，这个过程中会产生多个历史装载位信息，因此本发明通过对历史装载位信息的分析，可以对挖机的下一个装载位进行预测。具体步骤如下：
[0072]
获取挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向；
[0073]
具体的，为了保证历史装载位的准确性，只取一定数量的历史装载位数据进行分析。同时，若当前装载位与历史装载位的间距或朝向偏差超过一定阈值时，则认为挖机已经更换了装载位置，清空历史装载位。
[0074]
因此，获取历史装载位时，会出现如下三种情况：
[0075]
1)没有获取到历史装载位；
[0076]
2)有历史装载位，但是所有历史装载位相对于挖机而言都在一侧；
[0077]
3)有历史装载位，且历史装载位分布于挖机的两侧。
[0078]
对于第一种和第二种情况，认为历史装载位不可用，因此需要利用挖机和当前装载位的对应关系来计算，具体如图3所示，步骤包括：
[0079]
计算当前装载位相对于挖机的所在侧，且装载位相对于挖机的所在侧包括装载位位于挖机的左侧或右侧；
[0080]
以当前装载位为基准，向当前装载位相对于挖机的另一侧平移当前装载位，得到目标装载位的坐标；
[0081]
若挖机与目标装载位朝向共线时，随机生成方向作为目标装载位的朝向，否则将当前装载位的朝向作为目标装载位的朝向。
[0082]
举例说明：
[0083]
假设挖机的位置在当前装载位朝向延长线左侧时，预测装载位应当在当前装载位的左侧。以当前装载位位置和朝向为参考，将当前装载位的位置左侧平移距离为d的距离，朝向保持不变，就得到预测的装载位。平移距离d需要根据待装横向安全间距以及无人驾驶车辆的宽度来进行设定。
[0084]
同理，当挖机的位置在装载位朝向延长线的右侧时，则向右平移来获得预测装载位。
[0085]
如果挖机与装载位朝向共线时，可任取一个方向。
[0086]
当车辆有历史装载位，但是所有历史装载位相对于挖机的而言都在一侧时，也认为历史装载位不可用，同样采用没有历史装载位的方式来确定进行装载位的预测
[0087]
对于第三种情况，说明挖机的装载已经进入左右装车的正常作业模式，可以根据历史装载位进行下一个装载位的预测，需要确定坐标和朝向。
[0088]
对于目标装载为的朝向，可计算所有历史装载位的平均朝向作为目标装载位的朝向；
[0089]
对于目标装载位的坐标，可将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；
[0090]
具体的，
[0091]
首先将历史装载位的坐标轴xoy逆时针旋转得到新的坐标轴x'oy'；
[0092]
基于所述平均朝向计算所有历史装载位和当前装载位在坐标轴x'oy'的坐标，且计算方法为：
[0093][0094]
其中，x'和y'为x'oy'中的坐标的两个分量，x和y为xoy中的坐标的两个分量。
[0095]
得到新坐标系下的坐标后，再获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过现有的聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；可得到当前装载位的所在类，
[0096]
取当前装载位所在类的另一个分类，获取该类的中心位置，把该位置即为目标装载位的坐标。
[0097]
实施例2：
[0098]
一种用于矿山无人驾驶的待装车辆装载位生成装置，该装置包括：
[0099]
装载位信息获取模块，用于获取挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向；
[0100]
历史平均朝向计算模块，用于当历史装载位分布于挖机的两侧时，计算所有历史装载位的平均朝向
[0101]
坐标变换模块，用于将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；
[0102]
聚类模块，用于获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；
[0103]
目标装载位生成模块，用于将非当前装载位所在的类的中心坐标作为目标装载位的坐标，将平均朝向作为目标装载位的朝向。
[0104]
历史装载位清理模块，用于若当前装载位与历史装载位的间距或朝向偏差超过一定阈值时，清空历史装载位。
[0105]
可理解的是，本发明实施例提供的用于矿山无人驾驶的待装车辆装载位生成装置与上述用于矿山无人驾驶的待装车辆装载位生成方法相对应，其有关内容的解释、举例、有益效果等部分可以参考用于矿山无人驾驶的待装车辆装载位生成方法中的相应内容，此处不再赘述。
[0106]
实施例3
[0107]
一种计算机可读存储介质，其存储用于生成矿山无人驾驶的待装车辆装载位的计算机程序，其中，所述计算机程序使得计算机执行如下步骤，包括：
[0108]
获取挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向；
[0109]
当历史装载位分布于挖机的两侧时，计算所有历史装载位的平均朝向作为目标装载位的朝向；
[0110]
将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；
[0111]
获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进
行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；
[0112]
将非当前装载位所在的类的中心坐标作为目标装载位的坐标。
[0113]
实施例4
[0114]
一种电子设备，包括：
[0115]
一个或多个处理器；
[0116]
存储器；以及
[0117]
一个或多个程序，其中所述一个或多个程序被存储在所述存储器中，并且被配置成由所述一个或多个处理器执行，所述程序包括用于执行如下步骤，包括：
[0118]
获取挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向；
[0119]
当历史装载位分布于挖机的两侧时，计算所有历史装载位的平均朝向作为目标装载位的朝向；
[0120]
将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；
[0121]
获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；
[0122]
将非当前装载位所在的类的中心坐标作为目标装载位的坐标。
[0123]
综上所述，与现有技术相比，本发明具备以下有益效果：
[0124]
1)本发明实施例将挖机的当前装载位的坐标和朝向和历史装载位的坐标和朝向作为输入，当历史装载位分布于挖机的两侧时，将所有历史装载位的平均朝向作为目标装载位的朝向；同时，将历史装载位的坐标轴xoy变换为以平均朝向为y'轴的新坐标轴x'oy'，得到所有历史装载位和当前装载位在坐标轴x'oy'的坐标；获取所有历史装载位和当前装载位在坐标轴x'oy'的x'分量，并通过聚类算法进行聚类，将所有历史装载位按照其平均朝向的左右两侧分成两类；令非当前装载位所在的类的中心坐标作为目标装载位的坐标。本发明能根据挖机的装车特点和无人驾驶的特点，对历史装载位信息进行分析，预测出下一个装载位，以便保障车辆的有序装载。
[0125]
需要说明的是，通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到各实施方式可借助软件加必需的通用硬件平台的方式来实现。基于这样的理解，上述技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品可以存储在计算机可读存储介质中，如rom/ram、磁碟、光盘等，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个
……”
限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
[0126]
以上实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。