PUMA560机器人的硬件改进和计算转矩的控制外文文献翻译中英文翻译外文翻译Word格式文档下载.docx

1、正如操作臂接口卡中所描述的一样，原来的功率放大器以及电流、转矩控制器在新设计的控制结构体系中仍然存在。Puma 560机器人控制部分的硬件结构如图一所描述。专用的TRC041改进卡代替原来的芯片安装在Mark 控制器的背面。控制器上的TRC041芯片通过专用的电缆与Q8数据采集器相连接,而Q8数据采集器又与个人计算机上的PCI接口相连接。 奔腾4, 2.4GHz的个人计算机在Windows 2000操作系统下运行,用于控制机器人操作臂的精确运动。伺服电机的转矩通过Mark 控制器来控制，并且与由个人计算机通过Q8数据采集器发送过来的数字电压相比较。Q8数据采集器从TRC041芯片上接收到编码器

2、和电位计上的信号。 电位计上的信号用来校准和标定最近接收到的标志信号，然后校准编码器上的读数用来决定关节的位置和方位。 控制器设计利用控制计算转矩来实现机器人操作臂的控制，这一项技术多用于非线形的动态系统的控制中，用来去掉操作臂控制的非线形、也方便内部控制和定值的获得。关节位置通过微分积分调节器控制计算转矩，进而来控个人计算机 Windows 2000MATLA 6.5/Simulink5.0 Wincon 402PUMA560操作臂改进的UNIMATE控制器PCI总线Q8数据采集器TRC041网卡设置图1 硬件结构专用的TRC041改进卡安装在Mark控制器上，控制器上的TRC041改进卡和

3、Q8数据采集器通过专用的电缆线来连接。奔腾4,2.4GH的个人计算机在Windows2000操作系统下运行，同时应用MATLAB/SIMULINK以及Wincon应用软件来控制机器人操作臂。制关节位置，计算转矩控制器计算必须的参考转矩值，参考转矩值的计算公式如下：M（q）（qKeKeK）N（q,q） （A1）在这里R6是一个矢量，是指关节转矩的参考值；qR6也是一个矢量，一般是指关节变量；M（q）是转动惯量矩阵；N（q,q）代表非线性的术语，例如向心力和震动的影响，以及摩擦和重力（万有引力）的影响；e（t）=qd（t）-q（t）是跟踪误差；qd（t）R6是理想的轨迹值；R6是总的跟踪误差；并且

4、Kp、 Ki和 Kv是微分，积分调节器在各个关节的参数设定值的矩阵真值表。因为公式（）是一个在时间上连续，即动态参数的公式在应用的初期通常应在数字计算机中利用。假定这个动态的模型应用的相当恰当和精确，这个设计将对机器人操作臂提供有效的控制，幸运的是这种Puma 560机器人操作臂的动态性正如其所描述的一样，满足这种设计要求。相对的动态性和Denavit-Hatenburg操作臂所应用的参数是基于45，参考文献中所描述的一样。PID调节器参数的获取可参考文献4。软件部分设计 软件结构的实现是基于在Windows 2000下运行的SIMULINKLAB和SIMULINK软件来实现的。SIMULIN

5、K软件使控制算法的快速设计得以实现，并且允许利用C代码来实现特殊的功能，并称之为S功能。除此之外，Wincon 4.16用来实时执行已经编译的C代码，这些C代码是来自于SIMULINK软件项目下的实时监控处得来的，并且通过它来与Q8数据采集器通信。图2 利用PID调节器设计计算转矩控制 并在SIMULINK软件下实现控制利用PID调节器设计计算转矩控制并在SIMULINK软件下实现控制。已知当前的关节位置和过去的关节位置通过调节器计算当前的关节速度。饱和反馈用来防止积分器出错，采样间隔是1ms。轨迹生成轨迹的生成也即是关节的运行路线的生成，是通过MATLAB代码来实现的。在实时控制器运行的时候

6、通过关节点理想轨迹的离线计算可以充分利用处理器，提高处理器的利用效率。第五个命令是用来计算关节沿着指定的路线运动时关节角的矩阵变换。这个矩阵一旦被计算出来，这个变换矩阵就被用来作为控制器的表格来实现理想关节角的插值。控制器的实现PID计算转矩控制器利用SIMULINK软件来实现，它的实现如图2所示。由公式（1）给定的计算转矩的控制准则有一部分写成C代码作为SIMULINK软件的S功能。专门的SIMULINK软件模块与Q8数据采集器连接在一起来实现控制算法的计算，并且将计算转矩的参考值传送到Mark 控制器。相对的动态性和Denavit-Hatenburg操作臂所应用的参数是基于45参考文献中所

