带性能和状态约束的关节型机器人末端轨迹控制方法.pdf

《带性能和状态约束的关节型机器人末端轨迹控制方法.pdf》由会员分享，可在线阅读，更多相关《带性能和状态约束的关节型机器人末端轨迹控制方法.pdf（24页完成版）》请在专利查询网上搜索。

1、(19)中华人民共和国国家知识产权局 (12)发明专利申请 (10)申请公布号 (43)申请公布日 (21)申请号 201910435568.9 (22)申请日 2019.05.23 (71)申请人 重庆大学 地址 400030 重庆市沙坪坝区沙正街174号 (72)发明人 沈志熙宋永端张天凤谭炼 于爽爽 (74)专利代理机构 重庆信航知识产权代理有限 公司 50218 代理人 吴彬 (51)Int.Cl. B25J 9/16(2006.01) (54)发明名称 带性能和状态约束的关节型机器人末端轨 迹控制方法 (57)摘要 本发明公开了一种带性能和状态约束的关 节型机器人末端轨迹控制方法， 。

2、包括步骤： 1)建 立关节型机器人的动力学模型， 2)设定对机器人 的位置跟踪误差， 3)基于预定性能带对跟踪误差 进行变换， 4)设计考虑性能及全状态约束的跟踪 控制器， 并通过设计的控制器控制关节机器人系 统。 本发明能解决关节机器人在存在末端执行器 故障、 末端位置及移动速度约束的情况下， 控制 关节型机器人末端位置和速度的跟踪误差都能 以指数收敛到极小残差集的技术问题， 并且其引 入了切换控制方案， 保证了整个控制器的连续 性， 避免了控制器在切换点发生跳跃导致执行器 在运行过程中发生切换振荡的问题。 权利要求书4页 说明书12页 附图7页 CN 110142766 A 2019.08。

3、.20 CN 110142766 A 1.带性能和状态约束的关节型机器人末端轨迹控制方法， 其特征在于： 包括以下步骤： 1)建立关节型机器人的动力学模型如下： 上式中：是惯性矩阵，是离心力矩阵，是重力向量， 是静态或者动态摩擦向量，是外界未知干扰，是执行器实际 输入向量； 是机械臂各关节的旋转角度，是机械臂各 关节的移动角速度，是机械臂各关节的移动角加速度， 由于机械臂的 物理结构和性能指标限制， 各关节的角度以及角速度都需要满足如下限制： |q|c1， 其中c1和c2是机械臂关节角度和角速度所能达到的最大极限值； 其中： Ua (t)U+Ur(t) 上式中， ()diag 1(), 2()。

4、,., n()是个对角矩阵， 每个元素满足0 i ()1； Ur()表示在各关节执行器运行中所有的不可控部分， U是执行器的理想输入转 矩； 虽然执行器的容错参数 ()和Ur()具有未知性， 时变性和不可预知性， 但是满足有 界性： 0 n i() m1,0|Ur()|urm， 其中 n, m,urm均是已知常数； 将式(1)所示的动力学模型变为如下等式： 上式中， 控制输入信号UU1,U2,.,UnT， 将系统模型重新整理为 控制系统的控制增益A(q,t)H-1(q) (t)，则代表了控制系统中所有的不确 定因素的集合， 其数学表达式为： 函数的幅值只 与q(t)和有关； 2)设定对机器人的。

5、位置跟踪误差为eq-qd， 速度跟踪误差为其中qdqd1, qd2,.,qdnT，为期望轨迹； 理想轨迹qd(t)为设定的已知轨迹， 因此其 导数和也为已知， 且|qd(t)|d1c1，c1， c2是机械臂的关节角度 和角速度极限值， d1， d2是小于极限值的已知常数； 权利要求书 1/4 页 2 CN 110142766 A 2 3)基于预定性能带技术对跟踪误差进行变换， 具体如下： 引入中间误差变量 ， 定义为 其中 0是一个正常数； 则e, 到 , 的传递函数为 e, 到 , 均是有界输入有界输出稳定； 定 义 性 能 函 数 f ( t - ta) ， 该 函 数 满 足 条 件 ：。

