基于运动规划的桥式吊车自适应控制方法.pdf

摘要
申请专利号：	CN201010593335.0	申请日：	2010.12.17
公开号：	CN102030263A	公开日：	2011.04.27
当前法律状态：	撤回	有效性：	无权
法律详情：	发明专利申请公布后的视为撤回IPC(主分类):B66C 13/06申请公布日:20110427\|\|\|实质审查的生效IPC(主分类):B66C 13/06申请日:20101217\|\|\|公开
IPC分类号：	B66C13/06	主分类号：	B66C13/06
申请人：	南开大学
发明人：	方勇纯; 马博军; 孙宁; 王鹏程
地址：	300071 天津市南开区卫津路94号
优先权：
专利代理机构：	天津佳盟知识产权代理有限公司 12002	代理人：	侯力
PDF下载：	PDF下载

内容摘要

一种基于运动规划的桥式吊车自适应控制方法。该方法包括：制定运动规划，为吊车台车设计一条期望的位置-时间曲线，如果台车沿其运动，可使台车相对快速到达目标位置，而负载摆角也在一个较小的可以接受的范围内。同时，针对不同情况与需求可调整其中参数，使其运输最大速度、加速性能满足实际工况要求与约束；设计自适应跟踪控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出。该控制器可以在未知吊车台车负载质量、吊绳长度、摩擦等阻力参数时，较好地跟踪设定运动曲线，最终使误差、摆角和控制力全程保持在较小范围内，并最终收敛至0。可见，本发明轨迹规划与自适应跟踪控制方法的优越性。

权利要求书

1：一种基于运动规划的桥式吊车自适应控制方法，其特征在于该方法包括：第一、台车运动规划为吊车台车设计一条期望的位置一时间曲线，如果台车沿其运动，可使台车快速到达目标位置，而负载摆角也在一个可以接受的范围内；为此，将位置 - 时间曲线设计为单向平滑的 S 形曲线，即：其中 pd 为台车所要达到的目标位置 ( 起始位置为 0 位置 )， kv、 ka 分别为允许的台车最大速度与加速度， ε 为调整曲线形状的相关参数；该曲线所设计的台车位移 xd(t)、速度加速度均为光滑连续曲线，且比现有的指令曲线有更好的摆角抑制能力；第二、自适应跟踪控制器的设计对于实际应用情况，当负载质量、吊绳长度、摩擦阻力未知时，为使台车跟踪以上曲线，设计了一种自适应控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出，控制电机与执行器提供相应输出力，带动台车运动，完成运动曲线的跟踪，并适应未知参数，该控制器具体形式如下：其中 r(t) ＝ x(t)-xd(t) 为台车现有位置与运动规划曲线的误差，而为该误差导数； PD 控制项，而为参数适应项，其中： ω ＝ [fr0x fr0xwrx krx+dx+df dfl mx+m]T 为位置参数向量，而为未知适应项系数； n(t) ＝ YTω 为控制器中的为控制器设计时所需适应的未知参数式，为吊车各部分质量 mx 与 m、吊绳长度 l、摩擦阻力 fr0x 及其阻力因数 krx、 dx、 df 与 wrx 的线性组合项；我们对其中的未知参数项进行在线估计，参数更新律如下：其中 Γ 为一正定对称阵，而对进行在线积分即可得到 ω 的估计值。

说明书

