bj0585-自定中心振动筛设计刘城建

1、低能耗机器人悬浮机构的应用本文给出一种采用悬浮装置直接驱器人来重型物体的低能量方法。考虑到在水平面内悬吊工具的操作，利用悬吊在水平面内的工具的动态行为给出了混合位置/悬浮机器人,由考虑到弹簧秤的重力补偿，这力计划的运算法则，为了垂直种混合位置/力的动力学模型已经发展。为了显示应用于工业的可能性，这种模型在倒角作业领域已经展开。模拟和实验证明了此拟议系统的可行性。著作权 MCB UP Limited (MCB) 2000 截至 2000 小型断路器(简称MCB)mmad Jashim Uddin: 博士, 山形大学系统和信息工程系,日立 4-3-16,Yonezawa 992-8510,:26

2、3237; 传真:26 3205.Yasuo Nasu:山形大学机械系统工程部教授,日立 4-3-16,Yonezawa 992-8510,Kazuhisa Mitobe: 992-8510, 山形大学机械系统工程部教授,日立 4-3-16,YonezawaKou Yamada: 副研究员, 山形大学电子及信息工程系, 日立 4-3-16, 992-8510,Yonezawa鸣谢: 在此作者的感谢Yoshihiro Ishihara 先生,Yoshiyasu Hariu 先生,HidekazuSatou 先生, 及 Kazuo Abe 先生在机器人的制作和控制的执行中所做出的努力mmad Ja

3、shim Uddin 还将感谢教育部，科学会，运动商及(MONBUSHO)给出的奖学金, Japan. Received: 5 January 2000 Accepted: 7 February 20001. 简介：在水平的运动中，工具重量在连接摩擦上有相当大的影响，它直接地影响推进时的转动力矩。在垂直的运动中，地心引力效果在操作体的动力学上有相当大的影响。机器人的应该在推进转力矩的可允许极限和力量感应器的能力里面。悬浮工具系统(STS)是一种新提议的横向重型工具的处理策略，悬吊机器人系统()是一种新提议的机器人用在垂直面实现低功率驱动和小容量感应器的操作方法。由于和传统的系统比起来具有很多优

4、点，悬浮工具系统和悬吊机器人话题。系统已经成为工业应用领域越来越感的当需的坚硬性和高性能动态的时候，并联操作结构与现有的机器人系列相比，提供了许多明显的优点。因此, 这种机制在过去二十年受到了一定的关注(自1983). 一般说来，直接驱动式机械手, ,容易出现过快的操作幅度, 然而其输出动力却很小。为了使其能拿起物体，在多个机械手的协调性控制方面做了很多研究(Schneider and Cannon, 1992;Walker et al., 1988). 当两个或机器人用来完成一单一的任务时，其承载、处理、文本全文 (5295 个字)摘要 （文档摘要）能力会得到增强。 然而, 一个单一的机械手

5、不能重物，因为其驱动转矩滞留在一个固定的极限。当前，许多工业机器人被用于研磨作业。大部分的研磨机器人操作受限于环境. 许多研究开展了工业机器人的力量控制(Kashiwagi et al., 1990; Whitneyand Brown, 1987). 然而, 在那些系统中,研墨工具以传统的方式直接装在机器人上，而且需要一个很大的驱动力，虽然对有关在垂直面内机器人的操作有所研究(Nemec, 1994), 但没考虑到重力的补偿，一般，由一个或多个机械手完成一个任务的可能性取决于其运动学和动态的能力。自动化机器人的修边已经在(Her and Kazerooni, 1991)被描述。在等地，美洲狮

6、560 机器人的机械手焊珠研磨系统已经具有视觉系统 (1990). 在所有先前的修边或研磨的研究中,大功率驱动器被应用于机器人系统。在垂直面内，由于机械手的巨大的重力的影响，研磨加工过程变得非常，尤其是当驱动器的转矩极限小于重力的影响范围。机器人系统通常应用于一个受约束的环境，所以，要控制最终受力器在方向的位置和在被约束方向的触点压力 。由 Raibert 和 Craig (1981)的现存的控制方案上拥有相当大的声望。混合位置/力控制方案在别本文中, 将阐述具有一种悬吊工具系统的机械手混合位置/力控制方案。考虑到悬浮工具在延伸说明到混合控制方案的基本原理。在垂直的运动中,讨水平面内的动态性能