6、 1 ) f ( t - ta) 严 格 递 减 ； 2 ) ta是指初始时间点； i(t)满足: 则能保证轨迹跟踪误差的收敛状态； 其中 和是大于0的预定性能界限常数， 性能函数 f(t-ta)为 f()代表了在稳定状态时跟踪误差 i(t)的最大允许值， f(t-ta)则表示了误差收敛速 度的最低界限，和 f(ta)分别表示了跟踪误差的正、 负超调量； 将原系统的误差 i(t)转换为受性能限制的新误差 i(t)， 转换误差 (t) 1, 2, i, nT， n就是指列向量 的第n个元素， 转换关系如下 i(t)f(t-ta)( i) (7) 上式中， 函数()满足光滑性和严格递增性， 且： 。

7、(ta)0； 函数()定义为： 4)设计考虑性能及全状态约束的跟踪控制器， 并通过设计的控制器控制关节机器人系 统， 具体如下： 第一步： 定义控制器的切换范围如下： 上述切换范围定义中是系统中可测的状态向量， 1, 2,., nT是 与切换范围相关的参数， Cl表示集合关闭， ta是当所有的i1,2,.,n均满足不等式 时的时间点， 也就是说对于任意时间tta， 集合(t)是期望值qd,的 权利要求书 2/4 页 3 CN 110142766 A 3 一个紧集， 即该集合内的状态实际值与期望值之差ei, 为有限值； 以范围Dn2将关节机器人控制器分成两个部分， 当时使用监督控制器控制关节 机。

8、器人系统， 当xDn2则切换为基于预定性能带技术的自适应控制器控制机器人系统. 第二步： 设计软连接器在切换点处连接切换前后的执行器输入信号， 以保证执行器在 切换点处动作的连续性， 软连软连接器用公式表示为： 上式中为控制器输入信号向量的第i个元素， Ui1(ta-tm)为切换点前一刻的控制输入 信号， Ui2(ta)为切换点时刻的控制输入信号， ta为切换点时间， tm为系统控制间隔时间； 第三步： 设计监督控制器， 通过监督控制器在时控制关节机器人系统， 具体如 下： 由于误差eq-qd， 引入作为中间变量出现在控制器中， e和 的 导数分别表示为： 以式(3)考虑了全状态约束以及执行器。

9、故障的多自由度关节型机器人系统为控制对 象， 当时， 监督控制器U定义为 U-k1 -Fu (11) 上式中控制系数k10， 当时， 能实现跟踪误差e, 的一致有界性， 并且保证在 时间tta,0ta时， 满足xDn2； Fu定义为 是已知函数，c2 是关节角速度的极限值， d2是理想关节角速度的极限值， l1c1-d1， c1是关节角度的极限值， d1是理想关节角度的极限值； 是未知参数a1的估计值， 通过以下式子更新 其中 10是由设计者给定的参数； 第四步， 设计基于预定性能带技术的自适应控制器， 通过基于预定性能带技术的自适 应控制器在xDn2时控制关节机器人系统， 具体如下： 选择切。

10、换范围Dn2| i(t)| i， 性能函数参数与切换范围之间需要满足如下不等式 i满足不等式 当xDn2时， 基于预定性能带技术的自适应控制器设置为： 权利要求书 3/4 页 4 CN 110142766 A 4 其中为软连接器， 软连接器用于 防止控制器在切换点处发生切换振荡， ui是输入信号矩阵uu1,.,unT的元素， i1, 2,.,n； 控制器ui的定义为： 其中， 是未知参数bi的估计值， 通过以下式子更新 上式中20是由设计者给定的参数，其中， 函数 i()是由设计 者给出的已知函数， 满足有界光滑性， 取为 n0， 在函数F2()中，为已知函数， 是由设计者给定的正常数， r 。

