Escolar Documentos
Profissional Documentos
Cultura Documentos
Received: February 12, 2014 / Accepted: March 05, 2014 / Published: April 25, 2014.
Abstract: This paper describes an automated path generation method for industrial robots. Based on force control, a robotic subsystem
has been developed for path automatic generation or path learning. Using a dummy tool and roughly taught guiding points around a part
contour, the robot moves in position and force controlled hybrid mode, following the order of the guiding points and with contact force
direction and value predefined. During the motion, robot actual position is recorded by the robot controller. After the motion, the
recorded position data is used to generate a robot path program automatically. Robot lead-through may be used in the guiding point
teaching. Furthermore, a GUI (graphical user interface) is developed on the teach pedant to guide through the guiding point creation and
teaching, path learning, program verification and execution. The development has been incorporated into a robotic machining product
option. Combination of the robot path learning function and GUI enhances the interaction between the robot and operator and
drastically increases the level of robotic ease-of-use.
needed to generate a precision robotic machining such curvature in path post processing were studied and
as deburring, grinding and polishing program from developed. Ref. [10] gives the detail of the system
weeks to hours. configuration of the path learning and post processing.
Section 2 of this paper deals with the evolution of the Fig. 2 shows the system configuration diagram.
robotic path learning concept. A real-world case of A typical workflow of the system is shown in Fig. 3,
path learning on which the concept was formed is which comprises: (1) determining the guiding points of
introduced and described. Algorithm used to realize the the path on the part; (2) using robot lead through to
robotic path learning function has been developed; teach the guiding points; (3) executing force feedback
Section 3 briefly presents the implementation and contour following with the robot based on the taught
application of the robot path learning technology; guiding points while continuously recording the TCP
Section 4 of this paper deals with GUI for the robotic (tool center point) positions of the robot during
path learning feature. With carefully designing, the movement; and finally (4) post processing the recorded
GUI has dramatically increased the level of easiness for position and generating the robot motion program. The
robot force control setup, calibration, teaching and path benefit of this system is that the operator is only
learning, verification, as well as execution. An example involved with the steps of determining and teaching the
of the impact of path learning with GUI to its end users gross guiding points while the rest of work is
is described and evaluated; Finally, Section 5 gives the automatically done by the robot controller.
summary and conclusions. The guiding points should cover any sharp turns on
the contour of the workpiece. Typically, the guiding
2. Path Learning Concept Development
points are needed at corners and places of large
As mentioned in the introduction, utilizing the curvature. If a specific application requires a big
touching feeling of robot force control in robot path change of the tool position and/or orientation at certain
automatic generation has been in consideration at places on the contour, these places should also be
initial stage of force control development at ABB. The included in the guiding path. Since force control can
first path learning lab experiment is done on a casting enforce the contact, the guiding points are not required
case of water pump. Fig. 1 gives the experiment set up. to be physically on the workpiece. However, it is
A dummy tool is used in the guiding point teaching and generally required that the robot tool is in the same
path learning along the gasket grove of the casting part. preferred orientation as in the actual application.
In this particular scenario, the edge of the grove will In order to realize the force controlled robotic path
guide the tool through during the path learning; the learning, a force/position hybrid control loop, robotic
force applied is in tool Z direction; robot is under force lead through teaching, contour following motion and
control in X and Y direction and position control in the position recording, as well as post processing are
orientation direction Rx, Ry and Rz. Robot lead-through necessary and desired. Those feathers and functions are
is used for teaching the guiding points. To verify the described respectively as below.
accuracy of the path learned, an actual milling tool and
a spindle was employed to cut the sealing gasket grove 2.1 Hybrid Position/Force Control Loop
tool frame, and the joint references generated from the trajectory references calls for an extended trajectory
joystick are directly forwarded to the hybrid P/F generator. Such a generator could be built on the existing
controller. trajectory generator of a position controlled robot with
The user is required to hold the teach pendant in lead the addition of a path frame calculation module.
through mode in order to comply with robot safety Fig. 7 illustrates a typical two stage trajectory
requirement. Lead through safety is further enhanced generation process commonly found in commercial
by adding force control specific supervisions. For industrial robots. The demonstrated guiding path is a
instance, the TCP is not allowed to move beyond a simple two line segment that starts from P1 and ends
specified distance from its original force-control with P3 via a sharp corner point P2. In the first stage of
enabling position and the speed limit is set to lower the trajectory generation, a macro interpolator divides
than the standard 250 mm/s position jogging safety in the Cartesian space the guiding path into short line
limit. segments (marked by macro points S1 to S11), each
having the same traveling time. Kinematic and
2.3 Contour Following Servo
dynamic models are applied at each macro point to
During contour following, the task frame Tc of the calculate the joint position, speed and acceleration
hybrid position/force control is chosen as the path references. In the second stage, a micro interpolator
frame. As shown in Fig. 6, a path frame is defined such further divides each macro step into smaller time equal
that: micro steps that are ready for the joint PID controller.
(1) The path frame X axis (Xp) is the tangent of the As this stage is done in the joint space, no Cartesian
path along the traveling direction; information is available at the micro points q1-q3. As a
(2) The path frame Y axis (Yp) is calculated as the result, the path frame is preferably calculated at the end
cross product of the tool frame Z axis (Zt) and the path of macro interpolation stage where the Cartesian
frame X axis; information is available. The path frame at a micro
(3) The path frame Z axis (Zp) is calculated as the point is then interpolated from the path frame data at
cross product of the path frame X and Y axes. the neighboring macro points. To avoid time delays,
The tasks of the contour following servo are: (1) to the calculation and the interpolation should always
determine the safe speed in executing the contour involve the past, present and future points. For instance,
following; (2) to configure the force control loop as the path frame at point S2 is calculated using points S1,
position controlled in the path tangential direction and S2 and S3 Cartesian position data, while at point q1, the
force controlled in the path normal directions; and (3) path frame is calculated using the well-known sphere
to continuously generate and feed the position and linear interpolation algorithm [11]:
force references as well as path frame to the force
Slerp(1 , 2 ; t ) 1 11 2
t
control loop. The inclusion of the path frame in the (1)
ZT X
P3
Tool
YT
ZP
YP XP
Path P2
P1
Fig. 6 Path frame definition. Fig. 7 Extended trajectory generation.
Robotic Path Learning with Graphical User Interface 265
where, 1 and 2 are the quaternions of the path two or more long line segments can be formed by those
frames at macro point S1 and S2, and t is the unmerged points according to a user-defined Path
interpolation parameter that equals 0.25, 0.5, 0.75 at Accuracy Parameter. This is achieved by the following
point q1, q2 and q3, respectively. procedure. First, the system calculates the distance
between each unmerged point ( Pt5 to Pt14 ) and the line
2.4 Real-Time Path Recording
connecting the last merged point ( Pt4 ) and the last
While the robot with tool is moving along the unmerged point ( Pt14 ). Then, the system compares the
workpiece contour, the actual robot target (position and calculated distances to the Path Accuracy Parameter.
orientation) is continuously recorded. To be able to Merging occurs by deleting all the points between the
capture the corners and the places of sharp curvature, last merged point and the first unmerged point whose
the sampling rate has to be high enough with respect to distance is greater than the user specified parameter
the contour following speed. On the other hand, a fast ( Pt5 to Pt12 ).
sampling rate will create a huge amount of data to be During post processing of the learned path, extra
stored in the robot controller memory. This would be a points are taken out for path cleanness and robot
problem if the path was very long and the controller motion efficiency by avoiding two robot targets being
had limited memory. Ideally, fewer points would be too close together. Later the algorithm was
saved for regions of a contour where the curvature implemented into the learning process. The extra points
changes slowly, while more points would be saved for will not be recorded, which further improved the path
regions of a contour where the curvature changes generation process. Fig. 8 shows the system set up for
sharply. In this way, a more efficient program with less the path learning and actual cutting test. And Fig. 9
point data can be generated for production use. In the illustrates the path post processing result.
proposed system, a real-time line recovery module (to
3. Implementation and Applications
get rid of unnecessary intermediate points) is
implemented for this goal. Due to the real-time nature After the technology development, the algorithm
of this module, a simplified line recovery algorithm is and engineering knowledge were transferred and
adopted. More sophisticated line recovery is decided to implemented into a robot product. Fixell, et al. [12]
be left to the offline post processing. described the implementation process and result. Since
The line recovery algorithm is simply the real-time then, force control robots have been increasingly used
merging of short line segments into longer ones based for laptop cover grinding and finishing, blade grinding,
on a set of user-defined criteria. In this algorithm, a costing part pre-machining and various robotic
path point buffer is set up to receive the incoming path material removal and finishing applications. Recently
points from the real-time position recording function.
Every time the position recording function pushes a
new point (for instance point 14 in Fig. 7) into this
buffer, the real-time line recovery module is activated
to scan the buffer and try to merge shorter line
segments into a longer one. As can be expected, during
the contour following process the merged ( Pt1 to Pt4 )
and un-merged line segments ( Pt4 to Pt14 ) would
coexist in the buffer. The line recovery module only
deals with unmerged points ( Pt5 to Pt14 ). It checks if Fig. 8 Real-time line recovery.
266 Robotic Path Learning with Graphical User Interface
Fig. 10 Main page of the FC machining package. Fig. 11 A set of control points used in path learned.