基于运动规划的桥式吊车自适应控制方法
    技术领域本发明属于非线性欠驱动系统自动控制的技术领域，特别是涉及一种基于运动规划的桥式吊车自适应控制方法。
     背景技术桥式吊车是一种十分常见的装配运输工具，它利用绳索将负载与吊车上的台车相连，并通过台车的运动来将负载运送到指定的位置，桥式吊车在港口、仓库、建筑工地等场所得到了广泛的应用。
     桥式吊车在运行时，吊车上台车的运动会引起负载的摆动，使得负载可能会和周围的操作工人或者是其它物体发生碰撞，致使负载损坏，甚至导致发生人员伤亡事故，尤其是当台车到达指定位置停止运行后，吊车所悬挂的负载会发生比较强烈的残余摆动，这样不仅会带来较大的安全隐患，同时也严重影响了吊车的工作效率。因此，为了有效避免安全隐患，提高吊车的工作效率，在操作吊车时，一方面需要实现台车的快速准确定位，以满足准确运送负载的要求；另一方面，需要有效地抑制负载的摆动，实现负载的 “无摆” 或者 “微摆” 操作。特别是当台车到达指定位置时，负载必须很快地停止摆动，以期提高吊车的工作效率。
     目前，为了满足台车的快速准确定位和有效地抑制负载的摆动这两方面的吊车操作要求，一般是通过有经验的工人操纵吊车来实现，具体在操作过程中，工人需要利用他们的经验并通过其眼睛的观测来估计台车的位置与摆角大小，然后选择合理的动作序列来有效抑制负载的摆动，并尽快将它运送到指定的位置，所以一个工人只有在具备多年吊车操作经验，并且掌握娴熟的吊车操作技巧之后，才能利用吊车快速地将负载运送到指定的位置，并有效地抑制负载的摆动。
     虽然国内外自动化领域的许多学者针对桥式吊车系统开展了大量研究，针对这种欠驱动系统提出了多种不同的控制方法，力图实现桥式吊车的安全、高效运输，但是目前还没有开发出一种方便、可靠的桥式吊车自动控制系统或方法。
     且在已有的控制算法中，又缺乏对未知参数的适应能力。而随任务和状态不同导致的未知参数的变化对各控制算法均有较大影响，很大程度上局限了控制器的功能实现和实用化。
     发明内容本发明目的是克服现有技术存在的上述不足，提供一种基于运动规划的桥式吊车自适应控制方法。
     一、系统模型
     对于 2D 桥式吊车系统，如图 1 所示，其动力学模型用拉格朗日方程表述为：
     G(q) ＝ [0 mglSx]T U(t) ＝ [fx 0]T其中 q ＝ [x θx]T 代表系统状态向量，包括台车位置 x 与负载摆角 θx， U(t) 为控制输入力向量，其中 fx 为对台车牵引力。M(q)、与 G(q) 分别为惯量矩阵、科氏 - 向心力矩阵与重力向量。而 Fd(t) 代表摩擦阻力向量，两分量为在广义坐标下的摩擦力分量，包含台车轨道与台车之间摩擦与空气阻尼等。其中，对其主要作用的台车 - 轨道间摩擦机型如下建模：
     该模型可有效描述静摩擦、动摩擦以及低速时的 stribeck 现象，同时在速度为零时的近似兼顾控制器设计时的连续要求。同时在各矩阵与向量中普遍存在台车质量 mx、负载质量 m 及吊绳长度 l 等未知参数。当参数未知时，控制器无法对模型进行精确地补偿，从而降低控制精度，甚至影响系统稳定性，即吊车台车不能达到目标位置并使负载摆角收敛至 0。
     二、控制算法
     如前所述，桥式吊车是一类欠驱动系统，所以难以兼顾台车快速运动，而同时使负载摆角的快速抑制。以上两指标需要相互协调达到整个系统的最优。在台车运行时，一类通用的方法为根据负载的摆动情况及时调节台车速度或加速度。而现有调整过程一般基于经验，这就导致了运输效率的低下与操作失败的风险性加大。为此，本发明提出了一种两步控制策略：运动规划与自适应跟踪。
     本发明提供的基于运动规划的桥式吊车自适应控制方法基于运动规划的桥式吊车自适应控制方法，包括：
     第一、制定运动规划
     为吊车台车设计一条期望的运动位置时间曲线，如果台车沿其运动，可使台车相对快速到达目标位置，而负载摆角也在一个较小的可以接受的范围内；为此，将台车位移时间曲线设计为单向平滑的 S 形曲线，即：
     其中 pd 为台车所要达到的目标位置 ( 起始位置为 0 位置 )， kv、 ka 分别为规划的台4102030263 A CN 102030265说明书加速度3/7 页车最大速度与加速度， ε 为调整曲线形状的相关参数。
     该曲线所设计的台车位移 xd(t)、速度均为光滑连续曲线，且比一般现有的指令曲线有更好的摆角抑制能力，其光滑连续性又为控制器的设计提供了便利；
     第二、自适应跟踪控制器的设计
     对于实际应用情况，当某些实验参数 ( 吊车台车负载质量、吊绳长度、摩擦等阻力 ) 未知时，为使台车较好的实现对以上设计曲线的跟踪，设计了一种控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出，控制电机等执行器提供相应输出力，带动台车运动，完成运动曲线的跟踪，该控制器具体形式为：
     其中 r(t) ＝ x(t)-xd(t) 为台车现有位置与同时刻运动规划中运动位置时间曲线中的轨迹位置间的误差，为控制器中的 PD 控制项，而为参数适应项。其中： ω ＝ [fr0x fr0xwrx krx+dx+df dfl mx+m]T 为未知参数向量，而为未知适应项系数； n(t) ＝ YTω而为误差导数，
     为控制器设计时所需适应的未知参数式。我们对其中的未知参数项进行估计，有参数更新率：其中 Γ 为一正定对称阵，而对进行在线积分可得到 ω 的估计值代入上述控制器。三、控制器稳定性证明
     该部分从理论上说明了控制器的作用和参数适应功能，即在存在未知参数时，台车位置误差与负载摆角误差在控制器左右下随时间可趋于 0 ：
     首先，定义系统能量函数：其对时间的导数为由不等式可得
     即由于所设计轨迹的有界性：可知以下变量的有界性：
     同时由于可得所以由 barbalat 引理可得又于是台车加速度可写为：其中由以上分析，可得：应用 barbalat 扩展引理可得对摆角的分析：由摆角动力学方程可得由以上分析有与有同时证明完成。
     本发明的优点和积极效果：
     本发明基于工程实际需要，将自适应控制方法应用于具体被控对象桥式吊车负载的水平运输控制上。针对可能随任务、工作环境等变化的参数吊绳长度、负载及台车质量、相应各部分摩擦力水平等参数进行自适应，即克服未知参数的影响，将负载运至目标位置，并使摆角收敛至 0。对设计的以上算法，经过理论证明稳定性，从理论上表明了控制器的可靠性。同时经过试验平台的验证进一步说明了改控制器可较好地完成上述控制要求。
     考虑到各国现有吊车的控制基本均由人工进行操纵，研究该方向的自动控制方法无疑对安全、效率、精确性的提升有较大帮助，同时针对实际操作中位置参数的适应，进一步加强了自动控制算法的实用性，具有明显的优点与积极效果。
     附图说明
     图 1 是现有技术中 2D 桥式吊车系统示意图。图 2 是实验平台示意图。图 3 是试验 1 结果图。图 4 是试验 2 结果图。图 5 是试验 3 结果图。图中， 1-- 台车， 2-- 桥架， 3-- 负载， 4-- 台车， 5-- 卷轴， 6-- 桥架， 7-- 轨道， 8-- 负载。具体实施方式
     实施例 1 ：
     第一、制定运动规划
     目的是为台车设计一条期望的运动位置时间曲线，如果台车沿其运动，可使台车相对快速到达目标位置，而负载摆角也在一个较小的可以接受的范围内。为此，本发明将台车位移时间曲线设计为单向平滑的 S 形曲线，即：
     该曲线所设计的台车位移 xd(t)、速度加速度均为光滑连续曲线。且比一般现有的指令曲线有更好的摆角抑制能力。同时，针对不同情况与需求可调整其中参数。使其运输最大速度、加速性能满足实际工况要求与约束。
     第二、自适应跟踪控制器的设计
     对于实际应用情况，为使台车较好的实现对以上设计曲线的跟踪，本发明设计了一种控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出，使电机等执行器提供相应输出力，带动台车运动，完成运动曲线的跟踪。而对于一般控制器而言，台车本身质量、所运输负载质量、吊绳长度以及台车与轨道之间的摩擦力中的某些参数是控制器设计的必需参数，而本发明的控制器可以在以上参数未知时提供较好的控制输出，即具有相应的自适应能力。
     该控制器具体形式为：其中
     r(t) ＝ x(t)-xd(t)
     为台车现有位置与同时刻运动规划中运动位置时间曲线中的轨迹位置见的误差。而为误差导数，
     为控制器中的 PD 控制项。而为参数适应项。其中： ω ＝ [fr0x fr0xwrx drx+dx+df dflmx+m]T 为未知参数向量，而为未知适应项系数。 n(t) ＝ YTω为控制其设计时所需适应的未知参数式。本发明对其中的位置参数项进行估计，有参数更新率：其中 Γ 为一正定对称阵，而对进行在线积分可得到 ω 的估计值代入上述控制器。完成控制器的求解过程。
     四、实验效果描述为验证说明上述控制器的有效性，本发明在桥式吊车模拟机械平台进行了实际实验验证，见图 2。
     其控制器与系统参数为：
     kv ＝ 0.4， ka ＝ 0.15， ε ＝ 2.2
     kp ＝ 200， kd ＝ 50， Γ ＝ 2I5
     三组实验参数 ( 负载质量、吊绳长度 ) 为：
     1.l ＝ 0.60m， m ＝ 1.025kg
     2.l ＝ 0.80m， m ＝ 1.025kg
     3.l ＝ 0.75m， m ＝ 2.025kg
     实验效果依次为附图 3 至图 5 所示，
     图 3 为试验 1 结果图，由该图说明控制器在条件 l ＝ 0.60m， m ＝ 1.025kg 下的台车位置曲线跟踪情况 ( 实现为台车实际未知变化，虚线为规划的轨迹 ) 及负载摆角变化关系，以及控制器输出的力指令曲线，均有较好的性能，即台车较好跟踪了规划的轨迹，同时保证摆角的收敛，同时整个过程中力指令始终在合理的范围内。
     图 4 为试验 2 结果图，由该图说明控制器在条件 l ＝ 0.80m， m ＝ 1.025kg 下的台车位置曲线跟踪情况 ( 实现为台车实际未知变化，虚线为规划的轨迹 ) 及负载摆角变化关系，以及控制器输出的力指令曲线，均有较好的性能，即台车较好跟踪了规划的轨迹，同时保证摆角的收敛，同时整个过程中力指令始终在合理的范围内。
     图 5 为试验 3 结果图，由该图说明控制器在条件 l ＝ 0.75m， m ＝ 2.025kg 下的台车位置曲线跟踪情况 ( 实现为台车实际未知变化，虚线为规划的轨迹 ) 及负载摆角变化关系，以及控制器输出的力指令曲线，均有较好的性能，即台车较好跟踪了规划的轨迹，同时保证摆角的收敛，同时整个过程中力指令始终在合理的范围内。
     综合以上三组实验结果可以看出，对不同的负载质量、吊绳长度，和相应不同的摩擦力水平，控制器均可对其进行适应，从而较好跟踪设定运动曲线 ( 虚线 )，且最终误差很小，而摆角也全程保持在较小范围内，最终收敛至 0，控制力也全程保持在较小范围内。
     可见，实验体现了本发明控制方法的优越性。

资源描述

《基于运动规划的桥式吊车自适应控制方法.pdf》由会员分享，可在线阅读，更多相关《基于运动规划的桥式吊车自适应控制方法.pdf（12页珍藏版）》请在专利查询网上搜索。

1、(10)申请公布号 CN 102030263 A(43)申请公布日 2011.04.27CN102030263A*CN102030263A*(21)申请号 201010593335.0(22)申请日 2010.12.17B66C 13/06(2006.01)(71)申请人南开大学地址 300071 天津市南开区卫津路94号(72)发明人方勇纯马博军孙宁王鹏程(74)专利代理机构天津佳盟知识产权代理有限公司 12002代理人侯力(54) 发明名称基于运动规划的桥式吊车自适应控制方法(57) 摘要一种基于运动规划的桥式吊车自适应控制方法。该方法包括：制定运动规划，为吊车台车设计一条期望的位置。

2、-时间曲线，如果台车沿其运动，可使台车相对快速到达目标位置，而负载摆角也在一个较小的可以接受的范围内。同时，针对不同情况与需求可调整其中参数，使其运输最大速度、加速性能满足实际工况要求与约束；设计自适应跟踪控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出。该控制器可以在未知吊车台车负载质量、吊绳长度、摩擦等阻力参数时，较好地跟踪设定运动曲线，最终使误差、摆角和控制力全程保持在较小范围内，并最终收敛至0。可见，本发明轨迹规划与自适应跟踪控制方法的优越性。(51)Int.Cl.(19)中华人民共和国国家知识产权局(12)发明专利申请权利要求书 1 页说明书 7 页附图 3。