11、diagr1,.,rn,mdiagm1,.,mn， 权利要求书 4/4 页 5 CN 110142766 A 5 带性能和状态约束的关节型机器人末端轨迹控制方法 技术领域 0001 本发明涉及机器人控制技术领域， 特别涉及一种关节型机器人的末端轨迹控制方 法。 背景技术 0002 自从世界第一台机器人-Unimate映入人类眼帘开始， 机器人的发展就势如破竹， 目前已经被广泛应用于家务， 工业以及军事等领域。 随着机器人应用领域的不断扩展化， 先 进的控制方法在其产品的迭代中起到重要作用， 现有技术中采用了各种自适应控制方法来 克服机器人系统在实际控制过程中遇到的各种不可控问题。 但是， 现有。

12、的控制方法都忽略 了控制系统中存在的约束条件(包括执行器的物理约束， 轨迹跟踪过程的性能约束等系统 在实际运行中存在的并且必须考虑的约束条件)。 值得注意的是， 如果物理系统的约束条件 得不到满足， 除了会导致系统性能的严重下降， 作业失败以外， 还有可能造成系统的宕机以 及机器人本身结构的不定程度损坏等等问题。 因此， 在机器人控制系统的研究中考虑系统 中存在的约束条件(即， 轨迹跟踪过程的瞬态性能约束， 状态约束， .)已经成为近年来 控制领域的研究焦点。 0003 为了解决机械臂执行器的物理约束问题， 目前已经取得了一些成就， 可以较好的 解决系统中考虑位置或者速度约束时控制器的设计难点。

13、， 但遗憾的是， 机器人的实际应用 场景中， 往往需要同时考虑位置和速度的约束即控制器设计中需要考虑系统的全状态约 束。 0004 除了机器人的运动约束外， 在其长期的运行中， 执行器发生未知故障也是不可避 免的。 值得注意的是， 极少有文献在满足全状态约束的前提下保证执行器故障时的系统稳 定性。 因此， 需要通过构造一个自适应容错控制策略， 以确保机械臂执行器在发生未知故障 时， 依然能够在满足约束条件的前提下稳定运行。 0005 并且， 虽然现有技术中对控制系统的性能约束问题提出了有效的解决方案， 但这 些方案都是建立在PPB技术的基础之上。 PPB技术可以保证系统在轨迹跟踪过程中， 跟踪。

14、误 差按照给定边界收敛， 也是最有效的性能约束技术， 但是该技术存在的不足就是初始误差 需要满足边界初始条件， 而现有技术中涉及PPB算法的控制方案均对该条件做了直接或者 间接的假设， 然而预设条件可能导致该理论在实际系统中不适用。 发明内容 0006 有鉴于此， 本发明的目的是提供一种带性能和状态约束的关节型机器人末端轨迹 控制方法， 以解决存在末端执行器故障、 末端位置及移动速度约束的情况下， 控制关节型机 器人末端位置和速度的跟踪误差都能以指数收敛到极小残差集的的技术问题。 0007 本发明带性能和状态约束的关节型机器人末端轨迹控制方法， 包括以下步骤： 0008 1)建立关节型机器人的。

15、动力学模型如下： 说明书 1/12 页 6 CN 110142766 A 6 0009 0010上式中：是惯性矩阵，是离心力矩阵，是重力 向量，是静态或者动态摩擦向量，是外界未知干扰，是执行器 实际输入向量； 0011是机械臂各关节的旋转角度，是机械 臂各关节的移动角速度，是机械臂各关节的移动角加速度， 由于机械 臂的物理结构和性能指标限制， 各关节的角度以及角速度都需要满足如下限制： |q| c1，其中c1和c2是机械臂关节角度和角速度所能达到的最大极限值； 0012 其中： 0013 Ua (t)U+Ur(t) 0014 上式中， ()diag 1(), 2(),., n()是个对角矩阵，。

16、 每个元素满足0 i()1； Ur()表示在各关节执行器运行中所有的不可控部分， U是执行器的理想输入 转矩； 虽然执行器的容错参数 ()和Ur()具有未知性， 时变性和不可预知性， 但是满足 有界性： 0 n i() m1,0|Ur()|urm， 其中 n, m,urm均是已知常数； 0015 将式(1)所示的动力学模型变为如下等式： 0016 0017 上式中， 控制输入信号UU1,U2,.,UnT， 将系统模型重新整理为 0018 0019控制系统的控制增益A(q,t)H-1(q) (t)，则代表了控制系统中所有的 不确定因素的集合， 其数学表达式为： 函数的幅值只 与q(t)和有关； 。

