当前位置:文档之家› 6DOF并联机器人并行控制算法与优化

6DOF并联机器人并行控制算法与优化


1.2运动参数的分析
下面给出K、K、K和∞。、脚、09,的求法。 在规划级上首先输入机器人运动的参数。这些参数包括:
上平台中心终点坐标参数(相对于固定平台k,弘,昂,%, 屏,始;上平台中心起点坐标参数(相对于固定平台k,yb,磊,‰
肪,如;各方向的加速度值a¨,各方向的减加速度值a2,,i=x,y,z;Z 方向的最大速度值VMAXz。 根据上述已知条件和物理学运动公式可进行下列计算: Z向在加速度和减加速度阶段所需时间为:Tzl=VMAXz/ ak,Tz3=VMAXz/a。。Z向在匀速(Ⅵ“AXz)阶段所需时间为:
基金项目:中国科学院机器人开放实验室基金项目(RL2002—07)。
作者简介:张兆印(1955--),男,黑龙江五常人,硕士,副教授,研究方向为机器人技术、并行计算。 一3182一
万方数据
并且A矩阵中
t特一等等,玎老专
JF睇m,n,],r2F[x'2,y'2

0 0
完成,∞。,(-OB,CO,分配给CPU2计算,只需传送角速度与角加速度 值给CPU2;CPU2完成计算后送给CPUl即可。使两部分并行 计算,可提高一倍的计算效率。分配方案如图2所示。
uJ L21瓦而瓦百可酉p 9以妣 Li-=[器器芸甏茜茜k巧K∞。090 coyl]c2,
式中:X。、yo、z。、Ⅱ、B、1r_上平台运动过程中的位姿参数。
K、K、圯和09。、∞。、∞厂_上平台中心分速度值,和角速度值。
其中一阶偏导数矩阵[器器尝舞券茜]为
m.n。
b。].[R。].[r2t] Nhomakorabea[s。].[Rp]・k一] [S:].[Rp]・[场]
辫 灞
图3


参考文献:
[1]
Roger S 267.268.
用户、角色、权限和数据的关系
Pressman.软件工程[M】.北京:机械工业出版社,2004:
基于角色的权限管理模型方法引入角色的概念,安全管 理人员根据需要定义角色、设置权限,用户根据出事再被指派 不同的角色。这样,就可以实现用户与访问权限的逻辑分离。 我们提出的权限和访问集中管理模型就是基于角色的权 限管理模型,对权限进行集中管理,并结合用户的实际情况, 在信任与授权服务平台支持基础上提供业务信息流处理过程 中的操作权限的分配和控制旧。
与研究,尤其对上平台中心的运动速度和角速度的计算及液压缸各杆的伸长速度计算矩阵进行了细致的研究,提出了并行 算法及CPU的优化分配策略,大大提高了并联机器人的实时控制质量。 关键词:并联机器人;并行计算;计算机控制;控制算法;机器人技术 中图法分类号:TP24 文献标识码:A 文章编号:1000.7024(2007)13—3182—02
6-DOF并联机器人是一种新型机器人,结构如图l所示。 它由一个活动平台、一个固定平台和6个液压缸组成,在活动 平台中间安装机械手。当6个液压缸伸缩时,位于上平台中心 的机械手就可以随着活动平台的移动而移动,这样就可以对 工件进行加工了。并联机器人和串联机器人相比,具有许多 优点和互补性,但就目前来说国内外均未进入到工业应用阶 段,通过文献[8]可以解决机器人的控制问题,但其计算量大, 算法复杂,通过对并联机器人样机的研制,解决了并联机器人 的运动控制问题,按传统的方法,在实现时采用了离线计算在
第28卷第13期
V01.28 No.1 3
计算机工程与设计
Computer Engineering and Design
2007年7月
July 2007
6-DOF并联机器人并行控制算法与优化
张兆印
(黑龙江大学计算机科学技术学院,黑龙江哈尔滨150080)
摘 要:为了实现对6-DOF并联机器人实时在线控制,并能取得良好的控制效果,对其运动控制算法的结构进行了深入剖析
形=(T+m}国土√r+斫。+盔一20。寸啦J+忽+乱+%)/白。施)(i同上)
ndT+‰十a:^/P+斫,4砖一2Q。加0+岛+‰}n:施。加Ⅸi,九同上)
在减加速度阶段的速度值为
7i11
K=√砌别砰一2"a2,+假一岛,)(i同上,岛。为上平台中心从起点
开始移动的距离)
生成见皿,氧R,矩阵
传岛和R,矩阵