3、页CN 102030265 A 1/1页21.一种基于运动规划的桥式吊车自适应控制方法，其特征在于该方法包括：第一、台车运动规划为吊车台车设计一条期望的位置一时间曲线，如果台车沿其运动，可使台车快速到达目标位置，而负载摆角也在一个可以接受的范围内；为此，将位置-时间曲线设计为单向平滑的S形曲线，即：其中pd为台车所要达到的目标位置(起始位置为0位置)，kv、ka分别为允许的台车最大速度与加速度，为调整曲线形状的相关参数；该曲线所设计的台车位移xd(t)、速度加速度均为光滑连续曲线，且比现有的指令曲线有更好的摆角抑制能力；第二、自适应跟踪控制器的设计对于实际应用情况，当负载质量、吊绳长度、摩擦。

4、阻力未知时，为使台车跟踪以上曲线，设计了一种自适应控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出，控制电机与执行器提供相应输出力，带动台车运动，完成运动曲线的跟踪，并适应未知参数，该控制器具体形式如下：其中r(t)x(t)-xd(t)为台车现有位置与运动规划曲线的误差，而为该误差导数；为控制器中的PD控制项，而为参数适应项，其中：fr0xfr0xwrxkrx+dx+dfdfl mx+mT为位置参数向量，而为未知适应项系数；n(t)YT为控制器设计时所需适应的未知参数式，为吊车各部分质量mx与m、吊绳长度l、摩擦阻力fr0x及其阻力因数krx、dx、df与wrx的线性组合。

