CN116853286A - 一种露天矿厂矿车的无人驾驶控制方法 - Google Patents
一种露天矿厂矿车的无人驾驶控制方法 Download PDFInfo
- Publication number
- CN116853286A CN116853286A CN202310654326.5A CN202310654326A CN116853286A CN 116853286 A CN116853286 A CN 116853286A CN 202310654326 A CN202310654326 A CN 202310654326A CN 116853286 A CN116853286 A CN 116853286A
- Authority
- CN
- China
- Prior art keywords
- preset
- unmanned vehicle
- increment
- accelerator
- less
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000012937 correction Methods 0.000 claims description 51
- 239000011159 matrix material Substances 0.000 claims description 18
- 230000001105 regulatory effect Effects 0.000 claims description 12
- 230000001276 controlling effect Effects 0.000 claims description 7
- 238000005070 sampling Methods 0.000 claims description 3
- 238000004891 communication Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000013473 artificial intelligence Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000002372 labelling Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012806 monitoring device Methods 0.000 description 1
- 238000003909 pattern recognition Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
- B60W60/0017—Planning or execution of driving tasks specially adapted for safety of other traffic participants
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0953—Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/50—Barriers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/06—Combustion engines, Gas turbines
- B60W2710/0605—Throttle position
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及无人驾驶技术领域,公开了一种露天矿厂矿车的无人驾驶控制方法,确定无人驾驶车辆的当前行驶轨迹,实时判断当前行驶轨迹中是否出现障碍车辆,当出现障碍车辆时,获取障碍车辆的状态参数,并根据状态参数设定无人驾驶车辆的控制状态,基于无人驾驶车辆的控制状态对无人驾驶车辆进行控制,本发明可以在出现障碍车辆时,对无人驾驶车辆的行驶状态进行控制,进而可以降低无人驾驶车辆发生安全事故风险,提高无人驾驶车辆的安全性和可靠性。
Description
技术领域
本发明涉及无人驾驶技术领域,特别是涉及一种露天矿厂矿车的无人驾驶控制方法。
背景技术
无人驾驶技术是传感器、计算机、人工智能、通信、导航定位、模式识别、机器视觉、智能控制等多门前沿学科的综合体。自动驾驶汽车依靠人工智能、视觉计算、雷达、监控装置和全球定位系统协同合作,让电脑可以在没有任何人类主动的操作下,自动安全地操作机动车辆,然而随着路况越来越复杂,路上的车辆也越来越多,各种违反交通规则的行为层出不穷,无人驾驶技术必须有更高级的系统,更出色的识别能力和计算能力,才能适应复杂的路况。
当前无人驾驶车辆的视频画面和远程驾驶控制指令是通过无线通信网络进行数据传输,但是数据通信时延导致无人驾驶车辆接收到远程驾驶控制指令的时刻远滞后于其发送时刻,在接收时刻远程驾驶控制指令已与无人驾驶车辆的实时操纵需求不匹配,增加了无人驾驶车辆发生安全事故的风险,降低了远程驾驶无人驾驶车辆的安全性和可靠性。
发明内容
本发明实施例提供一种露天矿厂矿车的无人驾驶控制方法,用以解决现有技术中无法降低无人驾驶车辆发生安全事故风险,无法提高无人驾驶车辆的安全性和可靠性的技术问题。
为了实现上述目的,本发明提供了一种露天矿厂矿车的无人驾驶控制方法,所述方法包括:
确定无人驾驶车辆的当前行驶轨迹;
实时判断所述当前行驶轨迹中是否出现障碍车辆;
当出现所述障碍车辆时,获取所述障碍车辆的状态参数,并根据所述状态参数设定所述无人驾驶车辆的控制状态;
基于所述无人驾驶车辆的控制状态对所述无人驾驶车辆进行控制。
在其中一个实施例中,在实时判断所述当前行驶轨迹中是否出现障碍车辆时,包括:
沿当前行驶轨迹方向进行障碍点采样;
当识别到障碍点标注时,向所述障碍点发射第一红外光,并记录发射所述第一红外光的第一时间节点;
接收所述障碍点反射的第二红外光,并记录接收所述第二红外光的第二时间点;
计算所述第一时间点和所述第二时间点的时间差值,并根据所述时间差值确定所述无人驾驶车辆和所述障碍点之间的相对距离;
当所述相对距离大于预设相对距离时,则判断所述障碍点不是障碍车辆;
当所述相对距离小于或等于所述预设相对距离时,则判断所述障碍点是障碍车辆。
在其中一个实施例中,在获取所述障碍车辆的状态参数,并根据所述状态参数设定所述无人驾驶车辆的控制状态时,包括:
获取所述障碍车辆的多个行驶速度;
基于多个行驶速度计算所述障碍车辆的平均行驶速度;
获取所述无人驾驶车辆的当前行驶速度,根据所述平均行驶速和所述当前行驶速度设定所述无人驾驶车辆的控制状态,
当所述当前行驶速度小于或等于所述平均行驶速度时,则根据所述当前行驶速度对所述无人驾驶车辆进行控制;
当所述当前行驶速度大于所述平均行驶速度时,则对所述无人驾驶车辆生成变道指令。
在其中一个实施例中,在对所述无人驾驶车辆生成变道指令时,包括:
确定目标车道,并判断所述目标车道和所述当前行驶轨迹之间是否存在可并入路段,
若否,则基于所述相对距离对所述无人驾驶车辆的当前行驶速度进行调节;
若是,则根据所述平均行驶速和所述当前行驶速度生成所述无人驾驶车辆的变道数据,基于所述变道数据生成所述变道指令。
在其中一个实施例中,在基于所述相对距离对所述无人驾驶车辆的当前行驶速度进行调节时,包括:
确定所述相对距离A和所述无人驾驶车辆的当前行驶速度a,
预设相对距离矩阵B,设定B(B1,B2,B3,B4),其中,B1为第一预设相对距离,B2为第二预设相对距离,B3为第三预设相对距离,B4为第四预设相对距离,且B1<B2<B3<B4;
预设无人驾驶车辆的当前行驶速度修正系数矩阵h,设定h(h1,h2,h3,h4,h5),其中,h1为第一预设当前行驶速度修正系数,h2为第二预设当前行驶速度修正系数,h3为第三预设当前行驶速度修正系数,h4为第四预设当前行驶速度修正系数,h5为第五预设当前行驶速度修正系数,且0.6<h1<h2<h3<h4<h5<1;
根据所述相对距离A与各预设相对距离之间的关系对所述无人驾驶车辆的当前行驶速度a进行调节:
当A<B1时,选定所述第一预设当前行驶速度h1对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h1;
当B1≤A<B2时,选定所述第二预设当前行驶速度h2对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h2;
当B2≤A<B3时,选定所述第三预设当前行驶速度h3对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h3;
当B3≤A<B4时,选定所述第四预设当前行驶速度h1对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h4;
当B4≤A时,选定所述第五预设当前行驶速度h5对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h5。
在其中一个实施例中,在根据所述平均行驶速和所述当前行驶速度生成所述无人驾驶车辆的变道数据,基于所述变道数据生成所述变道指令时,包括:
计算所述平均行驶速度和所述当前行驶速度的速度差值f;
根据所述速度差值f设定所述无人驾驶车辆的油门增量。
在其中一个实施例中,在根据所述速度差值f设定所述无人驾驶车辆的油门增量时,包括:
预设速度差值矩阵D,设定D(D1,D2,D3,D4),其中,D1为第一预设速度差值,D2为第二预设速度差值,D3为第三预设速度差值,D4为第四预设速度差值,且D1<D2<D3<D4;
预设无人驾驶车辆的油门增量矩阵E,设定E(E1,E2,E3,E4,E5),其中,E1为第一预设油门增量,E2为第二预设油门增量,E3为第三预设油门增量,E4为第四预设油门增量,E5为第五预设油门增量,且E1<E2<E3<E4<E5;
根据所述速度差值f与各预设速度差值之间的关系设定所述无人驾驶车辆的油门增量:
当f<D1时,选定所述第一预设油门增量E1作为所述无人驾驶车辆的油门增量;
当D1≤f<D2时,选定所述第二预设油门增量E2作为所述无人驾驶车辆的油门增量;
当D2≤f<D3时,选定所述第三预设油门增量E3作为所述无人驾驶车辆的油门增量;
当D3≤f<D4时,选定所述第四预设油门增量E4作为所述无人驾驶车辆的油门增量;
当D4≤f时,选定所述第五预设油门增量E5作为所述无人驾驶车辆的油门增量。
在其中一个实施例中,在根据所述速度差值f设定所述无人驾驶车辆的油门增量之后,还包括:
获取所述无人驾驶车辆的车轮转速w;
根据所述车轮转速w和所述当前行驶速度a计算所述当前行驶轨迹的滑移率P;
根据所述滑移率P对所述无人驾驶车辆的油门增量进行调节。
在其中一个实施例中,根据下式计算所述当前行驶轨迹的滑移率P:
;
其中,β为无人驾驶车辆的车轮半径。
在其中一个实施例中,在根据所述滑移率P对所述无人驾驶车辆的油门增量进行调节时,包括:
预设滑移率矩阵G,设定G(G1,G2,G3,G4),其中,G1为第一预设滑移率,G2为第二预设滑移率,G3为第三预设滑移率,G4为第四预设滑移率,且G1<G2<G3<G4;
预设无人驾驶车辆的油门增量修正系数矩阵y,设定y(y1,y2,y3,y4,y5),其中,y1为第一预设油门增量修正系数,y2为第二预设油门增量修正系数,y3为第三预设油门增量修正系数,y4为第四预设油门增量修正系数,y5为第五预设油门增量修正系数,且0.8<y1<y2<y3<y4<y5<1.2;
在将所述无人驾驶车辆的油门增量设定为第i预设油门增量Ei时,i=1,2,3,4,5,根据所述滑移率P与各预设滑移率之间的关系对所述无人驾驶车辆的油门增量进行修正:
当P<G1时,选定所述第一预设油门增量修正系数y1对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y1;
当G1≤P<G2时,选定所述第二预设油门增量修正系数y2对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y2;
当G2≤P<G3时,选定所述第三预设油门增量修正系数y3对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y3;
当G3≤P<G4时,选定所述第四预设油门增量修正系数y4对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y4;
当G4≤P时,选定所述第五预设油门增量修正系数y5对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y5。
本发明提供了一种露天矿厂矿车的无人驾驶控制方法,相较现有技术,具有以下有益效果:
本发明公开了一种露天矿厂矿车的无人驾驶控制方法,确定无人驾驶车辆的当前行驶轨迹,实时判断当前行驶轨迹中是否出现障碍车辆,当出现障碍车辆时,获取障碍车辆的状态参数,并根据状态参数设定无人驾驶车辆的控制状态,基于无人驾驶车辆的控制状态对无人驾驶车辆进行控制,本发明可以在出现障碍车辆时,对无人驾驶车辆的行驶状态进行控制,进而可以降低无人驾驶车辆发生安全事故风险,提高无人驾驶车辆的安全性和可靠性。
附图说明
图1示出了本发明实施例中一种露天矿厂矿车的无人驾驶控制方法的流程示意图。
具体实施方式
下面结合附图和实施例,对本发明的具体实施方式做进一步详细描述。以下实施例用于说明本发明,但不用来限制本发明的范围。
在本申请的描述中,需要理解的是,术语“中心”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本申请和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本申请的限制。
术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个该特征。在本申请的描述中,除非另有说明,“多个”的含义是两个或两个以上。
在本申请的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体的连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本申请中的具体含义。
下文是结合附图对本发明的优选的实施例说明。
如图1所示,本发明的实施例公开了一种露天矿厂矿车的无人驾驶控制方法,所述方法包括:
S110:确定无人驾驶车辆的当前行驶轨迹;
S120:实时判断所述当前行驶轨迹中是否出现障碍车辆;
S130:当出现所述障碍车辆时,获取所述障碍车辆的状态参数,并根据所述状态参数设定所述无人驾驶车辆的控制状态;
S140:基于所述无人驾驶车辆的控制状态对所述无人驾驶车辆进行控制。
本实施例中,本发明可以在出现障碍车辆时,对无人驾驶车辆的行驶状态进行控制,进而可以降低无人驾驶车辆发生安全事故风险,提高无人驾驶车辆的安全性和可靠性。
在本申请的一些实施例中,在实时判断所述当前行驶轨迹中是否出现障碍车辆时,包括:
沿当前行驶轨迹方向进行障碍点采样;
当识别到障碍点标注时,向所述障碍点发射第一红外光,并记录发射所述第一红外光的第一时间节点;
接收所述障碍点反射的第二红外光,并记录接收所述第二红外光的第二时间点;
计算所述第一时间点和所述第二时间点的时间差值,并根据所述时间差值确定所述无人驾驶车辆和所述障碍点之间的相对距离;
当所述相对距离大于预设相对距离时,则判断所述障碍点不是障碍车辆;
当所述相对距离小于或等于所述预设相对距离时,则判断所述障碍点是障碍车辆。
本实施例中,可以通过图像采集的方式在当前行驶轨迹上进行图像采集,当采集到其他车辆时,则进行障碍点标注。
本实施例中,根据时间差值与预设映射表之间的关系来判断时间差值对应的相对距离,其中,预设映射表可以根据历史数据进行构建,一个时间差值对应一个相对距离。
上述技术方案的有效效果是:通过判断相对距离和预设相对距离之间的关系,准确判断当前行驶轨迹上是否有障碍车辆,可以避免无人驾驶车辆与障碍车辆相撞的风险。
在本申请的一些实施例中,在获取所述障碍车辆的状态参数,并根据所述状态参数设定所述无人驾驶车辆的控制状态时,包括:
获取所述障碍车辆的多个行驶速度;
基于多个行驶速度计算所述障碍车辆的平均行驶速度;
获取所述无人驾驶车辆的当前行驶速度,根据所述平均行驶速和所述当前行驶速度设定所述无人驾驶车辆的控制状态,
当所述当前行驶速度小于或等于所述平均行驶速度时,则根据所述当前行驶速度对所述无人驾驶车辆进行控制;
当所述当前行驶速度大于所述平均行驶速度时,则对所述无人驾驶车辆生成变道指令。
本实施例中,障碍车辆的状态参数即障碍车辆的多个行驶速度。
本实施例中,当当前行驶速度小于或等于平均行驶速度时,此时说明无人驾驶车辆处于安全的行驶状态,可以基于当前的行驶速度进行行驶。
本实施例中,当当前行驶速度大于所述平均行驶速度时,则对无人驾驶车辆生成变道指令。
上述技术方案的有益效果是:通过生成变道指令,可以避免无人驾驶车辆与障碍车辆相撞的风险,同时还可以保证无人驾驶车辆在目标时间内到达目标地点,避免影响无人驾驶车辆的正常行驶。
在本申请的一些实施例中,在对所述无人驾驶车辆生成变道指令时,包括:
确定目标车道,并判断所述目标车道和所述当前行驶轨迹之间是否存在可并入路段,
若否,则基于所述相对距离对所述无人驾驶车辆的当前行驶速度进行调节;
若是,则根据所述平均行驶速和所述当前行驶速度生成所述无人驾驶车辆的变道数据,基于所述变道数据生成所述变道指令。
本实施例中,可并入路段是指可以由当前行驶轨迹转向到目标车道的路段。
在本申请的一些实施例中,在基于所述相对距离对所述无人驾驶车辆的当前行驶速度进行调节时,包括:
确定所述相对距离A和所述无人驾驶车辆的当前行驶速度a,
预设相对距离矩阵B,设定B(B1,B2,B3,B4),其中,B1为第一预设相对距离,B2为第二预设相对距离,B3为第三预设相对距离,B4为第四预设相对距离,且B1<B2<B3<B4;
预设无人驾驶车辆的当前行驶速度修正系数矩阵h,设定h(h1,h2,h3,h4,h5),其中,h1为第一预设当前行驶速度修正系数,h2为第二预设当前行驶速度修正系数,h3为第三预设当前行驶速度修正系数,h4为第四预设当前行驶速度修正系数,h5为第五预设当前行驶速度修正系数,且0.6<h1<h2<h3<h4<h5<1;
根据所述相对距离A与各预设相对距离之间的关系对所述无人驾驶车辆的当前行驶速度a进行调节:
当A<B1时,选定所述第一预设当前行驶速度h1对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h1;
当B1≤A<B2时,选定所述第二预设当前行驶速度h2对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h2;
当B2≤A<B3时,选定所述第三预设当前行驶速度h3对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h3;
当B3≤A<B4时,选定所述第四预设当前行驶速度h1对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h4;
当B4≤A时,选定所述第五预设当前行驶速度h5对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h5。
本实施例中,当不存在可并入路段时,根据相对距离A与各预设相对距离之间的关系对无人驾驶车辆的当前行驶速度a进行调节,通过对无人驾驶车辆的当前行驶速度a进行调节,可以使无人驾驶车辆与障碍车辆处于安全的驾驶距离,又可以保证无人驾驶车辆的行驶速度,避免延误无人驾驶车辆的正常行驶。
在本申请的一些实施例中,在根据所述平均行驶速和所述当前行驶速度生成所述无人驾驶车辆的变道数据,基于所述变道数据生成所述变道指令时,包括:
计算所述平均行驶速度和所述当前行驶速度的速度差值f;
根据所述速度差值f设定所述无人驾驶车辆的油门增量。
本实施例中,油门增量是指油门的供油量,通过增大油门增量可以增大行驶车辆的行驶速度。
在本申请的一些实施例中,在根据所述速度差值f设定所述无人驾驶车辆的油门增量时,包括:
预设速度差值矩阵D,设定D(D1,D2,D3,D4),其中,D1为第一预设速度差值,D2为第二预设速度差值,D3为第三预设速度差值,D4为第四预设速度差值,且D1<D2<D3<D4;
预设无人驾驶车辆的油门增量矩阵E,设定E(E1,E2,E3,E4,E5),其中,E1为第一预设油门增量,E2为第二预设油门增量,E3为第三预设油门增量,E4为第四预设油门增量,E5为第五预设油门增量,且E1<E2<E3<E4<E5;
根据所述速度差值f与各预设速度差值之间的关系设定所述无人驾驶车辆的油门增量:
当f<D1时,选定所述第一预设油门增量E1作为所述无人驾驶车辆的油门增量;
当D1≤f<D2时,选定所述第二预设油门增量E2作为所述无人驾驶车辆的油门增量;
当D2≤f<D3时,选定所述第三预设油门增量E3作为所述无人驾驶车辆的油门增量;
当D3≤f<D4时,选定所述第四预设油门增量E4作为所述无人驾驶车辆的油门增量;
当D4≤f时,选定所述第五预设油门增量E5作为所述无人驾驶车辆的油门增量。
本实施例中,根据速度差值f与各预设速度差值之间的关系设定无人驾驶车辆的油门增量,通过设定无人驾驶车辆的油门增量可以保证无人驾驶车辆的正常变道,同时还可以保证变道的安全性,避免出现车速过快或者过慢的现象。
在本申请的一些实施例中,在根据所述速度差值f设定所述无人驾驶车辆的油门增量之后,还包括:
获取所述无人驾驶车辆的车轮转速w;
根据所述车轮转速w和所述当前行驶速度a计算所述当前行驶轨迹的滑移率P;
根据所述滑移率P对所述无人驾驶车辆的油门增量进行调节。
本实施例中,受天气影响,如下雨天或者下雪天,路面较滑,导致滑移率较高。
在本申请的一些实施例中,根据下式计算所述当前行驶轨迹的滑移率P:
;
其中,β为无人驾驶车辆的车轮半径。
在本申请的一些实施例中,在根据所述滑移率P对所述无人驾驶车辆的油门增量进行调节时,包括:
预设滑移率矩阵G,设定G(G1,G2,G3,G4),其中,G1为第一预设滑移率,G2为第二预设滑移率,G3为第三预设滑移率,G4为第四预设滑移率,且G1<G2<G3<G4;
预设无人驾驶车辆的油门增量修正系数矩阵y,设定y(y1,y2,y3,y4,y5),其中,y1为第一预设油门增量修正系数,y2为第二预设油门增量修正系数,y3为第三预设油门增量修正系数,y4为第四预设油门增量修正系数,y5为第五预设油门增量修正系数,且0.8<y1<y2<y3<y4<y5<1.2;
在将所述无人驾驶车辆的油门增量设定为第i预设油门增量Ei时,i=1,2,3,4,5,根据所述滑移率P与各预设滑移率之间的关系对所述无人驾驶车辆的油门增量进行修正:
当P<G1时,选定所述第一预设油门增量修正系数y1对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y1;
当G1≤P<G2时,选定所述第二预设油门增量修正系数y2对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y2;
当G2≤P<G3时,选定所述第三预设油门增量修正系数y3对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y3;
当G3≤P<G4时,选定所述第四预设油门增量修正系数y4对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y4;
当G4≤P时,选定所述第五预设油门增量修正系数y5对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y5。
本实施例中,在将所述无人驾驶车辆的油门增量设定为第i预设油门增量Ei时,i=1,2,3,4,5,根据所述滑移率P与各预设滑移率之间的关系对无人驾驶车辆的油门增量进行修正,进而可以进一步保证无人驾驶车辆的安全行驶,避免出现安全事故。
在上述实施方式的描述中,具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
虽然在上文中已经参考实施例对本发明进行了描述,然而在不脱离本发明的范围的情况下,可以对其进行各种改进并且可以用等效物替换其中的部件。尤其是,只要不存在结构冲突,本发明所披露的实施例中的各项特征均可通过任意方式相互结合起来使用,在本说明书中未对这些组合的情况进行全部的描述仅仅是出于省略篇幅和节约资源的考虑。因此,本发明并不局限于文中公开的特定实施例,而是包括落入权利要求的范围内的所有技术方案。
本领域普通技术人员可以理解:以上仅为本发明的优选实施例而已,并不用于限制本发明,尽管参照前述实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种露天矿厂矿车的无人驾驶控制方法,其特征在于,所述方法包括:
确定无人驾驶车辆的当前行驶轨迹;
实时判断所述当前行驶轨迹中是否出现障碍车辆;
当出现所述障碍车辆时,获取所述障碍车辆的状态参数,并根据所述状态参数设定所述无人驾驶车辆的控制状态;
基于所述无人驾驶车辆的控制状态对所述无人驾驶车辆进行控制。
2.根据权利要求1所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在实时判断所述当前行驶轨迹中是否出现障碍车辆时,包括:
沿当前行驶轨迹方向进行障碍点采样;
当识别到障碍点标注时,向所述障碍点发射第一红外光,并记录发射所述第一红外光的第一时间节点;
接收所述障碍点反射的第二红外光,并记录接收所述第二红外光的第二时间点;
计算所述第一时间点和所述第二时间点的时间差值,并根据所述时间差值确定所述无人驾驶车辆和所述障碍点之间的相对距离;
当所述相对距离大于预设相对距离时,则判断所述障碍点不是障碍车辆;
当所述相对距离小于或等于所述预设相对距离时,则判断所述障碍点是障碍车辆。
3.根据权利要求2所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在获取所述障碍车辆的状态参数,并根据所述状态参数设定所述无人驾驶车辆的控制状态时,包括:
获取所述障碍车辆的多个行驶速度;
基于多个行驶速度计算所述障碍车辆的平均行驶速度;
获取所述无人驾驶车辆的当前行驶速度,根据所述平均行驶速和所述当前行驶速度设定所述无人驾驶车辆的控制状态,
当所述当前行驶速度小于或等于所述平均行驶速度时,则根据所述当前行驶速度对所述无人驾驶车辆进行控制;
当所述当前行驶速度大于所述平均行驶速度时,则对所述无人驾驶车辆生成变道指令。
4.根据权利要求3所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在对所述无人驾驶车辆生成变道指令时,包括:
确定目标车道,并判断所述目标车道和所述当前行驶轨迹之间是否存在可并入路段,
若否,则基于所述相对距离对所述无人驾驶车辆的当前行驶速度进行调节;
若是,则根据所述平均行驶速和所述当前行驶速度生成所述无人驾驶车辆的变道数据,基于所述变道数据生成所述变道指令。
5.根据权利要求4所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在基于所述相对距离对所述无人驾驶车辆的当前行驶速度进行调节时,包括:
确定所述相对距离A和所述无人驾驶车辆的当前行驶速度a,
预设相对距离矩阵B,设定B(B1,B2,B3,B4),其中,B1为第一预设相对距离,B2为第二预设相对距离,B3为第三预设相对距离,B4为第四预设相对距离,且B1<B2<B3<B4;
预设无人驾驶车辆的当前行驶速度修正系数矩阵h,设定h(h1,h2,h3,h4,h5),其中,h1为第一预设当前行驶速度修正系数,h2为第二预设当前行驶速度修正系数,h3为第三预设当前行驶速度修正系数,h4为第四预设当前行驶速度修正系数,h5为第五预设当前行驶速度修正系数,且0.6<h1<h2<h3<h4<h5<1;
根据所述相对距离A与各预设相对距离之间的关系对所述无人驾驶车辆的当前行驶速度a进行调节:
当A<B1时,选定所述第一预设当前行驶速度h1对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h1;
当B1≤A<B2时,选定所述第二预设当前行驶速度h2对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h2;
当B2≤A<B3时,选定所述第三预设当前行驶速度h3对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h3;
当B3≤A<B4时,选定所述第四预设当前行驶速度h1对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h4;
当B4≤A时,选定所述第五预设当前行驶速度h5对所述无人驾驶车辆的当前行驶速度a进行调节,调节后的无人驾驶车辆的当前行驶速度为a*h5。
6.根据权利要求4所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在根据所述平均行驶速和所述当前行驶速度生成所述无人驾驶车辆的变道数据,基于所述变道数据生成所述变道指令时,包括:
计算所述平均行驶速度和所述当前行驶速度的速度差值f;
根据所述速度差值f设定所述无人驾驶车辆的油门增量。
7.根据权利要求6所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在根据所述速度差值f设定所述无人驾驶车辆的油门增量时,包括:
预设速度差值矩阵D,设定D(D1,D2,D3,D4),其中,D1为第一预设速度差值,D2为第二预设速度差值,D3为第三预设速度差值,D4为第四预设速度差值,且D1<D2<D3<D4;
预设无人驾驶车辆的油门增量矩阵E,设定E(E1,E2,E3,E4,E5),其中,E1为第一预设油门增量,E2为第二预设油门增量,E3为第三预设油门增量,E4为第四预设油门增量,E5为第五预设油门增量,且E1<E2<E3<E4<E5;
根据所述速度差值f与各预设速度差值之间的关系设定所述无人驾驶车辆的油门增量:
当f<D1时,选定所述第一预设油门增量E1作为所述无人驾驶车辆的油门增量;
当D1≤f<D2时,选定所述第二预设油门增量E2作为所述无人驾驶车辆的油门增量;
当D2≤f<D3时,选定所述第三预设油门增量E3作为所述无人驾驶车辆的油门增量;
当D3≤f<D4时,选定所述第四预设油门增量E4作为所述无人驾驶车辆的油门增量;
当D4≤f时,选定所述第五预设油门增量E5作为所述无人驾驶车辆的油门增量。
8.根据权利要求7所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在根据所述速度差值f设定所述无人驾驶车辆的油门增量之后,还包括:
获取所述无人驾驶车辆的车轮转速w;
根据所述车轮转速w和所述当前行驶速度a计算所述当前行驶轨迹的滑移率P;
根据所述滑移率P对所述无人驾驶车辆的油门增量进行调节。
9.根据权利要求8所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,
根据下式计算所述当前行驶轨迹的滑移率P:
;
其中,β为无人驾驶车辆的车轮半径。
10.根据权利要求9所述的露天矿厂矿车的无人驾驶控制方法,其特征在于,在根据所述滑移率P对所述无人驾驶车辆的油门增量进行调节时,包括:
预设滑移率矩阵G,设定G(G1,G2,G3,G4),其中,G1为第一预设滑移率,G2为第二预设滑移率,G3为第三预设滑移率,G4为第四预设滑移率,且G1<G2<G3<G4;
预设无人驾驶车辆的油门增量修正系数矩阵y,设定y(y1,y2,y3,y4,y5),其中,y1为第一预设油门增量修正系数,y2为第二预设油门增量修正系数,y3为第三预设油门增量修正系数,y4为第四预设油门增量修正系数,y5为第五预设油门增量修正系数,且0.8<y1<y2<y3<y4<y5<1.2;
在将所述无人驾驶车辆的油门增量设定为第i预设油门增量Ei时,i=1,2,3,4,5,根据所述滑移率P与各预设滑移率之间的关系对所述无人驾驶车辆的油门增量进行修正:
当P<G1时,选定所述第一预设油门增量修正系数y1对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y1;
当G1≤P<G2时,选定所述第二预设油门增量修正系数y2对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y2;
当G2≤P<G3时,选定所述第三预设油门增量修正系数y3对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y3;
当G3≤P<G4时,选定所述第四预设油门增量修正系数y4对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y4;
当G4≤P时,选定所述第五预设油门增量修正系数y5对所述第i预设油门增量Ei进行修正,修正后的无人驾驶车辆的油门增量为Ei*y5。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310654326.5A CN116853286A (zh) | 2023-06-02 | 2023-06-02 | 一种露天矿厂矿车的无人驾驶控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310654326.5A CN116853286A (zh) | 2023-06-02 | 2023-06-02 | 一种露天矿厂矿车的无人驾驶控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116853286A true CN116853286A (zh) | 2023-10-10 |
Family
ID=88220541
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310654326.5A Pending CN116853286A (zh) | 2023-06-02 | 2023-06-02 | 一种露天矿厂矿车的无人驾驶控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116853286A (zh) |
-
2023
- 2023-06-02 CN CN202310654326.5A patent/CN116853286A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109649390B (zh) | 一种自动驾驶汽车自主跟车系统及方法 | |
WO2020187254A1 (zh) | 自动驾驶车辆的纵向控制方法系统 | |
CN107993453B (zh) | 一种基于车路协同的弯道安全车速计算方法 | |
US9555801B2 (en) | Active steering safety system | |
CN110293970B (zh) | 一种自动驾驶汽车的行驶控制方法、装置及汽车 | |
EP2251238B1 (en) | Vehicle travel support device, vehicle, and vehicle travel support program | |
US7191049B2 (en) | Vehicle drive assist system | |
US20190084564A1 (en) | Traveling control system and vehicle control method | |
CN112373485A (zh) | 一种考虑交互博弈的自动驾驶车辆决策规划方法 | |
US10990108B2 (en) | Vehicle control system | |
US20210179092A1 (en) | Active safety assistance system for pre-adjusting speed and control method using the same | |
EP3600999B1 (en) | Distance control for a vehicle with trailer | |
JP4946702B2 (ja) | 走行制御装置 | |
US20220194425A1 (en) | Method for operating a vehicle configured for automated, in particular highly automated or autonomous driving | |
CN112224202B (zh) | 一种紧急工况下的多车协同避撞系统及方法 | |
CN110040138A (zh) | 一种车辆并行辅助驾驶方法和系统 | |
CN106043277A (zh) | 汽车自动跟车控制系统及方法、汽车自动跟车系统及方法,控制雷达转向方法 | |
CN116946137A (zh) | 一种基于驾驶意图的车路协同智能车辆换道防碰撞系统 | |
CN112092812A (zh) | 一种自适应巡航控制系统下车辆上坡自动限速的方法 | |
CN116853286A (zh) | 一种露天矿厂矿车的无人驾驶控制方法 | |
US6879901B2 (en) | Method for regulating the speed of a vehicle | |
CN116080754A (zh) | 一种车辆自主驾驶横向控制方法 | |
CN115195563A (zh) | 一种基于激光感知的无人矿车自主卸料方法 | |
CN114954262A (zh) | 一种基于高精度地图的自适应转向驾驶辅助方法与系统 | |
CN116495013B (zh) | 面向任务需求的速度规划方法、系统、设备及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |