一种重载无人系统实验验证系统的横纵向协调控制的方法技术方案

本发明专利技术公开了一种重载无人系统实验验证系统的横纵向协调控制的方法，该方法包括：设定目标路径并按照目标路径进行跟踪；获取实际路径与目标路径的偏差并输入至横向控制算法，得到舵机转向占空比值；根据舵机转向占空比值确定目标速度；获取实际速度与目标速度的偏差并输入至纵向控制算法，得到直流电机占空比值；结合舵机转向占空比值和直流电机占空比值的同时作用，完成协调控制

【技术实现步骤摘要】
一种重载无人系统实验验证系统的横纵向协调控制的方法


[0001]本专利技术涉及车辆协调控制领域，尤其涉及一种重载无人系统实验验证系统的横纵向协调控制的方法
。

技术介绍

[0002]轨迹跟踪作为自动驾驶的关键问题，是智能汽车领域的研究重点
。
目前采用的方法主要有
PID
控制
、
模糊控制
、
滑模控制
、
鲁棒控制和模型预测控制等，但上述对于车辆轨迹跟踪方面大多只是针对于横向控制研究，对于横纵向协调控制的研究较少
。
然而，在实际的行驶车辆中横纵向控制之间存在一定联系，单独的横向控制仿真效果不错，但在实车试验的过程中存在冲出轨迹等问题，其原因在于并没有考虑到纵向控制对于整个轨迹跟踪的影响
。

技术实现思路

