基于伪谱法的双摆吊车全局时间最优轨迹规划方法技术

一种基于伪谱法的双摆吊车全局时间最优轨迹规划方法。解决非线性双摆桥式吊车系统自动控制问题，方法具有良好的台车定位与两级负载摆动消除性能。首先对系统运动学模型进行变换，以方便接下来的分析。之后考虑包括两级摆角及台车速度和加速度上限值在内的多种约束，构造出相应的优化问题。随后，利用高斯伪谱法将该带约束的优化问题转化为更易于求解的非线性规划问题并求解，得到时间最优的台车轨迹。本发明专利技术利用伪谱法的思想对复杂的时间最优问题进行处理与转化，降低了求解的难度；同时，本方法可以得到全局时间最优的结果，可极大地提高吊车系统的工作效率。仿真与实验结果表明，本发明专利技术能取得良好的控制效果，具有很好的实际应用价值。

【技术实现步骤摘要】
基于伪谱法的双摆吊车全局时间最优轨迹规划方法
本专利技术属于非线性欠驱动机电系统自动控制的
，特别是涉及一种基于伪谱法的双摆吊车全局时间最优轨迹规划方法。
技术介绍
在工业生产过程中，为运送负载到所期望的位置，包括桥式吊车、悬臂式吊车、塔式吊车、船用吊车在内的各类吊车系统，有着非常广泛的应用。为了简化吊车系统的机械结构，往往不直接控制负载，而是通过台车的运动，间接地拖动负载至目标位置。这种结构带来的结果是，吊车系统的控制输入维数小于待控自由度维数。具有该特性的系统即所谓的欠驱动系统[1]。相比全驱动系统，由于欠驱动特性的存在，欠驱动系统往往更难控制，而在实际生产中，吊车系统往往是由经验丰富的工人操作。如果发生误操作，可能引起负载剧烈摆动导致碰撞，甚至发生安全事故。因此，对吊车系统自动控制方法的研究具有现实意义与广泛应用价值，得到了广大学者的关注。对于桥式吊车系统，主要的控制目标包括两个方面，即快速且精确的台车定位与负载摆动的抑制与消除。然而，这两方面通常是互相矛盾的，即过快的台车运动往往导致较大的负载摆动。因此，同时实现这两方面的控制目标具有较高的难度。为了获得较好的控制效果，目前国内外学者已经提出了很多吊车系统自动控制方法。Tuan等提出了基于部分反馈线性化的控制方法[2-3]，可以简化桥式吊车系统的控制算法设计。在文献[4]，[5]中,Singhose等利用输入整形的思想对吊车系统进行控制，可有效地抑制负载残余摆动。为处理不确定的外界干扰，研究人员利用滑模算法控制吊车系统[6-7]，可以获得很好的鲁棒性。胡洲等提出了一种非线性信息融合控制方法[8]，可以处理控制器输入饱和的问题，实现对吊车系统的高性能控制。文献[9]，[10]提出了基于能量与无源性的控制策略，可获得较好的效果。除此之外，近年来，包括遗传算法[11]、模糊控制[12]等一些智能控制方法同样在吊车控制领域有着一定的应用。众所周知，吊车系统的负载摆动由台车的加减速运动引起，在台车运动与负载摆动之间存在着较强的耦合。基于此，可以为台车规划一条合适的轨迹，当台车按照该轨迹运动时，即可实现对其快速精确定位的目标。同时，考虑到摆角抑制与消除的要求，在轨迹规划过程中，通过深入分析与合理利用台车运动与负载摆动之间的耦合关系，可以规划出一条具有消摆能力的台车轨迹。这样即可完成台车快速精确定位与负载消摆的双重目标。基于该思想,研究人员已提出了很多吊车轨迹规划方法[13-17]。例如，在文献[13]中，Uchiyama等提出了一种针对悬臂吊车的开环控制策略，为了消除残余摆动，他们为悬臂的水平运动规划了一条S型轨迹。文献[14]则提出了一种基于相平面分析的轨迹规划方法，它可以较好地抑制负载摆动，并消除了残余摆动。对于吊车系统，虽然上述各种方法在理想情况下可以得到较好的控制效果，但是这些方法均假设吊钩的质量可以忽略且负载可看作质点，并将吊车系统的负载摆动视为单摆系统。若吊钩的质量较大，无法忽略，或者负载形状很大，不能简单看作质点，在这种情况下，吊车系统的摆动将会呈现出双摆现象，即吊钩绕台车进行一级摆动，同时负载绕吊钩发生二级摆动。此时，上述的单摆吊车控制方法无法取得令人满意的控制性能，目前仅存在极少考虑双摆效应的吊车系统控制策略。文献[18-20]通过分析双摆吊车系统的固有频率，将输入整形的方法成功地扩展到双摆吊车系统。孙宁等在考虑系统摆角约束、台车速度约束等一系列约束的前提下，提出了一种基于微分平坦理论的双摆吊车最优轨迹规划方法[21]。郭卫平等通过分析吊车系统的能量，提出了一种基于无源性的双摆吊车控制策略[22]。尽管上述控制策略可以实现对双摆吊车系统的控制，它们均无法实现全局时间最优的控制效果，即无法保证吊车系统运行效率的最大化。因此需要设计合适的控制方法，以提高吊车系统的工作效率。
技术实现思路
本专利技术的目的是解决现有双摆效应桥式吊车系统轨迹规划方法存在的上述不足，提供一种基于伪谱法的双摆吊车全局时间最优轨迹规划方法。本专利技术致力于通过分析具有双摆效应的桥式吊车系统的运动学模型，提出了一种基于伪谱法的双摆吊车全局时间最优轨迹规划方法，得到了一条全局时间最优的台车轨迹，在完成台车精确定位的同时，实现了两级负载摆动的快速抑制与消除，并将其应用于实际吊车平台进行实验，可极大地提高吊车系统的工作效率。本专利技术提供的基于伪谱法的双摆吊车全局时间最优轨迹规划方法包括：第1、分析轨迹约束并构造相应的优化问题分析吊车系统的控制目标，考虑包括两级摆角及台车速度和加速度上限值在内的多种约束，得出如下的以运送时间为代价函数的优化问题：其中，x(t)代表台车的位置，xf表示台车的目标位置，括号中的t表示时间，变量后面(t)表示该变量为关于时间的变量，为简明起见，在公式中略去大部分变量中的(t)，T表示完成运送的总时间，min表示最小，s.t.后面接表示需要考虑的约束条件；分别表示台车位置x(t)关于时间的一阶导数和二阶导数，即台车速度与加速度；vmax,amax分别代表所允许的台车最大速度与最大加速度；θ1(t),θ2(t)分别表示一级与二级摆角，表示一级与二级角速度；θ1max,θ2max表示运送过程中允许的一级与二级最大摆角，ω1max,ω2max表示所允许的一级与二级最大角速度。第2、加速度驱动模型建立与优化问题转化分析与利用双摆桥式吊车系统，得到如下的加速度驱动系统模型：其中，ζ表示系统的全状态向量，具体定义如下：其中，x(t),分别表示台车位置与速度，θ1(t),表示一级摆角及角速度，θ2(t),表示二级摆角及角速度，括号的上标T代表矩阵的转置运算；u(t)代表该系统的系统输入，且为台车加速度；f(ζ),h(ζ)均代表以系统的全状态向量ζ为自变量的函数，由吊车系统运动学方程得到，具体形式见(7)；为系统的全状态向量关于时间的导数。利用上述加速度驱动系统模型，原优化问题转化为如下的形式：其中，ζ表示系统的全状态向量，u(t)代表该系统的系统输入，且为台车加速度；括号中的t表示时间，变量后面(t)表示该变量为关于时间的变量，为简明起见，在公式中略去大部分变量中的(t)，T表示完成运送的总时间，min表示最小，s.t.后面接表示需要考虑的约束条件；向量的上标T代表矩阵的转置运算；xf表示给定的台车目标位置，表示台车速度，vmax,amax分别代表所允许的台车最大速度与最大加速度；θ1(t),θ2(t)分别表示一级与二级摆角，表示一级与二级角速度；θ1max,θ2max表示运送过程中允许的一级与二级最大摆角，ω1max,ω2max表示所允许的一级与二级最大角速度。第3、基于高斯伪谱法的轨迹规划利用高斯伪谱法的思想对第2步中的优化问题进行处理与求解，具体步骤如下：第3.1、首先利用拉格朗日插值方法，选择勒让德-高斯(Legendre-Gauss,LG)点处的离散系统状态轨迹以及输入轨迹，通过离散轨迹与拉格朗日插值多项式，表示相应的近似轨迹模型。第3.2、接着，通过对近似后的轨迹模型进行求导，将系统状态的导数用拉格朗日多项式导数表示。第3.3、随后，利用离散的轨迹模型及其导数，将原系统运动学模型转化为一系列多项式方程；利用高斯积分，第2步中优化问题里的边界条件同样表示本文档来自技高网...

