当前位置: 首页 > 专利查询>东南大学专利>正文

基于自适应模型预测控制的收获机路径跟踪控制器的设计方法技术

技术编号:21377035 阅读:61 留言:0更新日期:2019-06-15 13:08
本发明专利技术公开了一种基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,包括如下步骤:(1)建立收获机三自由度运动学模型;(2)以转向角为控制变量,设计模型预测控制算法;(3)采用改进粒子群算法对不同路径和速度情况下的预测时域进行参数整定;(4)根据路径和行驶速度选定工作模式进而得到相应的预测时域。本发明专利技术能够有效解决由于收获机滞后性大引起的延迟问题,改善预测时域的选取进而提高路径跟踪效果。

【技术实现步骤摘要】
基于自适应模型预测控制的收获机路径跟踪控制器的设计方法
本专利技术涉及农业车辆自主行驶
,尤其是一种基于自适应模型预测控制的收获机路径跟踪控制器的设计方法。
技术介绍
随着导航和控制技术的快速发展,农业机械的自动化和智能化程度不断提高,是实现精准农业的前提。自主式农业机械通过提高效率、可靠性和精确性,以及减少对人为干预的需求,大大提高生产力,降低生产成本和能源消耗,利于环境保护。路径跟踪控制是自主化技术的关键技术,它使车辆能够有效跟踪一个期望的路径,完成农作业需求。纯跟踪控制方法在这一领域得到了广泛应用,该方法基于几何方式,通过在期望路径的前视距离处选择一个点来计算所需的转向角。然而,前视距离的选取与行驶速度、跟踪轨迹、位置误差和航向偏差等因素有关,选取较为困难。为了提高鲁棒性,模型控制器、鲁棒H∞输出反馈控制器、基于神经网络的自适应控制、滑模控制等方法被用于路径跟踪控制。但是,这些方法不适用于联合收获机质量大、惯性大造成的控制滞后问题。并且,没有考虑约束条件。而模型预测控制能够基于当前的输入预测未来时刻的控制量,有效抑制滞后性,且可充分考虑状态量和控制量的约束条件。因此,模型预测控制是实现收获机路径跟踪控制的有效方式。为了提高其环境适应性,根据跟踪路径和运动速度自适应调整预测时间,实现自适应模型预测控制。
技术实现思路
本专利技术所要解决的技术问题在于,提供一种基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,能够有效解决由于收获机滞后性大引起的延迟问题,改善预测时域的选取进而提高路径跟踪效果。为解决上述技术问题,本专利技术提供一种基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,包括如下步骤:(1)建立收获机三自由度运动学模型;(2)以转向角为控制变量,设计模型预测控制算法;(3)采用改进粒子群算法对不同路径和速度情况下的预测时域进行参数整定;(4)根据路径和行驶速度选定工作模式进而得到相应的预测时域。优选的,步骤(1)中,建立收获机三自由度运动学模型具体为:在导航坐标系下,建立以双后轮支撑转向、双前轮驱动的三自由度运动学模型:式中,(x,y)为收获机前轴中心坐标,为车身导航角,v为收获机行驶速度,δ为后轮转向角,L为前后轮轴距;对上式进行线性化和离散化处理,可得到该系统的状态空间方程其中,为状态变量,为输入量,为状态转移矩阵,为输入转移矩阵,y(k)为输出量,为输出矩阵,T为采样时间,下标d表示相应的期望值。优选的,步骤(2)中,以转向角为控制变量,设计模型预测控制算法具体为:构造新的状态量根据上式,可得新的状态空间方程为ζ(k+1)=Aζ(k)+BΔu(k)η(k)=Hζ(k)其中,Δu(k)=u(k)-u(k-1),u为控制量δ,η(k)为输出量;假设预测时域为P,控制时域为C,Δu(k+C-1)=Δu(k+C)=…=Δu(k+P-1),则根据上式可得时刻k的预测输出为令时刻k的控制序列为ΔU(k),输出序列为Y(k+1),则模型预测控制的评价函数为其中,J为目标函数,Q为预测时域的权重矩阵,R为控制时域的权重矩阵;构建系统控制量和控制增量的约束条件为其中,umin和umax为控制量约束最值,Δumin和umax为控制增量约束最值;通过最优求解,得控制时域内时刻k的控制输入增量ΔU(k),将控制输入增量第一个因素作用于系统,实施控制输入量u(k)=u(k-1)+Δu(k)在k+1时刻,系统重新预测控制时域内的控制输入增量,从而实现滚动最优控制。优选的,步骤(3)中,采用改进粒子群算法对不同路径和速度情况下的预测时域进行参数整定具体为:设搜索空间为D维,群体规模为m,粒子的运动轨迹简化为一维运动方程式中,V为粒子速度;X为粒子位置;w为惯性权重;c1、c2是加速度常数;r1、r2是随机数;Xp为该粒子经过的最优位置;Xg是整个种群中粒子经过的最优位置;对惯性权重的线性变化过程分为两个部分,引入参数wλ,则第k次迭代的惯性权重值wk为式中,Iλ为转折迭代次数;Imax为最大迭代次数;wmax和wmin分别为最大惯性权重值和最小惯性权重值;根据不同路径和不同作业速度将收获机的工作模式分为9种,分别基于改进的粒子群算法得到对应的预测时域。优选的,步骤(4)中,根据路径和行驶速度选定工作模式进而得到相应的预测时域具体为:根据当前期望的路径和速度值,选取对应的工作模式,进而得到当前的最优预测时域。本专利技术的有益效果为:本专利技术提供一种基于自适应模型预测控制的收获机路径跟踪控制器,能够有效解决由于收获机滞后性大引起的延迟问题,改善预测时域的选取进而提高路径跟踪效果。附图说明图1为本专利技术收获机路径跟踪控制器的结构示意图。图2为本专利技术基于粒子群算法的预测时域整定流程示意图。具体实施方式一种基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,包括如下步骤:步骤一,建立收获机三自由度运动学模型,具体方法如下:模型预测控制的数学模型包括动力学模型和运动学模型两种。运动学模型适用于低速场合,由于收获机的作业速度通常低于3.5m/s,故本专利技术建立了以双后轮支撑转向、双前轮驱动的三自由度运动学模型。在导航坐标系下,收获机的运动学模型表示为式中,(x,y)为收获机前轴中心坐标;为车身导航角;v为收获机行驶速度;δ为后轮转向角;L为前后轮轴距。对上式进行线性化和离散化处理,可得到该系统的状态空间方程其中,为状态变量,为输入量,为状态转移矩阵,为输入转移矩阵,y(k)为输出量,为输出矩阵,T为采样时间,下标d表示相应的期望值。步骤二,以转向角为控制变量,设计模型预测控制算法,具体方法如下:模型预测控制器基于运动学模型、当前状态和未来控制量来预测未来时刻的输出。由于未来控制量未知,需要根据一定的约束条件进行优化,得到未来控制量。构造新的状态量根据上式,可得新的状态空间方程为ζ(k+1)=Aζ(k)+BΔu(k)η(k)=Hζ(k)其中,Δu(k)=u(k)-u(k-1),u为控制量δ。假设预测时域为P,控制时域为C,Δu(k+C-1)=Δu(k+C)=…=Δu(k+P-1),则根据上式可得时刻k的预测输出为令时刻k的控制序列为ΔU(k),输出序列为Y(k+1),则模型预测控制的评价函数为其中,J为目标函数,Q为预测时域的权重矩阵,R为控制时域的权重矩阵。构建系统控制量和控制增量的约束条件为其中,umin和umax为控制量约束最值,Δumin和umax为控制增量约束最值。通过最优求解,得控制时域内时刻k的控制输入增量ΔU(k),将控制输入增量第一个因素作用于系统,实施控制输入量u(k)=u(k-1)+Δu(k)在k+1时刻,系统重新预测控制时域内的控制输入增量,从而实现最优控制。步骤三,采用优化粒子群算法对不同路径和速度情况下的预测时域进行参数整定,具体方法如下:在模型预测控制中预测时域P的选取至关重要,不同的选取结果将直接影响控制效果。本方法利用粒子群算法(PSO)强大的寻优能力对其进行选定,以模型预测控制的误差性能作为适应度值,从而将参数的选取问题转化成了算法的寻优问题。PSO根据其特有的记忆功能可以动态跟踪当前的搜索情况并作出相应的调整,每一次迭代过程,所有个体均能记忆当前最佳位置,且通过跟踪两个极值来更新自本文档来自技高网...