09尸√朐别砰一2+口2。+@一&,)(i,九同上)
即可求得并联机器人6个液压缸的伸长速度值可按下式 计算出来 [三j
三乞 三I 三- £:
耐算I-,m…㈣,和并生成s・矩阵
传s,矩阵

I一
‘。
牛成A矩阵第j行 传A矩阵5.6列
计算蠹
计算M。
[蝴
[蝴
三t]1=[4]s。s[歧

虻∞。∞口∞J7(4)
1并联机器人运动控制的并行算法 1.1运动控制算法
在文献[1]中,我们已给出了六自由度并联机器人的运动 位置,速度算法分析的全过程,所得结果如下: 各路液压杆的伸长值为
L=√G:一工,)2+◇:一Y。)2+(z:一z。)2
坐标系下的坐标。 液压杆伸长的变化速度为
i=1,2,…,6
(1)
式中:(x。’,Y。’,Zit)和(‰Y。,Zi)——上平台与下平台各铰点在固定
1.3并行算法与任务的化分策略
机器人控制算法的核心是计算液压杆的伸长速度值,而 液压杆的伸长速度依懒于A矩阵和上平台中心的速度和角速 度值K,巧,K,09。,郇,∞,的计算。 对于圪,K,K,09。,∞岛国,的计算,因为只要给了初始条件,就 可以计算出各阶段相应的值,计算量大且较复杂。经过分析, 这些算法相互独立。为了加快计算的速度,实现实时控制,将
50080,China)
Abstract:In order to realize to the 6-DOF parallel robot and the research to its
real.time on—line control,and to obtain the good control effect,the analysis
LRyJ_l cats,一sasfls?, l cacflcy+sac7 其中:C=COS,s=sin。

对于矩阵A是一个6×6的矩阵,它的计算速度也直接影 响到对机器人的控制效果。在该样机的研制开发中采用了离 线计算在线控制的策略,其方法是在实施控制之前首先给出 机器人的运动规划,并按照运动规划计算出各液压杆的伸长 速度和伸长值,存入计算机的存储区中,即离线计算。对于控 制端从这个存储区中读出数据来完成机器人控制。这种策略 虽说可行,但不能实现实时控制的要求。 文献[2]和文献[3】中给出了并行算法设计的方案。实现 了实时控制,但效果并非是最佳。通过分析,这个矩阵的前3 列只是各完成一次减法运算和一次除法运算,相对比较容易 和快捷。第4~6列计算量大、复杂,且相对独立。但后3列的 计算又依赖于前3列的结果。也即需要计算^,m。,胛,来构成相
万方数据
基础,减轻了管理负担。该模型主要有以下特点: ・模型主要阐述了角色概念及授权原理,权限的分配和 授权以角色为中心。 ・权限管理通常包括授权、验证、监控和审计,而该模型 着重于角色授权。 ・访问控制不仅控制用户可以使用的权利,而且控制用 户应该履行的义务。 ・角色用于组织大量用户权限规范,以减轻管理的负担。 通过引入角色的概念,对权限的管理就可以以角色做中 介,并且可以通过角色来实现权限的继承关系。因此,用户、 角色、权限和数据的关系可以简单表示,如图3所示。
[s,]‘[R,].[n。] [Sz].[R,]‘[P2z] (3)
m:”:[s:].哝。].[F22]
图1
6-DOF并联机器人结构
E—mail:zzyl025483@163.com
m。
n。
[s。]・[R。].[ns]
[Ss]・[RB].[r2s]
[ss].[R,].[ns]
收稿日期:2006—06—02
CPUl
速度及角速度:K=√2・mt&,(i_x,y'z),其中Olz为加速度阶段各
向的加速度值,&为上平台中心各向的液压杆伸长值(此值在
运动过程中是变化的)。∞尸√2+all*&,(i=x,y,z,九可,B,曲,ali为加
速度阶段的各向的角加速度值,S同上。 匀速阶段,即以最大速度和最大角速度运动的求法
are
movement
control
algorithm
structure
researched.Especially has conducted the careful research to the first plat—
form center velocity of movement and the angular speed computation and the hydraulic cylinder various poles elongated velocity calcu—

i“
;=蔓, —丛一;芝

计算6个鑫k杆的速度值
对机器—妥时控制
。…….』.……。……。。+
图3 A矩阵并行算法与任务分配 (下转第3282页)
一3183—
这6个值的计算分成两部分K,巧,K和∞。嘶,09,,其中K,巧,K的 计算只与速度和加速度有关,而09。,嘶,嘶的计算只与角速度和 角加速度有关,且这两部分计算量均衡,K,巧,圯分配给CPUl

啦y
够0 1 一casZ
0 0 0
LRpJ=l

sacflc),
一sacfls?s∞归0 J cflc),0 一sacflsr casfls7一sas7
计算A矩阵
r————————一
计算CO。,嘶,∞,
【一cacflc?,cacfls?,
一啦y
0]
0 0
图2
K,巧,K和CO。,嘶,∞,并行算法与任务分配
相关主题