7/21/2019 Hiba papier2.pdf http://slidepdf.com/reader/full/hiba-papier2pdf 1/12 See discussions, stats, and author profiles for this publication at: https://www.researchgate.net/publication/258576045 Simulation of a Stäubli TX90 Robot during Milling Using SimMechanics ARTICLEinAPPLIED MECHANICS AND MATERIALS · MARCH 2012 Impact Factor: 0.15 · DOI: 10.4028/www.scientific.net/AMM.162.403 READS 157 3 AUTHORS, INCLUDING: Philippe Bidaud Pierre and Marie Curie University - Paris 6 193 PUBLICATIONS 1,087 CITATIONS SEE PROFILE Available from: Philippe Bidaud Retrieved on: 10 January 2016
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
All rights reserved. No part of contents of this paper may be reproduced or transmitted in any form or by any means without the written permission of TTP,www.ttp.net. (ID: 134.157.253.65-22/06/12,14:17:23)
j[5]) were calibrated previously by using an autonomous
calibration method [2, 3, 4] which aims to identify the difference between the nominal and the real
values of the kinematic parameters and then to have a better knowledge of the position of the end-
effector (rate of knowledge improvement is about 94 %). The nominal values of the kinematic
parameters (in bold) added to the errors found during calibration are shown in Table 1.
Table 1. Calibrated Kinematic parameters of the TX90 robot
j α d θ r β
units [rad ] [mm] [rad ] [mm] [rad ]
1 0-0.0046 0-0.89 θ1+0.0083 0-0.96 0
2 -π /2-0.0012 50+0.96 θ2+0.0017 0 0
3 0+0.0004 425+3.26 θ3+0.0044 50+0.67 0+0.0006
4 π /2 0-2.29 θ4+0.0027 425+3.19 0
5 -π /2 0-1.13 θ5-0.0036 0-0.45 0
6 π/2 0 θ6 0 0
Previously, identification of the dynamic parameters, and identification of the elastic parameters
and the joint stiffness matrix (Table 2) were carried out on the TX90 robot [4]. These parameters
are taken into consideration in the simulator for the nearest representation of the reality.
The simulation tool will be applied on an example of milling and then a comparison between the
real and the simulated data (i.e. angular torques) will be applied.
Description of the simulation tool
To model the dynamics and the control of the robot, the simulation tool must be coupled with
Simulink blocks and use Matlab functions in order to compute for example: the inverse kinematic
model, the trajectory generation and the control blocks.
The chosen tool to simulate the TX90 is SimMechanics [6,7,8] which is a sub-tool of Simulink®.
Consequently, its models can be interfaced with ordinary Simulink block diagrams which speed up
the simulation and integrate everything in the same environment.
Moreover, it is simple to use and its block set consists of seven sub-libraries that represent the
following: bodies, joints, sensors (joint sensors, body sensors), actuators (joint actuators, bodyactuators), gearboxes, constraints and drivers, and force elements.
SimMechanics tool allows to:
− Model all the elements of a multi-body system (i.e. bodies, joints, connections, forces) in
Simulink;
− Import full models from CAD systems (i.e. Stäubli SolidWorks CAD [9]), with the
properties of inertia, lengths, angles;
− Generate a 3D animation to visualize system dynamics.
404 Mechanisms, Mechanical Transmissions and Robotics
Figure 2. Three-dimensional animation of the TX90 robot
Trajectory generation and control
The approach used for the generation of trajectories in the case of the TX90 was not provided by the
manufacturer for reasons of confidentiality. The study of the position and the velocity signals (given
by the "Stäubli recorder") and the calculation of the accelerations (derivation of the velocity) show
that the approach is applied in the joint space using the trapezoidal velocity law.
This approach provides during movement: a continuous velocity (ensures a minimum time by
saturating the velocity and acceleration at the same time) and a continuous acceleration (replaces
the acceleration and braking phases by a law of the second degree and therefore the position is a law
of the fourth degree) [10].
On the other hand, only the name of the controller used by Stäubli has been provided by the
manufacturer through a confidential agreement and so it is not possible to present it in this paper.
The controller and the trajectory generations blocks are designed under the environment ofSimulink. Fig. 2 presents an example of the angular positions, velocities and accelerations related to
The maintenance operation treated is the milling. It is a process that requires high precision and
where differences between planned and actual trajectories are observed.
Description of a Milling Test. The total mass of the milling tool is 6.76 kg and the Cartesianvelocities are in the range of 2000 mm/min. The contact’s length, during the milling, between the
tool and the block is 70 mm and the depth of penetration into the steel is 1.2 mm.
Figure 4. Milling test
Test Results. The following figures represent the filtered of the measured angular positions,
velocities and torques and the calculated angular accelerations (derivation of the velocity). The
Butterworth filter whose response is flat in the passband is most suitable, so we used an order 4
Lowpass Butterworth filter with normalized cutoff frequency Wn=0.8/5.
Matlab function "butter" is used to provide the coefficients of the numerator and the denominator ofthis filter. The output parameters of this function are used as entries to the "filtfilt" function that
performs the Butterworth filtering on the signal in both the forward and reverse directions, which is
necessary in order to eliminate phase distortion.
Figure 5. Measured angular positions
406 Mechanisms, Mechanical Transmissions and Robotics
The study of the positions, velocities and the accelerations signals prove the choice of the
trapezoidal velocity law while maintaining continuous velocity and acceleration. Deviations in the
velocities, accelerations and torques signals are noticed during the milling time. This is explained
by the fact that forces are created during the steel milling.
Note that the signals corresponding to angles 5 and 6 are noisier than the others. This can beexplained by a control problem due to the fact the integral gain used by the manufacturer is very
low. It can also be due to the fact that gear types of the joint 5 and 6 (endless screw and
Monosatellite) are different from the gear type of the first four joints (joints combined engine).
Application to the Simulator. The purpose of this paragraph is to apply the same milling test to the
simulator and compare the simulated data to the real data, in order to illustrate the industrial interest
of the simulator.
Milling Cutting Force. This force can be measured through a dynamometer. But, since the
recorder of Stäubli provides the values of joint torques, one can calculate the cutting forcesrepresented by Fext (the external force to the end-effector) from the following equation (Eq. 1).
Fext = J-T ∆Γ. (1)
With:- ∆Γ: the torque variation due to the application of the external force;
- Fext = [Fx, Fy, Fz, Mx, My, Mz] T.
Figure 8.Weight of the milling tool added to milling cutting force.
Knowing F, one can find ∆Γ and then calculate: the angle variation due to the external forces:
∆Γ = K θ ∆θ= Diag (K θi) ∆θ. (2)
With:
- ∆θ: the angle variation ;
- K θ: the joint stiffness (or rigidity) matrix.
Table 2. Joint stiffness matrix elements
i 1 2 3 4 5 6K θi 1.7 x 10 5.9 x10 1.8 x 10 2.9 x 10 9.3 x10 4.9 x10
We can also calculate the Cartesian position variation due to the external forces:
F = K x ∆x = J-T K θ JT ∆x. (3)
408 Mechanisms, Mechanical Transmissions and Robotics
The simulated positions, velocities, accelerations and the torques are very close to those from the
recorder respectively (Fig. 5, Fig. 6, Fig. 7 and Fig. 8). This proves that the simulator is accurate
and show reality with a good reliability.
In the following picture (Fig. 13), we show, on the right, the surfaces obtained on the steel includingthe marks left by the milling tool. On the left, we show a zoomed area of the steel block where the
deformation of the milling line are the highest during the penetration of the milling tool into the
steel.
410 Mechanisms, Mechanical Transmissions and Robotics
The simulated Cartesian position [Px, Py, Pz]T of the robot’s end-effector is shown in Fig. 14. One
can clearly notice Cartesian position deviations, especially in the z direction, during all the millingduration and especially during the penetration of the milling tool into the steel. This is explained by
the fact that cutting forces acting during the penetration are higher than the ones during the rest of
the milling.
Figure 14. Simulated Cartesian position
Conclusions and outlookThis paper has presented the implementation of the Stäubli TX90 simulator using SimMechanics
which is an interactive three-dimensional modeling of mechanical systems in Simulink®. It allows
building simulations and automatically generates 3D animations of multi-body systems such as
robots. Blocks representing all external perturbations (deformations, cutting forces, flexibilities,
loads) have been integrated into this simulator. This simulator is able to predict the position and
trajectory of the end-effector according to the loading and deformation in order to represent realitywith high reliability.
An application of milling was presented and a comparison between data from the Stäubli recorder
and simulated data (positions, velocities, accelerations and torques) has proved the reliability of the
simulator.
The robotic simulation can now be used to optimize the robot trajectories and to improve milling.
Using the simulator, one can analyze the behavior of the robot, qualify its performance and consider
appropriate changes in the system. In order to optimize the whole process of maintenance operation,
in terms of quality and development time, different solutions, based on the results of the simulator,
can be proposed, for example: changes in the configuration of the end-effector and changes in themilling trajectory. Another possible solution is to consider, with a step ahead, the predicted position
deviation, and integrate it into the control in a way to attenuate the observed end-effector position
deviations especially during the penetration into the steel.