Robot programming device

BACKGROUND OF THE INVENTION

00011. Field of the Invention

0002The present invention relates to a device for programming the cooperative motion of a plurality of robots.

00032. Description of the Related Art

0004In an arc welding process or a trimming process on a workpiece having a complicated shape, a plurality of robots (for example, two robots) may be cooperatively controlled. In the teaching of the cooperative control, the robots are moved one-by-one, so as to determine a taught position of each robot, by means of an operating panel or the like. Alternatively, two robots may be simultaneously moved by using a cooperative jog function. For example, Japanese Unexamined Patent Publication No. 2004-9279 discloses a welding robot system in which a welding robot and a positioner are cooperatively controlled. Also, Japanese Unexamined Patent Publication No. 2003-340756 discloses a robot controller in which a plurality of robots are taught in parallel by a plurality of operators so as to reduce the time of teaching.

0005When a plurality of robots are moved one-by-one, a jog operation for each robot must be carried out gradually, from the viewpoint of cooperation of the robots. Therefore, the operation takes a long time. On the other hand, when the cooperative jog function is used, two robots may be simultaneously moved. However, a teaching operation for a complicated process, such as arc welding or trimming in three-dimensional space, must be carried out by a person highly skilled in the art and also takes a long time. Also, in general, the cooperative jog function can be applied to only two robots. Therefore, if three or more robots are necessary, much more time is necessary for the teaching operation. As described above, as the teaching operation needs a long time, the starting-up of a robot system including the robots also takes a long time or many man-hours.

SUMMARY OF THE INVENTION

0006Accordingly, it is an object of the present invention to provide a robot programming device in which the teaching of cooperative motion to a plurality of robots may be carried out in a short time so as to reduce the number of man-hours for starting-up a robot system including the robots.

0007To this end, according to the present invention, there is provided a robot programming device for a robot system including a handling robot having a hand for gripping a workpiece and a processing robot cooperatively moved with the handling robot and having a work tool for processing the workpiece, the robot programming device making a motion program for the handling robot and the processing robot, the robot programming device comprising: a display means for indicating three-dimensional images of the handling robot, the hand, the processing robot, the work tool and the workpiece; a means for specifying the condition of the movement of the workpiece; a means for specifying the positional relation between the workpiece and the hand; a means for determining the position and the motion of the handling robot based on the condition of the movement of the workpiece and the positional relation between the workpiece and the hand; a means for specifying a site on the workpiece to be processed; a means for determining the position and the motion of the processing robot based on the condition of the movement of the workpiece and the position of the site on the workpiece to be processed; and a means for making a motion program for the handling robot and the processing robot based on the determined positions and motions of the handling robot and the processing robot.

0008It is preferable that the means for determining the position and the motion of the handling robot changes the determined position of the handling robot and checks again the possibility of the motion of the handling robot at a changed position, when the determined motion of the handling robot at the determined position is judged to be inappropriate.

0009It is also preferable that the means for determining the position and the motion of the processing robot changes the determined position of the processing robot and checks again the possibility of the motion of the processing robot at a changed position, when the determined motion of the processing robot at the determined position is judged to be inappropriate.

0010The robot programming device may further comprise a means for calculating the positional relation between the workpiece and the hand based on the position of the center of gravity and the three-dimensional shape of the workpiece.

BRIEF DESCRIPTION OF THE DRAWINGS

0011The above and other objects, features and advantages of the present invention will be made more apparent by the following description, of preferred embodiments thereof, with reference to the accompanying drawings, wherein:

0012<figref idref="DRAWINGS">FIG. 1</figref> is a schematic diagram of a basic constitution of a robot system including a robot programming device according to the invention;

0013<figref idref="DRAWINGS">FIG. 2</figref> is a flowchart showing a procedure of the robot programming device;

0014<figref idref="DRAWINGS">FIG. 3</figref> shows the positional relation between a workpiece and a hand of a robot;

