《并聯(lián)機(jī)器人原》由會(huì)員分享，可在線閱讀，更多相關(guān)《并聯(lián)機(jī)器人原（11頁(yè)珍藏版）》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。

1、Virtual Prototyping of a Parallel Robot actuated by Servo-Pneumatic Drives using ADAMS/Controls Walter Kuhlbusch, Dr. R diger Neumann, Festo AG & Co., Germany Summary Advanced pneumatic drives for servo-pneumatic positioning allow for new generations of handlings and robots. Especially parallel r

2、obots actuated by servo-pneumatic drives allow the realization of very fast pick and place tasks in 3-D space. The design of those machines requires a virtual prototyping method called the mechatronic design [ 1]. The most suitable software tools are ADAMS for mechanics and Matlab/Simulink for drive

3、s and controllers. To analyze the overall behavior the co-simulation using ADAMS/Controls is applied. The combination of these powerful simulation tools guarantees a fast and effective design of new machines. 1. Introduction Festo is a supplier for pneumatic components and controls in industrial a

4、utomation.The utilization of pneumatic drives is wide spread in industry when working in open loop control. It s limited howwven it comes to multipoint movement or path control. The development has been driven to servo-pneumatic drives that include closed loop control. Festo servo-pneumatic axes ar

5、e quite accurate, thus they can be employed as drives for sophisticated tasks in robotics. The special advantage of these drives is the low initial cost in comparison to electrical and hydraulic drive systems. Servo-pneumatic driven parallel robots are new systems with high potentials in application

6、s. The dynamical performance meets the increasing requirements to reduce the cycle times. One goal is the creation and optimization of pneumatic driven multi-axes robots. This allows us to support our customers, and of course to create new standard handlings and robots (Fig. 1). The complexity of

7、parallel robots requires the use of virtual prototyping methods. Two-axes machine with pneumatic muscles Tripod Fig. 1. Prototypes of servo-pneumatic driven multi-axes machines Ssra  Preferred applications are fast multipoint positioning tasks in 3-D space. Free programmable stops allow a fle

8、xible employment of the machine. The point to point (ptp) accuracy is about 0.5 mm. The continuous path control guarantees collision free movement along a trajectory. 1.1. Why parallel robots? The main benefits using parallel instead of serial kinematics is shown in Fig. 2. - dynamical performanc

9、e: high speed and acceleration - high stiffness: closed kinematic system , intelligent motion control with continuous path control reduced moving mass load - simple construction: identical parts, modular concept， . Fig. 2. Benefits of robots with parallel kinematics High dynamical performance

10、is achieved due to the low moved masses. While in serial robots the first axis has to move all the following axes, the axes of a parallel robot can share the mass of the workpiece. Furthermore serial axes are stressed by torques and bending moments which reduces the stiffness. Due to the closed kine

11、matics the movements of parallel robots are vibration free for which the accuracy is improved. Finally the modular concept allows a cost-effective production of the mechanical parts. On the other hand there is the higher expense related to the control. 1.2. Why Pneumatic Drives? The advantages of

12、servo-pneumatic drives are: direct drives fhigh accelerating power compact (especially rodless cylinders with integrated guidance) robust and reliable cost-effective Direct drives imply a high acceleration power due to the low equivalent mass in relation to the drive force. With pneumatic drives th

13、e relationship is particularly favorable. Festo has already built up some system solutions, predominantly parallel robots (see Fig. 1), to demonstrate the technical potential of servo-pneumatics. Which performance can be reached is shown in Fig. 3. This prototype is equipped with an advanced model b