5、项；我们对其中的未知参数项进行在线估计，参数更新律如下：其中为一正定对称阵，而对进行在线积分即可得到的估计值。权利要求书CN 102030263 ACN 102030265 A 1/7页3基于运动规划的桥式吊车自适应控制方法技术领域0001 本发明属于非线性欠驱动系统自动控制的技术领域，特别是涉及一种基于运动规划的桥式吊车自适应控制方法。背景技术0002 桥式吊车是一种十分常见的装配运输工具，它利用绳索将负载与吊车上的台车相连，并通过台车的运动来将负载运送到指定的位置，桥式吊车在港口、仓库、建筑工地等场所得到了广泛的应用。0003 桥式吊车在运行时，吊车上台车的运动会引起负载的摆动，使。

6、得负载可能会和周围的操作工人或者是其它物体发生碰撞，致使负载损坏，甚至导致发生人员伤亡事故，尤其是当台车到达指定位置停止运行后，吊车所悬挂的负载会发生比较强烈的残余摆动，这样不仅会带来较大的安全隐患，同时也严重影响了吊车的工作效率。因此，为了有效避免安全隐患，提高吊车的工作效率，在操作吊车时，一方面需要实现台车的快速准确定位，以满足准确运送负载的要求；另一方面，需要有效地抑制负载的摆动，实现负载的“无摆”或者“微摆”操作。特别是当台车到达指定位置时，负载必须很快地停止摆动，以期提高吊车的工作效率。0004 目前，为了满足台车的快速准确定位和有效地抑制负载的摆动这两方面的吊车操作要求，一般是通过。