17、00202)设定对机器人的位置跟踪误差为eq-qd， 速度跟踪误差为其中qd qd1,qd2,.,qdnT，为期望轨迹； 理想轨迹qd(t)为设定的已知轨迹， 因 此其导数和也为已知， 且|qd(t)|d1c1，c1， c2是机械臂的关节 角度和角速度极限值， d1， d2是小于极限值的已知常数； 0021 3)基于预定性能带技术对跟踪误差进行变换， 具体如下： 0022 引入中间误差变量 ， 定义为 说明书 2/12 页 7 CN 110142766 A 7 0023 0024其中 0是一个正常数； 则到的传递函数为 0025 0026到均是有界输入有界输出稳定， 因 i(t)有界， 则ei。

18、和也均有界； 因 i(t) 满足指数衰减趋向于0， 则ei和也以同样的衰减速度趋于0； 由此将 i(t)预定义于给定性 能界限之内， 则ei和 也将具有相同的性质， 这样便将同时保证机械臂末端执行器对于理想 位置轨迹和速度轨迹的跟踪性能目标转换为保证中间变量 i(t)以指数形式收敛； 0027 定 义 性能 函 数f (t- ta) ， 该 函 数 满足 条 件 ： 1) f (t- ta) 严 格 递 减 ； 2) ta是指初始时间点； 0028 i(t)满足: 0029 0030则能保证轨迹跟踪误差的收敛状态； 其中 和是大于0的预定性能界限常数， 性 能函数f(t-ta)为 0031 f。

19、()代表了在稳定状态时跟踪误差 i(t)的最大允许值， f(t-ta)则表示了误差收 敛速度的最低界限，和 f(ta)分别表示了跟踪误差的正、 负超调量； 0032 将原系统的误差 i(t)转换为受性能限制的新误差 i(t)， 转换误差 (t) 1, 2, i, nT，n就是指列向量 的第n个元素， 转换关系如下 0033 i(t)f(t-ta)( i) (7) 0034上式中， 函数()满足光滑性和严格递增性， 且： (ta)0； 函数()定义为： 0035 0036 4)设计考虑性能及全状态约束的跟踪控制器， 并通过设计的控制器控制关节机器 人系统， 具体如下： 0037 第一步： 定义控。

20、制器的切换范围如下： 0038 0039上述切换范围定义中是系统中可测的状态向量， 1, 2,., nT是与切换范围相关的参数， Cl表示集合关闭， ta是当所有的i1,2,.,n均满足不等式 说明书 3/12 页 8 CN 110142766 A 8 时的时间点， 也就是说对于任意时间tta， 集合(t)是期望值的 一个紧集， 即该集合内的状态实际值与期望值之差为有限值； 0040以范围Dn2将关节机器人控制器分成两个部分， 当时使用监督控制器控制 关节机器人系统， 当xDn2则切换为基于预定性能带技术的自适应控制器控制机器人系 统； 0041 第二步： 设计软连接器在切换点处连接切换前后的。

21、执行器输入信号， 以保证执行 器在切换点处动作的连续性， 软连接器用公式表示为： 0042 0043上式中为控制器输入信号向量的第i个元素， Ui1(ta-tm)为切换点前一刻的控制 输入信号， Ui2(ta)为切换点时刻的控制输入信号， ta为切换点时间， tm为系统控制间隔时间； 0044第三步： 设计监督控制器， 通过监督控制器在时控制关节机器人系统， 具 体如下： 0045由于误差eq-qd， 引入作为中间变量出现在控制器中， e 和 的导数分别表示为： 0046 以式(3)考虑了全状态约束以及执行器故障的多自由度关节型机器人系统为控制 对象， 当时， 监督控制器U定义为 0047 U。