14、ased controller that makes use of the computed torque method [ 3]. Frame space 800x750 h 二 1100 [mm] Workspace (cylindrical) d 二 400 h = 200 [mm] Max acceieration (5 bar, 0 3 kg lead) 50 [mnV 守 Max velocity 38 [mm/s] Absolute accuracy 0.5 [mm] Repetition accuracy 0.1 [mm] Load

15、< 1 陶 Technical Data: Fig. 3. Performance of the Tripod 2. Design Method The system design, where several engineering disciplines are involved in, requires a holistic approach. This method is the so-called mechatronic design. The components of a mechatronic system are the mechanical support

16、ing structure, the servo drives as well as the control. All these components are mapped into the computer and optimized with respect to the mutual interaction. This procedure can be used to analyze and improve existing systems as well as to create new systems. The two main steps of the mechatronic d

17、esign are first building models in each discipline, and secondly the analysis and synthesis of the whole system. These steps are done in a cycle for the optimization. The modeling can be carried out in two ways: Either you apply one tool to build up models in all disciplines, but with restrictions.

18、 The other way is to use powerful tools in each discipline and to analyze the whole system via co-simulation. In this case you have to consider some specials of the solving method like communication step size or direct feedthrough behavior. 2.1. Why Co-Simulation? Co-simulation is used because of

19、the powerful tools, each specialized in its own discipline. ADAMS is an excellent tool for the mechanical part and Matlab/Simulink is the suitable tool for controller development and simulation of pneumatics. The behavior of the mechanical part is modeled at best using ADAMS/View. The advantages of

20、 ADAMS are: fast physically modeling of rigid and elastic bodies extensive features for parameterization animation of simulation results solving inverse kinematics by “general point motion ” visualization of eigenmodes (ADAMS/LINEAR) export of linear models (A,B,C,D) A big advantage is the automa

21、tic calculation of the direct and inverse kinematics. The direct kinematics of parallel structures often cannot be solved analytically. Furthermore different kinematics can be compared to each other very easily when you define a trajectory of the end- effector via “general point motion ” . Applying

22、 these two software tools guarantees a high flexibility regarding the design of new systems. It is very important to analyze the closed loop behavior at an early stage. This makes a big difference between the mechatronic design and the conventional design. Furthermore the visualization of the mechan

23、ical system makes the discussion within a team very easy. 2.2. Restrictions A disadvantage is that the model of the mechanics is purely numerically available. However some symbolic code of the mechanical system is needed for the control hardware when the system becomes realized. In general we have

24、 to derive the equations of the inverse kinematics, which are used in the feed forward control. For specific robot types a controller with decoupling structure is necessary in order to fulf川 the requirements. Then the symbolic code of the dynamics is needed. For this we have to pull up further tools

25、 to complete the task. 2.3. What has to be analyzed? For the design of new robots it is important to know about the effect on the system stability and accuracy. The main properties that influence stability and accuracy are opposed in Table 1 for different kinematical structures. Table 1: Properti

26、es of different kinematical configurations serial rotxjts parallel robot Robot Type: * L * ■ ■ 『；丁小 Hflkl i a 1 尸* ? *耍 -J, 1 -鏟1 L * [ cartesian cylindrical articulated Position dependency on inertia none minor strong medial Position dependency on gravity forces n

27、one none medial (scara: none) existing Coupling between axes none none strong medial Gyroscopic forces none minor strong medial With respect to the control the cartesian type is the best one. But the main disadvantage of a serial robot compared with a parallel one is the lower dynami

28、cs and the lower stiffness (see Fig. 2). Depending on the requirements with regard to dynamics and accuracy different control approaches must be applied. As mentioned above we prefer to employ a standard controller SPC200 for a single axis. Due to the coupling of the axes the stability of the clos

29、ed loop system must be checked. 3. Model of the Tripod The model of the Tripod consists of three parts: the mechanics, the pneumatic drives, and the controller. 3.1. Mechanics (ADAMS) We apply the so-called delta-kinematics which causes a purely translational movement of the tool center point (t

30、cp). An additional rotary drive allows the orientation of the gripper in the horizontal plane. Together with the rotary drive the machine has four degrees of freedom. upper plate (fixed to ground) slider of the drive profile tube of the drive tcp plate rotary drive gripper lower plate (fixed

31、to ground) Fig. 4. Degrees of freedom and structure of the Tripod The tripod is modeled using rigid body parts what is often sufficient for the present type of parallel structure. The upper and lower plates are fixed to ground. The profile tubes are connected to these plates via fixed joints. Each

32、 slider has one translational degree of freedom. Both ends of a rod are connected to the neighbored parts by universal joints. Including the rotary drive, the model verification results in four Gruebler counts and there are no redundant constraints. The model is parameterized in such a way that diff

33、erent kinematical configurations can be generated very easily by means of design variables. The most important parameters are the radiuses of the plates (see Fig. 4) and the distances to each other. For instance the following configurations can be achieved just by variation of these parameters or de

34、sign variables. Fig. 5. Variation of kinematics by “ design variables 3.2. Servo-Pneumatic Drives (Simulink) The models of the servo-pneumatic drives are developed by means of Matlab/Simulink. Depending on the requirements several controller models were developed. It is common to all that the

35、y are highly non-linear. Mainly the compressibility of air makes a more complex control system necessary. All controller models including the standard controller SPC200 are available as C-coded s-functions. This allows to use the same code in the simulation as well as on the target hardware. A surv

36、ey of the control scheme is shown in Fig. 6. For this contribution it is important to know about the interface for the co-simulation. The calculated forces of the servo pneumatics are the inputs to the mechanics. The slider positions are the outputs of the mechanics. Detailed information on the cont

37、rollers can be found in [ 2] and [ 3]. Sirnullnk .\DAMS Fig. 6. Control structure —:*一一*三.三住」— uo一百一-sdJJEEI3L E,LPffl苫 工 wlWLW IZH 4. Analyzing the behavior of the whole system When the modeling is done we can go on with the second step of the mechatronic design. In the following it is ass

38、umed that the SPC200 controller always controls the machine. The task is the analysis and synthesis of different parallel kinematics relative to stability, dynamics, and accuracy for a given workspace. Some studies, e.g. concerning the workspace, can be made exclusive using ADAMS. Others such as fe

39、edback analysis are carried out by means of co-simulation. The workspace can be determined by varying all drive positions in all combinations. After simulation the end-effector positions are traced using the feature “create tracespline ” . V u id 0 加打.任咽 i” jOS JDte-IOII七位吼 Fig. 7. Drive mot

40、ions for the workspace calculation The data can be visualized in ADAMS or any other graphics tool. As an example the workspace of the Tripod configuration of Fig. 7 is represented in Fig. 8  Right rie# From vie卻 Fig. 8. Workspace of the Tripod (configuration as in Fig. 7) Measuring the velo

41、city of the end-effector at the same time delivers the gear ratios of all drives over the workspace. To examine the behavior of the closed loop system ADAMS/Controls is used to couple ADAMS and Simulink. Before the model can be exported some inputs and outputs of the plant must be defined by state

42、variables. The inputs of the Tripod are the drive forces. Though the controller makes only use of the drive position some additional signals are defined as outputs: The drive velocities are needed for solving the differential equations of the pressures in the pneumatics model. Furthermore we need th

43、e velocity of the tool center point to calculate the non-linear gear ratios. Finally the drive accelerations serve for the calculation of the equivalent moved masses. The whole system is shown in Fig. 9. Fig. 9. Model of the whole system The model of the mechanics is embedded in Simulink. ADAM

44、S/Controls makes the interface available by means of s-function. The equivalent moved masses depend on the positions of drives. The non-linearity of the robot grows with the strength of this dependency. As shown in Table 1 with the parallel kinematics there is a medium strong coupling of the dynami

45、cs. This coupling is neglected, if we use the standard SPC200 controller. Nevertheless there is an influence on the stability of the closed loop system. To initialize and parameterize this controller we need the following information from the mechanics model: equivalent moved mass of each drive (

46、depends on slider positions) gravity forces in initial position Coulomb and viscous friction The controller is designed for a single axis with a constant mass. Due to the position dependency of the equivalent moved masses of the robot we have to choose an average value for each drive. Unfortunatel

47、y with ADAMS there is no easy way to calculate the equivalent moved masses along a trajectory. We tried to apply different methods such as dividing a drive force by its acceleration during a slow motion, but this method yielded not in satisfying results. The best method found is the linearization of

48、 the system. However this requires ADAMS/Linear. When we define the drive accelerations as plant outputs in ADAMS/Controls the direct feed through matrix D of the exported linear system delivers the mass matrix in the defined operating point as M(q) f D(q1) Corresponding to the three degrees of

49、 freedom of the rigid body system the size of the mass matrix M(q) is three by three. It depends on the vector of the generalized coordinates of the drives. The non-diagonal elements cause the coupling between the axes. The factor f depends on the units chosen for the inputs and outputs. When the fo

50、rces are given in [N] and the accelerations are given in [mm/s 2] f is 0.001. With a slider mass of 2 kg and an end-effector mass of 2 kg the mass matrix for the three positions shown in Fig. 10 are: pos. 0 pos 1 pos. 2 M = -4.13 -03 -03 -03 4.B -03 -03 -C.3 4.13 - 5.01 -LQ3 -1.05 -1

51、.03 SOI - 104 -1 05 -1 04 5.01 M = - 5.14 -032 -2A2 -0.32 4.10 -1 17 U 2.42 -1J7 6 8。 The gravity forces can be calculated very easily by static simulation. Likewise it is easy to model the friction in ADAMS. Nevertheless the parameters can differ very strong from one application to anot

52、her one. With the parameterized controller the stability should be checked in several operating points by means of eigenvalues and the dynamics of the closed loop system can be analyzed by means of frequency responses. Of course with a robust controller you can start with a simulation in time doma

53、in. This gives information about the accuracy and system limits. For this we need the references for the drives. For a reference trajectory of the tool center point ADAMS applying the “general point motion " can generate the drive positions. Fig. 10. Solving inverse kinematics by feature "general

54、point motion" In the following the simulation results are presented for a tripod configuration shown in Fig. 10. The workspace of this machine is 川ustrated in Fig. 8. Fig. 11. Left: Trajectory of the tool center point. Right: Drive references and measures 5. Conclusion The coupling of the soft

55、ware tools ADAMS and Simulink via co-simulation is a powerful method of virtual prototyping. This method enables an efficient design and optimization of servo-pneumatic driven robots. Especially robots with parallel kinematics can be analyzed very fast using ADAMS. Due to the potential of the linear

56、 analysis the use of ADAMS/Linear is meaningful. Particularly with controlled systems the linear analysis is required. Literature [1] Kuhlbusch, W, Moritz, W, L ckel,J., Toepper, St., and Scharfeld, F.: TriPlanar - A New Process-Machine Type Developed by Means of Mechatronic Design. Proceedings of

57、 the 3 rd International Heinz Nixdorf Symposium on Mechatronics and Advanced Motion Control, Paderborn, Germany, 1999. [2] Neumann, R., G? ttert, M. Ohmer, M.: Servopneumatik - eine alternative Antriebstechnik f r R oboter, Robotik 2002, 19-20. Juni in Ludwigsburg, Germany, 2002, VDI-Bericht Nr. 1679 p. 537-544. [3] Neumann, R., Leyser, J., Post, P.: Simulationsgest tzte Entwicklung eines servopneumatisch angetriebenen Parallelroboters. Tagungsband SIM2000 - Simulation im Maschinenbau, Dresden, Germany, 2000, p. 519-536.