0015<figref idref="DRAWINGS">FIG. 4</figref> is a diagram in relation to the determination of the position of a handling robot;

0016<figref idref="DRAWINGS">FIG. 5</figref> shows an example of the layout of the handling robot;

0017<figref idref="DRAWINGS">FIG. 6</figref> shows a site on the workpiece to be processed;

0018<figref idref="DRAWINGS">FIG. 7</figref><i>a </i>is a diagram in relation to the determination of the position of a processing robot;

0019<figref idref="DRAWINGS">FIG. 7</figref><i>b </i>is a schematic diagram of a lattice used in the configuration of <figref idref="DRAWINGS">FIG. 7</figref><i>a</i>;

0020<figref idref="DRAWINGS">FIG. 8</figref> shows an example of the layout of the processing robot;

0021<figref idref="DRAWINGS">FIG. 9</figref> shows the position of a welding torch relative to the workpiece during a welding operation by the robot system;

0022<figref idref="DRAWINGS">FIG. 10</figref> is a diagram in relation to the automatic correction of the position of the handling robot; and

0023<figref idref="DRAWINGS">FIG. 11</figref> shows a diagram relating to the calculation of the part of the workpiece to be handled.

DETAILED DESCRIPTIONS

0024The present invention will be described below with reference to the drawings. <figref idref="DRAWINGS">FIG. 1</figref> is a schematic diagram of a basic constitution of a robot system <b>10</b> to which a robot programming device according to the invention may be applied. The robot system <b>10</b> includes two handling robots <b>12</b> and <b>14</b> each having a hand for gripping an object to be processed or a workpiece W. The robot system <b>10</b> also includes a welding robot <b>16</b> for processing (welding in this case) the workpiece W, a robot controller <b>18</b> for controlling the robots <b>12</b>, <b>14</b> and <b>16</b>, an input device such as a personal computer <b>20</b> connected to the controller <b>18</b>, and a teaching operation panel <b>22</b>, connected to the controller <b>18</b>, for teaching the robots <b>12</b>, <b>14</b> and <b>16</b>. In this embodiment, each means included in the programming device of the invention is incorporated in the personal computer <b>20</b>. However, it is obvious that another constitution of the means may be possible.

0025<figref idref="DRAWINGS">FIG. 2</figref> is a flowchart showing a procedure by means of the robot programming device. Hereinafter, the invention is explained with reference to the drawings regarding steps S<b>1</b> to S<b>7</b> of <figref idref="DRAWINGS">FIG. 2</figref>.

0026First, as shown in <figref idref="DRAWINGS">FIG. 3</figref>, three-dimensional models corresponding to a workpiece to be processed (or welded), hands <b>26</b> and <b>28</b> for gripping the workpiece W are selected and displayed on a display means such as a display <b>24</b> of the personal computer <b>20</b> (step S<b>1</b>).

0027Next, as shown in <figref idref="DRAWINGS">FIG. 3</figref>, the condition of the movement of the workpiece W is set (step S<b>2</b>). In the embodiment, the workpiece W may be rotated about a rotation axis A. Further, in step <b>3</b>, the positional relation between the hands <b>26</b>, <b>28</b> and the workpiece W (concretely, the handling or gripping positions of the workpiece by the hands <b>26</b>, <b>28</b>) is set such that the condition set in step S<b>2</b> is satisfied. In this case, both ends of the workpiece W are held by the hands <b>26</b> and <b>28</b>, which are automatically determined, as described below.

