专利名称：并联机器人的动力学协调控制系统的制作方法
技术领域：
本发明涉及一种并联机器人的动力学协调控制系统，属于运动控制系统的控制技术领域。
背景技术：
传统的工业机器人一般采用开链式结构，即基座和末端执行器之间只有一条运动链连接，对于具有这种结构的机器人，也称其为串联机器人。串联机器人具有工作空间大、操作灵活等优点，但其机械结构也使得它存在误差累积、刚度小、承载能力低等缺点，这都限制了串联机器人在实际应用中的性能。为了弥补串联机器人结构方面的不足，提高机器人的性能，人们提出了一种新型的具有多个运动链结构的机器人——并联机器人。由于并联机器人的基座和末端执行器之间具有两个或两个以上的运动链，多个运动链同时操作末·端执行器，不仅可以减小累积误差，而且使得并联机器人具有运动速度快、刚度大、承载能力强等许多优点。要实现并联机器人的高性能运动控制，关键在于设计良好的控制器。根据所使用的模型不同，并联机器人的控制器可以分为运动学控制器和动力学控制器两大类。其中动力学控制器的原理就是在给定了并联机器人期望运动轨迹后，利用动力学模型求解逆动力学问题，计算得到跟踪期望运动轨迹所需要的驱动力矩，然后控制各个运动链的驱动装置输出相应的力矩，从而使并联机器人按照期望轨迹运动。可见，并联机器人的动力学模型在动力学控制中具有重要意义，而动力学控制的核心问题就是并联机器人的逆动力学问题，因此，并联机器人的动力学控制也称作逆动力学控制。典型的并联机器人动力学控制器包括增广ro控制器和计算力矩控制器。由于充分考虑了并联机器人的动力学模型，动力学控制器在理论上具有较好的性能，尤其在高速运动控制中，采用动力学控制器能够获得比运动学控制器更好的控制效果。并联机器人的动力学控制器都是直接来源于传统串联机器人的控制方法，这些控制器在串联机器人的运动控制中能达到较好的控制效果。但是，当把这些方法用于并联机器人控制时，从本质上讲它们都没有考虑到并联机器人在机械结构上具有多个运动链这一特点，忽视了各支链间的协调运动。在实际应用中，各个运动链之间往往存在机械结构和动力学特性的差异，因此各个运动链的运动控制精度不同，进而无法实现多个运动链的协调运动。此外，并联机器人的多个运动链构成了一个闭环机构，因此，各个运动链的运动控制精度不同会大幅增加闭链机构中的约束力，故现有动力学控制器不能保证整个并联机器人的运动控制精度。特别是对于冗余驱动并联机器人来说，冗余驱动会进一步加深动力学模型的非线性程度，各个运动链之间存在的约束力也会被放大，从而并联机器人的协调性不能保证，甚至机械结构也会损坏。
发明内容
本发明为解决并联机器人的现有动力学控制技术中存在的无法实现多个运动链的协调运动，会导致各个运动链之间存在的约束力增加，并导致整个并联机器人的运动控制精度较低的问题，进而提供了一种并联机器人的动力学协调控制系统，本发明提供了如下的技术方案并联机器人的动力学协调控制系统，包括协调控制模块、非线性动力学补偿模块和非线性摩擦力补偿模块；所述协调控制模块用于输出协调控制信号τ el,所述协调控制信号τ el由比例增益矩阵Kd和组合误差信号s组成,记为τ ε1 = KdS ；所述非线性动力学补偿模块用于输出动力学补偿信号τ ，所述动力学补偿信号τ e2记为k = - C，其中的Me表示并联机器人的惯性矩阵，Ce表示科里奥利矩阵，C表示参考速度，用于对期望速度的修正，私表示参考加速度，用于对期望加速度的修正；所述非线性摩擦力补偿模块用于输出摩擦力补偿信号τ #所述摩擦力补偿信号·τ e3记为Te3 = STfa,其中的fa表示关节的非线性摩擦力，S表示速度雅克比矩阵。本发明实施方式提供的技术方案能够实现并联机器人多运动链之间的同步运动，其中的同步误差包括了跟踪误差信息，随着同步误差的减小，跟踪误差也将减小，因此提高了连续轨迹跟踪的精度；并且同步误差还包含了轴与轴之间的相对运动信息，因此同步误差中的每一项不但包括了对应轴的信息，还包括了其他运动轴的信息，从而同步误差可以调整轴与轴之间的关系。
为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图I是本具体实施方式
提供的同步误差的定义示意图；图2是本具体实施方式
提供的动力学协调控制系统中的协调控制模块的原理示意图；图3是本具体实施方式
提供的动力学协调控制系统中的非线性动力学补偿模块的原理不意图；图4是本具体实施方式
提供的并联机器人的动力学协调控制系统实施图；图5是本具体实施方式
提供的实际并联机器人系统的轨迹跟踪误差曲线，其中图5a表示X轴运动方向的轨迹跟踪误差，图5b表示Y轴运动方向的轨迹跟踪误差；图6是本具体实施方式
提供的实际并联机器人系统的轨迹同步误差曲线，其中图6a表示X轴运动方向的同步误差，图6b表示Y轴运动方向的同步误差。
具体实施例方式下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明的具体实施方式
提供了一种并联机器人的动力学协调控制系统，包括协调控制模块、非线性动力学补偿模块和非线性摩擦力补偿模块；所述协调控制模块用于输出协调控制信号τ el,所述协调控制信号τ el由比例增益矩阵Kd和组合误差信号s组成,记为τ ε1 = KdS ；所述非线性动力学补偿模块用于输出动力学补偿信号τ ，所述动力学补偿信号τ e2记为I2 =Μ^+￡^；，其中的表示并联机器人的惯性矩阵，Ce表示科里奥利矩阵，C表示参考速度，用于对期望速度的修正，C表示参考加速度，用于对期望加速度的修正；所述非线性摩擦力补偿模块用于输出摩擦力补偿信号τ #所述摩擦力补偿信号τ e3记为Te3 = STfa,其中的fa表示关节的非线性摩擦力，S表示速度雅克比矩阵。具体的，令ff表示末端执行器的期望轨迹，则跟踪误差向量et= [etx ety]T可表示为·. =q -qe々日/mJ，速度跟踪误差4可以表示为Kh由图I的几何关系可知，估计轮廓误差4可以表示为4 =(- . sin 0 + % cos 0)从图I中可以得出，通过减小估计轮廓误差^，并联机器人的末端执行器可以快速地靠近期望轨迹；而通过减小跟踪误差et，这种靠近并不明显。故相对于跟踪误差et来说，估计轮廓误差4对轨迹跟踪精度的影响更大，因此可以将估计轮廓误差4定义为同步误差es，则同步误差es可以表示为
Γ—sin θ~^ =ec = {-etx sin+ > cosΘ) ■ Q相应的，同步速度误差4可以表不为
Γηη<30 i ~f-sinJ Γ-sin6>sin2Θ-StyQζο%2θ
L J5 ~L cosi9J { Lcos< J -%6>cos20-e;vi sin20如图2所示，基于同步误差es的表达式，交叉耦合误差e。。可以表示为ecc =et +R\[es( w)Jw其中，R是耦合误差参数，则交叉耦合速度误差4可以表示为ecc=et+&es由交叉耦合误差e。。和交叉耦合速度误差4，则组合误差s可以表示为s = ecc+Pecc其中，P是组合误差参数矩阵，组合速度误差i可以表示为s = ecc+Pecc如图2所示，可以计算得到协调控制模块输出的协调控制信号τ el表示为Tel = KdS其中的Kd是比例增益矩阵，将交叉耦合误差e。。、交叉耦合速度误差^和组合误差s代入协调控制信号τ el的表达式中可进一步得到τΑ=Κ ,s=Kd{ecc+Pe ) = Kd + Pet +Res +P-R es (w)dw>j
从上述协调控制信号τ el的表达式可以得出，协调控制模块包含了跟踪误差信息和同步误差信息一方面，跟踪误差采用ro (比例微分)控制方式消除从而获得快速的跟踪能力；另一方面，同步控制误差采用pi (比例积分)控制方式从而获得精确的同步能力。由图3可知，参考速度信号C可以表示为= < - Rex+ Pe“相应的，参考加速度信号C可以表示为C = I + s = ^ - Re, + Pecc因此，可以计算得到非线性动力学补偿模块输出的动力学补偿信号可表示为Te2 = Meq'e + Ceq'e为了克服并联机器人关节的非线性摩擦力影响，将非线性摩擦力补偿模块的输出信号τ e3表不为:τ e3 = STfa其中，关节的非线性摩擦力fa可以表示为fai = Bviqai ++)其中，Bvi表示粘滞摩擦力系数，^表示主动关节的速度，fn和f2i分别表示库仑摩擦力和Stribeck摩擦力的幅值，ωπ和ω 2i分别表示S型函数对库仑摩擦力和Stribeck曲线的近似程度，i = 1，. . .，n，这里η表示关节的数目。图4给出了并联机器人的动力学协调控制系统实施图，其中并联机器人的动力学协调控制律可以表示为
权利要求
1.并联机器人的动力学协调控制系统，其特征在于，包括协调控制模块、非线性动力学补偿模块和非线性摩擦力补偿模块； 所述协调控制模块用于输出协调控制信号Tel，所述协调控制信号Tel由比例增益矩阵Kd和组合误差信号s组成，记为T el = KdS ; 所述非线性动力学补偿模块用于输出动力学补偿信号\2，所述动力学补偿信号记为=MJi: +CJfc，其中的表示并联机器人的惯性矩阵，(；表示科里奥利矩阵，C表示参考速度，用于对期望速度的修正，私表示参考加速度，用于对期望加速度的修正； 所述非线性摩擦力补偿模块用于输出摩擦力补偿信号\3，所述摩擦力补偿信号记为T e3 = STfa，其中的fa表示关节的非线性摩擦力，S表示速度雅克比矩阵。
2.根据权利要求I所述的并联机器人的动力学协调控制系统，其特征在于，所述组合误差信号S由耦合误差e。。和耦合误差变化量I通过线性组合的方式获得，记为S = Kc +Pecc，其中P为组合误差参数矩阵；所述的耦合误差e。。通过跟踪误差et和同步误差es的比例一积分组合得到，记为& = +R\[es(w)dw，其中R是耦合误差参数；所述的同步误差es为连续轨迹运动过程中的估计轮廓误差之。
3.根据权利要求I所述的并联机器人的动力学协调控制系统，其特征在于，所述参考速度私'记为名' =€ +包 ，其中的#表示期望速度，es表示同步误差，e。。表示f禹合误差；所述参考加速度 记为劣=qi ^Res +Pecc，其中的七表示期望加速度、<表示同步误差变化量，4c表不稱合误差变化量。
4.根据权利要求I所述的并联机器人的动力学协调控制系统，其特征在于，所述关节的非线性摩擦力fa记为/ = H+/uC1-1+ Imnllm)+fva-i+Jmiiiu)，其中的Bvi表示粘滞摩擦力系数，表示主动关节的速度，f\i和f2i分别表示库仑摩擦力和Stribeck摩擦力的幅值，Coli和co2i分别表示S型函数对库仑摩擦力和Stribeck曲线的近似程度，i = I,. . . , n, n表示关节的数目。
全文摘要
本发明提供了一种并联机器人的动力学协调控制系统，包括协调控制模块、非线性动力学补偿模块和非线性摩擦力补偿模块；协调控制模块用于输出协调控制信号τe1，协调控制信号τe1由比例增益矩阵Kd和组合误差信号s组成，记为τe1＝Kds；非线性动力学补偿模块用于输出动力学补偿信号τe2，动力学补偿信号τe2记为非线性摩擦力补偿模块用于输出摩擦力补偿信号τe3，摩擦力补偿信号τe3记为τe3＝STfa。本发明能够实现并联机器人多运动链之间的同步运动，其中的同步误差包括了跟踪误差信息，随着同步误差的减小，跟踪误差也将减小，提高了连续轨迹跟踪的精度；同步误差还包含了轴与轴之间的相对运动信息，同步误差中的每一项包括了对应轴的信息和其他运动轴的信息，从而可以调整轴与轴之间的关系。
文档编号B25J9/16GK102785245SQ201210282710
公开日2012年11月21日 申请日期2012年8月9日 优先权日2012年8月9日
发明者丛爽, 尚伟伟 申请人:中国科学技术大学