22、-k1 -Fu (11) 0048上式中控制系数k10， 当时， 能实现跟踪误差的一致有界性， 并且保证 在时间tta,0ta时， 满足xDn2； 0049 Fu定义为 0050 0051是已知函数， c2是关节角速度的极限值， d2是理想关节角速度的极限值， l1c1-d1， c1是关节角度的极限值， d1是理想关节角度的极限值； 是未知参数a1的估计值， 通过以 下式子更新 0052 0053 其中 10是由设计者给定的参数； 0054 第四步， 设计基于预定性能带技术的自适应控制器， 通过基于预定性能带技术的 自适应控制器在xDn2时控制关节机器人系统， 具体如下： 0055 选择切换范。

23、围Dn2| i(t)| i， 性能函数参数与切换范围之间需要满足如下不 等式 说明书 4/12 页 9 CN 110142766 A 9 0056 0057i满足不等式 0058 当xDn2时， 基于预定性能带技术的自适应控制器设置为： 0059 0060其中为软连接器， 软连接器 用于防止控制器在切换点处发生切换振荡， ui是输入信号矩阵uu1,.,unT的元素， i 1,2,.,n； 控制器ui的定义为： 0061 0062其中， 是未知参数bi的估计值， 通过以下式子更新 0063 0064上式中20是由设计者给定的参数，其中， 函数 i()是由 设计者给出的已知函数， 满足有界光滑性，。

24、 取为 n0， 在函数F2()中，为已知函数， 是由设计者给定的正常数， r diagr1,.,rn,mdiagm1,.,mn， 0065 本发明的有益效果： 0066 1、 本发明带性能和状态约束的关节型机器人末端轨迹控制方法， 其设计的控制器 不仅能实现控制机械臂末端执行器轨迹跟踪的UUB(最终一致稳定)目标， 而且还能实现控 制机械臂末端执行器轨迹跟踪的PPB(预定性能)目标， 从而解决了关节机器人在存在末端 执行器故障、 末端位置及移动速度约束的情况下， 控制关节型机器人末端位置和速度的跟 踪误差都能以指数收敛到极小残差集的技术问题。 0067 2、 本发明带性能和状态约束的关节型机器。

25、人末端轨迹控制方法， 为了解决PPB误 差转换技术中对初始状态的条件要求的不足， 引入了切换控制方案， 当初始误差在切换范 围之外时， 先使用监督控制器器使得误差快速收敛并保持在PPB条件之内， 以满足PPB的初 值条件， 然后启动基于预定性能带技术的自适应控制器， 保证了系统的瞬态性能要求； 并且 在切换控制器的切换点处通过设计软连接器来过渡， 保证了整个控制器的连续性， 避免了 控制器在切换点发生跳跃导致执行器在运行过程中发生切换振荡的问题。 说明书 5/12 页 10 CN 110142766 A 10 附图说明 0068 图1为三自由度关节型机器人的结构示意图， 图中q1为第一关节的转。

26、动角度， q2为 第二关节的转动角度， q3为第三关节的转动角度； 0069 图2为考虑初始误差条件的PPB技术图； 0070 图3为考虑性能约束的位置误差图； 0071 图4为未未考虑性能约束的位置误差图； 0072 图5为考虑性能约束的速度误图； 0073 图6为未考虑性能约束的速度误差图； 0074 图7为考虑性能约束的控制输入信号图； 0075 图8为未考虑性能约束的控制输入信号图； 0076 图9为考虑性能约束的中间误差变量图； 0077 图10为未考虑性能约束的中间误差变量图； 0078 图11为执行器工作效率 i()参数图； 0079 图12为执行器不可控部分Uri参数图。 具体。

27、实施方式 0080 下面结合附图和实施例对本发明作进一步描述。 0081 本实施例带性能和状态约束的关节型机器人末端轨迹控制方法， 包括以下步骤： 0082 1)建立关节型机器人的动力学模型如下： 0083 0084上式中：是惯性矩阵，是离心力矩阵，是重力 向量，是静态或者动态摩擦向量，是外界未知干扰，是执行器 实际输入向量。是机械臂各关节的旋转角度， 是机械臂各关节的移动角速度，是机械臂各关节的移动角加速度， 由 于机械臂的物理结构和性能指标限制， 各关节的角度以及角速度都需要满足如下限制： |q |c1，其中c1和c2是机械臂关节角度和角速度所能达到的最大极限值； 0085 其中： 008。

