【技术实现步骤摘要】
露天矿山无人驾驶重载车辆及其路径跟踪控制方法和装置
[0001]本专利技术涉及自动驾驶
，特别是关于一种露天矿山无人驾驶重载车辆及其路径跟踪控制方法和装置。
技术介绍
[0002]作为露天矿山无人驾驶系统的关键环节之一，路径跟踪控制性能表现直接影响无人驾驶车辆运行安全和运输效率，具有重要的学术研究意义和社会经济价值。经典路径跟踪控制算法包括PID(Proportional Integral Derivative，比例积分微分控制)、纯追踪、Stanley等。PID控制参数对控制效果有重要影响，理想条件下基于模型对PID参数进行整定可取得最佳效果，但当模型不确定时，其整定通常采取试凑法，工作量大。此外，PID在系统不确定性和外部扰动同时存在时无法进行有针对性地补偿。纯追踪控制算法是一种经典的路径跟踪控制算法，其核心思想是基于车辆单轨模型，以车辆后轴中心为切点，纵向中心线为切线，通过控制前轮转角使自车沿着经过预瞄点的圆弧行驶，是一种基于几何追踪的控制方法。纯追踪算法对道路曲率扰动具有良好的鲁棒性，但其跟踪性能严重依赖于预瞄距离的选择，最优性能难以保障。
[0003]随着人工智能的发展，许多智能控制算法也被应用于无人驾驶路径跟踪控制领域，如数据驱动、神经网络等。但是，这些智能控制算法控制精度严重依赖海量数据，无法进一步对系统动力学行为进行预测、分析。MPC(Model Predictive Control，模型预测控制)广泛应用于无人驾驶路径跟踪控制，针对矿卡路径跟踪控制也具有显著的优势。模型预测控制器是一个
【技术保护点】
【技术特征摘要】
1.一种露天矿山无人驾驶重载车辆路径跟踪控制方法，其特征在于，包括：前进路径跟踪步骤：根据预先设置的路径信息和车辆状态信息，用下式(1)所示的新Stanley控制器控制露天矿山重载车辆前进时的路径跟踪控制，新Stanley控制器考虑有车辆转向器时滞特性、车辆尺寸和前进行驶速度：式中，δ
c
为前轮转角指令，e
p
为横向距离误差，v
f
为车辆的前进行驶速度，为角度误差，Δt为系统采样时间，τ
δ
为时滞因子，k为自适应调整控制增益，为车辆的前进加速度，δ为车辆的前轮转角，c
rp
为最近路径点对应的曲率；后退路径跟踪步骤：用下式所示的新后轮反馈控制器控制露天矿山重载车辆后退时的路径跟踪控制，新后轮反馈控制器考虑有车辆转向器时滞特性、车辆尺寸和后退行驶速度：式中，δ
c
为前轮转角指令，L为轴距，c
r
为最近路径点对应曲率，为最近路径点对应曲率的变化率，为横摆角误差，e
r
为横向距离误差，为横摆角误差对应的比例因子，k
e
为横向距离误差对应的比例影子，τ
δ
为时滞因子，v
r
为正值的车辆后退行驶速度，为车辆横摆角速度。2.如权利要求1所述的露天矿山无人驾驶重载车辆路径跟踪控制方法，其特征在于，新Stanley控制器还根据露天矿山重载车辆的车辆信息和行驶特性，利用下式(6)至(8)提供的动态选择方法确定预瞄距离d
p
：d
p
＝max{d
pv
，d
pc
}
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(6)d
pv
＝k
pv
v
f
Δt
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(7)式中，d
pv
为根据v
f
获得的预瞄距离，k
pv
为比例因子，d
pc
为根据c
rp
标定的预瞄距离，d
hc
、d
mc
、d
lc
分别为根据数值不同的c
rp
标定的预瞄距离。3.如权利要求2所述的露天矿山无人驾驶重载车辆路径跟踪控制方法，其特征在于，新Stanley控制器还根据露天矿山重载车辆的车辆信息和行驶特性，利用下式(11)确定自适应调整控制增益k：其中，κ1和κ2为无纲量比例因子。
4.如权利要求1
‑
3中任一项所述的露天矿山无人驾驶重载车辆路径跟踪控制方法，其特征在于，新后轮反馈控制器还根据露天矿山重载车辆的车辆信息和行驶特性，利用下式(12)提供的动态选择方法确定预瞄距离：式中，d
pr
为根据c
rp
标定的预瞄距离，d
hr
、d
mr
、d
lr
分别为根据数值不同的c
rp
标定的预瞄距离。5.一种露天矿山无人驾驶重载车辆路径跟踪控制装置，其特征在于，包括：新Stanley控制器，其用于根据露天矿山重载车辆的车辆信息和行驶特性，控制露天矿山重载车辆前进时的路径跟踪控制，新Stanley控制器考虑有车辆转向器时滞特性，如下式(1)所示：式中，δ
c
为前轮转角指令，e
p
为横向距离误差，v
f
为车辆的前进速度，为角度误差，Δt为系统采样时间，τ...
【专利技术属性】
技术研发人员：胡满江，陈亮，秦兆博，边有钢，谢国涛，王晓伟，秦洪懋，秦晓辉，徐彪，丁荣军，
申请(专利权)人：湖南大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。