【技术保护点】
一种基于伪谱法的双摆吊车全局时间最优轨迹规划方法，其特征在于该方法包括：第1、分析轨迹约束并构造相应的优化问题分析吊车系统的控制目标，考虑包括两级摆角及台车速度和加速度上限值在内的多种约束，得出如下的以运送时间为代价函数的优化问题：minTs.t.x(0)=x·(0)=x··(0)=0,x(T)=xf,x·(T)=x··(T)=0,|x·(t)|≤vmax,|x··(t)|≤amax,θ1(0)=θ·1(0)=0,θ1(T)=θ·1(T)=0,θ2(0)=θ·2(0)=0,θ2(T)=θ·2(T)=0,|θ1(t)|≤θ1max,|θ2(t)|≤θ2max,|θ·1(t)|≤ω1max,|θ·2(t)|≤ω2max,---(5)]]>其中，x(t)代表台车的位置，xf表示台车的目标位置，括号中的t表示时间，变量后面(t)表示该变量为关于时间的变量，为简明起见，在公式中略去大部分变量中的(t)，T表示完成运送的总时间，min表示最小，s.t.后面接表示需要考虑的约束条件；分别表示台车位置x(t)关于时间的一阶导数和二阶导数，即台车速度与加速度；vmax,amax分别代表所允许的台车最大速度与最大加速度；θ1(t),θ2(t)分别表示一级与二级摆角，表示一级与二级角速度；θ1max,θ2max表示运送过程中允许的一级与二级最大摆角，ω1max,ω2max表示所允许的一级与二级最大角速度；第2、加速度驱动模型建立与优化问题转化分析与利用双摆桥式吊车系统，得到如下的加速度驱动系统模型：ζ·=f(ζ)+h(ζ)u,---(6)]]>其中，ζ表示系统的全状态向量，具体定义如下：ζ=xx·θ1θ·1θ2θ·2T]]>其中，x(t),分别表示台车位置与速度，θ1(t),表示一级摆角及角速度，θ2(t),表示二级摆角及角速度，括号的上标T代表矩阵的转置运算；u(t)代表该系统的系统输入，且为台车加速度；f(ζ),h(ζ)均代表以系统的全状态向量ζ为自变量的函数，由吊车系统运动学方程得到，具体形式见(7)；为系统的全状态向量关于时间的导数；f(ζ)=x·0θ·1Aθ·2BT,h(ζ)=010C0DT---(7)]]>利用上述加速度驱动系统模型，原优化问题转化为如下的形式：minTs.t.ζ·=f(ζ)+h(ζ)u,ζ(0)=000000T,ζ(T)=xf00000T,|x·(t)|≤vmax,|u(t)|≤amax,|θ1(t)|≤θ1max,|θ2(t)|≤θ2max,|θ·1(t)|≤ω1max,|θ·2(t)|≤ω2max---(9)]]>其中，ζ表示系统的全状态向量，u(t)代表该系统的系统输入，且为台车加速度；向量的上标T代表矩阵的转置运算；第3、基于高斯伪谱法的轨迹规划利用高斯伪谱法的思想对第2步中的优化问题进行处理与求解，具体步骤如下：第3.1、首先利用拉格朗日插值方法，选择勒让德‑高斯(Legendre‑Gauss,LG)点处的离散系统状态轨迹以及输入轨迹，通过离散轨迹与拉格朗日插值多项式，表示相应的近似轨迹模型；第3.2、接着，通过对近似后的轨迹模型进行求导，将系统状态的导数用拉格朗日多项式导数表示；第3.3、随后，利用离散的轨迹模型及其导数，将原系统运动学模型转化为一系列多项式方程；利用高斯积分，第2步中优化问题里的边界条件同样表示成多项式方程的形式；第3.4、最后，时间最优轨迹规划问题即转化为一种具有代数约束的非线性规划问题，通过求解即得到全局最优时间及最优轨迹；第4、轨迹跟踪通过码...