28、6 Ua (t)U+Ur(t) 0087 上式中， ()diag 1(), 2(),., n()是个对角矩阵， 每个元素满足0 i()1； Ur()表示在各关节执行器运行中所有的不可控部分， U是执行器的理想输入 转矩； 虽然执行器的容错参数 ()和Ur()具有未知性， 时变性和不可预知性， 但是满足 有界性： 0 n i() m1,0|Ur()|urm， 其中 n, m,urm均是已知常数。 0088 将式(1)所示的动力学模型变为如下等式： 说明书 6/12 页 11 CN 110142766 A 11 0089 0090 上式中， 控制输入信号UU1,U2,.,UnT， 将系统模型重新整。

29、理为 0091 0092控制系统的控制增益A(q,t)H-1(q) (t)，则代表了控制系统中所有的 不确定因素的集合， 其数学表达式为： 函数的幅值只 与q(t)和有关； 00932)设定对机器人的位置跟踪误差为eq-qd， 速度跟踪误差为其中qd qd1,qd2,.,qdnT，为期望轨迹； 理想轨迹qd(t)为设定的已知轨迹， 因 此其导数和也为已知， 且|qd(t)|d1c1，c1， c2是机械臂的关节 角度和角速度极限值， d1， d2是小于极限值的已知常数。 0094 3)基于预定性能带(PPB)技术带对跟踪误差进行变换， 具体如下： 0095 为了同时考虑系统对于跟踪位置轨迹和速度。

30、轨迹的收敛状态， 因此需要引入中间 误差变量 ， 定义为 0096 0097其中 0是一个正常数； 则到的传递函数为 0098 0099到均是有界输入有界输出稳定。 0100 定 义 性能 函 数f (t- ta) ， 该 函 数 满足 条 件 ： 1) f (t- ta) 严 格 递 减 ； 2) ta是指初始时间点。 0101 i(t)满足: 0102 0103则能保证轨迹跟踪误差的收敛状态； 其中 和是大于0的预定性能界限常数， 性 能函数f(t-ta)为 0104 f()代表了在稳定状态时跟踪误差 i(t)的最大允许值， f(t-ta)则表示了误差收 敛速度的最低界限，和 f(ta)分。

31、别表示了跟踪误差的正、 负超调量。 因此选择合适的 性能函数f(t-ta)并且设计恰当的性能界限常数可以影响系统轨迹跟踪的瞬态性能。 0105 将原系统的误差 i(t)转换为受性能限制的新误差 i(t)， 转换误差 (t) 1, 说明书 7/12 页 12 CN 110142766 A 12 2, i, nT，n就是指列向量 的第n个元素， 转换关系如下 0106 i(t)f(t-ta)( i) (7) 0107 上式中， 函数()满足光滑性和严格递增性， 且： (ta)0； 函数()定义为： 0108 0109 4)设计考虑性能及全状态约束的跟踪控制器， 并通过设计的控制器控制关节机器 人系。

32、统， 具体如下： 0110 第一步： 定义控制器的切换范围如下： 0111 0112上述切换范围定义中是系统中可测的状态向量， 1, 2,., nT是与切换范围相关的参数， Cl表示集合关闭， ta是当所有的i1,2,.,n均满足不等式 时的时间点， 也就是说对于任意时间tta， 集合(t)是期望值的 一个紧集， 即该集合内的状态实际值与期望值之差为有限值。 0113以范围Dn2将关节机器人控制器分成两个部分， 当时使用监督控制器控制 关节机器人系统， 当xDn2则切换为基于预定性能带技术的自适应控制器控制机器人系 统。 0114 第二步： 设计软连接器在切换点处连接切换前后的执行器输入信号，。

