KR102137156B1 - Distance measuring scanner and operating method thereof - Google Patents
Distance measuring scanner and operating method thereof Download PDFInfo
- Publication number
- KR102137156B1 KR102137156B1 KR1020130134118A KR20130134118A KR102137156B1 KR 102137156 B1 KR102137156 B1 KR 102137156B1 KR 1020130134118 A KR1020130134118 A KR 1020130134118A KR 20130134118 A KR20130134118 A KR 20130134118A KR 102137156 B1 KR102137156 B1 KR 102137156B1
- Authority
- KR
- South Korea
- Prior art keywords
- distance
- cleaning robot
- measurement
- measuring device
- scanner
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
- B25J11/0085—Cleaning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/005—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators using batteries, e.g. as a back-up power source
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
Abstract
본 발명의 일 실시 예에 따른 청소 로봇에 탑재된 거리 측정 장치는 거리 측정용 빔을 물체에 발광하는 송광부와 상기 물체에서 반사되어 상기 거리 측정 장치로 모이는 빛을 감지하는 수광부 및 상기 청소 로봇의 기준 지점과 물체 간의 기준 거리와 상기 청소 로봇을 일정 각도만큼 회전시켜 획득한 측정거리를 비교하여 상기 청소 로봇의 표면에 이물질이 존재하는지 여부를 확인하는 제어부를 포함한다.The distance measuring device mounted on the cleaning robot according to an embodiment of the present invention includes a light transmitting unit that emits a beam for distance measurement on an object, and a light receiving unit that detects light reflected from the object and collects the distance measuring device, and the cleaning robot. And a control unit that compares the reference distance between the reference point and the object and the measurement distance obtained by rotating the cleaning robot by a predetermined angle to determine whether a foreign object is present on the surface of the cleaning robot.
Description
본 발명은 거리 측정 장치 및 동작 방법에 관한 것이다.The present invention relates to a distance measuring device and an operating method.
본 발명의 거리 측정 장치(이하 '스캐너')는 빛을 이용하여 스캐너와 주변 사물 사이의 거리를 측정한다. 빛을 이용하여 거리를 측정하는 방식은 삼각측량(triangulation) 방식, TOF(Time of Flight) 방식, 위상차(phase-shift)를 이용한 방식 등이 있다.The distance measuring device (hereinafter referred to as a'scanner') of the present invention measures a distance between a scanner and surrounding objects using light. The method of measuring the distance using light includes a triangulation method, a time of flight (TOF) method, and a phase-shift method.
삼각측량 방식은 삼각측량법을 바탕으로 거리를 측정하는 방법이며, TOF 방식은 스캐너에서 빛을 발광한 시간과 그 발광된 빛이 주변 사물에 반사되어 거리측정 장치로 돌아오는 시간의 차이를 이용하여 스캐너와 주변 사물 사이의 거리를 계산하는 방법이다. 위상차를 이용한 방식은 일정한 주파수를 가진 신호를 이용하여 빛을 측정위치에 발광하고, 측정위치에 반사되어 스캐너로 돌아오는 빛을 이용하여 측정 신호를 생성하고, 측정 위치에 빛을 발광할 때 이용한 일정한 주파수를 가진 제어신호와 측정 측정위치에서 반사되어 스캐너로 돌아온 빛을 이용하여 생성한 측정 신호를 비교하여 위상차를 구하고, 구한 위상차를 기초로 거리를 측정하는 방법이다.The triangulation method is a method of measuring the distance based on the triangulation method, and the TOF method uses the difference between the time at which the light is emitted from the scanner and the time at which the emitted light is reflected by surrounding objects and returned to the distance measuring device. And how to calculate the distance between objects. The phase difference method uses a signal with a certain frequency to emit light at a measurement position, generates a measurement signal using light reflected at the measurement position and returns to the scanner, and is used to emit light at the measurement position. This method compares the control signal with frequency and the measurement signal generated by using the light reflected from the measurement measurement position and returned to the scanner to obtain the phase difference and measure the distance based on the obtained phase difference.
최근에 각종 거리측정장치는 빛(laser, led)을 이용하여, 사람이나 사물의 위치를 검출하고 이 정보를 거리로 계산하는데 많이 사용되고 있으며, 이때 거리측정장치를 보호하거나 디자인적인 측면에서 거리측정장치에 추가적으로 투명/불투명한 기구부를 부착하는 경우가 많다. Recently, various distance measuring devices use a light (laser, led) to detect the location of a person or an object and calculate this information as a distance. At this time, the distance measuring device is protected or a distance measuring device is designed in terms of design. In addition, in many cases, a transparent/opaque mechanism is attached.
그런데 시간이 지나거나 외부환경에 의해서 거리측정장치나 거리측정장치에 부착된 기구부가 오염되는 경우, 거리측정장치는 이 오염 물질에 의해서 측정 장치에서 입출사되는 빔의 형태가 변화되어 결과적으로 빛이 왜곡이 생기게 되고, 이로 인해 정확한 거리를 측정하기 어렵게 된다.However, if the distance measuring device or the mechanism attached to the distance measuring device is contaminated by time or by an external environment, the distance measuring device changes the shape of the beam entering and exiting the measuring device by this contaminant, resulting in light. Distortion occurs, which makes it difficult to measure an accurate distance.
본 발명은 청소 로봇의 표면에 이물질이 존재하는지 여부를 쉽게 확인할 수 있는 거리 측정 장치 및 그 동작 방법을 제공하고자 한다.The present invention is to provide a distance measuring device and an operation method for easily checking whether a foreign substance is present on the surface of a cleaning robot.
본 발명의 일 실시 예에 따른 청소 로봇에 탑재된 거리 측정 장치는 거리 측정용 빔을 물체에 발광하는 송광부와 상기 물체에서 반사되어 상기 거리 측정 장치로 모이는 빛을 감지하는 수광부 및 상기 청소 로봇의 기준 지점과 물체 간의 기준 거리와 상기 청소 로봇을 일정 각도만큼 회전시켜 획득한 측정거리를 비교하여 상기 청소 로봇의 표면에 이물질이 존재하는지 여부를 확인하는 제어부를 포함한다The distance measuring device mounted on the cleaning robot according to an embodiment of the present invention includes a light transmitting unit that emits a beam for distance measurement on an object, and a light receiving unit that detects light reflected from the object and collects the distance measuring device, and the cleaning robot. And a control unit that compares the reference distance between the reference point and the object and the measurement distance obtained by rotating the cleaning robot by a predetermined angle to determine whether a foreign object is present on the surface of the cleaning robot.
본 발명의 또 다른 실시 예에 따른 청소 로봇에 탑재된 거리 측정 장치의 동작 방법은 거리 측정용 빔을 물체에 발광하는 단계와 상기 물체에서 반사되어 상기 거리 측정 장치로 모이는 빛을 감지하는 단계 및 상기 청소 로봇의 기준 지점과 물체 간의 기준 거리와 상기 청소 로봇을 일정 각도만큼 회전시켜 획득한 측정거리를 비교하여 상기 청소 로봇의 표면에 이물질이 존재하는지 여부를 확인하는 단계를 포함한다.The operation method of the distance measuring device mounted on the cleaning robot according to another embodiment of the present invention includes the steps of emitting a beam for distance measurement to an object and detecting light reflected from the object and collected by the distance measuring device, and the And comparing the reference distance between the reference point of the cleaning robot and the object and the measurement distance obtained by rotating the cleaning robot by a predetermined angle to check whether a foreign object is present on the surface of the cleaning robot.
본 발명의 실시 예에 따르면, 청소 로봇을 일정 각도만큼 회전 시킨 후, 청소 로봇과 물체와의 거리 측정만을 통해 청소 로봇의 표면에 이물질이 존재하는지 여부를 확인할 수 있다.According to an embodiment of the present invention, after rotating the cleaning robot by a certain angle, it is possible to check whether a foreign object is present on the surface of the cleaning robot only by measuring the distance between the cleaning robot and the object.
또한, 본 발명의 다양한 실시 예에 따르면, 청소 로봇의 표면에 이물질이 존재하는지 여부를 사용자에게 알려주어 청소 로봇이 오작동하는 문제를 해결할 수 있다.In addition, according to various embodiments of the present invention, it is possible to solve a problem that the cleaning robot malfunctions by informing the user whether or not foreign substances are present on the surface of the cleaning robot.
도 1은 삼각측량 방식을 이용한 스캐너의 기본적인 동작 방법을 보여준다.
도 2는 본 발명의 한 실시예에 따른 스캐너의 기본적인 동작 방법을 나타내는 블록 구성도 이다.
도 3은 제어신호를 이용하여 일정 주파수를 가진 거리 측정용 빔을 측정위치에 발광하고, 발광한 거리 측정용 빔이 측정 위치에 반사되어 스캐너로 돌아오는 것을 보여준다.
도 4는 회전기판이 일정 각도로 회전한 모습을 위에서 본 모습으로 보여준다.
도 5는 전원 및 통신 연결부를 자세히 보여준다.
도 6과 도 7은 스캐너가 앞으로 이동하면서 거리 측정 위치를 수직 방향으로 이동하며 스캐너와 주변 사물 사이의 거리를 측정하는 예를 보여주고 있다.
도 8에서는 스캐너의 위아래의 위치를 바꾸어 송광부와 수광부의 위치를 바꾸어 스캐너를 구성하는 예를 보여준다.
도 9는 진공 청소 로봇에 탑재되어 사용되는 스캐너를 보여준다.
도 10은 본 발명의 일 실시 예에 따른 스캐너의 동작 방법을 설명하기 위한 흐름도이다.
도 11은 본 발명의 일 실시 예에 따라 스캐너가 기준 거리를 측정하는 방법을 설명하기 위한 도면이다.
도 12는 본 발명의 일 실시 예에 따라 스캐너가 진공 청소 로봇을 시계 방향으로 회전시킨 후, 거리를 측정하는 방법을 설명하기 위한 도면이다.
도 13은 본 발명의 일 실시 예에 따라 스캐너가 진공 청소 로봇을 반 시계 방향으로 회전시킨 후, 거리를 측정하는 방법을 설명하기 위한 도면이다.1 shows a basic operation method of a scanner using a triangulation method.
2 is a block diagram showing a basic operation method of a scanner according to an embodiment of the present invention.
3 shows that a beam for distance measurement having a predetermined frequency is emitted at a measurement position using a control signal, and the emitted beam for distance measurement is reflected at the measurement position and returned to the scanner.
Figure 4 shows the rotating substrate rotated at a certain angle as seen from above.
5 shows the power and communication connections in detail.
6 and 7 show an example of measuring the distance between the scanner and surrounding objects while moving the distance measurement position in the vertical direction as the scanner moves forward.
8 shows an example of configuring the scanner by changing the positions of the transmitter and the receiver by changing the upper and lower positions of the scanner.
9 shows a scanner used in a vacuum cleaning robot.
10 is a flowchart illustrating a method of operating a scanner according to an embodiment of the present invention.
11 is a view for explaining a method for a scanner to measure a reference distance according to an embodiment of the present invention.
12 is a view for explaining a method for measuring a distance after the scanner rotates the vacuum cleaning robot clockwise according to an embodiment of the present invention.
13 is a view for explaining a method for measuring a distance after the scanner rotates the vacuum cleaning robot counterclockwise according to an embodiment of the present invention.
이하, 본 발명과 관련된 스캐너에 대하여 도면을 참조하여 보다 상세하게 설명한다. 본 명세서에 기재된 실시예에 따른 구성은 다양한 장치에 적용될 수 있음을 본 기술분야의 당업자라면 쉽게 알 수 있을 것이다. 예를 들어 주변의 사물을 인식하여 동선을 정하는 로봇, 주변에서 일어나는 미세한 동작이나 주변 사물을 감지하는 장치, 앞을 보지 못하는 사람을 위해 주변의 장애물을 알려주는 장치, 사용자의 동작을 인식하는 장치 및 3차원 영상을 만드는 장치 등이 있다.Hereinafter, the scanner according to the present invention will be described in more detail with reference to the drawings. Those skilled in the art will readily appreciate that the configuration according to the embodiments described herein can be applied to various devices. For example, a robot that recognizes objects in the vicinity and determines the movement line, a device that detects minute motions or objects in the surroundings, a device that notifies obstacles in the vicinity for a person who cannot see, a device that recognizes the user's motion, and And 3D image making devices.
다음은 도 1을 참고하여 삼각측량 방식을 이용한 거리 측정 방식의 기본적인 동작 방법을 설명한다.Next, a basic operation method of a distance measurement method using a triangulation method will be described with reference to FIG. 1.
도 1은 삼각측량 방식을 이용한 스캐너의 기본적인 동작 방법을 나타내는 블록 구성도(block diagram)이다.1 is a block diagram showing a basic operation method of a scanner using a triangulation method.
상기 스캐너(100)는 송광부(110)와 수광부(120)를 포함한다.The
이하, 상기 구성요소에 대해 차례로 살펴본다.Hereinafter, the components will be described in turn.
송광부(110)는 거리 측정용 빔(1)을 발광하는 광원(112)을 포함한다. 또한 광원렌즈(114)를 포함할 수도 있다.The transmitting
수광부(120)는 거리 측정용 빔(1)이 주변 사물(130)에 반사되어 돌아오는 빛(3)을 수광센서(122)에 모아주는 수광렌즈(124)를 포함한다. 수광센서(122)는 반사되어 돌아오는 빛(3)이 수광센서(122)에 모이는 위치를 감지한다.The light-receiving
도 1에 도시된 바와 같이 송광부(110)에서는 주변 사물(130)을 향해 거리 측정용 빔(1)을 발광한다. 거리 측정용 빔(1)이 주변 사물(130)에 도착하면 주변 사물의 표면(T)에 반사되어 여러 갈래로 반사되는 빛(5)의 형태를 가진다. 이중 스캐너(100)에 포함된 수광렌즈(124)에 의해 여러 갈래로 반사되는 빛의 일부(3)가 수광부(120)의 수광센서(122)에 모이게 된다.As shown in FIG. 1, the
스캐너(100)와 주변 사물(130) 사이의 거리를 d, 광원렌즈(114)와 수광렌즈(124) 사이의 거리를 g, 수광렌즈(124)의 초점 거리를 f라고 정의한다. 또한 광원(112)이 수평선(7)에 대해 기울어진 각도를 θ, 수광센서(122)에 모인 빛의 위치를 p 라고 정의한다. 빛의 위치 p 값은 수광센서(122)의 중심을 "0"으로 기준하여 정한다. f 값, g 값, θ 값이 정해진 스캐너(100)에서는 빛의 위치 p 값을 수광센서(122)에서 감지하여 다음 수학식 1을 충족하도록 연산하면 스캐너(100)와 거리 측정 위치 사이의 거리인 d를 얻을 수 있다.The distance between the
도 2는 본 발명의 한 실시예에 따른 스캐너의 기본적인 동작 방법을 나타내는 블록 구성도(block diagram) 이다.2 is a block diagram showing a basic operation method of a scanner according to an embodiment of the present invention.
도 2는 도 1에서 설명한 삼각측량 방식을 이용한 거리 측정 방식을 이용한 스캐너의 한 실시예이다.FIG. 2 is an embodiment of a scanner using a distance measurement method using the triangulation method described in FIG. 1.
스캐너(300)는 송광부(310), 수광부(320), 회전 구동부(330), 통신부(350), 제어부(360), 전원 공급부(370), 전원 및 통신 연결부(390) 등을 포함할 수 있다.The
송광부(310)와 수광부(320)는 회전기판(303)에 고정될 수 있다. 회전기판(303)은 수직선 방향을 기준으로 회전한다. 도 2에서는 수광부(320)가 송광부(310) 위에 고정되어 있지만, 반대로 송광부(310)가 수광부(320) 위에 고정될 수 있다. 송광부(310)는 광원(312)과 광원렌즈(314)를 포함할 수 있다. 광원(312)은 LD(Laser Diode), LED(Light Emitting Diode) 등 직진성이 높은 광원을 사용될 수 있으며, 광원 렌즈(314)는 콜리메이터 렌즈(collimator lens)가 사용되어, 광원(312)에서 나오는 빛을 평행광 또는 수렴광으로 만들 수 있다.The light transmitting unit 310 and the light receiving unit 320 may be fixed to the rotating
수광부(320)는 수광센서(322), 수광렌즈(324), 파장필터(326) 등을 포함할 수 있다. 수광렌즈(324)는 수광센서(322)에 빛을 모아주며, 수광센서(322)는 수광렌즈(324)에서 모아준 빛의 위치를 감지한다. 파장필터(326)는 광원(312)의 파장과 다른 빛이 수광센서(322)에 감지되는 것을 방지해 준다.The light receiving unit 320 may include a
회전 구동부(330)는 회전기판(303)을 수직선 방향을 기준으로 회전하게 해준다. 회전기판(303)이 회전하면 회전기판(303)에 고정된 송광부(310)와 수광부(320)가 같이 회전한다. 송광부(310)와 수광부(320)의 회전에 따라서 측정 위치가 수평방향을 이동한다. 회전 구동부(330)는 회전기판(303)을 회전시키기 위해 다양하게 구성될 수 있다. 예를 들어서, 회전 구동부(330)는 회전 구동 모터(339), 제1 회전 풀리(331), 제2 회전 풀리(333), 회전벨트(337) 등을 이용하여 회전기판(303)을 회전시킬 수 있다.The
제어부(360)의 회전 제어부(364)에서 회전 구동 모터(339)를 제어하여 회전 구동 모터(399)를 회전시키고, 회전 구동 모터(339)가 회전하면, 회전 구동 모터(339)에 고정되어 있는 제1 회전 풀리(331)이 회전한다. 제1 회전 풀리(331)가 회전을 하면 제1 회전 풀리(331)과 제2 회전 풀리(333)이 고정된 회전벨트(337)가 회전하게 된다. 회전벨트(337)가 회전을 하며, 제2 회전 풀리(331)가 회전한다. 제2 회전 풀리(331)는 회전기판(303)에 고정되어 있어서, 제2 회전 풀리(331)가 회전할 때 같이 회전기판(303)이 회전한다.The
통신부(350), 제어부(360) 및 전원 공급부(370)는 메인기판(301)에 위치할 수 있다. 제어부(360)는 거리 계산부(362), 회전 제어부(364), 공간 정보 연산부(366), 송광 제어부(368) 등을 포함할 수 있다. 거리 계산부(362)는 수광센서(322)에서 전송되는 빛의 위치 p 값을 포함한 측정신호를 기초로 스캐너(300)와 측정 위치 사이의 거리를 계산한다. 회전 제어부(364)는 회전 구동부(330)를 제어한다. 공간 정보 연산부(366)는 거리 계산부(362)에서 계산된 거리와 회전 구동부(330)에서 보내온 회전 각도를 기초로 공간 정보 데이터를 만든다. 예를 들어, 회전 구동부(330)는 인코더를 포함할 수 있으며, 인코더에서 각 거리 측정 위치에 해당하는 회전기판(303)의 각도를 인코더 신호로 공간 정보 연산부(366)에 전송할 수 있다. 송광 제어부(368)는 송광부(310)를 제어한다. 특히 송광 제어부(368)은 송광부(310)에 포함된 광원(312)을 제어한다. 또한 제어부(360)는 스캐너(300)의 전반적인 작동을 제어한다. 제어부(360)는 통신부(350)를 통해 공간 정보 연산부(366)에서 작성한 공간 데이터를 외부의 장치에 유무선으로 전송할 수 있다.The
전원 공급부(370)는 제어부(360)의 제어에 의해 외부의 전원, 내부의 전원을 인가 받아 각 구성 요소들의 동작에 필요한 전원을 공급한다.The
전원 및 통신 연결부(390)는 메인기판(301)과 회전기판(303)을 연결하여 회전기판(303)에 전원을 공급하고, 메인기판(301)과 회전기판(303) 사이에서 오고 가는 제어 및 측정 신호를 전달하게 해준다. 도 2에서는 복수의 브러쉬(brush, 391, 393, 395, 397)와 회전링(392, 394, 396, 398)을 이용하여 회전기판(303)에 전원을 공급하고, 메인기판(301)과 회전기판(303)이 제어 및 측정 신호를 서로 주고 받게 하는 한 예를 보여준다. 브러쉬와 회전링은 짝을 이룬다. 자세한 설명은 도 5에서 하기로 한다.The power and
도 2 에 도시된 구성요소들이 필수적인 것은 아니어서, 그보다 많은 구성요소들을 갖거나 그보다 적은 구성요소들을 갖는 스캐너도 구현될 수도 있다.The components shown in FIG. 2 are not essential, so a scanner with more or fewer components may also be implemented.
도 2에서는 스캐너(300)와 주변 사물(380) 사이의 거리를 거리 측정용 빔(10)을 이용하여 측정하는 것을 보여준다.2 shows that the distance between the
제어부(360)의 송광 제어부(368)는 제어신호를 송광부(310)로 전송하여 광원(312)에서 거리 측정용 빔(10)을 주변 사물(380)에 발광하게 한다. 거리 측정용 빔(10)은 주변 사물(380)에 도착한다. 거리 측정용 빔(10)이 주변 사물(380)에 도착하면, 주면 사물의 표면(A)에 반사되어 여러 갈래로 반사되는 빛의 형태(50)를 가진다. 이중 스캐너(300)에 포함된 수광렌즈(324)에 의해 여러 갈래로 반사되는 빛의 일부(30)가 수광부(320)의 수광센서(322)로 모이게 된다. 수광센서(322)는 수광센서(322)에 맺힌 빛의 위치 p 값을 측정신호로 거리 계산부(362)에 전송한다. 이때 정확한 p 값 감지를 위해 수광렌즈(324)와 수광센서(322) 사이에 파장필터(326)를 위치 시킬 수 있다. 파장필터(326)는 광원(312)과 같은 파장의 빛만 통과시켜서 다른 외부의 빛이 수광센서(322)에 감지되는 것을 막아준다. 수광센서(322)는 p 값을 디지털 또는 아날로그 방식의 측정신호로 거리 계산부(362)에 전송할 수 있다.The
제어부(360)의 거리 계산부(362)는 수광센서(322)에서 받은 빛의 위치 p 값이 포함된 측정신호를 기초로 주변 사물의 표면(A)와 스캐너(300) 사이의 거리를 도 1에서 설명한 수학식 1을 이용해서 얻을 수 있다.The
위에서 설명했듯이 본 발명은 상기한 TOF 방식 및 위상차를 이용한 방식 등을 이용하여 스캐너와 주변 사물 사이의 거리를 계산할 수 있다.As described above, the present invention can calculate the distance between the scanner and the surrounding objects by using the TOF method and the phase difference method.
도 2를 다시 예로 들어 상기한 TOF 방식으로 스캐너(300)가 스캐너(300)와 주변 사물(380) 사이의 거리를 거리 측정용 빔(10)을 이용하여 측정하는 것을 다음과 같이 설명할 수 있다.Referring back to FIG. 2 as an example, it can be described as follows that the
제어부(360)의 송광 제어부(368)는 제어신호를 송광부(310)로 전송하여 광원(312)에서 거리 측정용 빔(10)을 측정 위치에 발광하게 한다. 여기서 측정 위치는 주변 사물의 표면(A)이다. 거리 측정용 빔(10)은 측정 위치에 도착한다. 거리 측정용 빔(10)이 측정 위치에 도착하면, 측정위치에 반사되어 여러 갈래로 반사되는 빛의 형태(50)를 가진다. 이중 스캐너(300)에 포함된 수광렌즈(324)에 의해 여러 갈래로 반사되는 빛의 일부(30)가 수광부(320)의 수광센서(322)로 모이게 된다.The
이때 정확한 빛(30)을 감지를 위해 수광렌즈(324)와 수광센서(322) 사이에 파장필터(326)를 위치 시킬 수 있다. 파장필터(326)는 광원(312)과 같은 파장의 빛만 통과시켜서 다른 외부의 빛이 수광센서(322)에 감지되는 것을 막아준다.At this time, the
거리 계산부(362)는 광원(312)에서 거리 측정용 빔(10)을 발광한 시간과 그 발광된 빛이 측정 위치에서 반사되어 스캐너(300)의 수광센서(322)에 감지되는 시간의 차이를 이용하여 스캐너(300)와 주변 사물 사이(380)의 거리를 계산할 수 있다.The
도 2를 다시 예로 들어 상기한 위상차를 이용한 방식으로 스캐너(300)가 스캐너(300)와 주변 사물(380) 사이의 거리를 거리 측정용 빔(10)을 이용하여 측정하는 것을 다음과 같이 설명할 수 있다.Referring back to FIG. 2 as an example, it will be described as follows that the
제어부(360)의 송광 제어부(368)는 일정한 주파수를 가진 제어신호를 송광부(310)로 전송하여 광원(312)에서 거리 측정용 빔(10)을 측정 위치에 발광하게 한다. 여기서 측정 위치는 주변 사물의 표면(A)이다. 거리 측정용 빔(10)은 주변 사물(380)에 도착한다. 거리 측정용 빔(10)이 주변 사물(380)에 도착하면, 주면 사물의 표면(A)에 반사되어 여러 갈래로 반사되는 빛의 형태(50)를 가진다. 이중 스캐너(300)에 포함된 수광렌즈(324)에 의해 여러 갈래로 반사되는 빛의 일부(30)가 수광부(320)의 수광센서(322)로 모이게 된다.The
수광센서(322)는 감지한 빛(30)을 이용하여 측정 신호를 생성하고, 거리 계산부(362)는 측정 위치에 거리 측정용 빔(10)을 발광할 때 이용한 일정한 주파수를 가진 제어신호와 측정위치에서 반사되어 스캐너(300)로 돌아온 빛(30)을 이용하여 생성한 측정 신호를 비교하여 위상차를 구하고, 구한 위상차를 기초로 거리를 계산할 수 있다.The
도 3에서는 일정 주파수(f)를 가진 제어신호에 따라 거리 측정용 빔(10)이 스캐너(300)에서 측정 위치에 발광되는 것을 보여준다. 여기서 측정 위치는 주변 사물의 표면(A)이다. 또한 일정 주파수를 가진 신호에 따라 발광된 거리 측정용 빔(10)이 측정 위치에 반사되어 스캐너(300)로 돌아오는 빛(30)을 보여준다. 이때, 스캐너(300)와 측정 위치 사이의 거리를 d, 거리 측정용 빔(10)과 반사되어 돌아오는 빛(30)의 측정 위상차는 k, 거리 측정용 빔(10) 및 반사되어 돌아오는 빛(30)의 파장을 l(=빛의 속도 c/ 제어신호의 주파수 f)이다.3 shows that the
위에서 설명했듯이, 거리 계산부(362)는 측정 위치에 거리 측정용 빔(10)을 발광할 때 이용한 일정한 주파수를 가진 제어신호와 측정위치에서 반사되어 스캐너(300)로 돌아온 빛(30)을 이용하여 생성한 측정 신호를 비교하여 위상차를 구하고, 구한 위상차를 기초로 거리를 계산할 수 있다.As described above, the
위에서 설명했듯이, 다양한 방법으로 거리를 계산할 수 있다. 공간 정보 연산부(366)는 거리 계산부(362)에서 각 측정 위치에 해당하는 계산된 거리와 회전 구동부(330)에서 보내온 회전 각도를 기초로 공간 정보 데이터를 만든다. 스캐너(300)의 회전기판(303)은 수직선 방향을 기준으로 회전하기 때문에 거리 측정 위치를 이동하며 거리를 구할 수 있다. 자세한 설명은 도 4에서 하기로 한다.As explained above, distances can be calculated in a variety of ways. The spatial
도 4는 회전기판(303)이 일정 각도로 수직선 방향을 기준으로 회전한 모습을 위에서 본 모습으로 보여준다. 제어부(360)의 회전 제어부(364)는 회전 구동부(330)를 구동시켜 회전기판(303)을 수직선 방향을 기준으로 회전 시킬 수 있다.4 shows a state in which the
도 4에서는 회전기판(303)의 회전에 따라, 제1 수평선(60) 상에 있는 거리 측정 위치가 수평 방향으로 이동하며 스캐너(300)와 주변 사물(380) 사이의 거리를 측정하는 한 예를 보여준다.In FIG. 4, according to the rotation of the
도 4에서 스캐너(300)는 스캐너(300)와 측정 지점(A) 사이를 거리 측정하고, 회전기판(300)의 회전에 따라, 스캐너(300)와 측정 지점(B) 사이의 거리를 측정하는 한 예를 보여준다.In FIG. 4, the
회전기판(303)이 시계반대 방향으로 회전을 하면 측정 방향이 왼쪽으로 이동하며, 반대로 회전기판(303)가 시계방향으로 회전을 하면 측정 방향이 오른쪽으로 이동한다. 스캐너(300)는 회전기판(303)이 일정 각도로 회전할 때마다 도 2에서 설명한 내용과 같이 스캐너(300)와 주변 사물(380) 사이의 거리를 측정할 수 있다.When the
도 5는 전원 및 통신 연결부(390)를 자세히 보여준다. 도 5에서는 복수의 브러쉬(brush, 391, 393, 395, 397)와 회전링(392, 394, 396, 398)을 이용하여 회전기판(303)에 전원을 공급하고, 메인기판(301)과 회전기판(303) 사이에서 제어 및 측정신호를 흐르게 하는 예를 보여준다.5 shows the power and
제1 브러쉬(391), 제2 브러쉬(393), 제3 브러쉬(395) 및 제4 브러쉬(397)는 메인기판(301)에 직접 또는 간접적으로 연결되어 있다. 제1 회전링(392), 제2 회전링(392), 제3 회전링(395) 및 제4 회전링(397)은 회전기판(303)에 고정되어 있으며, 상기한 브러쉬(391, 393, 395, 397)의 위치에 따라 회전기판(303)에 고정된 위치를 달리할 수 있다.The
도 5에서는 제1 브러쉬(391)와 제2 브러쉬(393)가 제1 회전링(392)과 2 회전링(394)에 각각 접촉하여 메인기판(301)과 회전기판(303) 간 제어 및 측정신호를 흐르게 해주는 한 예를 보여준다. 이 경우, 제1 브러쉬(391)와 제1 회전링(392)는 메인기판(301)에서 회전기판(303)으로 보내는 제어신호를 전달하는데 쓰일 수 있다. 예를 들어, 메인기판(301)에 위치한 송광 제어부(368)가 회전기판(303)에 위치한 광원(312)에 제1 브러쉬(391)와 제1 회전링(392)을 통해 제어신호를 전송할 수 있다.In FIG. 5, the
또한 제2 브러쉬(393)와 제2 회전링(394)는 회전기판(303)에서 메인기판(301)으로 보내는 측정신호를 전달하는데 쓰일 수 있다. 예를 들어, 회전기판(303)에 위치한 수광센서(322)에서 감지한 빛을 기초로 생성한 측정신호를 메인기판(301)에 위치한 거리 계산부(364)에 제2 회전링(394)과 제2 브러쉬(393)를 통해서 전송할 수 있다.In addition, the
도 5에서는 제3 브러쉬(395)와 제4 브러쉬(397)가 제3 회전링(396)과 제4 회전링(398)에 각각 접촉하여 회전기판(303)에 전원을 공급하는 한 예를 보여준다. 이 경우, 제3 브러쉬(395)와 제3 회전링(396)은 메인기판(301)에서 회전기판(303)에 전원을 공급하는데 쓰일 수 있다. 또한 제4 브러쉬(397)와 제4 회전링(398)을 이용하여 회전기판(303)에 접지(ground)를 제공하는데 쓰일 수 있다. 5 shows an example in which the
각 회전링은 간격을 두고 서로 떨어져 있는 것이 좋다. 또한 회전링과 회전링 사이의 간격은 전기를 통하지 않는 물질로 채워지는 게 좋다.It is recommended that each rotating ring is spaced apart from each other. Also, the gap between the rotating ring and the rotating ring is preferably filled with a non-electrical material.
또한 브러쉬가 짝이되는 회전링에만 접촉되도록 회전링이 가이드 홈 안에 위치할 수 있다..In addition, the rotating ring may be located in the guide groove so that the brush contacts only the mating rotating ring.
상기한 브러쉬와 회전링은 전도성이 높은 물질로 구성되는 것이 바람직하며, 특히 브러쉬는 전도성 및 탄성이 높은 물질로 구성되는 것이 좋다. 또한 먼지와 이물질이 브러쉬와 회전링 사이에 끼는 것을 방지하기 위해 브러쉬와 회전링이 접촉하는 부분이 외부에 노출되지 않는 것이 바람직하다.It is preferable that the brush and the rotating ring are made of a material having high conductivity, and particularly, the brush is preferably made of a material having high conductivity and elasticity. Also, in order to prevent dust and debris from being caught between the brush and the rotating ring, it is preferable that the portion where the brush and the rotating ring contact is not exposed to the outside.
위에서 설명한 전원 및 통신 연결부(390)는 다양하게 구성될 수 있다. 예를 들어, 브러쉬와 회전링의 숫자를 필요에 따라 조정할 수 있으며, 브러쉬와 회전링의 위치도 송광부(310)와 수광부(320)의 사이, 회전기판(303)의 상단 또는 하단을 기준으로 위치할 수 있다.The power and
도 6과 도 7은 스캐너가 앞으로 이동하면서 거리 측정 위치를 수직 방향으로 이동하며 스캐너와 주변 사물 사이의 거리를 측정하는 예를 보여주고 있다.6 and 7 show an example of measuring the distance between the scanner and surrounding objects while moving the distance measurement position in the vertical direction as the scanner moves forward.
도 6에서는 스캐너(300)가 주변 사물(410)과 스캐너(300) 사이의 거리를 측정하는 예를 보여준다. 이때 측정 위치는 주면 사물(410)의 표면(E)이다.6 shows an example in which the
도 7에서는 스캐너(300)가 전방으로 이동하면서 주변 사물(410)과 스캐너(300) 사이의 거리를 측정하는 예를 보여준다. 이때 측정 위치는 주면 사물(410)의 표면(F)이다.7 shows an example in which the distance between the surrounding
도 6과 도 7에서는 스캐너(300)이 전방 이동을 하면 거리 측정 위치가 위에서 아래로 이동하는 것을 보여준다. 여기에서는 거리 측정 지점(E)에서 거리 측정 지점(F)로 이동하였다. 반대로 스캐너(300)가 후방 이동을 하면 거리 측정 위치가 아래에서 위로 이동한다.6 and 7 show that the distance measurement position moves from top to bottom when the
거리 측정용 빔(10)은 일정한 각도(θ)를 가지고 주변 사물에 발광되도록 광원(312)를 구성되기 때문에 스캐너(300)가 전방 또는 후방으로 이동하며 거리 측정 위치를 아래 또는 위로 이동하며 주변 사물과의 거리를 측정할 수 있다.Since the
또한 거리 측정용 빔(10)이 일정한 각도(θ)를 유지 하게 되므로 스캐너(300)는 스캐너(300)와 다양한 높이를 가진 주변 사물과의 거리를 전후방으로 이동하면서 측정할 수 있다.In addition, since the
거리 측정용 빔(10)과 수평선(11) 사이의 각도(θ)는 예각을 이루는 것이 바람직하다. 각도(θ)는 광원(312)와 수광센서(322) 사이의 거리에 따라 달라질 수 있다.It is preferable that the angle θ between the
도 8에서는 송광부(310)와 수광부(320)의 위치를 바꾸어서 스캐너(300)를 구성하는 예를 보여준다. 도 7에서 보여주듯이 송광부(310)이 수광부(320) 위쪽에 위치할 수 도 있다. 이 경우, 스캐너(300)가 전방으로 이동하면, 거리 측정 위치가 위쪽으로 이동하며, 스캐너(300)이 후방으로 이동하면, 거리 측정 위치가 아래쪽으로 이동한다.8 shows an example of configuring the
도 9는 진공 청소 로봇(700)에 탑재되어 사용되는 스캐너(300)를 도시하였다. 본 발명이 주변 사물과 청소 로봇 사이의 거리를 측정하여 공간 데이터를 청소 로봇에 전송하면, 청소 로봇은 본 발명에서 전송 받은 정보를 바탕으로 동선을 정한다.9 shows a
다음으로 도 10 내지 도 13을 참조하여 본 발명의 실시 예에 따른 스캐너 및 그의 동작 방법에 대해 설명한다.Next, a scanner according to an embodiment of the present invention and an operation method thereof will be described with reference to FIGS. 10 to 13.
도 10은 본 발명의 일 실시 예에 따른 스캐너의 동작 방법을 설명하기 위한 흐름도이다.10 is a flowchart illustrating a method of operating a scanner according to an embodiment of the present invention.
특히, 도 10에서 설명하는 스캐너(300)의 동작 방법은 도 9에서 설명한 진공 청소 로봇(700)에 탑재되어 사용되는 경우를 가정하여 설명하고, 도 1 내지 도 9의 내용에 결부시켜 스캐너(300)의 동작 방법을 설명한다.In particular, the operation method of the
먼저, 스캐너(300)의 제어부(360)는 진공 청소 로봇(700)의 기준 지점과 물체 간의 기준 거리(d1)를 측정한다(S101). 일 실시 예에서 기준 지점은 고정된 위치에 있는 물체의 정면에서 진공 청소 로봇(700)의 정면 간의 거리 또는 물체와 스캐너(300) 간의 거리인 기준 거리를 측정하기 위해 정해진 지점일 수 있다. 즉, 스캐너(300)는 진공 청소 로봇(700)의 측면보다는 정면에서 물체와 비교적 정확한 거리를 측정할 수 있다. 왜냐하면, 진공 청소 로봇(700)의 측면에서는 진공 청소 로봇(700)의 표면에 투명 또는 반투명의 재질로 구성된 경우, 이물질에 의해 물체에 반사되어 입사되는 광량도 감소하게 되고, 이물질에 의해 직접 반사되는 광이 스캐너(300)의 거리 센서에 입사되어 거리 측정에 어려움이 있기 때문이다. First, the
스캐너(300)는 송광부(310)를 통해 빛을 발광할 수 있고, 수광부(320)는 발광된 빛이 물체를 맞고, 반사된 빛을 감지할 수 있다. 제어부(360)는 도 2에서 설명한 거리 계산부(362)를 통해 수광부(320)에 모아진 빛을 통해 진공 청소 로봇(700)의 기준 지점과 물체 간의 기준 거리를 측정할 수 있다. 단계 S101에 대한 설명을 도 11을 참조하여 설명한다.The
도 11은 본 발명의 일 실시 예에 따라 스캐너가 기준 거리를 측정하는 방법을 설명하기 위한 도면이다.11 is a diagram for explaining a method for a scanner to measure a reference distance according to an embodiment of the present invention.
도 11을 참조하면, 스캐너(300)는 고정된 위치의 물체(800)에 빛을 조사하여 물체(800)에 반사된 빛을 통해 기준 지점과 물체 간의 거리인 기준 거리를 측정할 수 있다. 기준 거리는 추후 진공 청소 로봇(700)의 일 지점에 이물질이 검출되었는지 여부를 확인하기 위해 사용될 수 있다.Referring to FIG. 11, the
또한, 기준 지점이 스캐너(300)의 일지점이라 한다면, 기준 거리 또한, 스캐너(300)의 일 지점과 물체(800) 간의 거리를 의미할 수 있다.In addition, if the reference point is a one point of the
다시 도 10을 설명한다.10 will be described again.
스캐너(300)의 제어부(360)는 제1 지점으로 진공 청소 로봇(700)을 회전시킨다(S103). 일 실시 예에서 제어부(360)는 진공 청소 로봇(700)의 제1 지점에 이물질이 존재하는지를 확인하기 위해 기준 지점으로부터 시계 방향으로 45도만큼 회전된 지점인 제1 지점으로 진공 청소 로봇(700)을 회전시킬 수 있다. 제어부(360)가 진공 청소 로봇(700)을 회전시키는 원리는 도 2에서 설명한 것과 같으므로, 자세한 설명은 생략한다. 또한, 여기서 45도는 예시에 불과한 수치이다. The
스캐너(300)의 제어부(360)는 제1 지점과 물체 간의 거리인 제1 거리(d2)를 측정한다(S105). 이 경우, 제어부(360)는 스캐너(300)를 고정 상태에 있도록 제어할 수 있고, 진공 청소 로봇(700)만을 제1 지점으로 회전시켜 제1 거리를 측정할 수 있다. The
제어부(360)는 단계 S101에서 설명한 것과 마찬가지로, 진공 청소 로봇(700)과 물체(800) 간의 거리를 측정할 수 있다. The
단계 S103 및 S105를 도 12를 참조하여 설명한다.Steps S103 and S105 will be described with reference to FIG. 12.
도 12는 본 발명의 일 실시 예에 따라 스캐너가 진공 청소 로봇을 시계 방향으로 회전시킨 후, 거리를 측정하는 방법을 설명하기 위한 도면이다.12 is a view for explaining a method for measuring the distance after the scanner rotates the vacuum cleaning robot clockwise according to an embodiment of the present invention.
도 12를 참조하면, 진공 청소 로봇(700)의 기준 지점(A)의 반 시계 방향으로 45도만큼 떨어진 위치에는 제1 지점(B)이 있고, 기준 지점(A)의 시계 방향으로 45도만큼 떨어진 위치에는 제2 지점(C)가 있다.Referring to FIG. 12, the first point B is located at a
스캐너(300)는 자신의 고정된 상태로 위치시키고, 진공 청소 로봇(700)을 시계 방향으로 45도만큼 회전시킬 수 있다. 그러면, 제1 지점(B)은 물체(800)의 정면을 향하게 되고, 기준 지점(A)은 시계 방향으로 45도만큼 회전 이동된 위치에 있게 된다.The
이 상태에서 스캐너(300)는 제1 지점(B)과 물체(800)와의 제1 거리를 측정할 수 있다.In this state, the
다시 도 10을 설명한다.10 will be described again.
스캐너(300)의 제어부(360)는 측정된 기준 거리와 제1 거리 간의 차이를 비교하여(S107), 비교된 거리 차이가 기 설정된 거리를 초과하는지 확인한다(S109).The
일 실시 예에서 기 설정된 거리는 진공 청소 로봇(700)의 해당 지점에 이물질이 검출된 것으로 확인하는 기준이 되는 최소 차이의 거리를 의미할 수 있다. 제어부(360)는 기준 거리와 제1 거리 간의 차이를 이용하여 기준 거리와 제1 거리 간의 차이가 기 설정된 거리보다 큰 경우, 진공 청소 로봇(700)의 제1 지점에 이물질이 있는 것으로 확인할 수 있다. 즉, 제어부(360)는 기준 거리와 제1 거리 간의 차이가 기 설정된 거리보다 큰 경우, 진공 청소 로봇(700)의 제1 지점에 부착된 이물질로 인해 송광되는 빛 또는 수광되는 빛이 적거나 왜곡이 발생한 것으로 판단할 수 있다.In one embodiment, the preset distance may mean a distance of a minimum difference that is a reference to confirm that a foreign object has been detected at a corresponding point of the
기준 거리와 제1 거리 사이의 차이가 기 설정된 거리를 초과하는 것으로 확인 된 경우, 제어부(360)는 진공 청소 로봇(700)의 제1 지점에 이물질이 존재하는 것으로 확인할 수 있다(S111).When it is determined that the difference between the reference distance and the first distance exceeds a preset distance, the
제어부(360)는 진공 청소 로봇(700)의 제1 지점에 이물질이 존재하는 것을 확인하여 이물질 검출 알림을 출력한다(S113). 일 실시 예에서 제어부(360)는 사용자에게 진공 청소 로봇(700)의 표면에 이물질이 검출되었음을 음성으로 출력할 수 있다. 이를 위해 스캐너(300)는 별도로 음성 출력부(미도시)를 구비할 수 있다. The
또 다른 실시 예에서 스캐너(300)가 디스플레이부(미도시)를 구비한 경우, 스캐너(300)는 디스플레이부를 통해 진공 청소 로봇(700)의 표면에 이물질이 검출되었음을 텍스트로 출력할 수 있다.In another embodiment, when the
일 실시 예에서 스캐너(300)가 상기 음성 출력부나 디스플레이부를 구비하지 않고, 진공 청소 로봇(700)이 이를 구비한 경우, 스캐너(300)는 진공 청소 로봇(700)에 제어신호를 전송하여 이물질 검출 알림을 출력하도록 제어할 수 있다.In an embodiment, when the
제어부(360)는 이물질 검출 알림을 출력한 후, 진공 청소 로봇(700)의 동작을 위한 사용자 입력이 존재하는지 확인한다(S115). 일 실시 예에서 사용자 입력은 진공 청소 로봇(700)의 제1 지점에서 검출된 이물질을 제거하기 위한 입력일 수 있다. After outputting the foreign substance detection notification, the
또 다른 실시 예에서 사용자 입력은 진공 청소 로봇(700)의 오작동을 방지하기 위해 진공 청소 로봇(700)의 전원을 비활성화 시키는 입력일 수 있다.In another embodiment, the user input may be an input that deactivates the power of the
만약, 사용자 입력이 존재하는 경우, 제어부(360)는 사용자 입력에 따른 동작을 수행하도록 진공 청소 로봇을 제어한다(S117). 일 실시 예에서 사용자 입력이 진공 청소 로봇(700)의 제1 지점에서 검출된 이물질을 제거하기 위한 입력인 경우, 제어부(360)는 이물질 제거 수단을 통해 제1 지점의 이물질을 제거할 수 있다. 그 후, 단계 S105 내지 S109를 반복하여 제1 지점에서 이물질이 제거되었는지 여부를 확인할 수 있다. If there is user input, the
또 다른 실시 예에서 사용자 입력이 진공 청소 로봇(700)의 전원을 비활성화 시키는 입력인 경우, 제어부(300)는 진공 청소 로봇(700)의 전원을 오프시킬 수 있다.In another embodiment, when the user input is an input for deactivating the power of the
한편, 사용자 입력이 존재하지 않는 경우, 제어부(360)는 진공 청소 로봇(700)이 충전 가능한 충전 장소로 이동하도록 제어한다(S119). Meanwhile, when there is no user input, the
한편, 단계 S109에서 측정된 거준 거리와 제1 거리 간의 차이가 기 설정된 거리 미만 인 경우, 제어부(360)는 제2 지점으로 진공 청소 로봇(700)을 회전시킨다(S121). 일 실시 예에서 제어부(360)는 진공 청소 로봇(700)의 제2 지점에 이물질이 존재하는지를 확인하기 위해 기준 지점으로부터 반시계 방향으로 45도만큼 회전된 지점인 제2 지점으로 진공 청소 로봇(700)을 회전시킬 수 있다. 제어부(360)가 진공 청소 로봇(700)을 회전시키는 원리는 도 2에서 설명한 것과 같으므로, 자세한 설명은 생략한다. 또한, 여기서 45도는 예시에 불과한 수치이다. On the other hand, when the difference between the collimated distance and the first distance measured in step S109 is less than a preset distance, the
스캐너(300)의 제어부(360)는 제2 지점과 물체 간의 거리인 제2 거리(d3)를 측정한다(S123). 이 경우, 제어부(360)는 스캐너(300)를 고정 상태에 있도록 제어할 수 있고, 진공 청소 로봇(700)만을 제2 지점으로 회전시켜 제2 거리를 측정할 수 있다. The
제어부(360)는 단계 S101에서 설명한 것과 마찬가지로, 진공 청소 로봇(700)과 물체(800) 간의 거리를 측정할 수 있다. The
단계 S121 및 S123을 도 13을 참조하여 설명한다.Steps S121 and S123 will be described with reference to FIG. 13.
도 13은 본 발명의 일 실시 예에 따라 스캐너가 진공 청소 로봇을 반 시계 방향으로 회전시킨 후, 거리를 측정하는 방법을 설명하기 위한 도면이다.13 is a view for explaining a method for measuring a distance after the scanner rotates the vacuum cleaning robot counterclockwise according to an embodiment of the present invention.
도 13을 참조하면, 진공 청소 로봇(700)의 기준 지점(A)의 반 시계 방향으로 45도만큼 떨어진 위치에는 제1 지점(B)이 있고, 기준 지점(A)의 시계 방향으로 45도만큼 떨어진 위치에는 제2 지점(C)가 있다.Referring to FIG. 13, the first point B is located at a
스캐너(300)는 자신의 고정된 상태로 위치시키고, 진공 청소 로봇(700)을 반시계 방향으로 45도만큼 회전시킬 수 있다. 그러면, 제2 지점(C)은 물체(800)의 정면을 향하게 되고, 기준 지점(A)은 반 시계 방향으로 45도만큼 회전 이동된 위치에 있게 된다.The
이 상태에서 스캐너(300)는 제2 지점(C)과 물체(800)와의 제2 거리를 측정할 수 있다.In this state, the
다시 도 10을 설명한다.10 will be described again.
스캐너(300)의 제어부(360)는 측정된 기준 거리와 제2 거리 간의 차이를 비교하여(S125), 비교된 거리 차이가 기 설정된 거리를 초과하는지 확인한다(S127).The
일 실시 예에서 기 설정된 거리는 진공 청소 로봇(700)의 해당 지점에 이물질이 검출된 것으로 확인하는 기준이 되는 최소 차이의 거리를 의미할 수 있다. 제어부(360)는 기준 거리와 제2 거리 간의 차이를 이용하여 기준 거리와 제2 거리 간의 차이가 기 설정된 거리보다 큰 경우, 진공 청소 로봇(700)의 제2 지점에 이물질이 있는 것으로 확인할 수 있다. 즉, 제어부(360)는 기준 거리와 제2 거리 간의 차이가 기 설정된 거리보다 큰 경우, 진공 청소 로봇(700)의 제2 지점에 부착된 이물질로 인해 송광되는 빛 또는 수광되는 빛이 적거나 왜곡이 발생한 것으로 판단할 수 있다.In one embodiment, the preset distance may mean a distance of a minimum difference that is a reference to confirm that a foreign object has been detected at a corresponding point of the
기준 거리와 제2 거리 사이의 차이가 기 설정된 거리를 초과하는 것으로 확인 된 경우, 제어부(360)는 진공 청소 로봇(700)의 제2 지점에 이물질이 존재하는 것으로 확인할 수 있다(S129).When it is determined that the difference between the reference distance and the second distance exceeds a preset distance, the
그 후에는 단계 S113으로 돌아가 제어부(260)는 이물질 검출 알림을 출력하고, 사용자 입력의 존재에 따른 단계를 수행하도록 제어할 수 있다.After that, the control returns to step S113, the control unit 260 outputs a foreign substance detection notification, and may be controlled to perform a step according to the presence of the user input.
상기와 같이 설명된 스캐너는 위에 설명된 실시예들의 구성과 방법이 한정되게 적용될 수 있는 것이 아니라, 상기 실시예들은 다양한 변형이 이루어질 수 있도록 각 실시예들의 전부 또는 일부가 선택적으로 조합되어 구성될 수도 있다.The scanner described above is not limited to the configuration and method of the above-described embodiments, and the above-described embodiments may be configured by selectively combining all or part of each embodiment so that various modifications can be made. have.
Claims (12)
거리 측정용 빔을 물체에 발광하는 송광부;
상기 물체에서 반사되어 상기 거리 측정 장치로 모이는 빛을 감지하는 수광부; 및
상기 청소 로봇의 기준 지점과 물체 간의 기준 거리와 상기 청소 로봇을 일정 각도만큼 회전시켜 획득한 측정거리를 비교하여 상기 기준 거리와 상기 측정 거리의 차이가 기 설정된 거리를 초과하는 경우, 상기 청소 로봇의 표면에 이물질이 존재하는 것으로 확인하는 제어부를 포함하는
거리 측정 장치.In the distance measuring device mounted on the cleaning robot,
A transmitter that emits a beam for distance measurement on an object;
A light receiving unit that senses light reflected from the object and collected by the distance measuring device; And
When the reference distance between the reference point and the object of the cleaning robot and the measurement distance obtained by rotating the cleaning robot by a certain angle are compared, and the difference between the reference distance and the measurement distance exceeds a preset distance, the cleaning robot It includes a control unit to confirm that the foreign matter is present on the surface
Distance measuring device.
상기 제어부는
상기 청소 로봇을 기준 지점으로부터 시계 방향 또는 반 시계 방향으로 일정 각도만큼 회전시킨 상태의 측정지점과 상기 물체 간의 거리인 측정 거리를 측정하고, 측정된 측정 거리와 상기 기준 거리를 비교하는
거리 측정 장치.According to claim 1,
The control unit
Measuring the measurement distance, which is the distance between the measurement point and the object in a state in which the cleaning robot is rotated by a predetermined angle from the reference point clockwise or counterclockwise, and compares the measured measurement distance with the reference distance
Distance measuring device.
상기 제어부는
상기 이물질이 존재하는 것으로 확인된 경우, 상기 이물질의 존재를 알리는 알림을 시각적 또는 청각적으로 출력하는
거리 측정 장치.According to claim 3,
The control unit
When it is determined that the foreign substance exists, visually or audiblely outputs a notification informing the existence of the foreign substance.
Distance measuring device.
상기 제어부는
상기 청소 로봇의 동작을 제어하기 위한 사용자 입력을 수신하는지 확인하고,
상기 사용자 입력이 수신되는 경우, 수신된 사용자 입력에 따라 상기 청소 로봇의 동작을 수행하도록 상기 청소 로봇을 제어하는
거리 측정 장치.According to claim 4,
The control unit
Check whether a user input for controlling the operation of the cleaning robot is received,
When the user input is received, controlling the cleaning robot to perform the operation of the cleaning robot according to the received user input
Distance measuring device.
상기 제어부는
상기 사용자 입력이 수신되지 않는 경우,
상기 청소 로봇이 충전 장소로 이동하도록 하는 제어신호를 상기 청소 로봇에 인가하는
거리 측정 장치.The method of claim 5,
The control unit
If the user input is not received,
Applying a control signal to the cleaning robot to move to the charging place to the cleaning robot
Distance measuring device.
거리 측정용 빔을 물체에 발광하는 단계;
상기 물체에서 반사되어 상기 거리 측정 장치로 모이는 빛을 감지하는 단계; 및
상기 청소 로봇의 기준 지점과 물체 간의 기준 거리와 상기 청소 로봇을 일정 각도만큼 회전시켜 획득한 측정거리를 비교하여 상기 청소 로봇의 표면에 이물질이 존재하는지 여부를 확인하는 단계를 포함하고,
상기 청소 로봇의 표면에 이물질이 존재하는지 여부를 확인하는 단계는
상기 기준 거리와 상기 측정 거리의 차이를 비교하여 차이가 기 설정된 거리를 초과하는 경우, 상기 이물질이 존재하는 것으로 확인하는 단계인
거리 측정 장치의 동작 방법.In the operation method of the distance measuring device mounted on the cleaning robot,
Emitting a beam for distance measurement on an object;
Sensing light reflected from the object and collected by the distance measuring device; And
And comparing the reference distance between the reference point and the object of the cleaning robot and the measurement distance obtained by rotating the cleaning robot by a certain angle, and checking whether a foreign substance is present on the surface of the cleaning robot,
The step of checking whether a foreign substance is present on the surface of the cleaning robot is
Comparing the difference between the reference distance and the measured distance, when the difference exceeds a preset distance, checking that the foreign substance exists
How the distance measuring device works.
상기 비교하는 단계는
상기 청소 로봇을 기준 지점으로부터 시계 방향 또는 반 시계 방향으로 일정 각도만큼 회전시킨 상태의 측정지점과 상기 물체 간의 거리인 측정 거리를 측정하고, 측정된 측정 거리와 상기 기준 거리를 비교하는
거리 측정 장치의 동작 방법.The method of claim 7,
The comparing step
Measuring the measurement distance, which is the distance between the measurement point and the object in a state in which the cleaning robot is rotated by a predetermined angle from the reference point clockwise or counterclockwise, and compares the measured measurement distance with the reference distance
How the distance measuring device works.
상기 이물질이 존재하는 것으로 확인된 경우, 상기 이물질의 존재를 알리는 알림을 시각적 또는 청각적으로 출력하는 단계를 더 포함하는
거리 측정 장치의 동작 방법.The method of claim 9,
If it is confirmed that the foreign matter exists, further comprising the step of visually or audibly outputting a notification informing the existence of the foreign matter.
How the distance measuring device works.
상기 청소 로봇의 동작을 제어하기 위한 사용자 입력을 수신하는지 확인하는 단계; 및
상기 사용자 입력이 수신되는 경우, 수신된 사용자 입력에 따라 상기 청소 로봇의 동작을 수행하도록 상기 청소 로봇을 제어하는 단계를 더 포함하는
거리 측정 장치의 동작 방법.The method of claim 10,
Checking whether a user input for controlling the operation of the cleaning robot is received; And
And when the user input is received, controlling the cleaning robot to perform an operation of the cleaning robot according to the received user input.
How the distance measuring device works.
상기 사용자 입력이 수신되지 않는 경우, 상기 청소 로봇이 충전 장소로 이동하도록 하는 제어신호를 상기 청소 로봇에 인가하는 단계를 더 포함하는
거리 측정 장치의 동작 방법.The method of claim 11,
When the user input is not received, further comprising applying a control signal to the cleaning robot to move the cleaning robot to the charging place.
How the distance measuring device works.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020130134118A KR102137156B1 (en) | 2013-11-06 | 2013-11-06 | Distance measuring scanner and operating method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020130134118A KR102137156B1 (en) | 2013-11-06 | 2013-11-06 | Distance measuring scanner and operating method thereof |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20150052562A KR20150052562A (en) | 2015-05-14 |
KR102137156B1 true KR102137156B1 (en) | 2020-07-24 |
Family
ID=53389440
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020130134118A KR102137156B1 (en) | 2013-11-06 | 2013-11-06 | Distance measuring scanner and operating method thereof |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102137156B1 (en) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004223703A (en) * | 2003-01-23 | 2004-08-12 | Lg Electronics Inc | Location information recognition device of robot for cleaning and robot main body for cleaning |
-
2013
- 2013-11-06 KR KR1020130134118A patent/KR102137156B1/en active IP Right Grant
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004223703A (en) * | 2003-01-23 | 2004-08-12 | Lg Electronics Inc | Location information recognition device of robot for cleaning and robot main body for cleaning |
Also Published As
Publication number | Publication date |
---|---|
KR20150052562A (en) | 2015-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9995576B2 (en) | Distance measuring device and method thereof | |
US9180596B2 (en) | Robot cleaner and method of operating the same | |
NL1033591C2 (en) | Unmanned vehicle for moving manure. | |
KR102328252B1 (en) | Cleaning robot and controlling method thereof | |
KR101822942B1 (en) | Robot cleaner and controlling method of the same | |
KR102001422B1 (en) | Electrical vacuum cleaner | |
KR102326479B1 (en) | Cleaning robot and controlling method thereof | |
KR102144541B1 (en) | Apparatus for sensing distances of two directions | |
TWI399677B (en) | Optical detection apparatus and method | |
EP2623010A2 (en) | Robot cleaner | |
US20170371066A1 (en) | Optoelectronic Sensor and Method for the Detection of Objects | |
RU2014154405A (en) | System and method for guiding an automatic cleaning device along a path | |
CN112153928B (en) | Sweeper and control method thereof | |
US9519059B2 (en) | Limited-area reflection type optical sensor and electronic device | |
KR102090502B1 (en) | Distance measuring device and method thereof | |
KR20180108116A (en) | Distance measuring apparatus | |
KR20160003435A (en) | Cleaning robot and controlling method thereof | |
KR20080093768A (en) | Position sensing device of traveling robot and robot cleaner using the same | |
US9798005B2 (en) | Three-dimensional space measurement device and method for operating same | |
WO2016051861A1 (en) | Obstacle determination device and obstacle determination method | |
KR102067600B1 (en) | Cleaner and controlling method thereof | |
KR102137156B1 (en) | Distance measuring scanner and operating method thereof | |
US11507104B2 (en) | Obstacle sensor system and autonomous device using the same | |
KR102188878B1 (en) | Distance measuring scanner and operating method thereof | |
US20180239022A1 (en) | Distance measuring device and distance measuring method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right |