7、有经验的工人操纵吊车来实现，具体在操作过程中，工人需要利用他们的经验并通过其眼睛的观测来估计台车的位置与摆角大小，然后选择合理的动作序列来有效抑制负载的摆动，并尽快将它运送到指定的位置，所以一个工人只有在具备多年吊车操作经验，并且掌握娴熟的吊车操作技巧之后，才能利用吊车快速地将负载运送到指定的位置，并有效地抑制负载的摆动。0005 虽然国内外自动化领域的许多学者针对桥式吊车系统开展了大量研究，针对这种欠驱动系统提出了多种不同的控制方法，力图实现桥式吊车的安全、高效运输，但是目前还没有开发出一种方便、可靠的桥式吊车自动控制系统或方法。0006 且在已有的控制算法中，又缺乏对未知参数的适应能力。而。

8、随任务和状态不同导致的未知参数的变化对各控制算法均有较大影响，很大程度上局限了控制器的功能实现和实用化。发明内容0007 本发明目的是克服现有技术存在的上述不足，提供一种基于运动规划的桥式吊车自适应控制方法。0008 一、系统模型0009 对于2D桥式吊车系统，如图1所示，其动力学模型用拉格朗日方程表述为：0010 说明书CN 102030263 ACN 102030265 A 2/7页40011 0012 0013 G(q)0 mglSxT0014 U(t)fx0T0015 0016 其中qx xT代表系统状态向量，包括台车位置x与负载摆角x，U(t)为控制输入力向量，其中fx为对台车牵。

9、引力。M(q)、与G(q)分别为惯量矩阵、科氏-向心力矩阵与重力向量。而Fd(t)代表摩擦阻力向量，两分量为在广义坐标下的摩擦力分量，包含台车轨道与台车之间摩擦与空气阻尼等。其中，对其主要作用的台车-轨道间摩擦机型如下建模：0017 0018 该模型可有效描述静摩擦、动摩擦以及低速时的stribeck现象，同时在速度为零时的近似兼顾控制器设计时的连续要求。同时在各矩阵与向量中普遍存在台车质量mx、负载质量m及吊绳长度l等未知参数。当参数未知时，控制器无法对模型进行精确地补偿，从而降低控制精度，甚至影响系统稳定性，即吊车台车不能达到目标位置并使负载摆角收敛至0。0019 二、控制算法0020 如。

10、前所述，桥式吊车是一类欠驱动系统，所以难以兼顾台车快速运动，而同时使负载摆角的快速抑制。以上两指标需要相互协调达到整个系统的最优。在台车运行时，一类通用的方法为根据负载的摆动情况及时调节台车速度或加速度。而现有调整过程一般基于经验，这就导致了运输效率的低下与操作失败的风险性加大。为此，本发明提出了一种两步控制策略：运动规划与自适应跟踪。0021 本发明提供的基于运动规划的桥式吊车自适应控制方法基于运动规划的桥式吊车自适应控制方法，包括：0022 第一、制定运动规划0023 为吊车台车设计一条期望的运动位置时间曲线，如果台车沿其运动，可使台车相对快速到达目标位置，而负载摆角也在一个较小的可以接受。