33、 以保证执行 器在切换点处动作的连续性， 软连接器用公式表示为： 0115 0116上式中为控制器输入信号向量的第i个元素， Ui1(ta-tm)为切换点前一刻的控制 输入信号， Ui2(ta)为切换点时刻的控制输入信号， ta为切换点时间， tm为系统控制间隔时间。 0117第三步： 设计监督控制器， 通过监督控制器在时控制关节机器人系统， 具 体如下： 0118由于误差eq-qd， 引入作为中间变量出现在控制器中， e 和 的导数分别表示为： 0119 以式(3)考虑了全状态约束以及执行器故障的多自由度关节型机器人系统为控制 对象， 当时， 监督控制器U定义为 0120 U-k1 -Fu 。

34、(11) 0121上式中控制系数k10， 当时， 能实现跟踪误差的一致有界性， 并且保 证在时间tta,0ta时， 满足xDn2。 说明书 8/12 页 13 CN 110142766 A 13 0122 Fu定义为 0123 0124是已知函数， c2是关节角速度的极限值， d2是理想关节角速度的极限值， l1c1-d1， c1是关节角度的极限值， d1是理想关节角度的极限值； 是未知参数a1的估计值， 通过以 下式子更新 0125 0126 其中 10是由设计者给定的参数； 0127 第四步， 设计基于预定性能带技术的自适应控制器， 通过基于预定性能带技术的 自适应控制器在xDn2时控制关。

35、节机器人系统， 具体如下： 0128 选择切换范围Dn2| i(t)| i， 性能函数参数与切换范围之间需要满足如下不 等式 0129 0130i满足不等式 0131 当xDn2时， 基于预定性能带技术的自适应控制器设置为： 0132 0133其中为软连接器， 软连接器 用于防止控制器在切换点处发生切换振荡， ui是输入信号矩阵uu1,.,unT的元素， i 1,2,.,n； 控制器ui的定义为： 0134 0135其中， 是未知参数bi的估计值， 通过以下式子更新 0136 0137上式中20是由设计者给定的参数，其中， 函数 i()是由 设计者给出的已知函数， 满足有界光滑性， 取为 n0。

36、， 在函数F2()中，为已知函数， 是由设计者给定的正常数， r 说明书 9/12 页 14 CN 110142766 A 14 diagr1,.,rn,mdiagm1,.,mn， 0138根据上述说明， 监督控制器只有在系统状态时激活， 该控制器在满足全状 态受限的条件下保证了x(t)在时间ta点时满足xDn2， 并且会确保x(t)一直收敛于集合Dn 2。 一旦x(t)满足条件xDn2， 控制器会切换至基于预定性能带技术的自适应容错控制器， 该控制器主要是满足系统的瞬态性能约束条件， 通过引入预定性能带(PPB)技术， 保证了机 械臂末端位置以及速度跟踪的误差以指数形式收敛至小残差集。 因此。

37、整个控制方案在 优化传统的单一PPB控制器对初值要求的不足的同时满足了控制目标。 0139 为了证明本实施例中所提出的控制方案的有效性和稳定性， 下面以三自由度机器 人系统模型进行仿真验证： 0140 0141上式中H(q),分别代表惯性矩阵和离心力矩阵，是重力矩 阵，代表系统中所有的不确定因素以及外界非线性未知干扰， 其中q q1,q2,q3T指代机械臂各关节位置角度， UU1,U2,U3T是系统的实际控制输入信号。 (t)为系统中执行器的执行效率， Ur(t)为控制系统执行机构中存在的不可控部分。 0142 0143 0144 0145 0146 0147 0148 0149 0150 0。

