Position detection system for detecting position of object
09574873 ยท 2017-02-21
Assignee
Inventors
Cpc classification
G01B11/14
PHYSICS
B25J17/0233
PERFORMING OPERATIONS; TRANSPORTING
Y10S901/44
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
G05B2219/39393
PHYSICS
International classification
Abstract
A position detection system includes: a contactor including a tracing unit that traces and fits with a recess or a protrusion of an object; a slide member; a sliding unit that causes the slide member to slide in two directions; a moving unit that causes the contactor to move in a direction perpendicular to a plane so as to cause the tracing unit of the contactor to trace and fit with the recess or the protrusion of the object; a contactor detecting unit that detects a position of the contactor in the plane; and an object position detecting unit that detects the position of the object based on movement amount of the contactor before and after the slide member slides on the sliding unit to slide, when the tracing unit traces the recess or the protrusion.
Claims
1. A position detection system for detecting a position of an object having a recess or a protrusion, the position detection system comprising: a contactor including an end configured to physically contact, trace and fit with the recess or the protrusion of the object; a sliding mechanism that causes the contactor to slide in two directions perpendicular to each other; a robot configured to cause the contactor to move in a direction perpendicular to a plane defined by the two directions so as to cause the end of the contactor to physically contact, trace and fit with the recess or the protrusion of the object; a camera in a fixed positional relationship to a base of the sliding mechanism and configured to detect a position of the contactor in the plane; and a controller configured to detect the position of the object based on a movement amount of the contactor before and after the contactor slides on the sliding mechanism when the end of the contactor physically traces the recess or the protrusion of the object.
2. The position detection system according to claim 1, wherein, when the contactor is moved by the robot in at least one of the two directions, the controller is configured to detect the position of the object based on (i) the movement amount of the contactor by the robot and (ii) the movement amount of the contactor by the sliding mechanism.
3. The position detection system according to claim 1, wherein the object has a recess, and the end of the contactor is a cone fittable with the recess.
4. The position detection system according to claim 1, wherein the object has a conical protrusion, and the end of the contactor has a cylindrical portion fittable with the protrusion.
5. The position detection system according to claim 1, wherein the controller is configured to detect the position of the object based on an image of the contactor, said image captured by the camera.
6. The position detection system according to claim 1, wherein the controller is configured to detect the position of the object based on a single image of the contactor, said single image captured by the camera when the end of the contactor physically fits with the recess or the protrusion of the object.
7. The position detection system according to claim 1, wherein the controller is configured to detect the position of the object by comparing first and second images of the contactor, said first image captured by the camera when the contactor is at a location over the object but the end of the contactor does not yet physically fit with the recess or the protrusion of the object, and said second image captured by the camera when the end of the contactor physically fits with the recess or the protrusion of the object.
8. The position detection system according to claim 1, wherein at least one of the sliding mechanism or the robot is configured to cause the contactor to move relative to the object to a location where the contactor is over the object but the end of the contactor does not yet physically fit with the recess or the protrusion of the object, and then the robot is configured to move the contactor from said location only downwardly in the direction perpendicular to said plane, while enabling the contactor to slide in said two directions as the end of the contactor physically contacts, traces and eventually fits with the recess or the protrusion of the object.
9. The position detection system according to claim 8, wherein the controller is configured to detect the position of the object based on a single image of the contactor, said single image captured by the camera when the end of the contactor physically fits with the recess or the protrusion of the object.
10. The position detection system according to claim 8, wherein the controller is configured to detect the position of the object by comparing first and second images of the contactor, said first image captured by the camera when the contactor is at said location over the object but the end of the contactor does not yet physically fit with the recess or the protrusion of the object, and said second image captured by the camera when the end of the contactor physically fits with the recess or the protrusion of the object.
11. The position detection system according to claim 1, wherein the contactor has, on a surface facing the camera, a target, and the controller is configured to detect the position of the object based on an image of the target, said image captured by the camera.
12. A position detection system for detecting a position of an object having a recess or a protrusion, comprising: a contactor including an end that traces and fits with the recess or the protrusion of the object; a sliding mechanism that causes the contactor to slide in two directions perpendicular to each other; a robot that causes the contactor to move in a direction perpendicular to a plane defined between the two directions so as to cause the end of the contactor to trace and fit with the recess or the protrusion of the object; a camera that is in a fixed positional relationship to a base of the sliding mechanism and detects a position of the contactor in the plane; and a controller that detects the position of the object based on movement amount of the contactor before and after the contactor slides on the sliding mechanism when the end of the contactor traces the recess or the protrusion of the object.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
DETAILED DESCRIPTION
(6) Embodiments of the present invention will now be described with reference to the accompanying drawings. Throughout the drawings, like reference numerals are assigned to like elements. In order to facilitate understanding, the scale of the drawings is appropriately changed.
(7)
(8) The moving unit 11 is a perpendicular articulated robot, for example, and instead may be another type of robot or another mechanism unit that can move in a vertical direction. Meanwhile, the contactor detecting unit 12 is a visual sensor or a camera. In the following, a description will be made on the assumption that the moving unit 11 is a robot and the contactor detecting unit 12 is a camera.
(9) As illustrated, a base member 13 is attached to a distal end of the robot 11. Further, the camera 12 is attached to a distal end of a bracket 14 fixed in such a manner as to extend substantially vertically with respect to the base member 13.
(10) Further, a sliding mechanism unit 20 is attached to the base member 13. More specifically, mutually parallel two X-axis rails 21 of the sliding mechanism unit 20 are provided on the upper surface of the base member 13. It is assumed that the positional relationship among the base member 13, the bracket 14, and the two X-axis rails 21 is such that they are fixed with respect to each other and are moved in unison when the robot 11 moves. Further, as illustrated, a first slider 23 of the sliding mechanism unit 20 is slidably located on the two X-axis rails 21.
(11) On the upper surface of the first slider 23 are provided mutually parallel two Y-axis rails 22 of the sliding mechanism unit 20. These Y-axis rails 22 are perpendicular to the above-mentioned X-axis rails. A second slider 24 of the sliding mechanism unit 20 is slidably located on the two Y-axis rails 22.
(12) Further, a generally cylindrical contactor 30 is inserted and fixed in an opening provided at the center of the second slider 24. Upper surface 31 of the contactor 30 is parallel with respect to the upper surface of the second slider 24, and a target T is provided thereon. As can be seen from
(13) As illustrated in
(14) The extension unit 32 has a size greater than that of a recess formed on an object, which will be described hereinafter. The tracing unit 33 has a shape adapted to trace and fit with the recess of the object. In
(15)
(16) Prior to the operation of the position detection system 1, the first slider 23 and the second slider 24 each are located at a predetermined initial position thereof. It is assumed, in this regard, that the first slider 23 and the second slider 24 will not be changed in position when the robot 11 is merely moved in the horizontal and/or vertical direction.
(17) As illustrated in
(18) Firstly, at step S11 of
(19) As described above, the base member 13, the bracket 14, the camera 12, and the two X-axis rails 21 are operated in unison so that when the base member 13 is moved, the camera 12 is also moved likewise. As such, as illustrated in
(20) The movements of the base member 13, etc. at step S11 may include both horizontal and vertical movements. Preferably, the distance between the contactor 30 and the object W illustrated in
(21) At step S12, the base member 13, etc. are moved only downwardly toward the object W by the robot 11 as illustrated by an arrow mark in
(22) As the base member 13, etc. are moved further downwardly by the robot 11, the tracing unit 33 descends while tracing the opening W0. In response to this descending operation, the contactor 30 and the second slider 24 are moved slightly in at least one of the X-direction and the Y-direction along the X-axis rail 21 and the Y-axis rail 22. As illustrated in
(23) Subsequently, at step S13, the target T of the contactor 30 is imaged by the camera 12, and the image is stored in the control device 10. Thereupon, the control device 10 compares the image imaged at step S13 with the above-mentioned image and thus detects the movement amount of the contactor 30 in the X-direction and in the Y-direction. Finally, at step S14, the control device 10 detects a position of the object W in the X-Y plane based on the movement amount of the contactor 30 in the X-direction and in the Y-direction.
(24) Alternatively, the control device 10 may process the image imaged at step S13, detect the movement amounts of the first slider 23 and the second slider 24 from their initial positions, and detect the position of the object W, with such movement amounts being the movement amounts of the contactor 30. In such an instance, it is unnecessary for the camera 12 to pick up an image at step S11, and a single image processing suffices.
(25) In this manner, in the present invention, the contactor 30, which has traced and fitted with the object W, is detected, instead of the object W being detected directly by the camera 12. When the tracing unit 33 of the contactor 30 fits with the opening W0 of the object W, the contactor 30 is moved in the X-direction and in the Y-direction along the X-axis rail 21 and the Y-axis rail 22. Thus, it is possible to indirectly grasp the position of the object W by detecting the movement amount of the contactor 30 using the camera 12.
(26) Consequently, in the present invention, it is possible to accurately detect the position of the object W even when the object W has a recess or a protrusion. In other words, in the present invention, it is possible to achieve a stable detection without being influenced by the feature of the object W, since the camera 12 does not detect the shape of the object W directly. As such, erroneous detection of the object W by the camera 12 decreases so that the operating efficiency is increased.
(27) Meanwhile, at step S11, the robot 11 may move the base member 13 and the camera 12, etc. in the horizontal direction. In this instance, the control device 10 stores the movement amount of the base member 13, etc. moved in the X-direction and in the Y-direction by the robot 11. Further, at step S14, the control device 10 detects the position of the object W using both the movement amount of the contactor 30 in the X-direction and in the Y-direction and the stored movement amount of the base member 13, etc. in the X-direction and in the Y-direction. In such an instance, it will be appreciated that the object W can be detected over a wide range since the base member 13, etc. are moved by the robot 11.
(28) In an unillustrated embodiment, the object has a protrusion, e.g., a conical protrusion. It is assumed, in this regard, that a recess, which is fittable with the protrusion and similar to that described above, is formed in the bottom surface of the extension unit 32 of the contactor 30. In this instance, the shape of the recess is a shape corresponding to the bottom surface of the conical protrusion. Meanwhile, it is to be understood that the present invention encompasses a case in which the protrusion or the recess has a different cross-sectional shape and a case in which the recess or the protrusion is cylindrical.
ADVANTAGE OF THE INVENTION
(29) In the first embodiment, the contactor is made to trace and fit with the object using the physical feature of the object. Then, the contactor detecting unit detects the contactor and indirectly grasps a position of the object. Thus, even with an object having a recess or a protrusion, it is possible to accurately detect a position of the object. Consequently, erroneous detection of the object by the contactor detecting unit decreases so that the operating rate is increased.
(30) In the second embodiment, the object can be detected over a wide range when the contactor is moved by the moving unit.
(31) In the third embodiment, the position of the contactor can be detected with ease via an analysis of an image acquired by imaging by the camera.
(32) In the fourth embodiment, the object can be easily approached by operating the robot in accordance with a simple program.
(33) In the fifth and sixth embodiments, it is possible, by a relatively simple structure, to cause the contactor to trace and fit with the object
(34) While the present invention has been described using exemplary embodiments, those skilled in the art could understand that the above-described changes as well as various other changes, omissions, and additions are possible without departing from the scope of the present invention.