1. Field of the Invention
The present invention relates to a simulation apparatus for a robot system including a visual sensor having an image capturing means and a robot, more particularly relates to a simulation apparatus useful when preparing an operation program including robot movement and detection by the visual sensor off line and evaluating, correcting, editing, etc. the program finished being prepared or in the process of preparation off line.
2. Description of the Related Art
Known in the art is a simulation apparatus arranging and displaying on a screen three-dimensional models of a robot, workpiece, and peripheral equipment and simulating robot operation in accordance with designated robot movement commands etc. The simulation apparatus is used when preparing an operation program for the robot off line or evaluating, correcting, editing, etc. the program prepared off line. With a conventional simulation apparatus, however, when trying to prepare, correct, edit, etc. a program off line at a location where the actual machinery is not deployed (for example, an office), simulation relating to the visual sensor has been almost impossible.
For example, it has not been possible to obtain a grasp of the three-dimensional shape (visual volume) of the visual field of the image capturing means (for example, digital CCD camera, same below) which the visual sensor uses for image capturing. Further, it has not been known what kind of image the image capturing means can capture. This was inconvenient. In particular, when mounting an image capturing means in a robot, not knowing what kind of image would be obtained along with the position and orientation of the robot was a big problem. Therefore, for matters relating to the visual sensor, the practice has been to actually mount an image capturing means on a robot on-site, operate the visual sensor to obtain an image while changing the position and orientation of the robot, and check the resultant image.
Further, when determining the position and orientation of the robot for the image capturing means actually mounted on the robot to view a reference point relating to detection of an object (workpiece etc.) (normally set to a suitable position on the object desired to be viewed by the image capturing means) as well, the practice has been to operate the robot on-site and perform the work by trial and error while viewing the captured image. Further, determining where in the operation program of the robot to insert the visual sensor detection command also required trial and error.
In this way, when using a simulation apparatus to prepare an operation program off line or evaluate, correct, edit, etc. the program prepared off line for a robot system including a visual sensor, various inconveniences arose and led to a drop in the work efficiency. No disclosure of technology for dealing with such inconveniences or the drop in work efficiency has been found in the known art.
The present invention provides a simulation apparatus able to reduce or eliminate the various inconveniences and drop in work efficiency which had arisen when preparing an operation program off line or evaluating, correcting, editing, etc. the program prepared off line for a robot system including a visual sensor.
To attain the above, the present invention provides a simulation apparatus arranging and simultaneously displaying on a screen three-dimensional models of at least a robot, workpiece, and image capturing means of a visual sensor and simulating operation of the robot, wherein provision is made of a visual field display means for displaying the visual field of the image capturing means on the screen by a three-dimensional shape. Due to this, the three-dimensional shape (visual volume) of the visual field of the image capturing means can be easily confirmed on the screen. Here, the three-dimensional shape of the visual field is typically a square pyramid.
These and other objects and features of the present invention will become clearer from the following description of the preferred embodiments given with reference to the attached drawings, wherein:
The present invention will be described in detail below while referring to the attached figures.
The present invention, referring to
Further, the present invention may also provide an image display means 42 for displaying an image captured by the image capturing means (2) in the visual field on a screen. Due to this, what kind of image is obtained can be understood without on-site confirmation work. In both cases, the image capturing means (2) is typically mounted on the robot, but the present invention may also be applied to a case of providing the image capturing means (2) away from the robot of course. In the case of mounting it on the robot, the screen of the simulation apparatus displays model images of the robot and the image capturing means mounted thereon, while in the case of provision away from the robot, the screen of the simulation apparatus displays model images of the robot and the image capturing means provided away from it. The present invention further proposes to provide a reference point designating means 43 for designating a first reference point relating to the workpiece and a robot operating means 44 for making the robot on the screen operate so that a predetermined second reference point relating to the visual field matches with the first reference point. According to this proposal, it is possible to use the simulation apparatus displaying the three-dimensional shape of the visual field of the image capturing means (2) of the visual sensor on a screen to easily define a reference point (first reference point) relating to detection of an object and study the position and orientation of the robot for viewing the first reference point.
Further, the present invention proposes to provide the simulation apparatus with a simulating means 45 for performing a simulation including robot movement in accordance with a robot operation program including image capturing commands for making the image capturing means (2) capture an image, movement commands for making the robot move along a path, and correction commands relating to the image capturing commands and movement commands, means (12, 13, 14) for storing correction amounts relating to the path of movement designated by the movement commands, and path correcting means 46 for reading out the stored correction amounts and correcting the path of movement on the screen by the correction commands during the simulation. Due to this proposal, it is possible to give suitable correction amounts envisioned for an operation program including instruction content for correcting the path of movement of the robot by using the results of detection by the visual sensor so as to make the robot move on the screen and assist evaluation and correction of the operation program. Here, in the case of correcting the path of movement of the robot on the screen as explained above, it is possible to correct the position of arrangement of at least one of the workpiece and peripheral equipment on the screen according to the above correction amount.
Note that it is also possible to provide a display switching means 47 for switching the display mode of the display of the visual field in accordance with the image capturing command. The switching of the display mode may also be switching of display/nondisplay in accordance with the image capturing command. By doing this, at the time of simulation, the operator can visually confirm the three-dimensional shape of the visual field of the image capturing means (2) and the timing of issuance of the image capturing command (where in operation program). This is extremely convenient.
According to the present invention, it is possible to reduce or eliminate the various inconveniences and drop in work efficiency which had arisen when preparing an operation program off line or evaluating, correcting, editing, etc. the program prepared off line for a robot system including a visual sensor. Specifically, the following advantages arise.
(1) The basic functions of a simulation apparatus are augmented by an image display function for the three-dimensional shape (visual volume) of the visual field of the image capturing means (2). The basic conditions for studying matters relating to the visual sensor are therefore met.
(2) Use of the simulation apparatus displaying the three-dimensional shape of the visual field of the image capturing means (2) of the visual sensor on a screen enables easy definition of the reference point (first reference point) relating to detection of an object and study of the position and orientation of the robot for viewing the first reference point.
(3) It is possible to give suitable correction amounts envisioned for an operation program including instruction content for correcting the path of movement of the robot by using the results of detection by the visual sensor (correction amounts envisioned as for the correction of the path based on the results of detection of the visual sensor) so as to make the robot move on the screen and assist evaluation and correction of the operation program.
(4) Switching the display mode relating to the display of the visual field in accordance with an image capturing command enables an operator to visually confirm the three-dimensional shape of the visual field of the image capturing means (2) and the timing (where in operation program) of issuance of the image capturing command at the time of simulation. This is extremely convenient.
Below, an embodiment of the present invention will be explained with reference to the drawings. First,
The memories store the three-dimensional shape data (including dimensional data, same below) of the robot covered by the display or simulation explained later, the three-dimensional shape data in the state where the robot mounts the image capturing means, the three-dimensional shape data of the workpiece, and also, in accordance with need, the three-dimensional shape data of the peripheral objects (for example, jigs of the workpiece, machine tools, etc.).
Further, the memories store programs, settings, etc. for operating the graphic control circuit 15 to display objects defined by these three-dimensional models in a three-dimensional space (hereinafter referred to as the “simulation space”) for the simulation. Here, the positions of provision and the orientations of the objects in the simulation space (three-dimensional models) are defined by work cell data. A “work cell” is a unit of arrangement in a robot system covered by the simulation and designates the objects (three-dimensional models of robot, workpiece, peripheral equipment, etc.) included in the robot system to be covered by the simulation. The work cell data includes data designating the initial positions and orientations of the objects designated. The content of the definitions of the work cell can be changed at any time by operating the keyboard/mouse 16 for example.
The above configurations and functions explained up to here relating to this embodiment are generally well known. The simulation apparatus according to the present embodiment is equipped with, in addition to these components and functions, software for the study of the robot orientation by a graphic jog, i.e., graphically presented “robot jog” (explained in detail later), simulation considering the visual sensor, and the display operation relating to the same by the routine and processing explained later.
In this embodiment, first, as “Preparations 1”, the visual field of the image capturing means is set, the tool coordinate system is set, the detection reference point is set, etc.
Step S1: The work cell is defined on the simulation apparatus 10. For example, a template of a work cell where the robot mounting the image capturing means, the workpiece, etc. are provisionally arranged is prepared in advance at an external CAD system (not shown). This is fetched into the simulation apparatus 10 once through the communication interface 17. Further, the necessary corrections, additions to, deletions from, and other changes are made to the template to determine the work cell to be covered by the simulation in the present embodiment. Of course, another method, for example, fetching existing similar work cell data from another electronic data storage medium (personal computer hard disk, flexible magnetic disk, etc.) is also possible or the data may be newly prepared on the simulation apparatus 10.
Further, reference numeral 21 indicates the center point of the camera defined by the image capturing means 2, while reference symbol A indicates the direction of the optical axis passing through the center point of the camera (centerline of visual field) by a broken arrow. Note that after completion of step S1 of
Step S2: the three-dimensional shape (visual volume) of the visual field of the image capturing means 2 is defined. For this purpose, the data of the height h0, depth d, and length l (see
When inputting the data of the height h0, the depth d, and the length l, the screen 1 (4-1) displays a visual volume model 30 showing the visual volume such as shown in
Step S3: The three-dimensional model 30 defined at step S2 is joined with (attached to) the image capturing means in the work cell (the image capturing means 2 in the screen of
The calculations for this are performed in the simulation apparatus (10). Further, the image incorporating the joined results is displayed in the “screen 1” as shown in
Step S4: The tool coordinate system of the robot 1 is defined. In this embodiment, as shown in
Step S5: The detection reference point relating to the workpiece 3 is set. This detection reference point is the “point” utilized in the later-mentioned “graphic jog”. Further, in general, it designates the “point” representing the workpiece 3 as the object for capture and for example the “point” corresponding to the most important image capture location in the actual work. The point is designated by defining the coordinate system such as shown in
The directions of the X-axis (Xdt) and the Y-axis (Ytl) of the detection reference coordinate system and the directions of the X-axis and Y-axis of the coordinate system defined in the simulation space are assumed to match. If the detection reference coordinate system is set, the origin (detection reference point) 24 is displayed in the image of
With the above step S1 to step S5, the “Preparations 1” are completed. However, when there are a plurality of robots 1 mounting image capturing means in the defined work cell, similar preparations to the above are performed for each robot in accordance with need. At this time, data able to be used in common among the plurality of robots (for example, data of the visual volume) are suitably shared in accordance with the applications (content of work performed by robot system).
Next, in the present embodiment, after the “Preparations 1”, a “graphic jog” is utilized to study the orientation of the robot relating to image capture.
The state of this robot movement is displayed in an animation form on the screen 1 (4-1). At this time, the image capturing means 2 also moves together with the robot 1 and the visual volume model 30 attached to the image capturing means 2 at step S3 also similarly moves. The screen 1 in
Note that as explained above, the tool tip point 23 and the detection reference point 24 are the origins of the tool coordinate system and detection reference coordinate system (see
The graphic jog explained above is useful for studying the orientation of the robot 1. For example, by checking if the orientation of the robot is unreasonable or if there is a possibility of interference with surrounding objects at the time of making the tool tip point 23 set to the view point of the image capturing means 2 match with the detection reference point 24, it is possible to evaluate the suitability of the position and orientation of arrangement of the robot which the work cell sets. If there is a problem in the position or orientation of arrangement of the robot (for example if the workpiece 3 and the robot 1 are too far apart or if the direction of the robot base is unsuitable), the position and orientation of arrangement of the robot in the work cell are corrected or the position and orientation of the workpiece or the position and orientation of mounting of the image capturing means are changed so as to correct the work cell. These corrections are performed until the orientation of detection of the robot 1 to the detection reference point 24 simulated by the graphic jog becomes suitable. Therefore, if necessary, the processings of “Preparations 1” and “graphic jog” are repeated.
Here, the “display of image visible from image capturing means 2” by the screen 2 (4-2) will be explained. As explained above, after the end of step S1, it becomes possible to display the image visible from the image capturing means 2 on the screen 2. That is, at the end of step S1, the relationship between the position and orientation of the visual volume model 30 having the camera center point 21 (and 22) as the peak in the simulation space and the position and orientation of the robot 1 is set and the position and orientation of the workpiece 3 etc. are also known as data of the work cell. Therefore, if giving the data of the position and orientation of the robot 1, it is possible to find by calculation the image visible from the image capturing means 2 from the three-dimensional position data grasped in the visual field according to the visual volume model 30. This calculation can for example be image projection calculation by applying the model of a pinhole camera to the image capturing means 2. Note that the software itself for simulating this kind of image projection of an image capturing means is known. A detailed explanation will be omitted.
The display of the screen 2 (4-2) may be performed at any time, but here if assuming display at the time of execution of the graphic jog, for example the display image such as shown in the screen 2 in
Next, the simulation in accordance with the robot operation program including robot movement commands and commands for correcting the path of movement utilizing a visual sensor in relation to the robot movement commands will be explained. In this embodiment, the “Preparations 2” are performed in accordance with the routine shown in the flow chart of
When the “Preparations 2” have been completed in this way, the “operation program simulation” is performed by the routine described in the flow charts of
Step V9: The visual volume model 30 in the screen 1 (4-1) is returned to the nondisplayed state.
Step V10: The robot 1 is made to move in the simulation space. Here, the robot 1 is moved from Q1 (X1, Y1, Z1; P1, W1, R1) to Q2′ (X2+ΔX2, Y2+ΔY2, Z2+ΔZ2; P2+ΔP2, W2+ΔW2, R2+ΔR2). This state is displayed on the screen 1 in the form of an animation. However, when proceeding from step V6 directly to step V10 (when there is no correction command using the visual sensor), the command of that line is executed in the usual manner.
Step V11: Whether the line is the final line is judged. If the result is yes, the processing is ended. If no, the routine proceeds to step V12.
Step V12: The line index I is incremented by “1” and the routine returns to step V5.
While the invention has been described with reference to specific embodiments chosen for purpose of illustration, it should be apparent that numerous modifications could be made thereto by those skilled in the art without departing from the basic concept and scope of the invention.
Number | Date | Country | Kind |
---|---|---|---|
2003-372518 | Oct 2003 | JP | national |