【技术保护点】
1.基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,其特征在于,包括如下步骤:(1)建立收获机三自由度运动学模型;(2)以转向角为控制变量,设计模型预测控制算法;(3)采用改进粒子群算法对不同路径和速度情况下的预测时域进行参数整定;(4)根据路径和行驶速度选定工作模式进而得到相应的预测时域。

【技术特征摘要】
1.基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,其特征在于,包括如下步骤:(1)建立收获机三自由度运动学模型;(2)以转向角为控制变量,设计模型预测控制算法;(3)采用改进粒子群算法对不同路径和速度情况下的预测时域进行参数整定;(4)根据路径和行驶速度选定工作模式进而得到相应的预测时域。2.如权利要求1所述的基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,其特征在于,步骤(1)中,建立收获机三自由度运动学模型具体为:在导航坐标系下,建立以双后轮支撑转向、双前轮驱动的三自由度运动学模型:式中,(x,y)为收获机前轴中心坐标,为车身导航角,v为收获机行驶速度,δ为后轮转向角,L为前后轮轴距;对上式进行线性化和离散化处理,可得到该系统的状态空间方程其中,为状态变量,为输入量,为状态转移矩阵,为输入转移矩阵,y(k)为输出量,为输出矩阵,T为采样时间,下标d表示相应的期望值。3.如权利要求1所述的基于自适应模型预测控制的收获机路径跟踪控制器的设计方法,其特征在于,步骤(2)中,以转向角为控制变量,设计模型预测控制算法具体为:构造新的状态量根据上式,可得新的状态空间方程为ζ(k+1)=Aζ(k)+BΔu(k)η(k)=Hζ(k)其中,Δu(k)=u(k)-u(k-1),u为控制量δ,η(k)为输出量;假设预测时域为P,控制时域为C,Δu(k+C-1)=Δu(k+C)=…=Δu(k+P-1),则根据上式可得时刻k的预测输出为η(k+1)=HAζ(k)+HBΔu(k)η(k+C)=HACζ(k)+HAC-1BΔu(k)+…+HBΔu(k+C-1)η(k+P)=HAPζ(k)+HAP-1BΔu(k)+…+H...

【专利技术属性】
技术研发人员:王立辉张月新汤新华
申请(专利权)人:东南大学
类型:发明
国别省市:江苏,32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1