Patent Application
20180373232
The present invention relates to an industrial robot having a movable robot arm for supporting a tool, wherein the robot is provided with an alignment function for aligning the tool with at least one specified axis. The present invention also relates to a method for controlling a robot provided with an alignment function for aligning the tool with at least one specified axis. The invention further relates to use of the method for lead-through programming of a robot.
An industrial robot includes a mechanical structure, also denoted a manipulator, and a control unit for controlling the movements of the manipulator. The manipulator has a plurality of arm parts that are movable relative each other about a plurality of joints. At least one of the arm parts is adapted to support a tool. Most robots have the ability to rotate the tool about three orthogonal axes, and by that to align the tool with any desired axis in the surroundings of the robot.
There exist several methods to program industrial robots to perform a task. The programming of the robot can, for example, be done by teaching the robot the movements needed to perform the task by moving the robot along a desired operating path while recording the movements of the robot. The operating path includes a sequence of target points, which define the operating path that the robot shall follow at run-time. During the teaching, the robot is guided through the various target points along the operating path, and the position and orientation of the robot in the target points are stored in a memory of the robot. The target points could be taught by a number of methods. A preferred method for teaching the robot the target points is called lead-through programming. During the lead-through programming, a robot operator manually moves the robot arm with the tool using his hands.
US2015/0081098 discloses lead-through programming of a robot having a force sensor. The sensor detects a guidance force applied to the robot arm by an operator. The movements of the robot are controlled using force control in such manner that a pre-specified reference point associated with the robot arm is moved only in a selected direction as a result of movement of the robot arm by the operator during manually-guided adjustment of the position and orientation of the robot arm.
During robot teaching by lead-through it is often desired to work with the tool aligned to an axis in the surroundings of the robot. For example, for gluing and arc welding applications it is necessary to keep the tool vertical to enable the glue and solder to flow smoothly. However, it is very difficult to do this alignment by hand. It is known to have an alignment function which upon activation aligns the tool with an axis in a world coordinate system. With a world coordinate system is meant a coordinate system defined in relation to a fixed point in the surroundings of the robot. The alignment function has to be activated manually by clicking a button on an HMI or a portable teach pendant unit (TPU) each time the alignment is to be performed. Upon clicking the button, the tool orientation is adjusted such that the z-axis of the tool is aligned with the alignment axis. If the tool is to be aligned with the alignment axis during an entire task, the alignment function has to be activated for each of the target points on the path. In order to click the button and activate the alignment function, the robot operator has to move one or both hands from the robot arm to the HMI/TPU. A problem is that this causes disturbances in the programming and the robot operator may lose focus on the robot.
It is an object of the present invention to at least partly overcome the above problems, and to help the robot operator to perform a desired alignment, without having to activate the alignment manually each time.
This object is achieved by a method according to the invention.
The method comprises:
According to the invention, the system automatically performs a tool alignment when the movement of the robot has been stopped and the alignment function is activated. This means that the user has stopped moving the robot, e.g. by lead-through or other means. The alignment is initiated by the robot operator by stop moving the robot arm. Preferably, the alignment function is activated during the entire teaching session. This means that the alignment function only has to be activated once during the teaching session. Alternatively, the alignment function is automatically activated when the robot is switched to teach mode.
The invention makes it possible to repeat the alignment for each target point during one teaching session without the need to click any button on the HMI/teach pendant. The method according to the invention saves time and increases the overall ease of use. The invention also provides faster and more accurate teaching, faster commissioning as well as better feel, especially regarding ease of use. Preferably, the method is repeated as long as the alignment function is activated.
The specified axis can be any linear axis in the surroundings of the robot. For example, the axis can be a vertical line.
With the term “automatically” is meant that the step is carried out by a machine, for example, the control unit of the robot.
The invention is particularly useful for teaching the robot a path including a plurality of target points by means of lead-through programming.
According to an embodiment of the invention, the method comprises adjusting the orientation of the tool so that the tool is aligned with the specified axis upon detecting that the movement of the robot has been stopped for a defined time period. The system automatically performs the tool alignment when the robot holding the tool has been standing still for a certain time period and the alignment function is activated. Thus, the tool alignment is initiated a certain time period, e.g. 1 second, after the operator has stopped moving the robot. This embodiment ensures that the alignment is not initiated by mistake if the operator stops moving the arm for a short time.
According to an embodiment of the invention, the orientation of the tool is kept aligned with the specified axis until detecting that the movement of the robot has been resumed. The tool is kept aligned with the specified axis as long as the robot is standing still. Thus, it is possible to keep the tool aligned with the specified axis when the position and orientation of the robot is recorded, for example, at the target points.
According to an embodiment of the invention, the method comprises releasing the alignment of the tool upon detecting that the movement of the robot has been resumed. The tool is no longer aligned with any axis when the robot is moving, and the robot operator is free to change the orientation of the tool during movement of the robot. Thus, the robot operator can reorient the tool during movement of the robot, which makes it possible to change alignment from one specified axis to another specified axis during the teaching session.
According to an embodiment of the invention, the method comprises:
Thus, the tool automatically “snaps” to the specified axis if the angle between the tool and the specified axis is less than a specific limit value, and it has been detected that the robot is standing still. If there are more than one specified axes, the tool may automatically “snap” to the nearest axis.
According to an embodiment of the invention, a plurality of orthogonal axes have been specified, and the method comprises:
According to an embodiment of the invention, the tool is aligned with the nearest of the specified axes if the angle of the tool in relation to the nearest axis is less than a limit value. The tool is then aligned along e.g. X, Y or Z axis depending on which axis the tool direction is closest to if the difference in angle is less than a specific limit.
According to an embodiment of the invention, the robot is teached a path including a plurality of target points, the method comprises:
This embodiment facilitates programming of an operating path with a large number of target points when it is required that the tool is aligned with a specified axis in the surroundings of the robot. If more than one axis has been specified, the orientation of the tool is adjusted so that the tool is aligned with the nearest of the specified axes when it has been detected that the movement of the robot has been stopped at the target point.
The object of the invention is also achieved by an industrial robot according to an embodiment of the invention.
The robot comprises a movable robot arm for supporting a tool, and a control unit configured to control the movement of the robot arm, wherein the control unit is provided with an alignment function for aligning the tool with at least one specified axis. The control unit is configured to detect the movement of the robot, and automatically adjust the orientation of the tool so that the tool is aligned with the specified axis upon detecting that the movement of the robot has been stopped and the alignment function is activated. The control unit is configured to supervise the movement of the robot and automatically adjust the orientation of the tool so that the tool is aligned with the specified axis upon detecting that the movement of the robot has been stopped.
According to an embodiment of the invention, the control unit is configured to adjust the orientation of the tool so that the tool is aligned with the specified axis upon detecting that the movement of the robot has been stopped for a defined time period.
According to an embodiment of the invention, the control unit is configured to keep the tool aligned with the specified axis until detecting that the movement of the robot has been resumed.
According to an embodiment of the invention, the control unit is configured to release the alignment of the tool upon detecting that the movement of the robot has been resumed.
According to an embodiment of the invention, the control unit is configured to determine the angle of the tool in relation to the specified axis, and to adjust the orientation of the tool so that the tool is aligned with the specified axis upon detecting that the movement of the robot has been stopped and if the angle of the tool in relation to the specified axis is less than a limit value.
According to an embodiment of the invention, a plurality of orthogonal axes have been specified, and the control unit is configured to determine the orientation of the tool, to compute the angles of the tool in relation to the specified axes, and to adjust the orientation of the tool so that the tool is aligned with the nearest of the specified axes when it has been detected that the movement of the robot has been stopped.
According to an embodiment of the invention, the control unit is configured to determine if the computed angle is less than a limit value, and to aligned the tool with the nearest of the specified axes if the angle of the tool in relation to the nearest axis is less than the limit value.
The invention will now be explained more closely by the description of different embodiments of the invention and with reference to the appended figures.
The control unit includes software as well as hardware, such as input and output means, a processor unit including one or more central processing units (CPU) for handling main functions of the robot controller, such as executing robot programs. The control unit has a storage medium for storing data, software and program code for controlling the movements of the manipulator.
The movements of the joints are driven by motors. The positions of the joints are controlled by the control unit 2. The joints are equipped with position sensors, for example angle-measuring devices, to provide position feedback to the control unit 2. The position and orientation of the TCP is given by the positions of the joints of the robot, and can be calculated based on the position feedback from the position sensors of the robot.
The robot may have a plurality of defined coordinate systems. A tool coordinate system XT, YT, ZT is defined for the tool. If the tool is elongated, the Z-axis of the tool coordinate system is usually defined along a length axis of the tool. The origin of the tool coordinate system is located in the TCP. A robot base coordinate system XB, YB, ZB is usually defined in the stationary base 4 of the robot. The relation between the tool coordinate system and the base coordinate system is known. The position and orientation of the TCP can be determined in the base coordinate system of the robot based on the position feed-back from the position sensors and the known relation between the tool coordinate system and the base coordinate system. A world coordinate system XW, YW, ZW is defined somewhere in the surroundings of the robot. The ZW-axis of the world coordinate system is commonly aligned with the vertical line. The relation between the world coordinate system and the base coordinate system is known. Thus, it is possible to determine the position and orientation of the TCP in the world coordinate system. In some applications, the world coordinate system coincides with the base coordinate system of the robot. If the robot is to carry out work on a work object, an object coordinate system is defined for the object.
The control unit 2 is provided with an alignment function for aligning the tool with at least one specified axis, in the following named alignment axis. The alignment axis is, for example, the ZW-axis of the world coordinate system or one of the axes in the object coordinate system. More than one alignment axes can be specified. For example, the XW, YW, ZW axes of the world coordinate system can be specified as alignment axes, or one or more of the axes in the object coordinate system can be specified as the alignment axes. Preferably, the axis/axes are specified in advance and stored in the memory storage of the control unit 2. It is also selected which one of the axes in the tool coordinate system to be aligned with the alignment axis. For example, the ZT-axis of the tool coordinate system can be selected as the axis to be aligned with the alignment axis.
Suitably, the alignment function is implemented as a software module executed by the processing unit of the control unit 2. The alignment function can be activated and deactivated. Suitably, the alignment function is activated during programming of the robot, and is turned off when the programming is finished. The alignment function can be activated manually by a user, for example, by clicking a button, or automatically, for example, when the robot is switched to teach mode or lead-through programming is initiated. In the same way, the alignment function can be deactivated manually or automatically when the teach mode has been switched off.
According to the invention, the control unit 2 is configured to supervise the movement of the robot as long as the alignment function is activated, and to automatically adjust the orientation of the tool so that the tool is aligned with the selected axis when it has been detected that the movement of the robot has been stopped. In one embodiment of the invention, the control unit is configured to align the tool with the alignment axis upon detecting that the movement of the robot has been stopped for a defined time period. Suitably, the time period is a few seconds, for example, the time period is one second. The control unit is configured to keep the tool aligned with the selected axis as long as the robot is standing still. The alignment of the tool is, for example, released upon detecting that the movement of the robot has been resumed. Thus, the tool is not automatically aligned with the alignment axis when the robot is moving.
In one embodiment of the invention, the control unit is configured to determine the angle of the tool in relation to the alignment axis, and to adjust the orientation of the tool so that the selected tool axis is aligned with the alignment axis if the angle between the selected tool axis and the alignment axis is less than a limit value. For example, the alignment is carried out if the angle between the tool and the alignment axis is less than 45°. In another example, the alignment is carried out if the angle between the tool and the alignment axis is less than 30°. Thus, the tool is automatically aligned to the alignment axis if the alignment function is activated, the movement of the robot has been stopped, and the angle between the selected tool axis and the alignment axis is less than the limit value. When a plurality of axes have been specified, the control unit is configured to compute the angles between the selected axis of the tool and the alignment axes, to determine which one of the alignment axes the tool is nearest, and to adjusting the orientation of the tool so that the tool is aligned with the nearest of the alignment axes. Thus, the tool “snaps” to the nearest of the alignment axes when it has been detected that the movement of the robot has been stopped. In one embodiment of the invention, the tool is aligned with the nearest of the alignment axes if the angle of the tool in relation to the nearest axis is less than a limit value.
To be able to compute the angles Vx, Vy, VZ between the axis of the tool and the specified alignment axes, the axis of the tool and the alignment axes must be transformed to the same coordinate system. In this example, it is suitable to transform the axis of the tool to the world coordinate system. This can be done by reverse transformation of the robot kinematic and knowledge of the relation between the robot base coordinate system and the world coordinate system. The position of the tool in the tool coordinate system is given by the TCP. When the axis of the tool and the specified alignment axes have been transformed to the same coordinate system, the angles Vx, Vy, VZ can be computed with common vector mathematics.
When it has been detected that the movement of the robot has been stopped, the angle between the tool axis and the alignment axis is computed, and it is determined how to control the movements of the robot so that the angle between the tool axis and the alignment axis becomes zero or at least close to zero. This may include to determine the positions of the robot joints and to generating motor references to the motors of the robot. The orientation of the tool is then adjusted so that the tool is aligned with the alignment axis, block 24. Optionally, the alignment is performed a certain period of time after it has been detected that the movement of the robot has been stopped, and the movement of the robot has not yet been resumed. The alignment of the tool axis is continued until it has been detected that the movement of the robot has been resumed, block 26. Thus, the supervision of the movements of the robot continues when the robot stands still in order to detect when the robot begins to move again. Upon detecting that the robot movement has been resumed, the alignment is ended, block 28. Thus, the operator is allowed to reorient the tool. The supervision of the movements of the robot continues until the next time the movement of the robot is stopped. The method steps 20-28 are repeated as long as the alignment function is activated, block 30.
The method is started upon activation of the alignment function, and is repeated until the alignment function is deactivated. The movement of the robot is supervised as described above. As long as the robot is moving, there is no alignment of the tool, block 40. When it has been detected that the operator has stopped moving the robot, the method waits for a certain period of time, block 42, and if the robot has not been moved during this period of time, block 44, the angles between the axis of the tool and the alignment axes are determined, block 46. The determined angles are compared to the limit value, block 48. If none of the determined angles is less than the limit value, no tool alignment is performed, block 40. If one of the determined angles is less than the limit value, the tool axis is aligned with this axis, block 50. If more than one of the determined angles is less than the limit value, the tool is aligned with the nearest of the alignment axes.
The alignment of the tool axis is continued until it has been detected that the operator moves the robot again, block 52. Upon detecting that the robot movement has been resumed, the alignment is ended, block 54. The operator can then choose to reorient the tool so that the axis of the tool is closer to any of the other alignment axes. The supervision of the movement of the robot continues until the next time the operator stops moving the robot. The tool is then aligned to the nearest of the alignment axes. Thus, the operator can choose which one of the axes the tool is to be aligned with. The operator can trigger the alignment by stop moving the robot for a certain timer period, and the tool is kept aligned with the alignment axis as long as the robot is not moving. This gives the operator time to record the position and orientation of the tool in the target point. When the target point has been recorded, the operator moves the robot arm with the tool to the next target point to be recorded. The method steps 20-52 are repeated as long as the alignment function is activated
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/EP2016/052124 | 2/2/2016 | WO | 00 |
