These and/or other aspects and advantages of the present general inventive concept will become apparent and more readily appreciated from the following description of the embodiments, taken in conjunction with the accompanying drawings of which:
Reference will now be made in detail to the embodiments of the present general inventive concept, examples of which are illustrated in the accompanying drawings, wherein like reference numerals refer to the like elements throughout. The embodiments are described below in order to explain the present general inventive concept by referring to the figures.
A robot system according to an embodiment of the present general inventive concept, as illustrated in
The mobile robot 400 detects a relative position with respect to the beacon 300 using the light beam TL transmitted from the beacon 300, and moves freely in a working area.
The beacon 300 transmits the light beam TL as well as measures a distance between the beacon 300 and the mobile robot 400 based on a time difference between a time when the light beam TL is transmitted and a time when a light beam RL is reflected by the mobile robot 400 is detected by the beacon 300.
The beacon 300 includes a light generator 310 to output the light beam TL having directionality. In order to adjust a transmission direction of the light beam TL outputted from the light generator 310, a phase adjustor 340 applies a driving signal to a rotation driver 330. The rotation driver 330 responds to the driving signal of the phase adjustor 340 to rotate the light generator 310.
The rotation driver 330, as illustrated in
The mobile robot 400 includes an optical receiver 410 to receive the light beam TL transmitted from the light generator 310 and an optical reflector 420 to reflect the transmitted light beam back to the beacon 300 as the light beam RL such that the beacon 300 measures the distance between the beacon 300 and the mobile robot 400. The optical reflector 420 may use a retroreflector to reflect an incident light beam to return to the beacon 300 as the reflected light beam RL.
The beacon 300 includes a reflected light detector 320 to detect the reflected light beam RL retroreflected by the optical reflector 420. The reflected light detector 320 may include at least one lens (not shown) to collect only the reflected light beam RL and outputs a reflected light detection signal due to the detected reflected light beam RL to a distance measuring unit 325.
The rotation driver 330 includes a rotation shaft 333 to connect the motor 331 to the reflected light detector 320. The rotation shaft 333 is connected to the reflected light detector 320 to transmit the driving force of the motor to the reflected light detector 320. The motor 331 rotates the rotation shaft 333 such that the reflected light detector 320 rotates at the predetermined angular velocity. As illustrated in
The light generator 310 is a light source producing a light beam having a directionality that can reach a remote mobile robot and may include an infrared laser diode to transmit an infrared laser ray having a wavelength of 850 nm as the light beam TL.
The phase adjustor 340 adjusts the transmission direction of the infrared laser ray TL through the rotation driver 330 such that the infrared laser ray TL transmitted from the light generator 310 is transmitted in the direction corresponding to a phase information φ. Moreover, the phase adjustor 340 delivers the phase information φ about the transmission direction of the infrared laser ray TL to an encoder 350.
Since the infrared laser ray TL transmitted from the light generator 310 has directionality, the light generator 310 may be installed parallel to the ground. As illustrated in
Generally, since the mobile robot 400 performs a given job while traveling freely in a working area, in order for the traveling mobile robot 400 to receive the infrared laser ray TL transmitted from the light generator 310, a plurality of optical receivers 410 may be distributed on an outside of the mobile robot 400 to increase a receiving efficiency of the infrared laser ray TL. Where a plurality of optical receivers 410 are installed, the position of the mobile robot may be determined by using the infrared laser ray TL received by at least one of the plurality of optical receivers 410.
Moreover, in order to increase the receiving efficiency of the reflected light detector 320, the optical reflectors 420 to reflect the infrared laser ray TL, as the reflected light beam RL, and in this case, the reflected infrared laser ray RL, transmitted from the light generator 310 may be arranged at plural positions on an upper and a lower side of the optical receiver 410.
Each of the optical reflectors 420 may be selected from various structures to retroreflect a light beam to the transmitter. For example, as illustrated in
The infrared laser ray TL transmitted from the light generator 310, as illustrated in
Referring to
The distance measuring unit 325, as illustrated in
The distance measuring unit 325 may measure a distance between the beacon 300 and the mobile robot 400 using a Time-of-Flight Measurement. Referring to
A Phase-Shift measurement and a Frequency Modulated Continuous Wave (FMCW) Measurement may also be used as other methods of measuring a distance between the beacon 300 and the mobile robot 400 according to the present general inventive concept in addition to the Time-of-Flight measurement.
The encoder 350 may also encode supplementary information, such as the phase information received from the phase adjustor 340, the distance information, and unique identity information ID of the beacon 300, which is received from the distance measuring unit 325 and encodes the information into the infrared laser ray TL outputted from the light generator 310. The encoding of the supplementary information may be carried out in the encoder by keying methods such as a Phase Shift Keying or a Frequency Shift Keying.
Moreover, in a case of the transmission of the infrared laser ray TL from the light generator 310, an infrared ray communication may be performed according to a kind of a wireless communication protocol such as IrDA (Infrared Data Association). In that case, the supplementary information, that is, the phase information, the distance information, and the unique identity information ID are attached to a header to form a packet and the packet may be transmitted through the infrared laser ray TL.
The mobile robot 400 includes a light direction detector 430 to detect an entrance direction of the transmitted light and a position measuring unit 440 to detect a relative position of the mobile robot 400.
The light direction detector 430 may include a lens (not shown) to condense light and a position diode (not shown) to detect a position of the light condensed by the lens and provides information about the condensing position to the position measuring unit 440. A configuration for implementing the light direction detector 430 has been described as one of the conventional art, and is disclosed in Korean Patent Laid-Open No. 10-2006-0068968.
Referring to
The position measuring unit 440 may estimate an incident angle ψ of the infrared laser from information about the condensing position that is received from the light direction detector 430, and a traveling direction θ=φ−ψ of the robot from the incident angle ψ.
An operation method whereby the beacon 300 transmits a infrared laser ray TL to the mobile robot 400, a distance is measured by the time difference between the transmission of the infrared laser ray TL and the receipt of the reflected infrared laser ray RL, and the position and the traveling direction θ of the mobile robot 400 are detected using the supplementary information contained in the transmitted infrared laser ray TL, according to an embodiment of the present general inventive concept, will be described.
First, in a case where the light generator 310 transmits the infrared laser ray TL n times during one revolution of the light generator 310 and the reflected light detector 320 by the rotation driver 330, an operation method according to an embodiment of the present general inventive concept will be described.
The light generator 310 transmits the infrared laser ray TL containing the information encoded by the encoder 350 (510).
The transmitted infrared laser ray TL is delivered to the mobile robot 400, is retroreflected by the optical reflectors 420 of the mobile robot 400 as the reflected laser ray RL, and then enters the transmission side, that is, the reflected light detector 320 of the beacon 300 (520).
The reflected light detector 320 detects the reflected infrared laser ray RL and delivers the reflected light detecting signal RLs to the distance measuring unit 325. The distance measuring unit 325 delivers the distance information, measured by the Time-of-Flight Measurement to measure a distance using the difference between the detecting time of the reflected light signal RLs and the transmission time of the transmitted light received from the light generator, to the encoder 350 (530).
The phase adjustor 340 delivers the phase information corresponding to the transmission direction of the infrared laser ray TL to be transmitted to the encoder 350. The encoder 350 encodes the phase information at the present (n time(s)), the distance information at the previous time (n−1 time(s)) that is received from the distance measuring unit 325, and the unique identity information ID of the beacon (540), and the light generator 310 puts the encoded supplementary information into a second infrared laser ray TL and transmits the same as the infrared laser ray TL to the mobile robot 550.
The optical receiver 410 receives the second transmitted infrared laser ray TL and delivers the same to the position measuring unit 440, and the light direction detector 430 delivers the information about the condensing position of the infrared laser ray TL to the position measuring unit 440. The position measuring unit 440 estimates the position of the mobile robot based on the phase information and the distance information that are contained in the second infrared laser ray TL (560), and estimates the traveling direction of the mobile robot 400 based on the phase information φ and the incident angle ψ of the infrared laser (570). After that, the processes 500 to 570 are repeated to continue the operation of detecting the position and the traveling direction of the mobile robot 400.
According to the above embodiment of the present general inventive concept, the rotation driver may be constructed by integrally forming the light generator and the reflected light detector with the rotation shaft of the motor and the rotation shaft transmits the driving force of the motor, but the present general inventive concept is not limited thereto. Since the light generator and the reflected light detector may be integrally formed with the rotation shaft of the motor, a high power motor may be required for a smooth rotation, increasing the size of the motor required. Moreover, in a case of a predetermined directional rotation, since electric wires to connect the light generator to the reflected light detector may tangle, there may need to be some restriction of the rotation range. Similarly, although the rotation driver may be reciprocally rotated within a restricted range, an acceleration and a reduction of the motor must be precisely controlled such that the rotation driver reciprocally rotates to change the transmission direction of the light beam.
Taking into account the above considerations, the following embodiments according to the present general inventive concept and with reference to
First, where a wide width installation space is secured, a method of transmitting a light beam and detecting a reflected light beam using a single mirror may be employed as shown in
Referring to
The single mirror 360 changes the traveling direction of the infrared laser ray TL transmitted at a predetermined incident angle toward the optical reflector 420 of the mobile robot, and changes the traveling direction of the reflected infrared laser ray RL retroreflected and returned by the mobile robot toward the reflected light detector 321.
As such, when using a single mirror 360, in order to make the traveling directions of the transmitted infrared laser ray TL and the retroreflected infrared laser ray RL parallel to each other, the light generator 311 and the reflected light detector 321 may be disposed parallel to a side of the single mirror.
If it is difficult to dispose the light generator and the reflected light detector parallel due to the restriction of installation circumstances, a method of transmitting a light beam and detecting the reflected light beam using two single mirrors, according to the present general inventive concept as illustrated in
Referring to
In the above embodiments, the present general inventive concept has been described in view of a mobile robot that receives the phase information φ and the distance information d contained in the infrared laser ray TL transmitted from the beacon to detect the position of the robot and to perform given jobs using the detected position. However, the positioning system according to the present general inventive concept is not limited to a freely moving mobile robot. For example, as illustrated in
The above-described method of the present general inventive concept may be embodied in a computer readable recording medium.
As described above, a position of a moving body such as a mobile robot, a movable cart, or the like can be precisely detected using the distance information measured by the difference between the transmission time of the transmitted light beam and the detecting time of the reflected light beam.
Since the present general inventive concept may use an infrared laser with a long range as a position determining light source to detect the position, the positioning system according to the present general inventive concept may be applied to a wide working area.
Since a single beacon is used to detect position, the present general inventive concept saves costs to configure the system and is easily applied to a small sized robot.
Since the present general inventive concept may employ a method of rotating a single mirror, rotated by a motor, to transmit a light beam and to receive a reflected light beam, a low power motor can be used. Moreover, since the beacons may be easily installed by modifying the number of the single mirrors and the arrangement of the components, it is convenient to use.
Although a few embodiments of the present general inventive concept have been shown and described, it will be appreciated by those skilled in the art that changes may be made in these embodiments without departing from the principles and spirit of the general inventive concept, the scope of which is defined in the appended claims and their equivalents.
Number | Date | Country | Kind |
---|---|---|---|
2006-66964 | Jul 2006 | KR | national |