0028Then, the locations and the motions of the handling robots <b>12</b> and <b>14</b> are determined (step S<b>4</b>). At this point, the three-dimensional positions of the robots may be inputted by an operator via the computer, otherwise, they may be automatically determined based on data set in steps S<b>2</b> and S<b>3</b>. In the latter case, the location may be determined in view of the stroke of each robot and/or interference between the workpiece and each robot. Concretely, as shown in a plain view of <figref idref="DRAWINGS">FIG. 4</figref>, when the position of the workpiece W handled by the handling robot <b>12</b> is set on the position R<b>1</b>, some candidate positions where the robot <b>12</b> may be located (the positions R<b>2</b> to R<b>4</b> in this case) are selected. Then, among the candidate positions, one or more positions where the robot <b>12</b> does not interfere with external equipments when the robot <b>12</b> is operated according to the condition of the movement set in step S<b>2</b> are selected and a margin of the stroke of the robot <b>12</b> in the position is calculated. In other words, when interference may occur in one candidate position, the position is changed to another candidate position and the possibility of interference is checked again. On the other hand, when interference cannot occur in one candidate position, the margin of the stroke is calculated. In this way, one of the candidate positions where the handling robot <b>12</b> may have the largest margin of the stroke is selected as the final location of the robot <b>12</b> and, the motion of the robot at the position is used for programming of a motion program. The above procedure is also applied to the other handing robot <b>14</b>.

0029In addition, if the largest margin of the stroke may be obtained in a plurality of candidate positions, one position, where the area of installation of the robots is smallest (for example, the distance between the robots <b>12</b> and <b>14</b> is shortest), is selected. Contrarily, one of the candidate positions, where the robot has the largest margin among a plurality of candidate positions where the area of installation of the robots is smallest, may be selected. <figref idref="DRAWINGS">FIG. 5</figref> shows a thus selected example of the layout of the handling robots <b>12</b> and <b>14</b>.

0030In the next step S<b>5</b>, as shown in <figref idref="DRAWINGS">FIG. 6</figref>, a welding site on the workpiece W (two sites W<b>1</b> and W<b>2</b>, in this case) and the welding condition is designated. As the welding condition, in the case of arc welding, a targeting angle, an angle of advance and a welding speed, etc., are possible.

0031Next, in step S<b>6</b>, the position and the motion of the welding robot <b>16</b> are determined. At this point, the three-dimensional positions of the robots may be inputted by an operator via a computer, otherwise, they may be automatically determined based on data set in steps S<b>2</b> to S<b>5</b>. In the latter case, the location may be determined in view of the stroke of the welding robot and/or interference between the workpiece and the robot. Concretely, as shown in <figref idref="DRAWINGS">FIGS. 7</figref><i>a </i>and <b>7</b><i>b</i>, when a site or area of the workpiece W to be weleded is set at position A<b>1</b>, some candidate positions where the welding robot <b>16</b> may be located are selected. In this case, the candidate positions are lattice points of a lattice G<b>1</b> (<figref idref="DRAWINGS">FIG. 7</figref><i>b</i>) defined in three-dimensional space. First, as shown in <figref idref="DRAWINGS">FIG. 7</figref><i>a</i>, the welding site A<b>1</b> is positioned at the center of the lattice G<b>1</b>. Then, among the candidate positions, one or more positions, where the welding robot <b>16</b> does not interfere with the handling robot <b>12</b> or <b>14</b> when the robots <b>12</b> and <b>14</b> positioned at the positions set in step S<b>5</b> and operated according to the condition of the movement set in step S<b>2</b> are selected and a margin of the stroke of the robot <b>16</b> in the position is calculated. In other words, when interference may occur in one lattice point, the position of the robot <b>16</b> is changed to another lattice point and the possibility of interference is checked again. On the other hand, when interference cannot occur in one lattice point, the margin of the stroke is calculated. In this way, one lattice point of the lattice G<b>1</b> where the welding robot <b>16</b> may have the largest margin of the stroke is selected as the final location of the robot <b>16</b> and the motion of the robot at the point is used for programming of a motion program.