7、，论由弹簧秤引起的重力补偿的动态性能。2. 系统描述：Asada 和 Ro (1985) 设计了直接驱动五杆并联机器人,具有如下许多优点：没有后冲，微小的摩擦，高机械硬度以及精确的运动。这种实验装置系统包含一个两度机器人，具有一个五杆连接结构和悬架系统。图 1 和图 2 展示了机器人结构的计算机辅助设计，在水平面和竖直面内分别附带一个弹簧平衡器。表一显示了五杆连接机制的一些重要性能。2.1. 运动学和动力学方程：本节的连接结构是一个五杆闭环连杆机构，如图 3。有两个输出环节，分别由两个独立的直驱马达驱动，两个马达安装在底架上， 1，2，3，4 杆的长度分别由sub1, lsub2, lsub3

8、, & lsub4 表示。输入杆的角度由qsub1 和 qsub2 表示，从Y 轴测量所得。终点坐标(见方程式 1)(见方程式 2)，从方程 (1)和 (2)得该机器人的反转运动学为：(见方程式 3)( 见方程式 4)，工作空间是一个 Jacobian 矩阵 22 矩阵,可以表示为：(见方程式5)，机器人的惯量矩阵是一个 2 x 2 矩阵，可以表示为 (见方程式 6)A=Isub1+msub1lsup2subC1+Isub3+msub3lsup2subC3+msub4lsup2sub 1B m= (msub3lsub2lsubC3+msub4lsub1lsubC4)cos(qsub1-qsub

9、2)C m= (msub3lsub2lsubC3+msub4lsub1lsubC4)cos (qsub1-qsub2)Dm=Isub2+msub2lsup2subC2+Isub4+msub4lsup2subC4+msub3lsup2su b2奥利公式和向心力矩阵是一个 2 x 1 矩阵，可表达为:(见方程式 7)(见方程式 8)，重利矩阵是一个 2 x 1 矩阵，可以表示为：( (见方程式 9)( (见方程式 10)，g 是由重力引起的重力加速度。2.2.硬件描述：控制系统的一个硬件示意图如图 4，一部奔腾微型计算机, 133 兆赫, 被用来控制此系统。输入（A/D）和输出（D/A）转换具有八

10、条通道和 12 字节的处理能力。伺服系统驱动器有三种控制模式：位置控制模式速度控制模式和转矩控制模式。此计算机主板具有三个端口和 24 字节脉冲处理。一个低容量的三轴力传感器 (逐渐校正到 19.62 N) 装在机器人顶端和气动之间。运算放大器与一个低通滤过器设计在一起，以消除预想不到的噪音，表 2 显示了直驱马达的一些重要性能。2.3. 工作空间与异常：对于一个给定的末端受动器位置，反转运动学一般具有两个可行的解决方案。异常的结构会分开这两种解决方案，在异常的结构中，器的最终受动器不能在一个特定的方向移动。异常分为两种：固定异常和不定异常。一个闭环器可能既有固定异常又有不定异，然而在一个不定

11、异常中，常，在一个的异常中, Jacobian 点阵具有零决定Jacobian点阵的决定环连杆机构的异常问题。为无穷大。Ting (1992) 、 Asada和 Ro (1985)了五杆闭对于五连杆结构，Jacobian 矩阵的决定J 被定义为(见方程式 11)；对于五连杆机构，当( 见方程式 12)的情况时，固定异常存在。由方程式 (10)知,固定异常发生在工作空间的边界，所以，籍由选择链环尺寸来获得一个空间的宽阔异常。机器人的工作空间是最终受力器的总电子扫频量，同时机器人器伴有一种特殊的力，即法向力和切向力。，最终受力迪工作空间受限于机器人的几何学分析和铰链的机械约束以及驱动器的旋转极限。

12、力量工作空间受限于最终受力器的发向力和切向力。实际上，力量工作空间是机械人的一个工作空间的子集。当驱动器的旋转力矩在如下范围内时：0sup- = qsub1 =180sup- & 0sup- =qsub2 =180sup-.图 5 展示了五连杆机构在水平面内的模拟工作空间。总工作空间应付 5.0 N 的力量工作空间，在 10.0 N 的力量工作空间情况下是工作空间的一个子集。当弹簧秤的力设为9.81 N 和驱动器的旋转力在以下范围时：0sup-= qsub1 =180sup- and 180sup- = qsub2 =360sup-.图 6 展示展示了五连杆机构在竖直面内的模拟工作空间。总工作

13、空间应付 5.0 N 的力量工作空间，在 10.0 N 的力量工作空间情况下是工作空间的一个子集。3. 悬浮动态悬浮工具系统和悬浮机器人系统的模型分别如图 7 图 8 所示。 弹簧秤的性能参数见表III 。在悬浮系统中, phi是旋转角度, psi 是方位角。为了将悬浮系统形象化，考虑做如下假设：高架铁路的弹性变形，钢索的质量，滚动阻力，风力以及忽略噪音。最终坐标定义如下： (见方程式 13)( 见方程式 14)，有效的力Fsub取决受力器的于弹簧秤的设置，与悬浮的质量有关而不是钢丝绳的长度变化。在悬浮工具上的有效力被定义为： (见方程式 15)( 见方程式 16)。现在，水平面内的悬浮力为：

14、(见方程式 17)。在竖直面内的有效力Fsubvy 和 Fsubvz 被定义为：(见方程式 18)( 见方程式 19)。此时，在竖直面内来自弹簧秤的补偿力可被定义为：(见方程式 20)4. 系统动力学混合位置/力控制方案以一个工作空间的直角分解为基础。在平面运动中，考虑到悬浮工具的动态影响，位置/力控制模型 。在这部分中，竖直面中的混合位置/力控制模型从弹簧秤的重力补偿方面来描述。5. 仿真结果为了探讨机器人在横向和纵向面内的执行性能，利用前面章节的仿真程序进行了动态模型模拟，仿真框图如图 10。轨迹发生器,运动器,控制器,操作器动力, 以及约束条件都在函数中被描述了。端口用来连接标量或矢量信

15、号汇集成一个更大的矢量信号。转换器用来选择输出矢量的有用信号。5.1.水平面内为显示工具重力的影响，利用混合位置/力模拟以实现水平面运动。在模拟过程中，总操作时间为 10 秒，混合的时间为 0.5 秒，要求速度为 0.02 米/秒。最终受力器的轨迹在一个被约束的表面，从(0.0, 0.3) 到 (0.2, 0.3) 。模型工具的重量是 2.0 kg 。 假设是特制钢，弹簧秤的力看作是 19.62 N ，所需的力为 5.0 N 。从图 11 可看出, 与传统的工具系统相比，由于特制钢工具系统具有更小的连接摩擦，故其位置误差更小。 此外，从图 12 可看出，由于小的悬浮力作用于此悬浮工具系统，故其

16、引起力的误差更小。5.2. 竖直面内在竖直面内，当驱动器力矩极限在重力影响范围之内时，弹簧秤的力是必要的，用以补偿重力。一个特征曲线图用来说明力的必要性以使机械手在力矩的极限内保持在一个预设的速度。图 13 表示了在速度为 0.01 米/秒时弹簧秤的力和马达的驱动力矩之间的关系Fsubb。 在此特征曲线图里，力达到 5.0 N ，由于假想摩擦力的影响（方向力河切向力），马达驱动力保持不变。此时，由于受到力的影响，马达的驱动力将增加。从此特征图可以看出，当力从 5.2 N 变到 16.5 N 时，在驱动力极限内机器人能够作。进行了悬浮机器人操作的混合位置/力控制模拟实验。在模拟实验中，总操作时间

17、为 10 秒，混合的时间为 0.5 秒，最大速度为 0.01 米/秒，从特征曲线图可知，力设定为 9.81 N ，要求的力是 5.0 N。在垂直向上的运动中，机械手的轨迹在一个被约束的表面，从(0.3, 0.0) 到(0.3, 0.1) 。图 14 展示了机械手的有效的力和重力 。在竖直面的运动，弹簧秤的 力是补偿重力的主要部分，以及有效力非常小。图 15 和图 16分别展示了位置轨迹和力的轨迹。输出的位置轨迹与要求的位置轨迹之间存在一个小的固定误差以及力的输出与要求的力输出有一个小的时间滞后。6. 实验结果为了证明以上系统地有效性和正确性，下部分所示。在水平面和竖直面都进行了实验，实验结果如

18、6.1. 静力图 17 和图 18 分别展示了在静态时沿X 轴和 Y 轴的有效力Fsubhx 和Fsubhy。很明显， 当机器人抓住悬浮工具时，有效的静态力大小接近最佳，但是当机器人抓住工具而没有悬浮时，由于工具自身重量的影响，有效力将非常高。由于工具自身重量，机械手顶端会偏离引起位置误差。有效的静态力造成连接摩擦影响驱动器的驱动力矩。6.2.水平运动在本实验中，机械手抓取一个 2.0 千克的悬浮工具的运动轨迹在一条从(0.1, 0.34) 到(0.2, 0.34)的线上。速度指令为 0.02 米/秒，所需的力是 10.0 牛。从弹簧秤上悬吊起工具所需的力为 19.62 N 。在实验开始之前，

19、最终受力器与一个被约束的表面接触，图 19 展示了本实验的位置轨迹，图 20 展示了力的轨迹。实际的位置轨迹与所需的位置轨迹存在一个稳定的小误差，以及实际力与要求的力输出有一个小的时间滞后。6.3. 竖直运动在竖直平面内，当驱动器的驱动力矩极限在重力影响范围之内时，机器人不能进行自簧秤的力设定为 15.0 N，足够将在低速运行的机器人动操作。在本实验悬吊起来。机械手的轨迹在一个从(0.28, 0.22) 到 (0.28, 0.26)的被约束表面上。指令速度为 0.005 米/秒，所需的力为 2.0 牛 。图 21 和图 22 分别展示了位置轨迹和力的轨迹。实际的位置轨迹与要求的位置轨迹之间存在

20、一个小的固定误差以及实际的力的与所需的力轨迹有一个小的时间滞后。图 23 说明了所需的驱动力矩，此力矩在驱动器的最大极限之内。7.工业应用为证实上述被应用于工业的机器人系统的低能耗，倒角作业已经实行。图 24 展示了在竖直平面内的实验装备，在传统的系统中，用旋转的铁碳锉刀修毛刺的结果显示，在 304不锈钢上用 0.88 牛的解点压力和 0.01 米/秒的速度可生成一个可令人接受的倒角。在上述被提议的机器人系统中，已经应用于 SS400 倒角作业。悬吊此低能耗机器人的力为 15.0 牛。用一个重 0.13 千克（直径为 16 mm）的气动砂轮以最大旋转速度为每秒 30000 转的速度进行铣削 ，

21、倒角表面的 如图 25 所示，图 26 显示了在匀速为 0.01 米/秒的法向摩擦力fsubn 及切向磨削力fsubt。法向磨削力保持在所需的大小 2.0 牛，因为在毛坯尺寸中没有大的变化。切向力大约是法向力的一半，图 27 展示了通过一次单一的磨削倒角表面的剖切图。倒角结果显示了倒角面的宽度 0.36 +- 0.07 mm ，此结果在公差范围内。8. 结论上述提议的悬浮系统的主要目标是用能耗操作器完成中午的作业。在水平面和竖直面内都已经过。在水平运动中，悬浮系统具有一些优点，当重型工具超出驱动器的驱动力矩极限时，它可以利用弹簧秤的力进行操作。此系统的连接摩擦力小于传统的系统，在桡腕关节产生的

22、阻力更小，这对小容量的力传感器来说更是一大益处。此外，在竖直运动中，悬浮力补偿了作用在操作器上的重力。悬浮工具的动态模型和悬浮机器人系统已经发展和执行，利用当前的动力学公式，开展了模拟和实验以证明上述提议的系统的有效性。在竖直平面内，倒角作业已经开展了。在竖直平面内操作机器人需要一个大力矩驱动的驱动器以克服重力。弹簧秤的力补偿了工具在竖直平面内的重力。倒角表面的结果证明了悬浮机器人的自动磨削系统可以以低功率驱动力传感器和低能量驱动器在大尺寸的金属切削过程中具有广泛的可应用性。Abstract:The manipulation methods of a lowered direct-drive

23、robot-arm forheavy object manipulation using a suspendevice are presented. Manipulation of asuspended toolhe horizontal plane is considered. The algorithm is presented of thehybrid tools hybridition/force tracking scheme with respect to the dynamic behavior of suspended he horizontal plane. To manip

24、ulate the suspended robot-arm vertically, theition/force dynamic mhas been developed by considering the gravitycompensation of the spring balancer. In order to show thesible industrial applicationschamfering operations have been carried out. Simulations and experiments demonstratethe feasibility of

25、the proed systems.Copyright MCB UP Limited (MCB) 2000mmad Jashim Uddin: PhD student, Department of Systems and Information Engineering, Yamagata University, Jonan 4-3-16, Yonezawa 992-8510, Japan.:26 3237; Fax:26 3205.Yasuo Nasu: Professor, Department of Mechanical Systems Engineering, Yamagata Univ

26、ersity, Jonan 4-3-16, Yonezawa 992-8510, Japan.Kazuhisa Mitobe: Assote Professor, Department of Mechanical SystemsEngineering, Yamagata University, Jonan 4-3-16, Yonezawa 992-8510, Japan.Kou Yamada: Research Assote, Department of Electrical and InformationEngineering, Yamagata University, Jonan 4-3-

27、16, Yonezawa 992-8510, Japan.ACKNOWLEDGMENT: The authors gratefully acknowledge Mr Yoshihiro Ishihara, Mr Yoshiyasu Hariu, Mr Hidekazu Satou, and Mr Kazuo Abes efforts duringfabrication of the robot and implemenion of the control software.mmadJashim Uddin would like to acknowledge his scholarship by

28、 the Ministry of Education, Science, Sports, and Culture (MONBUSHO), Japan. Received: 5 January 2000 Accepted: 7 February 20001.roductionIn horizontal motion, tool weighs a considerable effect on jofriction. It affectsdirectly the driving torque. In vertical motion, the gravity effecs a considerable

29、influence on the dynamics of the manipulator. Robotic manipulation should bewithhe allowable limits of the driving torque and capacity of the forensors.roductionApplication of suspenmechanisms for lowered robot tasksSuspended tool system (STS) is a newly proed objecndling strategy tomanipulate heavy

30、 tools horizontally and suspended robot-arm system ( newly pro) is aer actuators and small capacity forensors. Due to their many advantagescompared to conventional systems, STS and erest for applications in industry.havee topics of growingParallel manipulators offer significant advantages over curre

31、nt serial manipulators when structural stiffness and high-performance dynamic properties are required.Therefore, su decades (echanisms have received some attention over the last twot, 1983). Direct-drive arms, in general, tend to have exsively fastoperating ranges, whereas the output for 1985). For

32、objecare extremely small (Asada and Ro, searches on the coordinated controlof multiple robot-arms (Schneider and Cannon,two or more robot-arms are used to perform a single carrying, handling, and manipulating capability can be ach manipulator cannot manipulate a heavy object because the acwithin a f

33、ixed limit. Many industrial robots are currently used in auto operations. Most of the grinding robots operate in a constrained environm Force controlled grinding robots for industrial uses are developed by many researchers (Kashiwagi et al., 1990; Whitney and Brown, 1987). However,les dingesystems,

34、the grinding tool is directly mounted on the robot-arm in a conventionalway and requires a large actuatorer. There are some researches onrobot-arm manipulationhe vertical plane (Nemec, 1994), bompensation forgravity was not considered. In general, the feasibility of a task to be performed by one or

35、more arms depends on both the kinematic and dynamic abilities of the manipulators.Automated robotic deburring has been described in (Her and Kazerooni, 1991).Robotic weld bead grinding system by PUMA 560 robot with vi been reported in Whitney et al. (1990). In all the previous deburring researches,

36、bigplane, the grinding pro the manipulator, espe the gravity effects.system hasrinding erticalts ofRobotic systems usually operate in a constrained environment. So, it is nesaryto control theition of-effectorhe free direction and the contact forcehe constrained direction. The hybridition/force contr

37、ol scheme proed byRaibert and Craig (1981) has gained considerable popularity over the other existing force control schemes.his pr, hybridition/force control scheme of robot-arm wisuspendedtool system is described.xtend the basis of hybrid control scheme byconsidering the dynamics of the suspended t

38、ool system in horizontal motion. In vertical motion, the dynamics of gravity compensation by spring balancer is discussed.2. System descriptionAsada and Ro (1985) designed a direct-drive five-bar parallel drive manipulator,which has many advantagech as: no backlash, small friction, high mechanicalst

39、iffness, and accuracy of motion. The experimental system consists of a robot with two degrees of freedom (DOF) having a five-bar link configuration and asuspensystem. Figures 1 and Figure 2 show the CAD design of the robotconfiguration wispring balancerhe horizontal and vertical plane,respectively.

40、Table I shows some important properties of the five-bar link mechanism.2.1. Kinematic and dynamic equationsThe link mechanism discussedhis section is a closed-loop five-bar linkmechanism as shown in Figure 3. There are two input linkst are driven by twoindependent direct-drive motors. Both motors ar

41、e fixed to the base frame. The length of links 1, 2, 3, and 4 are denoted by lsub1, lsub2, lsub3, & lsub4, respectively. The angles of the input links are denoted by qsub1 and qsub2measured from Y-axis.pocoordinates are given by:(see equation1)(see equation 2)From equations (1) and (2) the inverse k

42、inematics of the manipulator is obtained as:(see equation 3)(see equation 4)The task space Jacobian matrix is a 2 x 2 matrix and can be expressed as:(see equation 5)The inertia matrix of the robot-arm is a 2 x 2 matrix and can be expressed as:(see equation 6)whereA =Isub1+msub1lsup2subC1+Isub3+msub3

43、lsup2subC3+msub4lsup2su b1B m= (msub3lsub2lsubC3+msub4lsub1lsubC4)cos(qsub1-qsub2)C m= (msub3lsub2lsubC3+msub4lsub1lsubC4)cos (qsub1-qsub2)D m= Isub2+msub2lsup2subC2+Isub4+msub4lsup2subC4+msub3lsup2su b2The Coriolis and centripetal formatrix is a 2 x 1 matrix and can be expressedas:(see equation 7)(

44、see equation 8)The gravity matrix is a 2 x 1 matrix and can be expressed as:(see equation 9)(see equation 10)where g is the acceleration due to gravity.2.2. Hardware descriptionA hardware schematic diagram of the control system is shown in Figure 4. APentium basedputer, 133 MHz, is used to control t

45、he system. The A/Dand D/A converter has eight channels and 12-bit resolution. The servo driver hasthree control modes:ition control mode, velocity control mode, and torquecontrol mode. The counter board has three ports and 24-bit pulse resolution. A lowcapacity three-axis forensor (calibrated to wor

46、k up to 19.62 N) is mountedbetn the robot-arm tip and the patic gripper. The operationallifier isdesigned wiloss filter to eliminate unexpected noise. Table II shows someimportant properties of direct-drive motors.2.3. Work space and singularityFor a given end-effectorition, there are in general two

47、sible solutions to theinverse kinematics. The singular configuration separates these two solutions. At the singular configuration, the manipulator end-effector cannot move in certaindirections. There are two types of singularities, sionary singularity anduncerta uncertay singularity. A closed-loop m

48、anipulator may have both sionary andy singularities. At a sionary singularity, the Jacobian matrix has zerodeterminant, whereas at an uncertay singularity, the determinant of Jacobianmatrix is infinity. Ting (1992) and Asada and Ro (1985) po problem for the five-bar closed link manipulator.singulari

49、tyFor the five-bar link configuration, the determinant of Jacobian matrix, J, is definedas follows:(see equation 11)For five-bar link configuration the sionary singularitywill exist when:(see equation 12)From equation (10), the sionary singularityoccurs on the boundary of the workspace. Thus, by sel

50、ecting link dimens, awide singularity free workspace can be obtained. The Cartesian workspace of arobot-arm is the total volume st out by-effector as the robot-armexecutes all volume s motions wisible motions. The force workspace of a robot-arm is the totalhe robot-arm executes allsibletangential fo

51、rce.The Cartesian workspace is constrained by the geometry of the robot-arm as wellas mechanical constras of the jos and the limit of the actuators roion. Theforce workspace is constrained by the normal and tangential force appd at theend-effector. Actually, the force workspace is a subset of Cartes

52、ian workspace of arobot-arm.Figure 5 shows the simulated Cartesian workspace of the five-bar link mechanismhe horizontal plane when the actuator roion is limited withhe followingranges: 0sup- = qsub1 =180sup- & 0sup- = qsub2 =180sup-. The total Cartesian workspace copes with 5.0 N force workspace, w

53、here the 10.0 N force workspace is a subset of Cartesian workspace. Figure 6 shows the simulatedCartesian workspace of the five-bar link mechanismhe vertical plane when thelifting force of the spring balancer is set to a force of 9.81 N and the actuatorro- and180sup- = qsub2 =360sup-. The total Cart

54、esian workspace copes with 5.0 N force workspace, where the 10.0 N force workspace is a subset of Cartesian workspace.3. SuspendynamicsThe ms of the suspended tool system and the suspended robot-arm systemare shown in Figure 7 and Figure 8, respectively. The properties of the springbalancer are show

55、nable III.he suspensystem, phi is swing angle, andpsi is orienion angle. In order to simplify the suspensystem, the followingamptions are considered. The elastic deformation of the overhead rail, the massof the wire rope, rolling Cartesian coordinates of, wind for, and noise are neglected. The-effec

56、tor are defined as follows:(see equation13)(see equation 14)The active lifting force, Fsubb,he wire rope depends onthe setting of the spring balancer, which is related to the suspended mass butindependent of the variation of the rope length. The active foron the suspendedtool are defined as follows:

57、(see equation 15)(see equation 16)Now, the suspenforce Fsubvzhe horizontal plane is:(see equation 17)The effective forFsubvy, ande equation 18)(see equation19)Then, the compensation force from the spring balancer be defined as follows:(see equation 20)he vertical plane can4. System dynamicsThe hybri

58、dition/force control scheme is based on an orthogonalitionof task space. The hybridition/force control mis discussed for planarmotion by considering the dynamic effect of the suspended tool.his section,hybridition/force control mfor vertical motion is described by gravitycompensation of the spring b

59、alancer.5. Simulation resultsIn order to investigate the performance of robot-armhe horizontal and verticalplanes, simulations have been carried out using the dynamic ms developed in block diagramthe preceding sections byprogram. Theis shown in Figure 10. The trajectory generator, kinematics, contro

60、ller, manipulatordynamics, and constraconditions are describedAB functions. The portsare used to combine scalar or vector signalso a larger vector. The switches areused to select the desired signals of the output vector.5.1. The horizontal planeHybridition/forimulation is carried out for horizontal