The invention concerns industrial painting systems, such as automated systems for painting automobiles. In particular it concerns a method for controlling a paint applicator while applying paint in an automated painting process and a system for carrying out that method.
Industrial robots with an arm or manipulator are often used to paint objects such as automobiles in industrial painting processes. When painting an object surface using a robot or manipulator arm it is desirable to move an applicator over the surface to be painted with a constant velocity in order to ensure good quality of the paint result. It has been common practice when a traditional type paint spray gun was used to switch the paint flow on-off with spray gun trajectory. Thus it was possible to switch paint off as the spray gun left the object to be painted, let the spray gun trajectory make a turn or U-turn, and then switch paint on again when the spray gun was back over the object and had reached full (programmed) velocity.
For paint process reasons such as transfer efficiency and paint gloss, etc. the bell applicator is used for robot-painting today much more than traditional spray gun type applicators. A drawback with the bell applicator is that the control of paint flow is slower, with the result that it is not practical to switch paint on/off synchronously with applicator trajectory. The preferred solution for a bell applicator is to let the paint flow continuously, and aim at keeping speed over the surface as constant as possible during the painting program.
This requires a very high bandwidth of the robot servo motors powering the robot joints and wrist which, for some movements (e.g., a U-turn) requires the motors in all of the robot joints involved to accelerate and decelerate at very high rates. It is complex and expensive to design a robot to such specifications including for example very high acceleration capabilities.
According to one or more embodiments of the present invention an improvement is provided to methods for controlling a robot arm or manipulator for painting an object.
According to embodiments of the present invention one or more improved methods for controlling a robot Tool Center Point (TCP) are described. A paint spray gun or applicator carried by a robot is normally passed over the surface to be painted and oriented perpendicular to the plane of the surface. However, the inventors have found that paint process is not very critical with regards to limited deviation in orientation of the applicator, so that by allowing for and planning for a certain deviation from an ideal or perpendicular position in programmed orientation a kinematic redundancy can be obtained.
According to an aspect of the present invention a method for painting a workpiece with an automated painting system comprising an industrial robot or manipulator arm arranged with a wrist section and carrying a paint applicator arranged on the wrist section of the manipulator arm is provided. The paint applicator is arranged to coat a surface on the workpiece, and paint is applied to a substantially circular or elliptical area on the surface, the center of the area being defined as a Tool Center Point. The wrist section is arranged capable of orienting the paint applicator and the paint applicator is moved by the manipulator arm so that the Tool Center Point moves along a planned path so coating a part of the surface. The method is further characterised by calculating a planned path comprising one or more turns such that a path taken by a fixed point on the robot wrist above the surface during a turn in the planned path is shorter than a path taken by the Tool Center Point along the surface.
According to an embodiment an improved method is provided wherein the fixed point on the wrist section is moved during part of the movement through a bend in the planned path with a velocity which is not the same velocity as that of the Tool Center Point along the planned path.
According to another embodiment an improved method is provided wherein a velocity of the fixed point on the robot wrist along the planned path is controlled to be substantially the same as the velocity of the Tool Center Point during a part of a straight path and a velocity which is less than the velocity of the Tool Center Point during a turn in the path.
According to another embodiment an improved method is provided wherein an orientation parameter of the wrist section, being a measure of deviation of the applicator axis from perpendicular to the surface, is optimised during movement in the planned path to one or more values different from the value of the orientation parameter during movement of the wrist section along a straight part of the planned path.
According to another embodiment an improved method is provided wherein the orientation parameter is optimised during movement in the planned path dependent on a position of the fixed point on the robot wrist relative to a part of the path comprising: a straight approach to a bend; a bend; a straight part upon leaving the bend; or a straight part of the path.
According to another embodiment an improved method is provided wherein the Tool Center Point is maintained at a constant or near constant velocity during movement through the bend in the planned path.
According to another embodiment an improved method is provided wherein the velocity of the wrist section is increased on completing the bend in the planned path by adding a positive orientation deviation in the first x direction and a negative orientation deviation in the second y direction to the wrist section.
According to one or more other embodiments an improved method is provided wherein a path for the wrist section is constrained by the optimised constant or near constant velocity of the Tool Center Point and for one or more joints of the manipulator arm by a limit selected from the group consisting of: a joint angle, an angular velocity, an angular acceleration, and a torque.
According an embodiment an improved method is provided wherein information concerning a Tool Center Point and/or a Wrist Center Point is displayed on a graphic user interface for the purpose of programming, monitoring, or controlling the industrial robot or manipulator arm carrying a paint applicator.
According to another aspect of the invention, a system is provided for painting a workpiece with an automated painting system comprising an industrial robot or manipulator arm arranged with a wrist section and carrying a paint applicator arranged on the wrist section of the manipulator arm. The paint applicator is arranged to coat a surface on the workpiece, where paint is applied to a substantially circular or elliptical area on the surface, and the center of the area being defined as a Tool Center Point. The wrist section is arranged capable of orienting the paint applicator and the paint applicator is moved by the manipulator arm so that the Tool Center Point moves along a planned path so coating a part of the surface, and means are provided for controlling the robot or manipulator arm to operate according to a planned path. The system comprises means for calculating a planned path comprising one or more turns such that a path taken by a fixed point on the robot wrist (WCP) above the surface is shorter than a path taken by the Tool Center Point (TCP) along the surface.
A prime advantage of the improved method and system for carrying out the method is that painting with an industrial robot may be carried out more quickly. Coverage can be achieved more quickly by providing faster movement of the robot through turns or bends in the paint path. Another technical advantage of the improved method is that by maintaining a constant velocity through the bend a more uniform coating or paint thickness on the surface is achieved.
Paint wastage is also reduced by means of the improved method which is another very important advantage. Overspray, coating that continues while the applicator is not directly above the surface to be coated, is eliminated. This feature greatly reduces waste of paint, with all the environmental benefits that follow therefrom. Continuous application is maintained, which reduces the necessity for cleaning and flushing the applicator or supply lines, also resulting in reduced paint waste and solvent use.
Another advantage is that rapid painting may be achieved by use of the described control methods which do not require investment in higher performance robots or robot servo motors for particular joints.
In another aspect of the invention the method offers extended opportunities for optimization. When details about the dynamics of the robot are also known (a robot has normally different acceleration capability in different directions and in different positions of the working envelope), then this knowledge can be utilized in the path planning to generate a Tool Center Point trajectory that is optimized with regards to constant velocity for the Tool Center Point during U-turns.
In another development the invention is used with a robot arranged with a modified robot wrist. The modification comprises that the wrist axes are lighter in weight. When the inventive control methods are employed together with the higher bandwidth of the lighter wrist axes this provides a significantly higher bandwidth of the overall resulting Tool Center Point motion.
In a preferred embodiment of the method of the invention the method may be carried out by a computing device comprising one or more microprocessor units or computers. The control unit(s) of the robot and/or automated painting system comprise memory means for storing one or more computer programs for carrying out the improved methods for controlling the operation of a mechanical press. Preferably, such computer programs contain instructions for the processor to perform the method as mentioned above and described in more detail below. In another embodiment the computer program is provided on a computer readable data carrier such as a DVD, an optical or a magnetic data device.
Embodiments of the invention will now be described, by way of example only, with particular reference to the accompanying drawings in which:
a-c and
e, is a schematic diagram for an ideal movement from a controlled paint applicator which may not be attainable in practice;
d, Prior Art, is a schematic diagram showing a known method for controlling a paint applicator according to the prior art;
The robot moves the arm and the wrist and orients (points) the applicator 11 so that the tool center point follows the pre-programmed path 5 on the object surface. In this diagram the paint applicator is shown at an angle which is approximately perpendicular to the plane of the paint surface. In other words, the orientation of the paint applicator is perpendicular relative the surface to be painted. Normally a fixed point on the wrist, the Wrist Center Point, and the Tool Center Point are all be aligned in one single orientation.
a-1f shows a series of schematic diagrams to explain one or more methods of the invention, which is primarily shown in
a shows the planned path 5 which includes a U-turn. Due to the limited acceleration capability of the robot, the programmed velocity of the Wrist Center Point cannot be maintained during the half circle of the turn or bend.
Using centripetal acceleration
Max velocity, Vcirc=√{square root over (a—a*r)}
where a_a is the available acceleration, and r is the radius.
The programmed velocity Vprog is reduced to a maximum velocity Vcirc during a deceleration phase d before the circular path is entered. Velocity Vcirc is then increased after the circular path is finished by acceleration a up to Vprog.
b is the planned path 5 from
c (Prior Art) shows the velocity profile versus distance for the Tool Center Point and Wrist Center Point points according to prior art. Strictly speaking the indicated velocity is not completely accurate in the acc/de-acc phases, because it is graphed as if the abscissa was time (linear), whereas, since the abscissa is distance, it should have been shown as a parabolic function of the form:
V=√{square root over (2*a*s)}
However the linear acc/de-acc representation is sufficient to describe the context of the technical functions carried out in embodiments of the invention.
d (Prior Art) shows a prior art method. The upper line W shows the position of the Wrist Center Point along the stretched out path at equally spaced time instants. The lower line T is the corresponding position of the Tool Center Point at the same instants. The arrow or vector from W to T indicates the orientation of the paint spray (the robot tool) which in this case is perpendicular to the path. The schematic diagram is not to scale, however, it is intended to show that it should be possible to identify the different phases by looking at the distances and variation in distance between the arrows.
e shows an ideal or desired path which may, in practice, not be possible to attain exactly. The figure indicates a constant speed through the U-turn. The diagram also shows
f illustrates a planned path according to an embodiment of the invention. While approaching the U-turn, the Wrist Center Point will have a lead relative to the Tool Center Point resulting in a deviation in orientation, which is visualized here by deviation from the perpendicular. The Wrist Center Point is allowed to decelerate, d, make the circle and accelerate a, while the Tool Center Point runs with constant speed indicated by equal spacing between the arrows at the Tool Center Point line.
At the completion of the bend the Wrist Center Point lags behind the Tool Center Point. This gives a deviation in orientation with the opposite sign to that of the start, i.e., the approach to the turn. The Wrist Center Point lag must be handled by the next paint stroke, so that the Wrist Center Point is once more leading the Tool Center Point again at the time when it approaches the next U-turn.
Thus the planned path includes or permits a deviation in orientation from a planned orientation of the applicator. Instead of the normal orientation perpendicular to the plane of the surface to be painted, the applicator is tilted when it is moved through a bend, expressed more precisely as a deviation in orientation of the Wrist Center Point while the Tool Center Point follows the planned path exactly.
It can be seen that in the deceleration phase, the x deviation becomes greater than zero, as indicated by the dashed line in
Block 30: move the Wrist Center Point and Tool Center Point at a constant (max) velocity Vprog along the planned path;
Block 32: if approaching bend, decelerate (d) Wrist Center Point and reduce velocity to a maximum Vcirc, allow deviation in x up to a max of +ve θx,m;
Block 34: in the bend maintain constant velocity Vcirc for Wrist Center Point, reduce allowed deviation in x to change between +ve θx,m to zero, and allow deviation in y from between −θy,m up to +ve θy,m; and
Block 36: on leaving the bend accelerate Wrist Center Point from Vcirc up to Vprog and increase allowed x deviation from −ve θx,m to zero.
The planned path has only been shown in the accompanying figures in terms of a planned paint path over a flat surface with two dimensions x and y. However, the methods described may also be applied to surfaces that are not flat and surfaces which may include concave or convex shapes.
In another embodiment, the planned path which includes or permits deviation in orientation by the Wrist Center Point may be optimized according to one or more other constraints. The Wrist Center Point path is calculated by optimizing a path for the wrist section while aiming for a constant or near constant velocity for the Tool Center Point and optimizing for one or more of the following criteria:
minimum total energy consumption for the robot joints involved;
minimum weighted energy consumption for the robot joints involved;
minimum total acceleration for the joints involved;
minimum weighted acceleration for the joints involved;
minimum total angular movement for the robot joints;
minimum weighted angular movement for the robot joints;
minimum linear acceleration of the Wrist Center Point; and
minimum deviation in orientation versus programmed orientation.
There are several variations and modifications which may be made to the disclosed solutions, and embodiments of the invention may also be used to coat different types of paint, two-component paint, basecoat, primer, clearcoat and so on. Similarly the above described solutions may also be adapted to coat or spray other substances such as protective coatings, sealants, adhesives and even abrasive materials.
Methods of the invention may be supervised, controlled or carried out by one or more computer programs. One or more microprocessors (or processors or computers) comprise a central processing unit (CPU) connected to or comprised in the paint application system described, which processors, PLCs or computers perform the steps of the methods according to one or more aspects of the invention, as described for example with reference to
The computer program comprises computer program code elements or software code portions that make the computer or processor perform the methods using equations, algorithms, data, stored values, calculations and the like for the methods previously described, and for example in relation to the flowchart of
It is also noted that while the above describes exemplifying embodiments of the invention, there are several variations and modifications which may be made to the disclosed solution without departing from the scope of the present invention as defined in the appended claims.
Number | Date | Country | Kind |
---|---|---|---|
06010330.6 | May 2006 | EP | regional |
The present application is a continuation of pending International patent application PCT/IB2007/051876 filed on May 16, 2007 which designates the United States and claims priority from European patent application EP 06010330.6 filed on May 19, 2006, the content of which is incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/IB2007/051876 | May 2007 | US |
Child | 12273063 | US |