【技术特征摘要】
1.一种基于伪谱法的双摆吊车全局时间最优轨迹规划方法，其特征在于该方法包括：第1、分析轨迹约束并构造相应的优化问题分析吊车系统的控制目标，考虑包括两级摆角及台车速度和加速度上限值在内的多种约束，得出如下的以运送时间为代价函数的优化问题：其中，x(t)代表台车的位置，xf表示台车的目标位置，括号中的t表示时间，变量后面(t)表示该变量为关于时间的变量，为简明起见，在公式中略去大部分变量中的(t)，T表示完成运送的总时间，min表示最小，s.t.后面接表示需要考虑的约束条件；分别表示台车位置x(t)关于时间的一阶导数和二阶导数，即台车速度与加速度；vmax,amax分别代表所允许的台车最大速度与最大加速度；θ1(t),θ2(t)分别表示一级与二级摆角，表示一级与二级角速度；θ1max,θ2max表示运送过程中允许的一级与二级最大摆角，ω1max,ω2max表示所允许的一级与二级最大角速度；第2、加速度驱动模型建立与优化问题转化分析与利用双摆桥式吊车系统，得到如下的加速度驱动系统模型：其中，ζ表示系统的全状态向量，具体定义如下：其中，x(t),分别表示台车位置与速度，θ1(t),表示一级摆角及角速度，θ2(t),表示二级摆角及角速度，括号的上标T代表矩阵的转置运算；u(t)代表该系统的系统输入，且为台车加速度；f(ζ),h(ζ)均代表以系统的全状态向量ζ为自变量的函数，由吊车系统运动学方程得到，具体形式见(7)；为系统的全状态向量关于时间的导数；其中，为方便描述，定义了如下的辅助变量A,B,C,D：

【专利技术属性】
技术研发人员：方勇纯，陈鹤，孙宁，
申请(专利权)人：南开大学，
类型：发明
国别省市：天津;12