[0003]有鉴于此，为了解决现有轨迹跟踪控制方法中只考虑了横向控制，进而导致实验试验过程中控制不精准的技术问题，本专利技术提出一种重载无人系统实验验证系统的横纵向协调控制的方法，所述方法包括以下步骤：
[0004]设定目标路径并按照目标路径进行跟踪；
[0005]获取实际路径与目标路径的偏差并输入至横向控制算法，得到舵机转向占空比值；
[0006]根据舵机转向占空比值确定目标速度；
[0007]获取实际速度与目标速度的偏差并输入至纵向控制算法，得到直流电机占空比值；
[0008]结合舵机转向占空比值和直流电机占空比值的同时作用，完成协调控制r/>。
[0009]在一些实施例中，所述设定目标路径并按照目标路径进行跟踪这一步骤，其具体包括：
[0010]基于电磁信号发生器铺设车辆运行轨道，得到目标路径；
[0011]所述车辆运行轨道的弧形轨迹的转弯角度小于等于车辆的最大转向角度；
[0012]控制重载车辆按照目标路径进行跟踪
。
[0013]通过该优选步骤，设定简单的运行轨道作为重载车辆的目标路径，用于后续的车辆跟踪控制
。
[0014]在一些实施例中，所述横向控制算法为模糊
PID
控制算法
。
[0015]通过该优选步骤，根据重载车实车采用传统
PID
控制跟踪的效果来看，最终选用模糊
PID
控制算法
。
[0016]在一些实施例中，所述横向控制算法将实际路径与目标路径的偏差
、
偏差变化率以及模糊过程的输出作为
PID
控制算法的三个参数的修正因子，其模糊集合均定义为
{
负大，负中，负小，零，正小，正中，正大
}
，用模糊语言表达为
{NB,NM,NS
，
ZO
，
PS,PM
，
PB}
，实际路
径与目标路径的偏差的和域为
{
‑3，
3}
，
Δ
K
p
的论域设定为
{
‑
10
，
10}
，
Δ
K
i
的论域设定为
{
‑
0.05
，
0.05}
，
Δ
K
d
的论域设定为
{
‑
0.1
，
0.1}。
[0017]在一些实施例中，所述根据舵机转向占空比值确定目标速度这一步骤，其具体包括：
[0018]根据线性关系，确定转向角度与舵机占空比的关系式；
[0019]构建转向角度与目标速度的关系式；
[0020]基于转向角度与舵机占空比的关系式
、
转向角度与目标速度的关系式，确定目标速度
。
[0021]通过该优选步骤，先分别构建出转向角度与舵机占空比的关系式
、
转向角度与目标速度的关系式，进而可以基于这两条关系式，根据舵机转向占空比值确定目标速度
。
[0022]在一些实施例中，所述转向角度与舵机占空比的关系式这一步骤，其具体包括：
[0023]θ
turn
＝
(PWM
d
‑
PWM
(0
，
d)
)k1[0024]上式中，
θ
turn
代表转向角度，
PWM
d
表示舵机占空比值，
PWM
(0
，
d)
表示车辆方向摆正时对应舵机0°
占空比值
。
[0025]在一些实施例中，所述转向角度与目标速度的关系式的表达式如下：
[0026]V
t
＝
PWM
e
+(
θ
s.m
‑
θ
turn
)k2[0027]s.t.
[0028]V
t
≤PWM
e,full
[0029]0≤PWM
e
≤PWM
e,full
[0030]上式中，
PWM
e
表示电机较高转速占空比值，
θ
s.m
表示车辆直线行驶最大舵机转角，
k2表示预设系数，
PWM
e,full
表示电机满占空比值，
θ
turn
表示转向角度
。
[0031]基于上述方案，本专利技术提供了一种重载无人系统实验验证系统的横纵向协调控制的方法，利用模糊
PID
控制来提高横向控制的精度，在横向控制的基础上，加入纵向控制，通过横向控制的输出获取实际道路的信息，进而确定目标速度，共同作用于智能车，以此来提高车辆行驶的稳定性和快速性
。
使得车辆能够适应各种不同的轨迹
。
附图说明
[0032]图1是本专利技术一种重载无人系统实验验证系统的横纵向协调控制的方法的步骤流程图；
[0033]图2是本专利技术方法的数据流向示意图；
[0034]图3是本专利技术一种重载无人系统实验验证系统的横纵向协调控制的系统
。
具体实施方式
[0035]高效稳定的轨迹跟踪控制系统是无人驾驶车辆实现智能化和实用化的必要条件，然而，目前轨迹跟踪方面大多只是针对于横向控制研究，导致实车试验时存在冲出轨迹等问题
。
[0036]针对
技术介绍
中提出的没有考虑到纵向控制对于整个轨迹跟踪的影响的技术问题，本专利技术基于模糊
PID
控制算法，结合横向控制和纵向控制，以解决传统单独控制对于重载车跟踪控制的稳定性低的问题
。
[0037]下面将结合本申请实施例中的附图，对本申请实施例中的技术方案本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种重载无人系统实验验证系统的横纵向协调控制的方法，其特征在于，包括以下步骤：设定目标路径并按照目标路径进行跟踪；获取实际路径与目标路径的偏差并输入至横向控制算法，得到舵机转向占空比值；根据舵机转向占空比值确定目标速度；获取实际速度与目标速度的偏差并输入至纵向控制算法，得到直流电机占空比值；结合舵机转向占空比值和直流电机占空比值的同时作用，完成协调控制
。2.
根据权利要求1所述一种重载无人系统实验验证系统的横纵向协调控制的方法，其特征在于，所述设定目标路径并按照目标路径进行跟踪这一步骤，其具体包括：基于电磁信号发生器铺设车辆运行轨道，得到目标路径；所述车辆运行轨道的弧形轨迹的转弯角度小于等于车辆的最大转向角度；控制重载车辆按照目标路径进行跟踪
。3.
根据权利要求2所述一种重载无人系统实验验证系统的横纵向协调控制的方法，其特征在于，所述横向控制算法为模糊
PID
控制算法
。4.
根据权利要求3所述一种重载无人系统实验验证系统的横纵向协调控制的方法，其特征在于，所述横向控制算法将实际路径与目标路径的偏差
、
偏差变化率以及模糊过程的输出作为
PID
控制算法的三个参数的修正因子，其模糊集合均定义为
{
负大，负中，负小，零，正小，正中，正大
}
，用模糊语言表达为
{NB,NM,NS,ZO,PS,PM,PB}
，实际路径与目标路径的偏差的和域为
{
‑3，
3}。5.
根据权利要求2所述一种重载无人系统实验验证系统的横纵向协调控制的方法，其特征在于，所述根据舵机转向占空比值确定目标速度这一步骤，其具体包括：根据线性关系，确定转向角度与舵机占空比的关系式；构建转向角度与目标速度的关系式；基于转向...

【专利技术属性】
技术研发人员：王萍，刘万泉，胡天江，韩瑜，林文龙，
申请(专利权)人：中山大学，
类型：发明
国别省市：