一种用于机器人同步控制的交叉耦合控制方法技术

本发明专利技术涉及一种用于机器人同步控制的交叉耦合控制方法，包括以下步骤：构建用于耦合机器人各关节误差的同步误差模型；将同步误差模型带入控制器，通过控制器控制机器人各关节动作。本发明专利技术可有效改善跟踪误差极值对整体系统影响大的问题，提高控制策略的鲁棒性，保障各关节跟踪精度，实现多关节机器人的同步控制，降低机器人末端精度不准导致的风险，提高多关节机器人产品运行安全性。多关节机器人产品运行安全性。多关节机器人产品运行安全性。

【技术实现步骤摘要】
一种用于机器人同步控制的交叉耦合控制方法


[0001]本专利技术属于机器人控制策略领域，具体地说是一种用于机器人同步控制的交叉耦合控制策略。

技术介绍

[0002]目前已有的机器人同步控制技术中，包括传统的机械式同步、早期非交叉耦合型控制策略和目前使用较多的交叉耦合型控制策略。机械式同步方式主要通过机械结构的改变进而实现对执行机构的同步控制，由于机械结构长期运作导致的磨损，以及机械结构间不可避免的装配误差等因素，都会影响整个系统的同步性能；非交叉耦合型控制策略的控制系统中各关节不存在关联，互不影响，在单个关节层面是闭环控制，但从整体系统层面实属开环控制，在这种控制策略下，当某一关节受到外界干扰，输出存在变化时，其他关节并不会因此影响而做出改变，从而导致最终误差产生，同步控制性能较差。
[0003]目前使用的交叉耦合型控制策略，解决了非交叉耦合控制策略中的开环问题，但存在以下问题：在控制系统中，各关节的信号反馈补偿，一方面来自于本关节的跟踪误差，另一方面来自于同其他关节间的同步误差，同步误差有两种方式，速度偏差和以各关节间的跟踪误差差值进行变换作为的补偿。以速度偏差作为的补偿只适用于输入信号相同的前提下，例如主从控制机械手，多机器人作业控制等，每类对应关节输入信号相同，这是宏观的、多机器人中的机器人同步控制，但当控制对象缩小到单机器人并且各关节输入信号不同时，例如六自由度机械臂，各关节间的速度偏差极大，这类控制策略不存在实际意义；以各关节间的跟踪误差差值进行变换得到的补偿计算量大，没有考虑跟踪误差极值对整体系统的影响，鲁棒性差，例如最大偏差耦合控制、加权耦合型同步控制策略。在机器人运动过程中，各关节之间的不同步，将最终导致末端工具的位姿发生偏差，影响工作质量及效率。

技术实现思路

