Patent Application
20060229766
The entire disclosure of Japanese Patent Application No. 2005-110955, filed Apr. 7, 2005, is expressly incorporated by reference herein.
1. Field of the Invention
The present invention relates to a technology suitable for operating of a robot to a teaching preset position while watching a captured image of a camera.
2. Description of the Related Art
Conventionally, according to a robot-position teaching method, a robot comprises a camera, the camera captures an image of an inspection object, the captured image is subjected to image processing by an image processing apparatus, and the inspection object is inspected. Further, in an inspecting apparatus having an image display apparatus for displaying the image, a coordinate system of the robot is set in the image processing apparatus before teaching the robot, and the robot position is transmitted to the image processing apparatus from a robot controller during the teaching. Furthermore, the image processing apparatus calculates a robot coordinate system in accordance with the change in the robot attitude, and the image display apparatus displays the robot coordinate system that changes the display direction thereof on a display screen in accordance with the change in the robot attitude.
Herein, in order to set, as the teaching position, the robot attitude at the time when an inspection object is in the center of a display screen, the jog operation for finely adjusting the robot position with manual operation is performed so that the inspection object comes to a target position by stepwise operation of the robot. When the operation is performed with the technology described in Japanese Patent No. 3125374 (Patent Document 1), a teacher needs to issue an operation instruction while recognizing a relationship between a robot coordinate system, serving as a coordinate system in actually issuing the operation instruction, and a camera coordinate system having vertical and horizontal directions, as the reference, on the display screen.
In consideration of the foregoing, an example is given as shown in
The present invention is devised in consideration of the above problems. An advantage of some aspects of the present invention is to provide a motion control apparatus and a robot-position teaching apparatus, for teaching a robot position, a motion control method and a robot-position teaching method, for teaching a robot position, a robot-position teaching method, and a motion control program for teaching a robot-position, in which an intuitional teaching operation based on an image capturing screen is made possible to reduce the burden of the teacher and improve the efficiency of the teaching operation.
According to an aspect of the present invention, there is provided a motion control apparatus for teaching a robot position by moving a robot end-point to a teaching preset position, in a system for displaying an image captured with a camera on a monitor and for setting a positional relationship between the camera and the robot end-point so that the captured image changes in conjunction with the operation of the robot end-point. The motion control apparatus comprises: operating means that inputs an operating command to the robot on a camera coordinate system having, as a reference, an image capturing screen displayed on the monitor; converting means that generates a motion vector on the camera coordinate system for moving the robot from the current position to the next moving position in accordance with the operating command on the camera coordinate system input from the operating means and converts the motion vector on the camera coordinate system into a motion vector on a robot coordinate system; operating-instruction generating means that generates a motor instructing value to be given to a motor arranged at a joint of the robot based on the motion vector on the robot coordinate system obtained by the converting means; and motor control means that controls the motor arranged at the joint of the robot in accordance with the motor instructing value generated by the operating-instruction generating means.
The motion is controlled on the camera coordinate system and, therefore, the end point of the robot can be moved to the teaching preset position by an intuitional operating instruction based on the image capturing screen. As a consequence thereof, the burden of the teacher can be reduced. Further, the end point of the robot can be moved to the target position by a minimum and sufficient number of execution without unnecessary increase in the excution number of the operation instructions. Thus, the efficiency of the teaching can be improved. Furthermore, the operating error can be suppressed.
Further, in the motion control apparatus for teaching a robot position according to another aspect of the present invention, the operating means comprises operating-direction designating buttons that designate the x axis, the y axis, and the z axis on the camera coordinate system, and operating buttons that operate the robot end-point in the axial direction designated by the operating-direction designating button. As mentioned above, the operating instruction using the button operation facilitates the input operation of the operating command.
Furthermore, the motion control apparatus for teaching a robot position according to a further aspect of the present invention further comprises: display means that displays a teaching operation screen having the operating-direction designating buttons and the operating buttons. As mentioned above, the teaching operation screen displayed on the display means may have the operating-direction designating button and the operating button.
In addition, in the motion control apparatus for teaching a robot position according to a further aspect of the present invention, the display means is touch-panel display means. As mentioned above, the display means may be a touch-panel one.
In addition, in the motion control apparatus for teaching a robot position according to a further aspect of the present invention, the amount of motion on the camera coordinate system in accordance with the press-down operation of the operating buttons is preset, and the end point of the robot is moved in accordance with the press-down operation of the operating buttons. As mentioned above, the motion of the end point of the robot can be moved with the amount of motion corresponding to the press-down operation.
In addition, in the motion control apparatus for teaching a robot position according to a further aspect of the present invention, preferably, the teaching preset position is the position of the robot end-point at the time when a work as a working target is positioned in the center of the image capturing screen. In general, in the image captured by the camera, processing precision of the center on the screen is higher than that of the end on the screen. Therefore, the teaching position is set to the robot position at the time when the work position is in the center of the image capturing screen and, thus, this contributes to the operation of the work with high precision.
In addition, according to a further aspect of the present invention, there is provided a robot-position teaching apparatus comprising one of the above-mentioned motion control apparatuses for teaching the robot position. The robot-position teaching apparatus further comprises memory means that stores, as teaching data, attitude data of the robot at the time when the operating command is repeatedly input from the operating means and the end point of the robot reaches the teaching preset position. Thus, upon teaching the robot position, the end point of the robot can be moved to the teaching preset position with the motion control apparatus for teaching the robot position. As a consequence thereof, the teaching operation can be easily performed.
In addition, according to a further aspect of the present invention, there is provided a motion control method for teaching a robot position by moving a robot end-point to a teaching preset position, in a system for displaying an image captured with a camera on a monitor and for setting a positional relationship between the camera and the robot end-point so that the captured image changes in conjunction with the operation of the robot end-point. The motion control method comprises: an operating-command input step of receiving an input of an operating command to the robot on a camera coordinate system having, as a reference, an image capturing screen displayed on the monitor; a converting step of generating a motion vector on the camera coordinate system for moving the robot from the current position to the next moving position in accordance with the operating command on the camera coordinate system input from the operating-command input step and converting the motion vector on the camera coordinate system into a motion vector on a robot coordinate system; a operating-instruction generating step of generating a motor instructing value be given to a motor arranged at a joint of the robot based on the motion vector on the robot coordinate system obtained by the converting step; and a motor control step of controlling the motor arranged at the joint of the robot in accordance with the motor instructing value generated by the operating-instruction generating step.
In addition, in the motion control method for teaching the robot position according to a further aspect of the present invention, the operating-command input step is repeated and the robot end-point is moved so that the robot end-point is positioned at the teaching preset position, and attitude data of the robot at the time is stored, as teaching data.
In addition, according to a still another aspect of the present invention, a motion control program for teaching a robot-position enables a computer to execute the steps of the above-mentioned motion control method for teaching the robot position.
A robot 1 comprises a multi-articulated robot having a plurality of joints according to the embodiment. An operating tool 3a capable of gripping a work, and a camera 4 that captures an image of the work are attached to a robot end-point 3 at the end of an arm 2. An image processing apparatus 5 processes the image captured by the camera 4 and a monitor 6 displays the image. Further, a robot control apparatus 10 that controls the robot 1 is connected to the robot 1, and a teaching operation apparatus 20 that performs teaching operation to the robot 1 is connected to the robot control apparatus 10. All the above-mentioned components constitute a robot system.
The teaching operation apparatus 20 comprises touch-panel display means 21 that displays a teaching operation screen shown in
The control means 16 comprises converting means 16a, and operating-instruction generating means 16b. The converting means 16a detects a designated coordinate system a designated operating direction and an amount of operation in accordance with an operating command input from the input means 12 or an operating command input from the teaching operation apparatus 20 via the teaching operation apparatus I/F 15. Further, the converting means 16a generates a motion vector on the designated coordinate system for moving the robot 1 from the current position to the next moving position on the basis of the data, and converts the motion vector on the designated coordinate system into a motion vector on the robot coordinate system. The operating-instruction generating means 16b generates a motor instructing value to be given to the motor M that is arranged at the joint of the robot 1 in accordance with the motion vector on the robot coordinate system obtained by the converting means 16a. The motor control means 14 receives the motor instructing value generated by the operating-instruction generating means 16b. Further, the motor control means 14 controls the motor M of the joint in accordance with the motor instructing value, thereby moving the end-point 3 of the robot 1.
The memory means 13 stores the control programs and various data including calibration data for converting the motion vectors on coordinate systems (a local coordinate system, a tool coordinate system, and a camera coordinate system) into a motion vector on the robot coordinate system.
The robot control apparatus 10 with the above structure functions as a motion control apparatus for teaching the robot position and a robot-position teaching apparatus.
The operating-direction designating button 32 is a button for designating the x axis, the y axis, and the z axis on the coordinate system selected by the coordinate-system switching button 31. The operating button 33 operates the robot end-point 3 in the direction of the coordinate axis on the coordinate system designated by the coordinate-system switching button 31 and the operating-direction designating button 32, and comprises a button in the positive direction and a button in the negative direction. By the operating button 33, the robot end-point 3 is moved by the preset amount of motion every press-down operation. Note that the amount of motion by one-time press-down operation of the operating button 33 is preset by the amount of motion on the camera coordinate system, and can be selected and can be set from three types of 10 mm, 1 mm, and 0.1 mm. Herein, the amount of motion by one-time press-down operation is set to 1 mm. Further, when the operating button 31 is pressed down continuously, the operation with the selected and set amount of motion is repeatedly performed.
The Teach button 34 is a button for storing, to the memory means 13, attitude data of the robot 1 upon pressing down the Teach button 34, as teaching data, and is pressed down when the robot end-point 3 reaches the teaching preset position.
When a plurality of the robots 1, the cameras 4 and the operating tools 3a are included, and a plurality of the user local coordinate systems are set in the robot system, the robot control screen 40 is a screen to select one of plurality of them, and comprises a robot No. Select button 41, a local-coordinate-system No. Select button 42, a tool-coordinate-system No. Select button 43, and a camera-coordinate-system No. Select button 44. With press-down operation of the Select buttons 41 to 44, a ten-key screen (not shown) is displayed. A number is pressed on the ten-key screen, thereby selecting a desired number.
Hereinbelow, a description is given of the operation according to the embodiment. First, the robot end-point 3 is moved to the position where the image of the work can be captured with the camera 4. Similarly to the conventional art, the moving operation is performed by issuing an operating command on the robot coordinate system while confirming a positional relationship between the robot end-point 3 and the work. It is assumed that, as a result of the moving operation, referring to
The operating commands from the operating-direction designating button 32 and the operating button 33, as operating means are input to the converting means 16a. The converting means 16a recognizes the designated coordinate system, the coordinate axis, the operating direction, and the amount of motion in accordance with the operating command. Herein, the converting means 16a recognizes the “camera coordinate system”, the “Yc axis”, and the direction “+”. Further, the amount of motion is recognized, as “1 mm”, because the number of press-down operation of the operating button 33 is one. The converting means 16a generates, on the basis of the data, the motion vector on the camera coordinate system for moving the robot 1 from the current position to the moving position. Further, the converting means 16a converts the motion vector on the camera coordinate system into the motion vector on the robot coordinate system on the basis of the calibration data on the camera coordinate system in the memory means 13. The motion vector on the robot coordinate system is input to the operating-instruction generating means 16b. The operating-instruction generating means 16b generates the motor instructing value to be given to the motor M arranged at the joint of the robot 1 based on the motion vector on the robot coordinate system, and outputs the generated value to the motor control means 14. The motor control means 14 outputs the control signal to the motor M of the joint in accordance with the motor instructing value input from the operating-instruction generating means 16b. As a consequence thereof, the motor M of each joint in the robot 1 is rotated, thereby moving the arm 2. The entire attitude of the robot 1 is changed, thereby changing the position of the robot end-point. The position of the work W is moved on the image capturing screen, to the position shown by a solid line in
The repetition of the above-mentioned operation enables the image of the work W to move to the center in the vertical direction on the image capturing screen, as shown in
According to the embodiment, the motion can be controlled on the basis of the camera coordinate system. That is, the motion in the horizontal and vertical directions on the image capturing screen is possible. Therefore, the robot end-point 3 can be moved to the teaching preset position in accordance with the intuitional operating instruction on the image capturing screen. As a consequence thereof, upon teaching the position of the robot, the burden of the teacher can be suppressed with the simple teaching operation. Further, the robot end-point 3 can be moved to the target position by the minimum and sufficient number of execution, without unnecessary increase in the excution number of the operating command, thereby improving the efficiency of the teaching operation. Furthermore, the operating errors can be reduced. In addition, since the operating command is actually input with the button, the operation is simple.
According to the embodiment, the work W is positioned in the center of the image capturing screen. Because the center of the screen generally has the precision higher than that of the end of the screen in the image captured with the camera. As mentioned above, the robot position at the time when the work W is positioned in the center of the image capturing screen is set as the teaching position, and this can contribute to the realization of the operation of the work W with high precision.
Note that, according to the embodiment, the camera 4 is attached to the robot end-point 3. However, the camera arrangement is not limited to this, and the camera may be arranged to another position of the robot 1. Alternatively, the camera may be fixed to the position other than the robot 1. That is, the positional relationship may be set between the camera 4 and the robot end-point 3 so that the captured image changes in conjunction with the operation of the robot end-point 3, and the arranging object is not limited.
According to the embodiment, the display means 21 of the teaching operation apparatus 20 is composed of a touch-panel one, and the operating command is input on the teaching operation screen 30 by directly pressing the operating-direction designating button 32 and the operating button 33. However, the teaching operation screen 30 may be displayed on the display means 11 of the robot control apparatus 10 and the buttons 32 and 33 on the teaching operation screen 30 may be operated with input means, such as a mouse. Alternatively, the buttons 32 and 33 may comprise dedicated input buttons and the press-down operation of the input buttons may become the input of the operating command.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2005-110955 | Apr 2005 | JP | national |
