资源描述
本科毕业设计(论文)外文翻译(附外文原文) 系 ( 院 ):机械与控制工程学院 课题名称:乒乓球发球器的结构设计 专业(方向):机械设计制造及其自动化 (机械装备设计与制造 ) 班 级: 机械11-2 学 生: 蔡书斌 指导教师: 张声岚 日 期: 2015年3月12日 第29届中国控制会议论文集7月29日至31日,2010年,北京,中国基本姿势5自由度混合机械臂控制算法适合乒乓球机器人ZHENG Kuijing1, CUI Pei 1, MAO Haixia21.机械工程学院,燕山大学,秦皇岛,066004中华人民共和国电子邮件:kjzheng2. E啊科学河北科技师范学院的学院,秦皇岛,邮编:066004摘要:发展和乒乓球机器人的组成进行了介绍。基于乒乓球,一种3-RPUR+ RP5自由度混合机械臂提出,它可以执行三个平移自由度和两个旋转自由度的运动特性。通过使用DH参数法和XYZ欧拉角,混合动力车机械臂的运动学逆溶液进行分析,球拍的姿势被方便地描述。姿态控制方程被推导,这可变换球拍构成在工作空间到关节空间的驱动轴的参数。通过ADAMS软件,将运动仿真被执行,从而有效地证明了理论分析。基本算法奠定了成功的5轴联动控制的乒乓球机器人的理论基础。关键词:乒乓球机器人,自由的五度,混合机械手臂和姿态的反解1引言作为一个服务机器人,乒乓球机器人可用于不仅为专业运动员作为试马针对性的训练,而且在行使对业余运动员。因此,乒乓球机器人吸引了来自学术界和工业界国内外越来越多的关注。许多大学和公司都在打乒乓球的机器人了深入的研究,并开发了多种乒乓球的机器人在不同结构和类型的自1980年以来初步乒乓球机器人具有比服务多样化球的功力没有其他的话,机械臂进行开发反击即将到来的球。 1983年,约翰比林斯利1从英国朴茨茅斯理工大学约占乒乓球机器人法规。罗素L.Andersson 2,宫崎文雄3等开发的乒乓球机器人一个接一个。建昌元4从西安理工大学,德许5从北京自动化研究所和魏巍6浙江大学还研究了乒乓球的机器人。的详细介绍可以在参考进行检查7。乒乓球机器人由机械系统,视觉系统和控制系统。作为手眼协调系统,三个子系统必须彼此协调。机械系统,类似于人类的手臂,直接进行打乒乓球的功能。视觉系统,类似于人的眼睛,监视乒乓球运动,并预测其运动轨迹。控制系统,类似于人类的大脑,控制所述机器人臂以敏捷摆动球拍根据移动轨迹乒乓去的规划位置和方向,并实现了精确的命中。A排序五自由度混合机械臂包括并行机制和串行机制提出,它可以执行三个平移自由度和两个旋转自由度。混合机械臂的运动学反解进行了深入分析。的位置和方向的控制方程推导。在前述的算法仿真,通过ADAMS软件的方式进行验证。该算法还规定,为人们控制机器人手臂的姿势的理论基础。2方案乒乓球机器人基于5自由度混合机械臂柔性双眼视乒乓球机器人的方案示于图1的混合式机器人臂装置串行机制连接到并行平台。它包括三个RPRU(回转-棱柱回转通用型),四肢和RP(回转-棱镜)肢。球拍安装在机器人臂的末端。在该并联机构中三个平移对和在串行机制两个旋转对被用作驱动轴达到5轴同步控制。球拍能够摆动到达需要的位置,方向和速度。两个2自由度摇篮头上面的机械臂安装和CCD照相机被安装在每个托架的头。两款相机都可以进行旋转2自由度,形成灵活的双眼视觉。图1:乒乓球机器人计划乒乓球的机器人是一个手眼协调系统与快速的眼睛和灵巧的手。该机器人可以摆动它的球拍敏捷,灵活,精确打击乒乓球和避免现有的人类击球的正反手问题。3说明5自由度混合机械臂乒乓球具有速度快,各种坠落点,广泛和强烈的旋转等特点。因此,机械臂必须满足顺序执行这些要求,以适合打回乒乓球。一方面,它必须是多自由度来实现的各种位置和方向和摆动球拍去的规划点。另一方面,它需要有足够的工作空间到盖体内部并在表外部更大的面积和回击各个到来乒乓球。此外,速度快,精度高,还需要快速,准确地回击了乒乓球。基于上述分析,一种3- RPUR+ RP 5自由度混合机械臂提出。如图2所示,混合机构由稳定的平台,移动平台,其与移动平台,旋转对和平移一对串联在移动平台和安装在端球拍连接稳定的平台四肢机器人手臂。其在特征在于:在稳定的平台和移动平台都具有相同的连接3 RPUR(旋转,平移万能旋转)驾驶的肢体。通过控制P对三个RPUR驱动四肢的位置和移动平台的取向的运动可以被改变以实现两维转动和一维平移。旋转一对R 4与移动台连接的,使周围的移动平台的中心轴的摆动杆L4转动。在摆杆L4平移对P5使得沿摆杆轴方向的球拍P数据搬移。a)机器人臂模型 b)该坐标机械臂系统图2:3 RPUR+ RP5自由度混合机械臂通用对和旋转对的轴的两个轴在一个点上相交的3- RPUR并联机构,其等于球体对,即3-RPS机构。 3-RPS+ BP混合机械臂自由度可以计算通过使用Kutzbach Grubler的公式如下:M = 61011-117 =5这样的3-RPS+ BP混合机器人手臂的自由度是5。该混合机械臂结合高刚性,速度快,惯性小,误差小,高负荷和简单的敏捷和串行机制,宽大的空间足够并联机构的结构。的惯性和累积误差被降低。的刚性提高。的运动精度和运动速度提高。的位置和取向以及动态属性的敏捷性被有效地提高。该混合机械臂能够进行球拍的运动计划更迅速,敏捷,准确地在不同的速度,落点,角度和各种未来乒乓球的条款。4. 混合机械臂的运动学逆解4.1转发和RP肢体位置分析反解用DH法8,该坐标系上的旋转对R4,平移对P5,哪些是在移动的平台上链接的乒乓球拍分别成立。如图2 b)的移动坐标系统B是基准坐标系中的0,坐标系4对应于R 4,坐标系5对应于P5的坐标系统P对应的乒乓球拍。表1示出了相应的D-H参数。 Q4和d5的是变量,A1,A2,d1和d3的是常数。90度A190A2,D1lB4,D3 l5P。LB4是坐标系统B和坐标系统P的原点的原点之间的距离。表1:D-H RP肢的参数根据表1中的参数,变换矩阵(_B P)的坐标系统P相对于坐标系统B的T被给出如下:在公式(1),S是sin,c是COS。从等式(1),相对于P的原点的位置,可以在B表示:等式(2)是反相肢体的位置的正解,所以逆溶液给出如下:4.23-RPS肢体位置分析的反解如图2,3-RPS并联机构的移动平台是正三角形S1S2S3。移动坐标系B是建立在移动平台上。产地OB位于动平台的几何中心。 Axis_XB恰逢载体OBS1。稳定的平台也是一个正三角形R1R2R3。稳定的坐标系A是建立在稳定的平台。产地OA位于稳定的平台的几何中心。 Axis_XA恰逢载体OAR1。相对于三个旋转对R1,R2和R3的三个轴是相切的稳定的平台的外接圆。外接圆半径为A R。的三个关节的R1,R2和R3可以在坐标系A中被表示为如下的位置:正三角形S1S2S3的外接圆的半径为Rb。三关节S1,S2和S3的位置可以被表示在坐标系统B如下:然后变换B相对于A可以表示如下的矩阵:在公式(4),OB原产地在A的位置。表示旋转矩阵和(A,B,g)为B相对于A的取向的欧拉角。关节的Si(=1,2,3)的位置的坐标系A中可被表示为如下:然后,在A的驱动轴的长度矢量可以举出:从等式(6),所有的驱动轴的长度可以计算:在3-RPS并联机构三个约束方程给出9:.从等式(8),下面的方程可以给出:从方程(9),在移动平台的位置和取向的6个参数,以及是独立的。一个,并且可以通过上述三个约束方程来解决。然后将三个驱动轴的长度可以表示为如下:4.3姿态混合机械臂的逆解从等式(1)和(4),P相对于A的变换矩阵给出如下:在公式(11),是相对于P的A原点OP的位置。它可以表示为如下:在欧拉角表示的旋转矩阵为P相对于A。是P相对的欧拉角A的欧拉角。4.4姿势3-RPS+ RP混合机械手臂的控制方程的球拍可以通过所描述的位置和方向表示的球拍中A的中央点的位置,并且表示相对于球拍的取向的方向角。通过使用方向余弦的ZP之间以及在三个坐标中A轴分别描述。从变换方程,规划的参数所构成的球拍,移动平台和(D5,Q4),反相肢的DH参数的姿势的参数由等式(12)中描述的。通过使用等式(12),的位置和移动平台的取向的数据可以根据相对于球拍的位置和方向的输入数据来计算。然后,利用位置反式(10),该规划姿势在工作空间的球拍可以被翻译成大约在关节空间的旋转轴的驱动轴和角度的长度。机器人手臂的运动控制可以通过等式(13)的方式来实现。机器人臂可以被控制以摆动其火箭到达规划姿势很快以便回击未来球准确。5仿真图3:模拟的流程图3 RPUR+ RP5自由度混合机械臂可以在SolidWorks中构建。然后,该实体模型是通过一种数据转换格式命名的Parasolid导入ADAMS。现有在SolidWorks中装配和约束关系成为unvalid当他们在ADAMS。因此,有必要定义约束模型中的所有部分。首先,成立了工作状态。然后定义运动副的约束,包括固定对,对平移和旋转对。运动关系可以通过运动副装载驱动运动构造,其中四对平移一转动对10-11。最后,仿真可以通过导入的驾驶数据来获得。的流程图被示出为图3.是机器人手臂的结构参数如下:rA=300mm, rB=220mm, lB4=132m, l5P=40mm是在驱动轴的初始参数如下:l1=l2=l3=679.72mm, q4 =0 , d5=500mm机器人手臂的规划动作如下:(500,0,847,90,90,0)(0,400,1147,110,108.75,27.99 O)(-200,0,847,90,90,0)(0,-400,1147,70,71.253,27.99)(500,0,847,90,90,0)表2:姿势火箭数据表3:机器人手臂的驾驶数据图4:混合机械臂的运动模拟图通过使用所构成的机器人手臂的控制方程,所述规划的位置和方向的数据(参照表2)的火箭,可以计算以获取控制数据(参照表3)然后,控制数据可以在每个驱动轴被装载在ADMAS软件。和火箭的运动轨迹可以生产。如图4的模拟结果一致的规划轨迹。6结论3 RPUR+ RP5自由度混合机械臂可以执行三个平移自由度和两个旋转自由度。通过使用XYZ欧拉角表示了火箭的位置和取向,所述机器人的运动学逆溶液简明解决。关于火箭的姿态控制式成立。通过ADAMS软件,模拟执行,从而有效地证明了理论分析。基本算法将为5轴同步控制的乒乓球机器人的理论基础。参考1比林斯利J.机器人乒乓C。在:实用计算。马萨诸塞州:麻省理工学院出版社,1983年。2罗素L.安德森。的机器人乒乓播放器:在实时控制实验。马萨诸塞州剑桥:麻省理工学院出版社,1987年。3宫崎文雄弥雅志松和竹内正博。学习动态处理:乒乓球机器人控制一个球和集会有一个人,先进的机器人控制。施普林格,2006年。4常健元。研究乒乓球机器人的手,杂志纺织科学与技术,2001,15(1)西北研究所:44-49。5郑涛张,许德和君宇智。研究和乒乓球机器人的最新发展。 4881-4886:第七届世界大会对智能控制与自动化,重庆,中国,2008年提起诉讼。6袁辉张,魏巍和丹宇。基于实时图像卡尔曼跟踪算法。浙江大学,2009年,43(9):1580至1584年。7郑窥镜,裴翠。审查关于促进机器人乒乓球。机床和液压,2009年,37(8):238-241。8游轮熊,鼎汉恩和刘苍。机器人技术。中国机械工业出版社,1993年。9闫文丽,黄震。用奇异研究方法基于运动学及其应用实例。中国机械工程学报,2004,17(2):161-165。10曾李刚。关于ADAMS引进和例子。北京:国防工业出版社,2006。11广达朱佳顺世和广奇彩。 3-TPS混联机床基于ADAMS运动学和动力学仿真。东北大学学报,2007,41(12):38-42。Proceedings of the 29th Chinese Control ConferenceJuly 29-31, 2010, Beijing, ChinaBasic Pose Control Algorithm of 5-DOF Hybrid Robotic Arm Suitable for Table Tennis RobotZHENG Kuijing1, CUI Pei 1, MAO Haixia21. Mechanical Engineering College, Yanshan University, Qinhuangdao, 066004, P.R.China E-mail: kjzheng2. E&A College of Hebei Normal University of Science & Technology, Qinhuangdao, 066004, P.R.ChinaAbstract: The development and the composition of table tennis robot are introduced. Based on the moving characteristic of table tennis, a sort of 3-RPUR+RP 5-DOF hybrid robotic arm is put forward, which can perform three translational DOFS and two rotational DOFS. By using D-H parameter method and XYZ Euler angle, the kinematic inverse solution of the hybrid robotic arm is analyzed and the pose of the racket is described conveniently. The pose control equation is deduced, which can transform the racket pose in working space into the parameters of the driving axis in joint space. By using ADAMS software, the motion simulation is performed so as to prove the theoretical analysis effectively. The basic algorithm lays the theoretical foundation for the successful 5-axis simultaneous control of the table tennis robot.Key Words: Table Tennis Robot, Five Degrees of Freedom, Hybrid Robotic Arm and Inverse Solution of Pose1 INTRODUCTIONAs a service robot, table tennis robot can be used not only in pertinent training for professional athletes as a trial horse, but also in exercising for amateur athletes. Therefore table tennis robot attracts increasing concern from academic and industrial community home and abroad. Many universities and companies have researched deeply in table tennis robot and developed a variety of table tennis robots in different structure and type since 1980. The initial table tennis robots had no other than the skill of serving diverse balls, then the robotic arm were developed to hit back the coming balls. In 1983, John Billingsley1 from Portsmouth Polytechnic University of Britain constituted regulations about table tennis robots. Russel L.Andersson2, Fumio Miyazaki3 and so on developed table tennis robots one by one. Jianchang Yuan4 from Xian Polytechnic University, De Xu5 from Beijing Research Institute of Automation and Wei Wei6 from Zhejiang University have also researched on table tennis robot. The detailed presentation can be checked in reference 7. Table tennis robot consists of mechanical system, vision system and control system. As a hand-eye coordinating system, the three subsystems must coordinate with each other. Mechanical system, similar to human arm, performs the function of hitting table tennis directly. Vision system, similar to human eye, monitors the movement of the table tennis and predicts its moving track. Control system, similar to human brain, controls the robotic arm to swing the racket agilely according to the moving track of the table tennis to get to the planning position and orientation and realize the accurate hit. A sort of 5-DOF hybrid robotic arm including parallel mechanism and serial mechanism is put forward, which can perform three translational DOFS and two rotational DOFS. The kinematic inverse solution of the hybrid robotic arm is analyzed deeply. The control equations of position and orientation are deduced. The forenamed algorithm is simulated and verified by means of ADAMS software. The algorithm also lays the theoretical foundation for people to control the pose of the robotic arm.2 SCHEME of TABLE TENNIS ROBOT The scheme of table tennis robot based on a 5-DOF hybrid robotic arm with flexible binocular vision is shown in Figure 1. The hybrid robotic arm means connecting the serial mechanism onto the parallel platform. It includes three RPRU(Revolute-Prismatic-Revolute-Universal) limbs and a RP(Revolute-Prismatic) limb. The racket is installed at the end of the robotic arm. Three translational pairs in the parallel mechanism and two rotational pairs in the serial mechanism are used as driving axes to achieve 5-axis simultaneous control. The racket can be swung to get to the required position, orientation and velocity. Two 2-DOF cradle heads are installed eudipleurally above the robotic arm and a CCD camera is installed in each cradle head. Each camera can perform 2 rotational DOFS to form agile binocular vision.Fig.1: Scheme of table tennis robot The table tennis robot is a hand-eye coordinating system with quick of eye and deft of hand. The robot can swing its racket agilely and flexibly to hit table tennis precisely and avoid the forehand and backhand problems existing in human hitting.3 DESCRIPTION of THE 5-DOF HYBRID ROBOTIC ARM The table tennis has the characteristics of fast speed, various falling points, wide range and strong spin and so on. Therefore, the robotic arm must satisfy these requirements in order to be suitable for hitting back table tennis. On the one hand, it is required to be multi-degrees of freedom to realize the various position and orientation and swing the racket to get to the planning point. On the other hand, it is required to have adequate work space to cover more area inside and outside the table and hit back the various coming table tennis. In addition, fast speed and high precision are also required to hit back the table tennis quickly and accurately. Based on the above analysis, a sort of 3-RPUR+RP 5-DOF hybrid robotic arm is put forward. As shown in Figure 2, the hybrid mechanism consists of the stable platform, the moving platform, the limbs which connect the stable platform with the moving platform, the rotational pair and translational pair in series with the moving platform and the racket installed at the end of robotic arm. Its characteristic lies in: the stable platform and the moving platform are connected with the samethree RPUR (Rotational-Translational-Universal-Rotational) driving limbs. By controlling the motion of P pair of the three RPUR driving limbs, the position and orientation of the moving platform can be changed to realize two-dimension rotation and one-dimension translation. The rotational pair R4 linked with the moving platform makes the swing rod L4 rotate around the central axis of the moving platform. The translational pair P5 on the swing rod L4 makes the racket P move along axial direction of the swing rod.a) robotic arm model b) the coordinate systems of the robotic armFig.2: 3-RPUR+RP 5-DOF hybrid robotic arm The two axes of the Universal pair and the axis of the Rotational pair intersect at one point in the 3-RPUR parallel mechanism, which is equal to a sphere pair, namely 3-RPS mechanism. The degrees of freedom of the 3-RPS+RP hybrid robotic arm can be calculated by using the following equation of Kutzbach Grubler:M = 61011-117 =5So the degrees of freedom of the 3-RPS+RP hybrid robotic arm are 5.The hybrid robotic arm combines high rigidity, fast speed, small inertia, small error, high load and simple structure of parallel mechanism with agility and large work space of serial mechanism sufficiently. The inertia and the accumulative error are reduced. The rigidity is enhanced. The kinematic accuracy and the kinematic velocity are improved. The agility of the position and orientation and dynamic properties are improved efficiently. The hybrid robotic arm is able to carry out the planning movement of the racket more quickly, agilely and accurately in terms of different speed, falling points, angles and variety of the coming table tennis.4 KINEMATIC INVERSE SOLUTION of THE HYBRID ROBOTIC ARM4.1 Forward and inverse solution of position analysis of RP limbBy using D-H method8, the coordinate systems are established respectively on rotational pair R4, translational pair P5 and the table tennis racket which are linked in the moving platform. As shown in Figure 2 b): the moving coordinate system B is the basic coordinate system 0, the coordinate system 4 corresponds to R4 , the coordinate system 5 corresponds to P5, the coordinate system P corresponds to table tennis racket. Table 1 shows the corresponding D-H parameters. q4 and d5 are variables, a1 ,a2 , d1 and d3 are constants. 90o a1 = - , 90o a2 = , d1 = lB4 , d3 = l5P . lB4 is the distance between the origin of the coordinate system B and the origin of the coordinate system P.Tab.1: D-H parameters of RP limbAccording to the parameters in Table 1, the transform matrix BPT of the coordinate system P relative to the coordinate system B is given as follows:In equation (1), s is sin and c is cos.From equation (1), the position with respect to the origin of P can be represented in B:Equation (2) is the forward solution of the position of RP limb, so the inverse solution is given as follows:4.2 Inverse solution of the position analysis of 3-RPS limbAs shown in Figure 2, the moving platform of 3-RPS parallel mechanism is a regular triangle S1S2S3 . The moving coordinate system B is established on the moving platform. Origin OB is located in the geometric centre of the moving platform. Axis_XB coincides with vector OBS1 . The stable platform is also a regular triangle R1R2R3. The stable coordinate system A is established on the stable platform. Origin OA is located in the geometric centre of the stable platform. Axis_XA coincides with vector OAR1 .The three axes relative to the three rotational pairs R1,R2 and R3 are tangent to the circumcircle of the stable platform. The radius of the circumcircle is A r . The position of the three joints R1, R2 and R3 can be represented in the coordinate system A as follows: The radius of the circumcircle of the regular triangle S1S2S3 is rB . The position of the three joints S1, S2 and S3 can be represented in coordinate system B as follows: Then the transform matrix of B relative to A can be represented as follows:In equation (4), the position of origin OB in A.represents the rotation matrix and (a,b ,g ) is Euler angle of orientation of B relative to A.The position of joints Si (i =1, 2,3) in the coordinate system A can be represented as follows:Then, the length vector of the driving axes in A can be given:From equation (6), the length of all driving axes can be calculated:Three constraint equations in 3-RPS parallel mechanism are given9:From equation (8), the following equation can be given:From equation (9), in the six parameters of the position and orientation of the moving platform, , and are independent. a , and can be solved by the three constraint equations above. Then the length of the three driving axes can be represented as follows:4.3 Pose inverse solution of hybrid robotic armFrom equation (1) and (4), the transform matrix of P relative to A is given as follows:In equation (11), is the position with respect to the origin OP of P in A. It can be represented as follows:is the rotation matrix represented in Euler angle and is the Euler angle of P relative to A.is the Euler angle of P relative to A.4.4 Pose control equation of 3-RPS+RP hybrid robotic armThe position and orientation of the racket can be described by represents the position of the central point of the racket in A and represents the direction angle with respect to the orientation of the racket. is described by using the direction cosine between axis_Z of P and the three coordinate axes in A respectively.The transform equations from , parameters of the planning pose of the racket to , parameters of the pose of the moving platform and (d5,q4 ) , D-H parameters of RP limb are described by equation (12).By using equation (12), the data of position and orientation of the moving platform can be calculated according to the input data with respect to the position and orientation of the racket. Then, making use of inverse position equation (10), the planning pose of the racket in work space can be translated into lengths of the driving axes and the angles about the rotation axes in joint space. The motion control of the robotic arm can be implemented by means of equation (13). The robotic arm can be controlled to swing its rocket to get to the planning pose quickly so as to hit back the coming ball accurately.5 SIMULATIONFig.3: The flow chart of simulationThe 3-RPUR+RP 5-DOF hybrid robotic arm can be constructed in Solidworks. Then the entity model is imported into ADAMS through a sort of data conversion format named parasolid. The assemblage and constraint relationship existing in Solidworks become unvalid when they are in ADAMS. Therefore, it is necessary to define constraints for all the parts in the model. First, set up the working condition. Then define kinematic pairs constraints, including fixed pair, translational pair and rotational pair. The motion relation can be constructed through loading driving motion on kinematic pairs, including four translational pairs and one rotational pair 10-11. Finally, the simulation can be gained through importing driving data. The flow chart is shown as Figure3.The structural parameters of the robotic arm are as follows:rA=300mm, rB=220mm, lB4=132m, l5P=40mmThe initial parameters of the driving axes are as follows:l1=l2=l3=679.72mm, q4 =0 , d5=500mmThe planning motion of the robotic arm is as follows: (500, 0, 847, 90 , 90 , 0 )(0,400,1147,110 ,108.75 ,27.99 o )(-200, 0, 847, 90 , 90 , 0 )(0, -400, 1147,70 , 71.253 , 27.99 )(500, 0, 847, 90 , 90 , 0 )Tab.2: Pose data of the rocketTab.3: Driving data of the robotic armFig.4: Graph of motion simulation of the hybrid robotic armBy using pose control equation of the robotic arm, the planning position and orientation data (refer to table 2) of the rocket can be calculated to acquire the control data (refer to table 3) Then the control data can be loaded in each driving axis in ADMAS software. And the motion track of the rocket can be produced. As shown in Figure 4,The simulation result coincides with the planning track.6 CONCLUSION3-RPUR+RP 5-DOF hybrid robotic arm can perform three translational DOFS and two rotational DOFS. By using XYZ Euler angle to represent the position and orientation of the rocket, the kinematic inverse solution of the robotic is solved concisely. The pose control equation about the rocket is established. By using ADAMS software, the simulation is perform
展开阅读全文