Apparatus, robot control device, robot system, and method of setting robot coordinate system
11654562 · 2023-05-23
Assignee
Inventors
Cpc classification
B25J9/1682
PERFORMING OPERATIONS; TRANSPORTING
Y02P90/02
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
B25J9/0018
PERFORMING OPERATIONS; TRANSPORTING
B25J9/0084
PERFORMING OPERATIONS; TRANSPORTING
B25J9/0096
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1669
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
An apparatus capable of accurately determining a robot coordinate system of a robot configured to be moved along an axis. The apparatus of setting the robot coordinate system of the robot configured to be moved along a first axis includes a coordinate system acquisition section configured to determine, from positions of two robot coordinate systems preset along the first axis, a position of another robot coordinate system to be set between the positions of the two robot coordinate systems by calculation. Further, a method of setting a robot coordinate system of a robot configured to be moved along a first axis includes determining, from positions of two robot coordinate systems preset along the first axis, a position of another robot coordinate system to be set between the positions of the two robot coordinate systems by calculation.
Claims
1. An apparatus configured to set a robot coordinate system for a robot movable on a rail extending along a first axis, the apparatus comprising: a coordinate system acquisition section configured to obtain by calculation, from positions of two robot coordinate systems preset along the first axis, a position of another robot coordinate system to be set between the positions of the two robot coordinate systems, wherein the coordinate system acquisition section is configured to: determine a curved line connecting origins of the two robot coordinate systems, the curved line corresponding to a deformation of the rail, and obtain the position of an origin of said another robot coordinate system on the curved line.
2. The apparatus of claim 1, wherein the coordinate system acquisition section is further configured to obtain, by calculation, an orientation of said another robot coordinate system as an intermediate orientation between orientations of the two robot coordinate systems.
3. The apparatus of claim 1, further comprising: a position acquisition section configured to acquire a relative position between the robot and an external device installed outside the robot; and a coordinate system setting section configured to preliminarily set the two robot coordinate systems, respectively, based on the relative position, wherein the coordinate system acquisition section is configured to obtain the position of said another robot coordinate system from the positions of the two robot coordinate systems preset by the coordinate system setting section.
4. The apparatus of claim 3, wherein the external device is configured to rotate a workpiece to be worked on by the robot about a second axis, and the position acquisition section is configured to acquire, as the relative position, a position and a direction of the second axis with respect to the robot.
5. The apparatus of claim 1, being a robot control device configured to control the robot.
6. A robot system comprising: a robot movable on a rail extending along a first axis; an external device installed outside the robot and configured to rotate, about a second axis, a workpiece to be worked on by the robot; and a robot control device configured to control an operation of the robot to perform a work on the workpiece in cooperation with an operation of the external device to rotate the workpiece, wherein the robot control device comprises a coordinate system acquisition section configured to obtain by calculation, from positions of two robot coordinate systems preset along the first axis, a position of another robot coordinate system to be set between the positions of the two robot coordinate systems, and the coordinate system acquisition section is configured to: determine a curved line connecting origins of the two robot coordinate systems, the curved line corresponding to a deformation of the rail, and obtain the position of an origin of said another robot coordinate system on the curved line.
7. A method of setting a robot coordinate system for a robot movable on a rail extending along a first axis, the method comprising: obtaining by calculation, from positions of two robot coordinate systems preset along the first axis, a position of another robot coordinate system to be set between the positions of the two robot coordinate systems, wherein said obtaining comprises: determining a curved line connecting origins of the two robot coordinate systems, the curved line corresponding to a deformation of the rail, and obtaining the position of an origin of said another robot coordinate system on the curved line.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
DETAILED DESCRIPTION
(9) Hereinafter, embodiments of the present disclosure will be described in detail with reference to the drawings. Note that, in the various embodiments to be described below, similar components are denoted by the same reference numerals, and redundant description thereof will be omitted. Further, in the following description, the upper, lower, left, and right in the drawing may be referred to as the upper (top), lower (bottom), left, and right. First, a robot system 10 according to an embodiment will be described with reference to
(10) With reference to
(11) The robot arm 22 includes a first arm 28 rotatably provided at the turning body 20 and a second arm 30 rotatably provided at a distal end of the first arm 28. The wrist 24 is rotatably provided at a distal end of the second arm 30. The end effector 26 is removably attached to a distal end of the wrist 24, wherein the wrist 24 rotatably supports the end effector 26. The end effector 26 is e.g. a welding torch, a robot hand, a laser processing head, or a coating material applicator, and configured to perform a predetermined work (welding, work-handling, laser machining, or coating) on a workpiece W.
(12) Servomotors (not illustrated) are built in the respective components of the robot 12 (i.e., the base 18, the turning body 20, the robot arm 22, and the wrist 24), and these servomotors rotationally drives the movable components of the robot 12 (i.e., the turning body 20, the robot arm 22, and the wrist 24) about drive shafts so as to move the end effector 26.
(13) The traveling device 14 is configured to move the robot 12 along the axis A.sub.1. Specifically, the traveling device 14 includes a support frame 32, a rail 34, a slider 36, and a drive section 38. The support frame 32 includes a plurality of columns 40 extending in the vertical direction, and a top wall 42 fixedly provided at upper ends of the columns 40.
(14) The rail 34 is fixedly provided on a bottom surface 42a of the top wall 42, and extends linearly along the axis A.sub.1. The slider 36 engages with the rail 34 so as to be slidable along the axis A.sub.1. The slider 36 is guided to reciprocate along the axis A.sub.1 by the engagement with the rail 34.
(15) The drive section 38 is e.g. a servomotor, and generates power to move the slider 36 along the axis A.sub.1.
(16) The drive section 38 rotates a timing belt (not illustrated) laid along the rail 34, wherein the timing belt engages with an upper portion of the slider 36 and transfers the power generated by the drive section 38 to the slider 36.
(17) The base 18 of the robot 12 is fixed on a lower surface of the slider 36. When the drive section 38 rotates the timing belt, the slider 36 engaging with the timing belt is moved along the axis A.sub.1, whereby the robot 12 mounted on the slider 36 is moved along the axis A.sub.1.
(18) The external device 16 is installed outside the robot 12, and rotates the workpiece W to be worked by the robot 12 about an axis A.sub.2 (second axis). Specifically, the external device 16 includes a driving device 44 and a driven device 46. The driving device 44 includes a base 48, an output flange 50, and a drive section 52. The base 48 is secured on a floor of a work cell. The output flange 50 is a circular disk-shaped member, and provided at the base 48 to as to be rotatable about the axis A.sub.2. The drive section 52 is e.g. a servomotor, and generates power to rotate the output flange 50.
(19) The driven device 46 includes a base 54 and a driven flange 56. The base 54 is secured on the floor of the work cell, and disposed opposite to the base 48 of the driving device 44. The driven flange 56 is a circular disk-shaped member disposed concentrically with the output flange 50 with respect to the axis A.sub.2, and provided at the base 54 so as to be rotatable about the axis A.sub.2.
(20) The workpiece W is secured to the output flange 50 and the driven flange 56 by a jig (not illustrated). When the drive section 52 rotates the output flange 50, the workpiece W is rotated together with the output flange 50, and the driven flange 56 is also rotated about the axis A.sub.2 in response to the rotation of the workpiece W. In the present embodiment, the axis A.sub.1 and the axis A.sub.2 are substantially parallel to each other.
(21) As illustrated in
(22) An external device coordinate system C.sub.E is set for the external device 16. The external device coordinate system C.sub.E is for automatically controlling an operation of the external device 16, and is a fixed-coordinate system fixedly set in a three-dimensional space. In the present embodiment, the external device coordinate system C.sub.E is set such that its origin is positioned at a center of the output flange 50 and its x-axis direction coincides with the axis A.sub.2.
(23) On the other hand, a robot coordinate system C.sub.R is set for the robot 12. The robot coordinate system C.sub.R is for automatically controlling the movable components of the robot 12, and is a moving-coordinate system that moves together with the slider 36 of the traveling device 14 in a three-dimensional space. In the present embodiment, the robot coordinate system C.sub.R is set such that its origin is positioned at a center of the base 18 and its z-axis direction coincides with the axis A.sub.3.
(24) When the work is performed on the workpiece W by the robot 12, the traveling device 14 sequentially disposes the robot 12 at predetermined work positions B.sub.1 and B.sub.2. These work positions B.sub.1 and B.sub.2 can be defined as positions in the direction of the axis A.sub.1 (i.e., x-coordinates of the traveling device coordinate system C.sub.T). At this time, the robot coordinate system C.sub.R is sequentially set at the work positions B.sub.1 and B.sub.2, and in cooperation with an operation in which the external device 16 rotates the workpiece W about the axis A.sub.2, the robot 12 is controlled with reference to the robot coordinate system C.sub.R so as to sequentially perform the work on the workpiece W at each of the work positions B.sub.1 and B.sub.2.
(25) In this regard, the rail 34 of the traveling device 14 may deform due to a factor such as gravity. An example in which such deformation occurs in the rail 34 is illustrated in
(26) In this case, positions and orientations of the base 18 of the robot 12 when the robot 12 is disposed at the work positions B.sub.1 and B.sub.2 by the traveling device 14 may be different from the designed positions and orientations illustrated in
(27) In the present embodiment, robot coordinate systems C.sub.R1 and C.sub.R2 are preset at the respective two work positions B.sub.1 and B.sub.1 illustrated in
(28) From position data of the robot 12 at this time and information indicating positions of the three points defined on the workpiece W, it is possible to acquire data indicating a relative position between the robot 12 (specifically, the base 18) disposed at the work position B.sub.1 and the external device 16. The position data of the robot 12 includes e.g. a rotation angle of each servomotor built in the robot 12, and the rotation angle can be detected by a rotation detector (encoder or Hall element) provided at the servomotor.
(29) As an example, a position and a direction of the axis A.sub.2 of the external device 16 with respect to the robot 12 (base 18) are acquired as the relative position data between the robot 12 disposed at the work position B.sub.1 and the external device 16. Based on the relative position data, an origin position (i.e., the center of the base 18) and directions of respective axes of the robot coordinate system C.sub.R1 to be set at the work position B.sub.1 are determined. In this way, it is possible to set the robot coordinate system C.sub.R1 at the work position B.sub.1 as illustrated in
(30) Similarly, the traveling device 14 disposes the robot 12 at the work position B.sub.2, and then, the robot 12 touches up three points defined on the workpiece W by the end effector 26 while the external device 16 is rotating the workpiece W, whereby, data indicating a relative position between the robot 12 (base 18) disposed at the work position B.sub.2 and the external device 16 (e.g., a position and a direction of the axis A.sub.2 with respect to the robot 12 disposed at the work position B.sub.2) is acquired.
(31) Based on the relative position data, the robot coordinate system C.sub.R2 can be set at the work position B.sub.2 as illustrated in
(32) If a further work position B.sub.3 is set between the work positions B.sub.1 and B.sub.2, the apparatus 100 according to the present embodiment automatically sets another robot coordinate system C.sub.R3 at the work position B.sub.3. Specifically, as illustrated in
(33) Hereinafter, a function of the coordinate system acquisition section 102 will be described with reference to
(34) Specifically, the coordinate system acquisition section 102 obtains, by calculation, coordinates (or functions) of the virtual straight line A.sub.4 in the traveling device coordinate system C.sub.T (so-called linear interpolation between two points). Then, the coordinate system acquisition section 102 obtains, by calculation, the coordinates in the traveling device coordinate system C.sub.T of a point P.sub.1 on the virtual straight line A.sub.4 at the work position B.sub.3. In this way, the coordinate system acquisition section 102 can obtain, by the calculation, the position P.sub.1 of the origin of the robot coordinate system C.sub.R3 to be set at the work position B.sub.3.
(35) Next, the coordinate system acquisition section 102 obtains an orientation of the robot coordinate system C.sub.R3 to be set at the work position B.sub.3. In the example illustrated in
(36) An example of a method of obtaining the orientation of the robot coordinate system C.sub.R3 will be described below with reference to
(37) As illustrated in
(38) In this case, the intermediate direction between the z-axis direction of the robot coordinate system C.sub.R1 and the z-axis direction of the robot coordinate system C.sub.R2 can be defined as a direction in which θ.sub.z=θ.sub.z0/2 is satisfied on the same plane as the z-axes of the robot coordinate systems C.sub.R1 and C.sub.R2. Thus, in this case, as illustrated in
(39) Similarly, in the traveling device coordinate system C.sub.T, the coordinate system acquisition section 102 calculates an intermediate direction between the x-axis (or y-axis) direction of the robot coordinate system C.sub.R1 and the x-axis (or y-axis) direction of the robot coordinate system C.sub.R2, and decides the calculated direction as the x-axis (or y-axis) direction of the robot coordinate system C.sub.R3. In this way, the coordinate system acquisition section 102 can obtain the orientation (directions of respective axes) of the robot coordinate system C.sub.R3 as the intermediate orientation between the orientations of the robot coordinate systems C.sub.R1 and C.sub.R2.
(40) Alternatively, the coordinate system acquisition section 102 may obtain the orientation of the robot coordinate system C.sub.R3 as a function based on the orientations of the robot coordinate systems C.sub.R1 and C.sub.R2, and on the position of the point P.sub.1. Specifically, the z-axis direction of the robot coordinate system C.sub.R3 can be expressed as a function: θ.sub.z=f.sub.z(x) where the angle θ.sub.z illustrated in
(41) Similarly, the x-axis (or y-axis) direction of the robot coordinate system C.sub.R3 can be expressed as a function: θ.sub.x=f.sub.x(x) (or θ.sub.y=f.sub.y(x)) that changes depending on the x-coordinate of the traveling device coordinate system C.sub.T. Accordingly, the coordinate system acquisition section 102 can obtain, by calculation, the x-axis (or y-axis) direction of the robot coordinate system C.sub.R3 from the x-coordinate in the traveling device coordinate system C.sub.T at the work position B.sub.3 and the function: θ.sub.x=f.sub.x(x) (or the function θ.sub.y=f.sub.y(x)).
(42) In this way, the coordinate system acquisition section 102 can obtain the orientation of the robot coordinate system C.sub.R3 by calculation, using the functions f.sub.z(x), f.sub.x(x), or f.sub.y(x). The parameter such as a coefficient or variable in the function f.sub.z(x), f.sub.x(x), or f.sub.y(x) can be determined by the operator.
(43) By the method described above, the coordinate system acquisition section 102 can automatically set the robot coordinate system C.sub.R3 at the work position B.sub.3 with the orientation at the position P.sub.1 obtained by the calculation. Note that, the coordinate system acquisition section 102 may set the robot coordinate system C.sub.R3 at the point P.sub.1 with a predetermined orientation, without calculating the orientation of the robot coordinate system C.sub.R3. For example, the coordinate system acquisition section 102 may set the robot coordinate system C.sub.R3 at the point P.sub.1 with the same orientation as the robot coordinate system C.sub.R1 or C.sub.R2.
(44) In the example illustrated in
(45) For example, the virtual curved line A.sub.5 may be a curved line connecting both ends of the rail 34 (or both ends of the movement stroke of the slider 36) and the origins of the robot coordinate systems C.sub.R1 and C.sub.R2, and may be comprised of a parabolic line, an arc line, arbitrary curved line, or a combination thereof. The coordinate system acquisition section 102 obtains, by calculation, coordinates (or function) of the virtual curved line A.sub.5 in the traveling device coordinate system C.sub.T (so-called a curved line (or parabolic line or arc) interpolation between a plurality of points).
(46) Then, the coordinate system acquisition section 102 obtains, by calculation, coordinates in the traveling device coordinate system C.sub.T of a point P.sub.2 on the virtual curved line A.sub.5 at the work position B.sub.3. In this way, the coordinate system acquisition section 102 can obtain, by calculation, the position P.sub.2 of the origin of the robot coordinate system C.sub.R3 to be set at the work position B.sub.3.
(47) In addition, the coordinate system acquisition section 102 can obtain the orientation of the robot coordinate system C.sub.R3 by the above-described method.
(48) The apparatus 100 having the above-described function is comprised of a computer including a processor (CPU, GPU, or the like) and a memory (ROM, RAM, or the like), for example. In this case, the processor of the computer performs various calculations to carry out the function of the coordinate system acquisition section 102. Note that the apparatus 100 may be a robot controller configured to control the robot 12.
(49) As described above, the coordinate system acquisition section 102 of the apparatus 100 obtains, by calculation, the position P.sub.1, P.sub.2 of the robot coordinate system C.sub.R3 to be set between the positions of the two robot coordinate systems C.sub.R1 and C.sub.R2, from the positions of the two robot coordinate systems C.sub.R1 and C.sub.R2 preset along the axis A.sub.1. According to this configuration, even when the rail 34 of the traveling device 14 deforms, it is possible to accurately and automatically obtain the position of the robot coordinate system C.sub.R3 so as to correspond to the deformation of the rail 34.
(50) Further, by controlling the robot 12 disposed at the work position B.sub.3 with reference to the robot coordinate system C.sub.R3, it is possible to carry out the more accurate cooperative operation between the robot 12 and the external device 16. In addition, since the operator does not need to manually obtain the position P.sub.1, P.sub.2 of the robot coordinate system C.sub.R3, the burden necessary for the startup of the robot system 10 can be reduced.
(51) In the above-described embodiment, the two robot coordinate systems C.sub.R1 and C.sub.R2 are preset along the axis A.sub.1. However, the operator may preset the n-th robot coordinate system C.sub.R_n (n=1, 2, 3 . . . ) along the axis A.sub.1.
(52) In this case, the coordinate system acquisition section 102 obtains, by calculation, a position P.sub.m of another robot coordinate system C.sub.R_n to be set between two robot coordinate systems C.sub.R_n−1 and C.sub.R_n adjacent to each other, from positions of the two robot coordinate systems C.sub.R_n−1 and C.sub.R_n, using the above-described method. By increasing the number of the preset robot coordinate systems C.sub.R_n in this way, it is possible to obtain the position P.sub.m of the robot coordinate system C.sub.R_n to be set between any two robot coordinate systems C.sub.R_n−1 and C.sub.R_n so as to correspond to the deformation of the rail 34 with higher accuracy.
(53) Next, another robot system 60 will be described with reference to
(54) The robot control device 62 includes a processor 64, a memory 66, and an input device 68. The processor 64 includes e.g. a CPU or GPU, and is communicably connected to the memory 66 and the input device 68 via a bus 70. The processor 64 performs various calculations while communicating with the memory 66 and the input device 68. The memory 66 includes e.g. a ROM or RAM, and stores various types of data. The input device 68 includes e.g. a keyboard, a mouse, or a touch panel, and receives input of data from an operator.
(55) The robot control device 62 includes an apparatus 110 configured to set the robot coordinate system C.sub.R. In the present embodiment, a function of the apparatus 110 is implemented in the robot control device 62 as software or hardware, and the processor 64 performs various calculations for carrying out the function of the apparatus 110.
(56) The function of the apparatus 110 will be described below. First, the processor 64 preliminarily sets n-th robot coordinate system C.sub.R_n (n=1, 2, 3 . . . ) along the axis A.sub.1. Specifically, the processor 64 controls the traveling device 14 so as to dispose the robot 12 at the n-th work position B.sub.n.
(57) Then, using the above-described method of setting the robot coordinate system, the processor 64 controls the robot 12 so as to touch up three points defined on the workpiece W by the end effector 26 along with controlling the external device 16 so as to rotate the workpiece W (or dummy workpiece), and acquires the data of the relative position between the robot 12 disposed at the n-th work position B.sub.n and the external device 16 (e.g., the data indicative of the position and the direction of the axis A.sub.2 of the external device 16 with respect to the robot 12). Thus, the processor 64 functions as a position acquisition section 104 configured to acquire the relative position between the robot 12 and the external device 16.
(58) Then, based on the acquired data of the relative position, the processor 64 determines the origin position (i.e., the center of the base 18) and the directions of respective axes of the n-th robot coordinate system C.sub.R_n to be set at the n-th work position B.sub.n. In this way, the processor 64 preliminarily sets the n-th robot coordinate system C.sub.R_n at the n-th work position B.sub.n.
(59) Thus, the processor 64 functions as a coordinate system setting section 106 configured to preliminarily set the n-th robot coordinate system C.sub.R_n based on the relative position. The processor 64 stores setting information (e.g., coordinates of the traveling device coordinate system C.sub.T) of the position and the orientation of the n-th robot coordinate system C.sub.R_n in the memory 66.
(60) Thereafter, the operator optionally sets a further work position B.sub.m between the (n−1)-th work position B.sub.n−1 and the n-th work position B.sub.n adjacent to each other, depending on e.g. the content of the work to be carried out on the workpiece W. Specifically, the operator operates the input device 68 so as to input position information of the work position B.sub.m as the x-coordinate of the traveling device coordinate system C.sub.T, for example.
(61) When receiving the input of the position information of the work position B.sub.m, the processor 64 functions as the coordinate system acquisition section 102 to obtain a position P.sub.m and an orientation of another robot coordinate system C.sub.R_m to be set between the (n−1)-th robot coordinate system C.sub.R_n−1 and the n-th robot coordinate system C.sub.R_n from the setting information of the positions and orientations of the (n−1)-th robot coordinate system C.sub.R_n−1 and the n-th robot coordinate system C.sub.R_n which are preset, using the method described above with reference to
(62) When disposing the robot 12 at the work position B.sub.m and performing the work on the workpiece W by the robot 12, the processor 64 controls the traveling device 14 so as to dispose the robot 12 at the work position B.sub.m, and sets the robot coordinate system C.sub.R_n at the position P.sub.m and the orientation, that have been obtained as described above, in the work position B.sub.m.
(63) Then, the processor 64 controls the robot 12 with reference to the robot coordinate system C.sub.R_m, and performs the work on the workpiece W by the robot 12, in cooperation with the rotating operation of the workpiece W by the external device 16. In this way, the processor 64 can sequentially perform the work on the workpiece W by the robot 12 at each of the n-th work position B.sub.n and the work position B.sub.m.
(64) According to the present embodiment, even when the rail 34 of the traveling device 14 deforms, the processor 64 can accurately and automatically obtain the position of the robot coordinate system C.sub.R_m to be set at the work position B.sub.m so as to correspond to the deformation of the rail 34. Furthermore, by controlling the robot 12 disposed at the work position B.sub.m with reference to the robot coordinate system C.sub.R_m, it is possible to carry out the more accurate cooperative operation between the robot 12 and the external device 16. Furthermore, since the operator does not need to manually determine the position P.sub.m of the robot coordinate system C.sub.R_m, the burden necessary for the startup of the robot system 60 can be reduced.
(65) In the above-described embodiments, the coordinates of the virtual straight line A.sub.4, the virtual curved line A.sub.5, the point P.sub.1, and the point P.sub.2 are obtained as the coordinates in the traveling device coordinate system C.sub.T. However, they may be obtained as coordinates in the external device coordinate system C.sub.E or a world coordinate system (not illustrated), for example. The world coordinate system is a fixed coordinate system that is set different from the robot coordinate system C.sub.R3, the traveling device coordinate system C.sub.T, and the external device coordinate system C.sub.E in order to define a three-dimensional space of a work cell.
(66) Further, in the above-described embodiments, the position information of the work position B.sub.3, B.sub.m is input as the x-coordinate of the traveling device coordinate system C.sub.T. However, the position information of the work position B.sub.3, B.sub.m may be input as coordinate of the external device coordinate system C.sub.E or the world coordinate system (not illustrated), for example.
(67) Further, the robot 12 is not limited to the articulated robot, but may be any other types of robots, such as a parallel link robot or the like. Further, the traveling device 14 may be any type of device as long as it can move the robot 12 along the axis A.sub.1. Additionally, the axis A.sub.1 is not limited to the straight line, but may be a curved line.
(68) Although the present disclosure has been described through the above embodiments, the above embodiments are not intended to limit the claimed invention.