0032In addition, if the largest margin of the stroke may be obtained in a plurality of candidate positions or lattice points, one of the candidate positions, where the area of installation of the whole robot system is smallest (for example, the distance between the welding robot <b>16</b> and each handling robot <b>12</b>, <b>14</b> is shortest), is selected. Contrarily, one of the candidate positions, where the robot <b>16</b> has the largest margin among a plurality of candidate positions where the area of installation of the robot system is smallest, may be selected. <figref idref="DRAWINGS">FIG. 8</figref> shows a thus selected example of the layout of the welding robot <b>16</b>, as well as the handling robots <b>12</b> and <b>14</b>.

0033After the position and the motion of each of the robots are determined according to the above steps S<b>1</b> to S<b>6</b>, the robot programming device automatically makes a robot program for the cooperative motion of the robots in step S<b>7</b>. When the process is a welding process, as in the embodiment, the program includes commands for activating each axis of the robots and starting and stopping the arc welding. An example of the robot program is described below: <tables id="TABLE-US-00001" num="1"><table frame="none" colsep="0" rowsep="0"><tgroup align="left" colsep="0" rowsep="0" cols="1"><colspec colname="1" colwidth="217PT" align="center" /><thead><row><entry /></row><row><entry namest="1" nameend="1" align="center" rowsep="1" /></row><row><entry>An example of robot program</entry></row><row><entry namest="1" nameend="1" align="center" rowsep="1" /></row></thead><tbody valign="top"><row><entry /></row></tbody></tgroup><tgroup align="left" colsep="0" rowsep="0" cols="4"><colspec colname="OFFSET" colwidth="21PT" align="left" /><colspec colname="1" colwidth="63PT" align="left" /><colspec colname="2" colwidth="63PT" align="left" /><colspec colname="3" colwidth="70PT" align="left" /><tbody valign="top"><row><entry /><entry> 1: Each Axis</entry><entry>100%</entry><entry>P[1];</entry></row><row><entry /><entry> 2: Each Axis</entry><entry>100%</entry><entry>P[2];</entry></row><row><entry /><entry> 3: Straight</entry><entry>500 mm/sec</entry><entry>P[3];</entry></row><row><entry /><entry> 4: Straight</entry><entry>500 mm/sec</entry><entry>P[4] Arc Start;</entry></row><row><entry /><entry> 5: Straight</entry><entry>500 mm/sec</entry><entry>P[5];</entry></row><row><entry /><entry> 6: Straight</entry><entry>500 mm/sec</entry><entry>P[6];</entry></row><row><entry /><entry> 7: Straight</entry><entry>500 mm/sec</entry><entry>P[7];</entry></row><row><entry /><entry> 8: Straight</entry><entry>500 mm/sec</entry><entry>P[8];</entry></row><row><entry /><entry> 9: Straight</entry><entry>500 mm/sec</entry><entry>P[9] Arc End;</entry></row><row><entry /><entry>10: Straight</entry><entry>500 mm/sec</entry><entry>P[10];</entry></row><row><entry /><entry>11: Each Axis</entry><entry>100%</entry><entry>P[2];</entry></row><row><entry /><entry>12: Each Axis</entry><entry>100%</entry><entry>P[1];</entry></row><row><entry /><entry namest="OFFSET" nameend="3" align="center" rowsep="1" /></row></tbody></tgroup></table></tables>

0034Next, the above program example is briefly explained with reference to <figref idref="DRAWINGS">FIG. 9</figref>. First, by the motion of each axis of the robot, the workpiece W is moved such that the position of the workpiece W relative to a welding torch <b>30</b> (<figref idref="DRAWINGS">FIG. 1</figref>) of the welding robot <b>16</b> is positioned at a teaching point P[<b>1</b>]. At this point, the condition “100%” means that each axis of the robots <b>12</b> and <b>14</b> is activated at the maximum speed thereof. The workpiece is moved to a teaching point P[<b>2</b>] for avoiding interference and, then, moved to a teaching point P[<b>3</b>] just before a welding start point. From the point P[<b>3</b>], the workpiece W is straightly moved at a predetermined welding speed (500mm/sec, in this case). During the straight movement, the welding process by the welding robot <b>16</b> starts after a teaching point P[<b>4</b>]. The welding terminates when the workpiece reaches a welding end point P[<b>9</b>] via predetermined teaching points P[<b>5</b>] to P[<b>8</b>]. The workpiece is further moved to a teaching point P[<b>10</b>] without changing the speed. After the point P[<b>10</b>], the workpiece is returned to the point P[<b>1</b>] by the motion of each axis.