[0004]本专利技术目的是提供一种用于机器人同步控制的交叉耦合控制方法，以解决控制系统中跟踪误差极值对整体系统的影响大的问题，以提高多关节机器人控制系统中控制策略的精确性、稳定性以及策略的普遍适用性。本专利技术可通过对各关节间采用改进的交叉耦合同步控制策略，提高机器人各关节的跟踪精度，实现多关节机器人的同步控制
[0005]本专利技术为实现上述目的所采用的技术方案是：一种用于机器人同步控制的交叉耦合控制方法，包括以下步骤：
[0006]构建用于耦合机器人各关节误差的同步误差模型；
[0007]将同步误差模型带入控制器，通过控制器控制机器人各关节动作。
[0008]所述同步误差模型如下：
[0009][0010][0011]其中，ε
i
为第i关节的同步误差，e
i
为第i关节的跟踪误差，λ
ij
为第i关节与第j关节间的影响权值，为所有关节跟踪误差的均值，n为关节数量，i、j＝1
…
n。
[0012]各关节的同步误差中，包含各关节的跟踪误差、关节间的跟踪误差差值以及所有关节跟踪误差的均值、极值。
[0013]所述控制器采用滑膜控制算法。
[0014]所述控制器输出如下：
[0015][0016]其中，u
i
(t)控制器输出，为期望关节角速度，为正常数，ε
i
(t)为第i关节的同步误差，c
i
为正常数，为第i关节总误差导数，t表示时间，n为关节数量；
[0017][0018]其中，e
i
为第i关节的跟踪误差。
[0019]本专利技术具有以下有益效果及优点：
[0020]1.本专利技术引入的同步误差结构，具备稳定性，适用于多关节不同的输入信号，具有普遍性，另外，将极值和平均值也耦合到其中，解决了跟踪误差极值对整体系统的影响大的问题。
[0021]2.本专利技术可有效改善跟踪误差极值对整体系统影响大的问题，提高控制策略的鲁棒性，保障各关节跟踪精度，实现多关节机器人的同步控制，降低机器人末端精度不准导致的风险，提高多关节机器人产品运行安全性。
附图说明
[0022]图1交叉耦合控制策略下的关节1同步误差结构示意图；
[0023]图2交叉耦合控制策略下的三关节机器人无干扰控制系统搭建图；
[0024]图3阶跃干扰模块图；
[0025]图4基于交叉耦合控制策略的三关节机器人不同信号下的有干扰仿真输出图；
[0026]图5基于交叉耦合控制策略的三关节机器人不同信号下的有干扰仿真误差分析图。
具体实施方式
[0027]下面结合附图及实施例对本专利技术做进一步的详细说明。
[0028]本专利技术针对现有同步控制策略存在的问题，首先采用了以各关节间的跟踪误差差值进行的变换作为同步误差，当输入信号不同时，同步误差耦合的只是各关节的跟踪误差差值，并不会因为各路信号不同而造成较大幅度的改变，从而降低对系统的影响；其次，本专利技术采用加权方法来表征每个关节跟踪误差的影响，另一方面将极值和平均值也耦合到其中，来解决跟踪误差极值对整体系统的影响大，鲁棒性差的问题。因此，多关节机器人各关节的同步误差表达式如下所示：
[0029][0030]其中：
[0031][0032]ε
i
：第i关节的同步误差；e
i
:第i关节的跟踪误差；λ
ij
：关节间的影响权值；n:关节数量；e表示所有的跟踪误差。
[0033]各关节的同步误差中，包含了本关节的跟踪误差、关节间的跟踪误差差值以及所有关节跟踪误差的均值、极值。
[0034]当系统满足e1(t)＝e2(t)＝
…
＝e
n
(t)
→
0时，同步误差ε(t)
→
0，可以达到系统的同步控制。为提高多关节系统的同步控制性能，有效的控制多关节系统，关键应考虑控制关节的跟踪误差和同步误差。多关节系统的总误差表达式如式2所示：
[0035][0036]式中：为正常数。
[0037]因此，设计控制函数u
i
(t)如式(3)所示：
[0038][0039]其中，u
i
(t)控制器输出，为期望关节角速度，为正常数，ε
i
(t)为第i关节的同步误差，c
i
为正常数，为第i关节总误差导数，t表示时间，n为关节数量；
[0040]式中：c
i
为正常数，由式(3)定义以下向量：
[0041][0042]其中，为关节角速度。
[0043]应用滑模控制原理，应设计控制力矩使得s
i
(t)＝0，处于滑动面上；通过齐次方程通解特性可知，当s
i
(t)处于滑动面时，系统总误差e
i*
(t)将以指数速率向零靠近。在得到系统的闭环控制方程后，选取Lyapunov函数如下：
[0044][0045]式中：V(t)表示选取的Lyapunov函数，M
i
、本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于机器人同步控制的交叉耦合控制方法，其特征在于，包括以下步骤：构建用于耦合机器人各关节误差的同步误差模型；将同步误差模型带入控制器，通过控制器控制机器人各关节动作。2.根据权利要求1所述的一种用于机器人同步控制的交叉耦合控制方法，其特征在于，所述同步误差模型如下：所述同步误差模型如下：其中，ε
i
为第i关节的同步误差，e
i
为第i关节的跟踪误差，λ
ij
为第i关节与第j关节间的影响权值，为所有关节跟踪误差的均值，n为关节数量，i、j＝1
…
n。3.根据权利要求1所述的一种用于机器人同步控制的交叉耦合控制方法...

【专利技术属性】
技术研发人员：贾凯，曹原，刘明敏，杜振军，唐忠华，
申请(专利权)人：沈阳新松机器人自动化股份有限公司，
类型：发明
国别省市：