第18卷增刊2 系
统 仿 真 学 报© Vol. 18 Suppl.2
2006年8月 Journal of System Simulation Aug., 2006
基于解耦控制的SCARA机器人轨迹跟踪控制器设计
谢冬梅1,2,曲道奎1,徐 方1, 胡炳德1
(1.中国科学院沈阳自动化研究所, 辽宁 沈阳 110016; 2. 中国科学院研究生院, 北京 100039)
摘 要:SCARA型机器人的控制问题由于其动力学模型中没有重力矩项的作用而得以简化,由于在实际应用中经常要求其高速运动,则对具有强耦合的哥氏力与向心力的控制就成为制约其系统性能的重要问题。提出通过线性变换对机器人系统解耦,将高阶系统转化为解耦的低阶系统进行控制的方法,并且应用极点配置对解耦的系统求解机器人控制器。该方法无需测量关节速度和加速度,只需要测量关节位置信号。所提出的控制器既能保证闭环系统全局渐进稳定,又能通过对线性化系统闭环极点的配置来获得期望的闭环系统响应性能。仿真实验证明了所提出的控制器设计方法的可行性。 关键词:SCARA机器人;动力学模型;解耦;极点配置;全局渐进稳定
中图分类号:TP24 文献标识码:A 文章编号:1004-731X (2006) S2-0931-04
Tracking Controller Design of SCARA Robot
Based on Decoupling Method
XIE Dong-mei1,2, QU Dao-kui1, XU Fang1, HU Bing-de1
(1.Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China;
2.Graduate School of Chinese Academy of Sciences, Beijing 100039, China)
Abstract: The requirement on SCARA robot control is simplified with the nonexistence of gravitational forces term in the dynamics model. In real applications, however, high velocity is frequently required in SCARA robot where coriolis and centrifugal forces become strongly coupled, therefore significantly restrict the performance of the control system. A linear transformation was proposed to decouple the robot system model, and a controller was obtained by using the pole assignment in the decoupled system. This method requires detection of only the position signal, but not the speed or acceleration signals. The presented controller can ensure the global asymptotic stability of the closed-loop system, and attain the desired response performance by assigning the poles of the closed-loop system. Computer simulation results demonstrate the effectiveness of the proposed approach.
Key words: SCARA robot; dynamics model; decoupling; pole assignment; global asymptotic method
本文针对SCARA型机器人的工作特性及传统计算力矩控制方法的缺点,提出了一种应用输出反馈进行极点配置求解机器人控制器的方法,该方法无需测量关节速度和加速度,只需要获取关节位置信号。求解过程中通过线性变换将高阶线性系统解耦为低阶近似线性系统来处理,较为有效地解决了关节之间的耦合扰动问题。
引 言机器人动力学控制方法从上世纪起就获得了许多学者的关注。传统的刚性机器人控制方法如计算力矩控制都需要准确测量机器人的关节速度甚至是加速度,同时还需要对机器人系统建立准确的数学模型,尽管可以使用测速计或加速度计来测量速度或加速度,但是测速计测量的速度或加速度信号会被噪声干扰而产生误差,从而降低了控制器的性能,而且还会增加设备费用,而且要获得机器人系统的准确模型几乎是不可能的,另外,计算力矩加PD反馈控制算法在保证Lyapunov渐近稳定的前提下,只能实现有偏跟踪。还有一类机器人控制方法将耦合与非线性都看作是对机器人单个关节的扰动因素进行处理,并没有对整个系统进行解耦控制。
对于SCARA型机器人,由于没有重力矩的作用,动力学模型得到了简化。然而,在SCARA型机器人大多工作在要求高速高精度的背景,此时哥氏力矩与向心力矩引起的耦合与非线性就成为干扰机器人控制系统性能的重要因素。
1 控制器提出及稳定性验证
n自由度刚性SCARA机器人Lagrange 方程如下:
&&+C(q,q&)=u;t≥0 (1) D(q)q
其中q∈ n代表连杆和电机转过的角度
&)q&代表哥D(q)=DT(q)>0是刚性连接的惯性矩阵, C(q,q
令x1=氏力和离心力矩矢量,u∈ n是控制力矩矢量,&q及
&。则(1)式的状态空间表达式为: x2=&q&1=x2x
&2=D 1(x1)( C(x1,x2)x2+u)

(2)x
假设系统中只有机器人关节位置信号可测量,提出如下控制器:
&= S(z x1) Rzz
收稿日期:2006-04-05 修回日期:2006-06-12
作者简介:谢冬梅(1972-), 女, 辽宁, 博士生, 研究方向为机器人控制,智能控制, 鲁棒控制等; 曲道奎(1962-), 男, 研究员, 博导, 研究方向为机器人控制, 智能系统等; 徐方(1961-), 男, 研究员, 研究方向为智能控制, 工业自动化, 机器视觉等。
u=KS(z x1)
(3)
式中v是决定平衡点的常向量,K ,S和R是控制器参数,并
模糊学习控制以模糊控制提供反馈机制为主体,辅以迭代学习控制提供前馈补偿机制,来实现时期望轨迹的完全跟踪。把模糊学习控制应用于SCARA机器人的轨迹跟踪。仿真试验表明...
国家自然科学基金 及广东省自然科学基金 及广东省教育厅资助项 第 卷第 期 池瑞楠等 基于解耦控制的非完整移动机器人实时轨迹跟踪 2 控制算法的设计 Δεσιγ...
类SCARA硅片传输机器人轨迹规划及控制器设计_机械/仪表_工程科技_专业资料。... 基于解耦控制的SCARA机器... 4页 免费 基于PMAC的硅片传输机器... 5页 7...
基于解耦控制的SCARA机器人... 4页 免费 液压...机械设计及理论 指导教师:冯培恩;潘双夏 20060201 ...(3)轨迹跟踪和自主挖掘控制技术。轨迹跟踪控制是使...
为研究SCARA机器人的轨迹规划,在MATLAB环境下,对该机器人运动学参数进行了设计,... 基于解耦控制的SCARA机器... 19人阅读 4页 2.00 基于测地线PowerCube...
基于解耦控制的SCARA机器人... 4页 免费 并联机器人轨迹跟踪离散变... 4页... 迹跟踪 控制律设计 也是 一项急需发展的关 轨键 技术 . 有效 性 的要 求...
基于解耦控制的非完整移... 5页 免费 非完整移动机器人的路径... 74页 7...设计 使得 李世华等 非完整移动机器人的轨迹跟踪控制 收敛于零并 使 则有 ...
问题设计出自组织模糊聚类神经网络控制器对 SCARA 机器人运动轨迹进行跟踪 控制。... 基于解耦控制的SCARA机器... 4页 免费 SCARA教学机器人的结构设... 3页 1...
问题设计出自组织模糊聚类神经网络控制器对 SCARA 机器人运动轨迹进行跟踪 控制。...(解耦)过程,其中 [7] W 2 = [ w 21 , w 22 ,...w 2 j ,...,...
热门文档