文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 信息与通信 > 基于解耦控制的SCARA机器人轨迹跟踪控制器设计
侵权投诉

基于解耦控制的SCARA机器人轨迹跟踪控制器设计

第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)

基于解耦控制的SCARA机器人轨迹跟踪控制器设计

(2)x

假设系统中只有机器人关节位置信号可测量,提出如下控制器:

&= S(z x1) Rzz

收稿日期:2006-04-05 修回日期:2006-06-12

作者简介:谢冬梅(1972-), 女, 辽宁, 博士生, 研究方向为机器人控制,智能控制, 鲁棒控制等; 曲道奎(1962-), 男, 研究员, 博导, 研究方向为机器人控制, 智能系统等; 徐方(1961-), 男, 研究员, 研究方向为智能控制, 工业自动化, 机器视觉等。

u=KS(z x1)

(3)

式中v是决定平衡点的常向量,K ,S和R是控制器参数,并

第1页

你可能喜欢

  • 机器人运动学
  • 机器人控制器
  • MATLAB机器人
  • 机械结构设计
  • ABB机器人
  • toolbox
  • Simulink仿真
  • 机器人控制系统

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email