0035In the case of a plurality of robots (for example, handling and processing robots) being cooperatively operated, as in this embodiment, each teaching point includes position data of the handling and processing robots. For example, the teaching point P[<b>1</b>] includes the position (W, Y, Z, W, P, R) of the handling robot (having six axes) and the position (W, Y, Z, W, P, R) of the welding robot. In addition, although this embodiment relates to the robot system for arc welding, the invention may be applied to a robot system for trimming.

0036The flowchart as shown in <figref idref="DRAWINGS">FIG. 2</figref> may further have a step, for example, after step S<b>7</b>, for correcting the position of the handling robots. In this step, as shown in <figref idref="DRAWINGS">FIG. 10</figref>, for example, lattices G<b>2</b> and G<b>3</b> including the handling robots <b>12</b> and <b>14</b>, respectively, are defined in three-dimensional space. Previously, the handling robots <b>12</b> and <b>14</b> are positioned at the centers of the lattices G<b>2</b> and G<b>3</b>, respectively. In this case, the candidate positions of the handling robots may be lattice points of the lattice G<b>2</b> and G<b>3</b>. Then, among the candidate positions, one or more positions, where each of the robots <b>12</b> and <b>14</b> does not interfere with external equipment when the robots are operated according to the set condition of the movement of the workpiece W, are selected and the margins of the strokes of the robots <b>12</b> and <b>14</b> at the positions are calculated. In this way, the candidate position where interference may occur is excluded as an inappropriate position and one of the candidate positions where each handling robot may have the largest margin of the stroke is selected as the final location of each robot.

0037In addition, if the largest margin of stroke is obtained in a plurality of candidate positions or lattice points, one of the candidate positions, where the area of installation of the whole robot system is smallest (for example, the distance between the handling robots is shortest), is selected. Contrarily, one of the candidate positions, where each of the handling robots has the largest margin among a plurality of candidate positions where the area of installation of the robot system is smallest, may be selected.

0038<figref idref="DRAWINGS">FIG. 11</figref> is a diagram showing a procedure for determining the handling position of the workpiece based on the three-dimensional shape of the workpiece. When the workpiece has a columnar shape as shown in <figref idref="DRAWINGS">FIG. 11</figref>, for example, one handling surface (end surface) S<b>1</b> of the workpiece is designated. Then, a straight line L<b>1</b>, extending from the center of gravity Wg of the workpiece and perpendicular to the handling surface S<b>1</b>, intersects with the handling surface S<b>1</b> at an intersecting point H<b>1</b>. Similarly, a straight line L<b>2</b>, extending from the center of gravity Wg and perpendicular to a handling surface S<b>2</b> opposite to the handling surface S<b>1</b>, intersects with the handling surface S<b>2</b> at an intersecting point H<b>2</b>. In this case, the intersecting points H<b>1</b> and H<b>2</b> are defined as handling points of the workpiece W. At this point, if the workpiece has another shape and the handling surface S<b>2</b> does not exist or is inappropriate as the handling surface, the previously defined handling surface S<b>1</b> is changed to another surface of the workpiece. This process may be executed automatically.

0039According to the robot programming device of the present invention, teaching of the cooperative motion of a plurality of robots and programming of each robot may be automatically carried out. Therefore, the number of man-hours for teaching, programming and/or adjusting in the field may be greatly reduced.

0040While the invention has been described with reference to specific embodiments chosen for the purpose of illustration, it should be apparent that numerous modifications could be made thereto, by one skilled in the art, without departing from the basic concept and scope of the invention.