KR20020080897A - Obstacle shape detecting apparatus of robot cleaner and method therefor - Google Patents
Obstacle shape detecting apparatus of robot cleaner and method therefor Download PDFInfo
- Publication number
- KR20020080897A KR20020080897A KR1020010020748A KR20010020748A KR20020080897A KR 20020080897 A KR20020080897 A KR 20020080897A KR 1020010020748 A KR1020010020748 A KR 1020010020748A KR 20010020748 A KR20010020748 A KR 20010020748A KR 20020080897 A KR20020080897 A KR 20020080897A
- Authority
- KR
- South Korea
- Prior art keywords
- obstacle
- robot cleaner
- unit
- light emitting
- light
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 12
- 238000001514 detection method Methods 0.000 claims description 29
- 238000013507 mapping Methods 0.000 claims description 8
- 239000000428 dust Substances 0.000 abstract description 11
- 238000004140 cleaning Methods 0.000 abstract description 7
- 230000003287 optical effect Effects 0.000 abstract 1
- 238000009434 installation Methods 0.000 description 4
- 230000002265 prevention Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000000593 degrading effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L9/00—Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
- A47L9/28—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
- A47L9/2805—Parameters or conditions being sensed
- A47L9/2826—Parameters or conditions being sensed the condition of the floor
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection
Abstract
Description
본 발명은 로봇 청소기의 장애물 형태 감지 장치 및 방법에 관한 것으로, 보다 구체적으로는 로봇 청소기의 이동체 소정 위치에 설치된 다수의 센서를 소정 방향으로 순차적으로 작동시켜 장애물의 형태를 스캐닝하는 장애물 형태 감지 장치 및 방법에 관한 것이다.The present invention relates to an apparatus and method for detecting an obstacle shape of a robot cleaner, and more particularly, an obstacle type detection device for scanning an obstacle shape by sequentially operating a plurality of sensors installed at a predetermined position of a robot cleaner in a predetermined direction. It is about a method.
일반적인 종래의 로봇 청소기(robot cleaner)는 이동가능한 주행부, 본체 소정 위치에 설치되어 먼지 및 오물을 흡입하는 흡입부, 상기 흡입된 먼지를 모아두는 집진부, 벽 등의 장애물의 존재를 감지하는 장애물 형태 감지 장치, 로봇 청소기의 전반적인 동작을 제어하는 제어부 및 로봇 청소기의 각 부에 전원을 공급하는 전원부로 구성된다.In general, the robot cleaner (robot cleaner) is a movable moving part, a suction part installed at a predetermined position of the main body to suck dust and dirt, an obstacle type for detecting the presence of obstacles such as a dust collecting part for collecting the sucked dust, a wall, etc. It is composed of a sensing device, a control unit for controlling the overall operation of the robot cleaner and a power supply unit for supplying power to each part of the robot cleaner.
종래 로봇 청소기는 본체의 주행부를 구동시켜 스스로 진행하며 청소 대상 영역의 먼지등 오물을 흡입하고, 장애물 형태 감지 장치에 의해 주행방향에 존재하는 장애물을 인식하여 스스로 장애물을 회피하여 이동할 수 있다.The conventional robot cleaner may drive by driving the driving unit of the main body and sucks dust such as dust in the cleaning target area, and recognizes an obstacle present in the driving direction by the obstacle type sensing device to move the obstacle by itself.
종래의 로봇 청소기는 통상적으로 하단부에 설치된 초음파 센서에 의해 주행방향에 있는 장애물까지의 거리를 판단하여 장애물을 회피하면서 이동하였다. 이 초음파 센서는 초음파를 방사하는 초음파 발광부와 장애물에 반사되어 돌아오는 반사 초음파를 수신하는 초음파 수광부로 이루어져 있다. 제어부는 방사된 초음파 신호와 수신된 초음파 신호 사이의 시간을 측정하고, 측정된 시간으로 부터 장애물까지의 거리를 계산하여 주행부의 모터를 제어하였다. 이와 같은 제어부의 제어 동작에 따라 로봇 청소기가 장애물을 회피하면서 주행할 수 있었다.Conventional robot cleaners have moved by avoiding obstacles by determining the distance to the obstacle in the driving direction by an ultrasonic sensor installed at the lower end. The ultrasonic sensor includes an ultrasonic light emitting unit for emitting ultrasonic waves and an ultrasonic light receiving unit for receiving reflected ultrasonic waves reflected by an obstacle. The controller measured the time between the emitted ultrasonic signal and the received ultrasonic signal, and calculated the distance from the measured time to the obstacle to control the motor of the driving unit. According to the control operation of the controller, the robot cleaner was able to travel while avoiding obstacles.
그러나, 이와 같은 종래 로봇 청소기의 장애물 형태 감지 장치 및 방법은 소정 높이까지에 존재하는 장애물의 존재 및 장애물까지의 거리는 감지할 수 있으나, 장애물의 형태를 정확하게 파악할 수 없었다.However, the apparatus and method for detecting the obstacle shape of the conventional robot cleaner can detect the existence of the obstacle present at a predetermined height and the distance to the obstacle, but cannot accurately identify the shape of the obstacle.
또한, 장애물의 형태를 정확하게 파악할 수 없으므로 폭이 넓거나 외곽 라인(포락선:envelope)이 불규칙한 장애물이 존재하는 경우에는 빈번하게 회피경로를 조정하여야 하므로 청소기의 성능이 저하되는 문제점이 있었다.In addition, since the shape of the obstacle cannot be accurately understood, when the obstacle is wide or has an irregular outer line (envelope), it is necessary to adjust the avoidance path frequently, thereby degrading the performance of the cleaner.
본 발명은 상기와 같은 문제점을 개선하기 위하여 안출된 것으로서, 로봇 청소기의 주행방향에 존재하는 장애물의 형태를 감지할 수 있는 로봇 청소기의 장애물 형태 감지 장치 및 방법을 제공하는데 그 목적이 있다.The present invention has been made to solve the above problems, and an object of the present invention is to provide an obstacle type detecting apparatus and method for a robot cleaner capable of detecting a shape of an obstacle present in a driving direction of the robot cleaner.
또한, 장애물의 형태를 정확히 파악함으로써 로봇 청소기의 잦은 회피 경로 설정을 방지할 수 있는 로봇 청소기의 장애물 형태 감지 장치 및 방법을 제공하는데 또다른 목적이 있다.In addition, another object of the present invention is to provide an apparatus and method for detecting an obstacle shape of a robot cleaner which can prevent the robot cleaner from frequently setting the avoidance path by accurately identifying the shape of the obstacle.
도 1은 본 발명의 바람직한 실시예에 따른 로봇 청소기의 기능을 도시한 블럭도.1 is a block diagram showing the function of a robot cleaner according to a preferred embodiment of the present invention.
도 2는 본 발명에 따른 장애물 형태 감지 장치가 장착된 로봇 청소기의 개략적인 구성을 도시한 사시도.Figure 2 is a perspective view showing a schematic configuration of a robot cleaner equipped with an obstacle shape detection apparatus according to the present invention.
도 3은 도 2의 장애물 형태 감지부의 정면도.3 is a front view of the obstacle shape detecting unit of FIG. 2;
도 4는 본 발명에 따른 장애물 형태 감지 방법을 나타내는 순서도.4 is a flowchart illustrating a method for detecting an obstacle shape according to the present invention.
도 5는 도 1의 장애물 형태 감지 장치의 동작 및 장애물 감지 결과를 도시한 도.FIG. 5 is a view illustrating an operation and an obstacle detection result of the obstacle shape detecting device of FIG. 1.
* 도면의 주요부분에 대한 부호의 설명 *Explanation of symbols on the main parts of the drawings
100 : 로봇 청소기 110 : 주행부100: robot cleaner 110: driving unit
120 : 클리닝부 130 : 비젼부120: cleaning unit 130: vision unit
140 : 천정거리 측정부 150 : 추락 방지부140: ceiling distance measuring unit 150: fall prevention unit
160 : 장애물 형태 감지 장치 170 : 충전 장치160: obstacle shape detection device 170: charging device
185 : RF 송수신부 190 : 제어부185: RF transceiver 190: control unit
상기와 같은 목적을 달성하기 위하여, 로봇 청소기의 본체 주행경로 주변에 존재하는 장애물을 감지하는 로봇 청소기의 장애물 형태 감지 장치에 있어서, 상기 로봇 청소기의 장애물 형태 감지 장치는: 본체의 주행면과 평행하게 설치된 다수의 발광 유니트들을 가진 발광부; 상기 다수의 발광 유니트에 대응하는 다수의 수광 유니트들을 가진 수광부; 상기 각 발광 유니트 및 대응하는 수광 유니트를 순차적으로 동작하도록 제어하는 형태 감지 제어부; 및 장애물에 반사되어 순차적으로 수신된 반사광으로 부터 장애물의 포락선을 검출하는 형태 감지부;를 포함하는 것이 바람직하다.In order to achieve the above object, in the obstacle type detection device of the robot cleaner for detecting an obstacle present around the main driving path of the robot cleaner, the obstacle type detection device of the robot cleaner: parallel to the running surface of the main body A light emitting unit having a plurality of light emitting units installed; A light receiving unit having a plurality of light receiving units corresponding to the plurality of light emitting units; A shape detecting controller configured to control the light emitting unit and the corresponding light receiving unit to sequentially operate; And a shape detector for detecting an envelope of the obstacle from the reflected light sequentially received by the obstacle.
상기 형태 감지 제어부는 본체 주행 방향의 우측에서 좌측 또는 좌측에서 우측으로 발광 유니트를 순차적으로 동작시키는 것이 바람직하다.It is preferable that the shape detecting controller sequentially operates the light emitting unit from the right side to the left side or the left side to the right side in the main driving direction.
로봇 청소기의 본체 주행경로 주변에 존재하는 장애물을 감지하는 로봇 청소기의 장애물 형태 감지 방법에 있어서, 상기 장애물 형태 감지 방법은: a) 장애물 감지 신호가 입력되면 동작 대상 발광부를 선택하고 총유니트수를 설정하는 단계; b) 유니트 변수를 초기화하는 단계; c) 상기 유니트 변수에 해당하는 발광 유니트를 동작하여 장애물로 광을 조사하는 단계; d) 상기 조사된 광에 대응하여 상기 장애물로 부터 반사된 반사광을 수신하는 단계; e) 상기 수신된 반사광을 거리 정보로 매핑하는 단계; f) 상기 총유니트수와 상기 유니트 변수를 비교하여 스캐닝 완료 여부를 판단하는 단계; g) 상기 총유니트수와 상기 유니트 변수가 일치하지 않으면, 상기 유니트 변수를 증가시키고 상기 광 조사 단계(a)로 진행하는 단계; 및 h) 상기 총유니트수와 상기 유니트 변수가 일치하면 상기 매핑된 정보로 부터 상기 장애물의 포락선을 추정하는 단계;를 포함하는 것이 바람직하다.In the obstacle type detection method of the robot cleaner for detecting an obstacle present around the main driving path of the robot cleaner, the obstacle type detection method includes: a) when the obstacle detection signal is input, select the operation target light emitting unit and set the total number of units Doing; b) initializing the unit variable; c) operating a light emitting unit corresponding to the unit variable to irradiate light to an obstacle; d) receiving reflected light reflected from the obstacle in response to the irradiated light; e) mapping the received reflected light into distance information; f) comparing the total number of units with the unit variable to determine whether scanning is complete; g) if the total number of units does not match the unit variable, increasing the unit variable and proceeding to the light irradiation step (a); And h) estimating the envelope of the obstacle from the mapped information if the total unit number and the unit variable match.
상기 포락선 추정 단계(h)는 상기 매핑 정보 중 로봇 청소기 본체와 가장 근접한 점을 기준으로 사각형이 되도록 상기 장애물의 포락선을 형성하는 것이 바람직하다.In the envelope estimating step (h), an envelope of the obstacle may be formed so as to form a rectangle based on the point closest to the robot cleaner body among the mapping information.
이하, 첨부된 도면을 참조하여 상기와 같은 구성을 갖는 본 발명의 바람직한실시예에 따른 로봇 청소기의 장애물 형태 감지 장치 및 방법에 대하여 상세하게 설명한다. 본 실시예를 설명함에 있어 동일한 구성 요소에 대하여는 동일한 참조번호를 사용하고 설명은 생략한다.Hereinafter, with reference to the accompanying drawings will be described in detail with respect to the obstacle type detection apparatus and method of the robot cleaner according to a preferred embodiment of the present invention having the configuration as described above. In describing the present embodiment, the same reference numerals are used for the same components, and description thereof will be omitted.
본 발명에 의한 장애물 형태 감지 장치가 장착된 로봇 청소기가 도 1 및 도 2를 참조하여 이하에 설명된다.A robot cleaner equipped with an obstacle shape detecting apparatus according to the present invention will be described below with reference to FIGS. 1 and 2.
로봇 청소기(100)는 주행부(110), 클리닝부(120), 흡입유무검출부(166), 집진부(128), 비젼부(130), 천정 거리 측정부(140), 추락 방지부(150), 장애물 감지장치(160), 충격 감지부(166), 충전장치(170), 리모콘 발광부(180), RF 송수신부(185) 및 제어부(190)를 포함한다.The robot cleaner 100 includes a traveling part 110, a cleaning part 120, a suction presence detection part 166, a dust collecting part 128, a vision part 130, a ceiling distance measuring part 140, and a fall prevention part 150. , An obstacle detecting device 160, an impact detecting unit 166, a charging device 170, a remote control light emitting unit 180, an RF transmitting and receiving unit 185, and a controller 190.
주행부(110)는 네 개의 바퀴(116), 각각의 바퀴(116)를 회전시키는 모터(114) 및 제어부(190)의 제어에 따라 모터(114)를 구동하기 위한 PWM 제어부(112)를 포함한다.The driving unit 110 includes four wheels 116, a motor 114 for rotating each wheel 116, and a PWM controller 112 for driving the motor 114 under the control of the controller 190. do.
클리닝부(120)는 로봇 청소기(100)의 주행경로를 따라 청소대상 평면 상의 먼지를 청소기 본체(105) 내부로 끌어들이기 위한 브러쉬를 동작시키는 브러쉬 모터(122) 및 브러쉬에 의해 모아진 먼지를 집진부(128)로 흡입하기 위한 흡입력을 발생하는 흡입 모터(164)를 포함한다. 먼지 흡입 유무 검출부(166)는 먼지 흡입 유무를 검출한다.The cleaning unit 120 collects the dust collected by the brush and the brush motor 122 that operates the brush for drawing the dust on the plane to be cleaned into the cleaner body 105 along the driving path of the robot cleaner 100. And a suction motor 164 generating a suction force for suction into the 128. The dust suction presence detector 166 detects the presence of dust suction.
비젼부(130)는 전면 카메라(132), 위치 카메라(134) 및 카메라 선택부(136)를 포함한다.The vision unit 130 includes a front camera 132, a location camera 134, and a camera selector 136.
전면 카메라(132)는 로봇 청소기(100)의 주행 방향 전면에 존재하는 장애물또는 청소 영역 내부의 상황을 촬영하기 위한 것이다.The front camera 132 is for photographing an obstacle or a situation inside the cleaning area that exists in the front of the driving direction of the robot cleaner 100.
위치 카메라(134)는 로봇 청소기(100)의 상부 중앙에 위치하여 로봇 청소기(100)가 위치한 공간의 천정부를 촬영한다. 촬영된 정보는 천정에 설치된 각종 전등 등과 같은 기물을 통하여 현재 로봇 청소기(100)가 위치한 공간 내에서 로봇 청소기(100) 자신의 위치 및 주행 경로 결정의 기준 정보를 제공한다.The location camera 134 is located at the upper center of the robot cleaner 100 to photograph the ceiling of the space where the robot cleaner 100 is located. The photographed information provides reference information for determining the position and driving route of the robot cleaner 100 in the space where the robot cleaner 100 is currently located, through various objects such as various lights installed on the ceiling.
카메라 선택부(136)는 사용자의 필요에 따라 전면 카메라(132) 및 위치 카메라(134)를 선택적으로 동작하도록 한다.The camera selector 136 selectively operates the front camera 132 and the position camera 134 according to a user's needs.
천정 거리 측정부(140)는 천정과의 거리를 측정한다.The ceiling distance measuring unit 140 measures a distance from the ceiling.
추락 방지부(150)는 탁자 위 또는 계단 등을 청소하는 경우 로봇 청소기(100)의 추락을 방지하기 위하여 바닥의 상태를 감지한다.The fall prevention unit 150 detects a state of the floor to prevent the robot cleaner 100 from falling when cleaning the table or the stairs.
장애물 감지장치(160)는 본체(105)의 주행경로 주변 소정 범위 내에 존재하는 벽 등의 장애물을 감지한다.The obstacle detecting device 160 detects an obstacle such as a wall existing within a predetermined range around the driving path of the main body 105.
충전장치(170)는 로봇 청소기(100)에 동작 전원을 제공한다.The charging device 170 provides operating power to the robot cleaner 100.
리모콘 발광부(180)는 로봇 청소기(100)의 원격 제어 정보를 수신한다.The remote controller light emitting unit 180 receives remote control information of the robot cleaner 100.
RF 송수신부(185)는 로봇 청소기(100)와 홈 네트워크, 홈서버 또는 개인 컴퓨터 등과 영상 정보 또는 명령 정보를 송수신하기 위한 것이다.The RF transceiver 185 is for transmitting and receiving image information or command information with the robot cleaner 100, a home network, a home server or a personal computer.
제어부(190)는 로봇 청소기(190)의 전반적인 동작을 제어한다. 특히 제어부(190)는 장애물 감지 센서(164)로 부터의 센싱 정보에 따라 주행부(110)를 구동시킨다. 제어부(190)는 장애물이 검출되는 경우 로봇 청소기(100)를 정지시키거나 이동 경로를 변경하도록 제어한다.The controller 190 controls the overall operation of the robot cleaner 190. In particular, the controller 190 drives the driving unit 110 according to the sensing information from the obstacle sensor 164. The controller 190 controls the robot cleaner 100 to stop or change a movement path when an obstacle is detected.
본 발명의 바람직한 실시예에 따른 장애물 형태 감지 장치의 상세 구성이 이하에 설명된다.The detailed configuration of the obstacle shape detecting apparatus according to the preferred embodiment of the present invention will be described below.
장애물 형태 감지 장치(160)는 센서 설치부(162), 광 가이드부(164), 발광부(166) 및 수광부(168)를 포함한다.The obstacle shape detecting device 160 includes a sensor installation unit 162, a light guide unit 164, a light emitting unit 166, and a light receiving unit 168.
센서 설치부(162)는 본체(105)의 주행방향 전면의 소정 위치에 설치된다. 센서 설치부(162)에는 비접촉식 센서의 한 예로 발광부(166) 및 수광부(168)가 설치된다.The sensor installation unit 162 is installed at a predetermined position on the front of the main body 105 in the traveling direction. The light emitting unit 166 and the light receiving unit 168 are installed in the sensor installation unit 162 as an example of the non-contact sensor.
발광부(166)는 제 1 발광부(166a) 및 제 2 발광부(166b)를 포함한다.The light emitter 166 includes a first light emitter 166a and a second light emitter 166b.
제 1 발광부(166a)는 제 1 높이 구간에 존재하는 장애물을 검출하기 위한 다수의 제 1 발광 유니트들(167)로 구성된다. 제 1 발광부(166a)는 본체(105)의 하단부측에 소정 높이로 설치된다. 제 1 발광부(166a)는 장애물에 제 1 광을 조사한다. 제 1 발광 유니트들(167) 중 4개의 중앙 유니트(167b, 167c, 167c, 167d, 167e)는 등간격으로 본체(105)의 정면 중앙에 설치되고, 나머지 두 개의 측부 유니트(167a, 167f)는 양측으로 소정 각도 이격하여 설치된다.The first light emitting unit 166a includes a plurality of first light emitting units 167 for detecting an obstacle present in the first height section. The first light emitting part 166a is provided at a predetermined height on the lower end side of the main body 105. The first light emitter 166a radiates the first light to the obstacle. Four central units 167b, 167c, 167c, 167d, and 167e of the first light emitting units 167 are installed at the front center of the main body 105 at equal intervals, and the other two side units 167a and 167f are provided. It is installed at a predetermined angle apart from both sides.
제 2 발광부(166b)는 제 2 높이 구간에 존재하는 장애물을 검출하기 위한 다수의 제 2 발광 유니트로 구성된다. 제 2 발광부(166b)는 제 1 발광부(166a)보다 위쪽에 설치되어 제 2 높이 구간에 존재하는 장애물을 검출한다. 다수의 제 2 발광 유니트들은 등간격으로 설치된다. 제 2 발광부(166b)는 장애물에 제 2 광을 조사한다. 제 2 발광 유니트들(169) 중 4개의 중앙 유니트(169b, 169c, 169c, 169d, 169e)는 등간격으로 본체(105)의 정면 중앙에 설치되고, 나머지 두 개의 측부 유니트(169a, 169f)는 양측으로 소정 각도 이격하여 설치된다.The second light emitting unit 166b includes a plurality of second light emitting units for detecting an obstacle present in the second height section. The second light emitting unit 166b is installed above the first light emitting unit 166a to detect an obstacle existing in the second height section. The plurality of second light emitting units are provided at equal intervals. The second light emitting unit 166b irradiates the obstacle with the second light. Four central units 169b, 169c, 169c, 169d, and 169e of the second light emitting units 169 are installed at the front center of the main body 105 at equal intervals, and the other two side units 169a and 169f are provided. It is installed at a predetermined angle apart from both sides.
광 가이드부(164)는 센서 설치부(162)의 전면에 소정 형상으로 관통된 상태로 구획되어 제 1 내지 제 2 발광부(166a, 166b)로 부터 조사되는 광을 가이드하는 가이드부(164a)를 가진다.The light guide part 164 is partitioned in the state penetrating the front surface of the sensor installation part 162 in a predetermined shape, and guide part 164a which guides the light irradiated from the 1st-2nd light emitting parts 166a and 166b. Has
장애물 형태 감지 장치(160)는 수신부(168)를 통해 수신된 제 1 및 제 2 반사광으로 부터 본체(105) 주행경로의 전방향에 존재하는 장애물의 높이를 검출한다.The obstacle type detecting device 160 detects the height of the obstacle existing in the omnidirectional direction of the main body 105 from the first and second reflected light received through the receiver 168.
장애물 형태 감지 장치(160)는 측방 장애물 감지부를 더 포함할 수 있음은 물론이다.Obstacle shape detection device 160 may further include a side obstacle detection unit.
상기와 같이 장애물의높이가 검출되면 장애물 검출 장치(160)는 장애물의 형태를 감지한다.When the height of the obstacle is detected as described above, the obstacle detecting apparatus 160 detects the shape of the obstacle.
본 발명에 따른 로봇 청소기의 장애물 형태 감지 장치의 동작 장애물 형태 감지 방법이 도 4 및 도 5를 참조하여 이하에 설명된다. 본 실시예를 설명함에 있어, 장애물이 제 2 높이에서만 검출되고, 장애물의 스캐닝 방향은 장애물의 좌측에서 우측으로 진행하는 것으로 가정한다. 그러나, 본 발명은 이에 한정되지 않고 다양한 변형 실시가 가능함은 물론이다.An operation obstacle shape detection method of the obstacle type detection device of the robot cleaner according to the present invention will be described below with reference to FIGS. 4 and 5. In describing the present embodiment, it is assumed that the obstacle is detected only at the second height, and the scanning direction of the obstacle proceeds from the left side to the right side of the obstacle. However, the present invention is not limited thereto, and various modifications can be made, of course.
로봇 청소기의 장애물 형태 감지 방법은 동작 대상 발광부 선택 단계(S62), 변수 초기화 단계(S64), 광조사 단계(S66), 반사광 수신 단계(S68), 수신 정보 매핑 단계(S70), 스캐닝 완료 판단 단계(S72), 변수 증가 단계(S74) 및 포락선 추정 단계(S76)를 포함한다.Obstacle type detection method of the robot cleaner includes the operation target light emitting unit selection step (S62), variable initialization step (S64), light irradiation step (S66), reflected light receiving step (S68), reception information mapping step (S70), scanning completion determination Step S72, variable increase step S74, and envelope estimation step S76.
동작 대상 발광부 선택 단계(S62)에서는 장애물 높이 감지 신호가 입력되면 입력된 높이 정보에 따라 동작 대상 발광부(166b)를 선택한다. 총유니트수 변수 T는 동작 대상 발광부(166b)를 구성하는 발광 유니트들(169)의 총 수인 6개이다.In the operation target light emitting unit selection step S62, when the obstacle height detection signal is input, the operation target light emitting unit 166b is selected according to the input height information. The total unit variable T is six, which is the total number of the light emitting units 169 constituting the operation target light emitting unit 166b.
변수 초기화 단계(S64)에서는 유니트 변수(n) 및 스캐닝 방향 변수를 설정한다. 유니트 변수(n)는 발광 유니트(169)를 카운트하기 위한 값으로 초기값은 1로 세팅한다. 스캐닝 방향 변수(d)는 장애물의 스캐닝 방향을 설정하기 위한 값이다. 스캐닝 방향은 장애물의 좌측으로 부터 우측으로 설정하거나, 우측으로 부터 좌측으로 설정할 수 있다. 또한, 스캐닝 방향은 상기 방향 중 하나로 미리 설정될 수 있고, 장애물 감지 결과에 따라 정해질 수도 있다. 각 발광 유니트를 순차적으로 발광시키는 것은 해당 반사광 정보가 서로 간섭되는 것을 방지하기 위함이다.In the variable initialization step S64, the unit variable n and the scanning direction variable are set. The unit variable n is a value for counting the light emitting unit 169 and an initial value thereof is set to one. The scanning direction variable d is a value for setting the scanning direction of the obstacle. The scanning direction may be set from the left side of the obstacle to the right side or from the right side to the left side. In addition, the scanning direction may be preset in one of the above directions, or may be determined according to the obstacle detection result. The emission of each light emitting unit in sequence is to prevent the reflected light information from interfering with each other.
광조사 단계(S66)는 스캐닝 방향에 따라 유니트 변수(n)에 해당하는 발광 유니트(169f)를 동작하여 장애물로 광을 조사한다.In the light irradiation step S66, light is irradiated to the obstacle by operating the light emitting unit 169f corresponding to the unit variable n according to the scanning direction.
반사광 수신 단계(S68)에서는 조사된 광에 대응하여 장애물로 부터 반사된 반사광을 수신한다.In the reflected light receiving step S68, the reflected light reflected from the obstacle is received in response to the irradiated light.
수신 정보 매핑 단계(S70)는 수신된 반사광을 거리 정보로 매핑한다.The reception information mapping step S70 maps the received reflected light into distance information.
스캐닝 완료 판단 단계(S72)는 총유니트수(T)와 유니트 변수(n)를 비교하여 스캐닝 완료 여부를 판단한다.In the scanning completion determination step (S72), the scanning completion is determined by comparing the total number of units T and the unit variable n.
변수 증가 단계(S74)는 총유니트수(T)와 유니트 변수(n)가 일치하지 않으면, 유니트 변수(n)를 증가시키고 광 조사 단계(S66)로 진행한다. 즉, 발광 유니트(169e)를 동작시킨다. 이와 같이 순차적으로 발광 유니트를 동작시킨다.If the total number of units T and the unit variable n do not match, the variable increasing step S74 increases the unit variable n and proceeds to the light irradiation step S66. That is, the light emitting unit 169e is operated. In this way, the light emitting unit is operated sequentially.
포락선 추정 단계(S76)는 총유니트수(T)와 유니트 변수(n)가 일치하면 도 5의 a)에 도시된 매핑 정보로 부터 장애물(250)의 포락선을 추정한다. 포락선 추정 단계(S76)는 도 5의 a)에 도시된 매핑 정보 중 로봇 청소기 본체와 가장 근접한 점(D)을 기준으로 사각형이 되도록 한다. 장애물(250)의 포락선(250')이 도 5의 b)에 도시되어 있다. 포락선 추정 단계(S76)는 매핑된 정보로 부터 D지점을 기준으로 반원형으로 형성할 수 도 있다.The envelope estimating step S76 estimates the envelope of the obstacle 250 from the mapping information shown in FIG. 5A when the total number of units T and the unit variable n coincide. The envelope estimating step S76 may be a quadrangle based on the point D closest to the robot cleaner body among the mapping information illustrated in FIG. 5A. The envelope 250 ′ of the obstacle 250 is shown in b) of FIG. 5. The envelope estimation step S76 may be formed in a semicircular shape based on the point D from the mapped information.
상기 본 발명에 따른 장애물 형태 감지 장치 및 방법에 따르면, 장애물을 스캐닝하여 포락선을 검출함으로써 장애물의 형태를 판단할 수 있다. 또한, 장애물의 형태를 정확히 파악함으로써 로봇 청소기의 잦은 회피 경로 설정을 방지할 수 있다.According to the obstacle shape detection apparatus and method according to the present invention, the shape of the obstacle can be determined by scanning the obstacle to detect the envelope. In addition, by accurately identifying the shape of the obstacle it is possible to prevent the frequent setting of the avoidance path of the robot cleaner.
이상에서 본 발명의 바람직한 실시예에 대하여 도시하고, 또한 설명하였으나 본 발명은 상술한 특정의 바람직한 실시예에 한정되지 아니하며, 이하 청구범위에서 청구하는 본 발명의 요지를 벗어남이 없이 당해 발명이 속하는 기술분야에서 통상의 지식을 가진 자라면 다양한 변형 실시가 가능할 것이다.Although preferred embodiments of the present invention have been shown and described above, the present invention is not limited to the above-described specific preferred embodiments, and the technology to which the present invention pertains without departing from the gist of the present invention as claimed in the following claims. Those skilled in the art will be able to implement various modifications.
Claims (4)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020010020748A KR100722762B1 (en) | 2001-04-18 | 2001-04-18 | Obstacle shape detecting apparatus of robot cleaner and method therefor |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020010020748A KR100722762B1 (en) | 2001-04-18 | 2001-04-18 | Obstacle shape detecting apparatus of robot cleaner and method therefor |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| KR20020080897A true KR20020080897A (en) | 2002-10-26 |
| KR100722762B1 KR100722762B1 (en) | 2007-05-30 |
Family
ID=27701534
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| KR1020010020748A KR100722762B1 (en) | 2001-04-18 | 2001-04-18 | Obstacle shape detecting apparatus of robot cleaner and method therefor |
Country Status (1)
| Country | Link |
|---|---|
| KR (1) | KR100722762B1 (en) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101229106B1 (en) * | 2011-03-15 | 2013-02-15 | 주식회사 한울로보틱스 | The distance perception infrared ray sensor which uses the multiplex reception department |
| CN106056833A (en) * | 2016-06-23 | 2016-10-26 | 乐视控股（北京）有限公司 | Safety monitoring method, device, system and monitoring system |
| WO2017126848A1 (en) * | 2016-01-19 | 2017-07-27 | (주)유진로봇 | Foreground obstacle sensing apparatus, autonomous mobile robot utilizing same, and obstacle sensing method for autonomous mobile robot |
| WO2017191928A1 (en) * | 2016-05-02 | 2017-11-09 | 삼성전자주식회사 | Cleaning robot and control method therefor |
| CN107544494A (en) * | 2017-08-17 | 2018-01-05 | 上海美祎科技有限公司 | Sweeping robot and its barrier-avoiding method |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101487778B1 (en) * | 2010-05-11 | 2015-01-29 | 삼성전자 주식회사 | Sensing system and moving robot having the same |
| JP6396475B2 (en) * | 2013-12-23 | 2018-09-26 | エルジー エレクトロニクス インコーポレイティド | Robot vacuum cleaner |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100266988B1 (en) * | 1998-06-20 | 2000-10-02 | 배길성 | Recognition device and method for cleaning area of robot cleaner |
-
2001
- 2001-04-18 KR KR1020010020748A patent/KR100722762B1/en not_active IP Right Cessation
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101229106B1 (en) * | 2011-03-15 | 2013-02-15 | 주식회사 한울로보틱스 | The distance perception infrared ray sensor which uses the multiplex reception department |
| WO2017126848A1 (en) * | 2016-01-19 | 2017-07-27 | (주)유진로봇 | Foreground obstacle sensing apparatus, autonomous mobile robot utilizing same, and obstacle sensing method for autonomous mobile robot |
| WO2017191928A1 (en) * | 2016-05-02 | 2017-11-09 | 삼성전자주식회사 | Cleaning robot and control method therefor |
| US11067998B2 (en) | 2016-05-02 | 2021-07-20 | Samsung Electronics Co., Ltd. | Cleaning robot and control method therefor |
| US11803190B2 (en) | 2016-05-02 | 2023-10-31 | Samsung Electronics Co., Ltd. | Cleaning robot and control method therefor |
| CN106056833A (en) * | 2016-06-23 | 2016-10-26 | 乐视控股（北京）有限公司 | Safety monitoring method, device, system and monitoring system |
| CN107544494A (en) * | 2017-08-17 | 2018-01-05 | 上海美祎科技有限公司 | Sweeping robot and its barrier-avoiding method |
Also Published As
| Publication number | Publication date |
|---|---|
| KR100722762B1 (en) | 2007-05-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP3417755B1 (en) | Autonomous traveling device | |
| EP2677386B1 (en) | Robot cleaner and obstacle detection control method of the same | |
| US10423163B2 (en) | Mobile robot and method of controlling same | |
| KR101822942B1 (en) | Robot cleaner and controlling method of the same | |
| EP3104194B1 (en) | Robot positioning system | |
| US10653282B2 (en) | Cleaning robot | |
| EP3418842A1 (en) | Autonomous travelling body | |
| EP3409177A1 (en) | Moving robot and controlling method thereof | |
| US20060229774A1 (en) | Method, medium, and apparatus for self-propelled mobile unit with obstacle avoidance during wall-following algorithm | |
| KR101555589B1 (en) | Method of controlling a cleaner | |
| SE522383C2 (en) | Mobile robot and course adjustment procedure for the same with a position recognition device that senses base marker in the ceiling. | |
| KR20170065620A (en) | Electrical vacuum cleaner | |
| KR20100098997A (en) | Robot cleaner and method for detecting position thereof | |
| KR20190093800A (en) | a Moving robot and Controlling method for the moving robot | |
| US20200245837A1 (en) | Self-propelled vacuum cleaner | |
| KR20200105916A (en) | Robot vacuum cleaner and its control method | |
| US11625043B2 (en) | Robot cleaner and method for controlling the same | |
| KR100722762B1 (en) | Obstacle shape detecting apparatus of robot cleaner and method therefor | |
| KR20180046175A (en) | Moving Robot and controlling method | |
| KR100825919B1 (en) | Distance measurement sensor, moving robot having the distance measurement sensor and driving method for moving robot using the moving robot | |
| KR100662638B1 (en) | Apparatus for correcting obstacle detection error of robot cleaner and method therefor | |
| CN113841098A (en) | Detecting objects using line arrays | |
| KR20020080900A (en) | Obstacle detecting apparatus of robot cleaner and method therefor | |
| US20210030234A1 (en) | Mobile robot | |
| US20230225580A1 (en) | Robot cleaner and robot cleaner control method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A201 | Request for examination | ||
| E902 | Notification of reason for refusal | ||
| E701 | Decision to grant or registration of patent right | ||
| GRNT | Written decision to grant | ||
| FPAY | Annual fee payment |
Payment date: 20130429 Year of fee payment: 7 |
|
| FPAY | Annual fee payment |
Payment date: 20140429 Year of fee payment: 8 |
|
| FPAY | Annual fee payment |
Payment date: 20150429 Year of fee payment: 9 |
|
| FPAY | Annual fee payment |
Payment date: 20160615 Year of fee payment: 10 |
|
| LAPS | Lapse due to unpaid annual fee |