38、151 0152 说明书 10/12 页 15 CN 110142766 A 15 0153 0154 0155 G2(q)g(m1a2cos q2+m2a2cos q2+m2a3cos(q2+q3) 0156 G3(q)g(m2a3(q2+q3) 0157上式中， q为关节轴的旋转角度，为关节轴的角速度， 为关节轴的角加速度， Si sin qi,Cicos qi,Sijsin(qi+qj),Cijcos(qi+qj)， Ii为各关节轴的转动惯量， mi为关节 杆的质量， ai为关节轴的长度， i1,2,3； g为重力加速度。 0158机械臂动力学模型中系统未知量给定为： 仿真过程中， 理想。

39、轨迹给定 为： qd1qd2qd30.2+exp(-t)。 为了便于系统仿真， 系统模型中容错参数设定为： 1() 2() 3(),Ur1Ur2Ur3， 执行器故障参数设定如图11和图12所示。 0159 为了同时证明监督控制器性能以及基于预定性能带技术的自适应控制器性能， 仿 真部分需要提前设定的参数为： 1)三轴机械臂的各关节角位移以及角加速度的初始状态给 定为q1(0)q2(0)q3(0)1，2)控制器参数为： k11,k2100， 121， 1， 1230 .013； 3)控制器中涉及到的核心函数分别设定为： 4)控制系统的全状态受限参数给定为： l1 1.1,l21.3,d11.2,。

40、d21， 因此可得c1l1+d12.3， c2l2+ l1+d23.4； 5)性能函数 的参数设定为： f(0)1.1,f()0.1, 0.2。 为了更直观的展现本实施例 中控制方案的优点(考虑跟踪过程的瞬态性能、 执行器故障以及全状态受限)， 仿真部分与 没有考虑瞬态性能的控制器进行了对比实验， 具体的对比仿真效果如下图3-10所示。 0160 由图3和图5可知， 在切换时间ta之前， 机械臂的位置跟踪误差以及其速度跟踪误 差均快速衰减至有限残差集， ta之后， 位置和速度的跟踪误差均趋于0。 相比之下图4和图6 中不论是位置跟踪误差还是速度的跟踪误差均不能实现快速的收敛， 而是呈现震荡波动。

41、， 因此， 可明显得出虽然本实施例中的控制模型中考虑了全状态受限， 执行器故障等复杂因 素但是本实施例中提出的切换控制方案可以很好的实现机械臂的轨迹跟踪性能。 0161中间误差变量如图9， 由于初始值 (0)在PPB技术的有效范围之外， 所 以开始是监督控制器运行， 快速将其收敛至切换范围之后， 激活基于预定性能带技术的自 适应控制器， 控制器的两个部分协作运行保证了整个关节型机器人系统的稳态性能和瞬态 性能。 同时，(t)的指数收敛可以保证跟踪误差以相同的速度收敛， 即也 是以指数形式衰减。 未考虑瞬态性能的控制器跟踪误差和 (t)分别如图4、 图6和 图10所示， 与之相比， 本实施例中提。

42、出的控制器收敛状态具有明显优势。 0162 输入信号的仿真结果如图7所示。 根据仿真结果可得整个控制方案虽然分为两部 分， 但是软连接器的存在保证控制器在任何时间点的连续性， 避免了在切换点处发生切换 振荡的可能性。 0163 值得注意的是， 虽然执行器故障考虑在了控制模型中， 控制方案依旧可以保证整 说明书 11/12 页 16 CN 110142766 A 16 个跟踪过程的稳定性。 根据仿真结果可知机械臂系统中所有信号均有界。 0164 最后说明的是， 以上实施例仅用以说明本发明的技术方案而非限制， 尽管参照较 佳实施例对本发明进行了详细说明， 本领域的普通技术人员应当理解， 可以对本发。

43、明的技 术方案进行修改或者等同替换， 而不脱离本发明技术方案的宗旨和范围， 其均应涵盖在本 发明的权利要求范围当中。 说明书 12/12 页 17 CN 110142766 A 17 图1 图2 说明书附图 1/7 页 18 CN 110142766 A 18 图3 图4 说明书附图 2/7 页 19 CN 110142766 A 19 图5 说明书附图 3/7 页 20 CN 110142766 A 20 图6 图7 说明书附图 4/7 页 21 CN 110142766 A 21 图8 图9 说明书附图 5/7 页 22 CN 110142766 A 22 图10 说明书附图 6/7 页 23 CN 110142766 A 23 图11 图12 说明书附图 7/7 页 24 CN 110142766 A 24 。