7、描述的一样。用户界面基于MATLAB的用户使用界面允许使用者通过改变由轨迹生成器生成的代码参数来详细的了解目标轨迹和用户界面。用户使用界面如图三所示。这个机器人操作的用户使用界面十分友好，关节空间的轨迹可以被储存，也可以被重新装载。末端执行器在笛卡尔坐标系中的位置和方位可以利用定义在文献7中的运动学方程来得到。关节到达笛卡尔坐标系中某一特定位置和方位的关节角由文献8中给定的逆运动学方程来求解。实验调试在模拟环境中完成测试，并且达到有效性的要求后，也应该调试一下实际的机器人操作臂的应用情况。很多测试指标都用来评估控制器的性能。控制器调试的结果表明此控制器的设计结构有很好的使用性能，对于不同的轨迹

8、参考值均能达到小的跟踪误差，并且这些误差在要求的范围之内。为了达到跟踪误差的高性能和高精度，在此设计中采用了飞投运动的原理。飞投指的是渔民投掷鱼线到河中的某一位置。这一涉及到飞投的行为存在以下几种状态，向前投掷，向前的运动，腕部关节的抖动，以及投掷运动的完成。PUMA 560机器人操作臂的运动通过提供一个预先设定的关节轨迹到控制器上，然后大体上来模仿投掷运动的原理来实现关节轨迹的控制。参考轨迹包括正弦曲线信号的合适的相位，量值，以及应用在关节二、三、五上的频率。运动结果实现了由人来完成的投掷运动的效果。PUMA 560机器人操作臂实验的关节轨迹的数值如图四所示，这个界面里包括了投掷运动的三个循

9、环周期。实验用的视频是AVI格式的，你可以在文献10里下载。图3应用界面该界面显示了当前的关节角度和末端执行器的笛卡尔坐标位置。在关节的运动范围内编辑器提供有效的关节角度，利用其可以设定理想关节角度。它也显示了末端执行器的理想笛卡尔坐标位置。该应用界面也可以存储当前位置和装载以前存储的位置。教学过程研究这个课题的学生获得了改进工业机器人操作臂的能力和接口部分的设计。这个课题包括阅读和解释即熟练掌握相关科技文献上的相关知识，移去UNIMATE控制器上的多余的芯片，根据使用指南插入改进后的芯片选择和购买电缆和终端，以及接口电源，伺服系统，编码器，以及电位计和数据采集器。学生也学习了计算转矩控制的原

10、理，并且将其熟练的应用到了PUMA 560机器人操作臂的运动控制当中。运动控制的实现还涉及到计算转矩控制方程的模型代码，在这里计算转矩控制方程是通过C语言编制的SIMULINK软件的S功能来实现的；运动控制的实现还包括作为校准的SIMULINK系统的设计，比例微分积分调节器控制，轨迹生成，以及外部信号接口。机器人的应用开发由于该课题是在2002-2003学年完成的，机器人和基于接口技术的新的个人计算机运动控制的开发已经由另外的两个再读研究生来完成，这次历时四年。这两次计算转矩的控制开发都是用在内环上。这次研究的主要内容是： PUMA机器人操作臂的力控制。这个内容涉及到操作臂的末端执行器的六个力

11、传感器以及和计算机的接口部分的设计，也包括在SIMULINK下对控制器的控制。 实现PUMA机器人操作臂的随意控制。这个内容包括利用专用的控制器替换在2002-2003年使用的比例微分积分调节器控制的控制。在基于神经网络控制器的发展和实现的基础上，未来的研究主题因该是利用神经网络控制器来控制PUMA机器人操作臂。一些机器人控制的实验手册可以提供给学生二手的资料，以便了解机器人控制的相关知识，也可以利用它来评估不同的控制器设计的优劣，包括0重力加速度、计算转矩控制、阻抗控制、以及导纳控制等。这篇论文描述了PUMA 560机器人操作臂的改进，与个人计算机的接口，基于MATLAB轨迹生成和友好的用户

12、界面的软件的开发，在SIMULINK下比例微分积分调节器控制的实现。这个项目是利用先进的技术将在技术上落后但机械结构上仍还完善的机器人实验台变废为宝的恰当的例证，能够使使用者在低成本的基础上利用基于SIMULINK和MATLAB开发的先进的、柔性的软件来实现对机器人操作臂的实验研究。附录 2Hardware Retrofit and Computed Torque Control of a Puma 560 RobotUpdating an industrial manipulator for educational useThe Department of Cybernetics at th