11、的范围内；为此，将台车位移时间曲线设计为单向平滑的S形曲线，即：0024 0025 0026 0027 其中pd为台车所要达到的目标位置(起始位置为0位置)，kv、ka分别为规划的台说明书CN 102030263 ACN 102030265 A 3/7页5车最大速度与加速度，为调整曲线形状的相关参数。0028 该曲线所设计的台车位移xd(t)、速度加速度均为光滑连续曲线，且比一般现有的指令曲线有更好的摆角抑制能力，其光滑连续性又为控制器的设计提供了便利；0029 第二、自适应跟踪控制器的设计0030 对于实际应用情况，当某些实验参数(吊车台车负载质量、吊绳长度、摩擦等阻力)未知时，为使台车。

12、较好的实现对以上设计曲线的跟踪，设计了一种控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出，控制电机等执行器提供相应输出力，带动台车运动，完成运动曲线的跟踪，该控制器具体形式为：0031 0032 其中0033 r(t)x(t)-xd(t)0034 为台车现有位置与同时刻运动规划中运动位置时间曲线中的轨迹位置间的误差，而为误差导数，为控制器中的PD控制项，而为参数适应项。其中：0035 fr0xfr0xwrxkrx+dx+dfdfl mx+mT0036 为未知参数向量，而0037 0038 为未知适应项系数；0039 n(t)YT0040 0041 0042 为控制器设计。

13、时所需适应的未知参数式。0043 我们对其中的未知参数项进行估计，有参数更新率：0044 0045 其中为一正定对称阵，而对进行在线积分可得到的估计值代入上述控制器。0046 三、控制器稳定性证明0047 该部分从理论上说明了控制器的作用和参数适应功能，即在存在未知参数时，台车位置误差与负载摆角误差在控制器左右下随时间可趋于0：0048 0049 首先，定义系统能量函数：0050 0051 其对时间的导数为0052 0053 由不等式说明书CN 102030263 ACN 102030265 A 4/7页60054 0055 可得0056 0057 即0058 由于所设计轨迹的有界性：00。

14、59 0060 可知以下变量的有界性：0061 0062 0063 同时由于0064 0065 可得0066 0067 所以由barbalat引理可得0068 0069 又0070 0071 于是0072 0073 台车加速度可写为：0074 0075 其中0076 0077 0078 由以上分析，可得：0079 说明书CN 102030263 ACN 102030265 A 5/7页70080 应用barbalat扩展引理可得0081 0082 对摆角的分析：0083 由摆角动力学方程可得0084 0085 由以上分析有0086 与0087 有0088 0089 同时0090 0091 。

15、证明完成。0092 本发明的优点和积极效果：0093 本发明基于工程实际需要，将自适应控制方法应用于具体被控对象桥式吊车负载的水平运输控制上。针对可能随任务、工作环境等变化的参数吊绳长度、负载及台车质量、相应各部分摩擦力水平等参数进行自适应，即克服未知参数的影响，将负载运至目标位置，并使摆角收敛至0。对设计的以上算法，经过理论证明稳定性，从理论上表明了控制器的可靠性。同时经过试验平台的验证进一步说明了改控制器可较好地完成上述控制要求。0094 考虑到各国现有吊车的控制基本均由人工进行操纵，研究该方向的自动控制方法无疑对安全、效率、精确性的提升有较大帮助，同时针对实际操作中位置参数的适应，进一步。

16、加强了自动控制算法的实用性，具有明显的优点与积极效果。附图说明0095 图1是现有技术中2D桥式吊车系统示意图。0096 图2是实验平台示意图。0097 图3是试验1结果图。0098 图4是试验2结果图。0099 图5是试验3结果图。0100 图中，1-台车，2-桥架，3-负载，4-台车，5-卷轴，6-桥架，7-轨道，8-负载。具体实施方式0101 实施例1：0102 第一、制定运动规划0103 目的是为台车设计一条期望的运动位置时间曲线，如果台车沿其运动，可使台车相对快速到达目标位置，而负载摆角也在一个较小的可以接受的范围内。为此，本发明将台说明书CN 102030263 ACN 102。