13、e University of Reading U.K. had, for a number of years, a functional PUMA 560 manipulator robot with its original control hardware and human interfaces. This article describes the results of a third-year project by two undergraduate students in the Cybernetics Department. The project consisted of i

14、nterfacing the robot arm with a PC and developing software for the real-time implementation of a computed torque control scheme.The PUMA 560 is a six-degree-of-freedom robotic manipulator that uses six dc servomotors for joint control. Joint positions are measured using encoders and potentiometers.

15、Three large motors provide control of the waist, shoulder, and elbow, while three smaller motors position the orientation of the wrist. The PUMA 560 has a large reach and can achieve impressive acceleration. Originally designed for assembly and manipulation tasks, the PUMA arm is now widely adopted

16、by academic institutions for research purposes. While the robot arm itself is still relatively robust, the original Unimation Mark II controller was outdated and in need of replacement. The use of a PC running MAT-LAB/SIMULINK and associated real-time tools facilitates the prototyping, development,

17、and on-line testing of advanced schemes for controlling the manipulator. A SIMULINK-based robotic toolkit for controlling the PUMA 560 manipulator, but which excludes the computed torque control technique employed in this article, is reported in1.Retrofitting and Interfacing the PUMA 560 RobotTo con

18、trol the PUMA arm using a PC, we removed the original LASI/11 computer, EEPROM boards, and arm interface card. The original power amplifiers and current/torque controllers remain in the control architecture, as does the arm cable card. The hardware configuration is illustrated in Figure 1.Special-pu

19、rpose TRC041 retrofit cards 2 re installed in the backplane of the Mark II controller, replacing the original boards. Custom-made cables are used to interface the TRC041 cards and a Q8 data acquisition board3, which is connected to the PCI interface of the PC. An Intel Pentium 4.2.4 GHz PC running t

20、he Windows 2000 operating system is used to control the arm. Servo torques are controlled by the Mark II controller, with reference values sent asPersonal ComputerMATLAB6.5/Simulink5.0P PUMA560 ManipulatorRetrofittedUNIMATEControllerPCI BUS Q8 Data Acquisition BoardTRC041Cable CardSetFigure1. Hardwa

21、re configuration.Special TRC041 retrofit cards were installed in the Mark II controller. The TRC041 cards in the controller and a Q8 data acquisition board were interfaced using custom-made cables. An Intel Pentium 4 2.4 GHz PC running the Windows 2000 operating system, together with MATLAB/SLMULINK

22、 and Wincon, are used to control the arm.analog voltages from the PC through the Q8 board. The Q8 board receives encoder and potentiometer signals from the TRC041. Readings from the potentiometers are used to calibrate the encoders to the nearest index purse. The calibrated encoder readings are then

23、 used to determine the joint positions.Controller DesignControl of the arm is performed using computed torque control4. This technique uses a nonlinear dynamic model of the system to remove the nonlinearities of the manipulator, facilitating external control with fixed gains. Joint positions are con

24、trolled by means of a proportional integral-derivative （PID） computed torque controller, which calculates the six required reference torque values by means of WhereR6 is a vector of joint torque references;qR6 is a vector of generalized joint variables; M（q） is the inertia matrix; N（q,q） represents

25、nonlinear terms, including Coriolis/centripetal effects, friction, and gravity; e（t）=qd（t）-q（t） is the tracking error, qd（t）R6 is the desired trajectory;R6 is the integral of the tracking error; and Kp, Ki and Kv are diagonal matrices with the proportional, derivative, and integral gains for each jo

26、int, respectively. Since （1） is a continuous-time formulation, a sufficiently short sampling period should be used in a digital computer-based implementation.Provided the dynamic model employed is reasonably accurate, this scheme provides effective control of the arm. Fortunately, the dynamics of th

27、e PUMA 560 manipulator are well known and reported. The inverse dynamics and Denavit-Hatenburg arm parameters employed are based on those reported in 45. The PID controller gains employed are reported in4.Software DesignThe implemented software architecture is based on MATLAB and SIMULINK running un

28、der Windows 2000. SIMULINK enables rapid design of control algorithms and allows specific functions to be implemented in C code as S-functions. In addition, WinCon 4.6 is used for real-time execution of the compiled C-code generated by the Real Time Work shop form the SIMULINK diagram, and to commun

29、icate with the Q8 board.Trajectory GenerationTrajectory generation, which is performed in joint space, was implemented in MATLAB code. The off-line calculation of points on the desired trajectory reduces the overhead on the processor while the real-time controller is running. A fifth-order polynomial is used to calculate a matrix of joint angles along the specified trajectory. Once calculated, this matrix is used