17、030265 A 6/7页8车位移时间曲线设计为单向平滑的S形曲线，即：0104 0105 0106 0107 该曲线所设计的台车位移xd(t)、速度加速度均为光滑连续曲线。且比一般现有的指令曲线有更好的摆角抑制能力。同时，针对不同情况与需求可调整其中参数。使其运输最大速度、加速性能满足实际工况要求与约束。0108 第二、自适应跟踪控制器的设计0109 对于实际应用情况，为使台车较好的实现对以上设计曲线的跟踪，本发明设计了一种控制器，通过在线实时测量台车位置、速度与负载摆角、角速度，得到控制输出，使电机等执行器提供相应输出力，带动台车运动，完成运动曲线的跟踪。而对于一般控制器而言，台车本身质量。

18、、所运输负载质量、吊绳长度以及台车与轨道之间的摩擦力中的某些参数是控制器设计的必需参数，而本发明的控制器可以在以上参数未知时提供较好的控制输出，即具有相应的自适应能力。0110 该控制器具体形式为：0111 0112 其中0113 r(t)x(t)-xd(t)0114 为台车现有位置与同时刻运动规划中运动位置时间曲线中的轨迹位置见的误差。而为误差导数，0115 0116 为控制器中的PD控制项。而为参数适应项。其中：0117 fr0xfr0xwrxdrx+dx+dfdflmx+mT0118 为未知参数向量，而0119 0120 为未知适应项系数。0121 n(t)YT0122 0123 012。

19、4 为控制其设计时所需适应的未知参数式。0125 本发明对其中的位置参数项进行估计，有参数更新率：0126 0127 其中为一正定对称阵，而对进行在线积分可得到的估计值代入上述控制器。完成控制器的求解过程。0128 四、实验效果描述说明书CN 102030263 ACN 102030265 A 7/7页90129 为验证说明上述控制器的有效性，本发明在桥式吊车模拟机械平台进行了实际实验验证，见图2。0130 其控制器与系统参数为：0131 kv0.4，ka0.15，2.20132 kp200，kd50，2I50133 三组实验参数(负载质量、吊绳长度)为：0134 1.l0.60m，m1.。

20、025kg0135 2.l0.80m，m1.025kg0136 3.l0.75m，m2.025kg0137 实验效果依次为附图3至图5所示，0138 图3为试验1结果图，由该图说明控制器在条件l0.60m，m1.025kg下的台车位置曲线跟踪情况(实现为台车实际未知变化，虚线为规划的轨迹)及负载摆角变化关系，以及控制器输出的力指令曲线，均有较好的性能，即台车较好跟踪了规划的轨迹，同时保证摆角的收敛，同时整个过程中力指令始终在合理的范围内。0139 图4为试验2结果图，由该图说明控制器在条件l0.80m，m1.025kg下的台车位置曲线跟踪情况(实现为台车实际未知变化，虚线为规划的轨迹)及负载摆。

21、角变化关系，以及控制器输出的力指令曲线，均有较好的性能，即台车较好跟踪了规划的轨迹，同时保证摆角的收敛，同时整个过程中力指令始终在合理的范围内。0140 图5为试验3结果图，由该图说明控制器在条件l0.75m，m2.025kg下的台车位置曲线跟踪情况(实现为台车实际未知变化，虚线为规划的轨迹)及负载摆角变化关系，以及控制器输出的力指令曲线，均有较好的性能，即台车较好跟踪了规划的轨迹，同时保证摆角的收敛，同时整个过程中力指令始终在合理的范围内。0141 综合以上三组实验结果可以看出，对不同的负载质量、吊绳长度，和相应不同的摩擦力水平，控制器均可对其进行适应，从而较好跟踪设定运动曲线(虚线)，且最终误差很小，而摆角也全程保持在较小范围内，最终收敛至0，控制力也全程保持在较小范围内。0142 可见，实验体现了本发明控制方法的优越性。说明书CN 102030263 ACN 102030265 A 1/3页10图1图2说明书附图CN 102030263 A。

展开阅读全文