KR20200119375A - a Moving robot and Controlling method for the moving robot - Google Patents
a Moving robot and Controlling method for the moving robot Download PDFInfo
- Publication number
- KR20200119375A KR20200119375A KR1020190033339A KR20190033339A KR20200119375A KR 20200119375 A KR20200119375 A KR 20200119375A KR 1020190033339 A KR1020190033339 A KR 1020190033339A KR 20190033339 A KR20190033339 A KR 20190033339A KR 20200119375 A KR20200119375 A KR 20200119375A
- Authority
- KR
- South Korea
- Prior art keywords
- mobile robot
- entry angle
- obstacle
- driving motor
- distance
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 43
- 230000002159 abnormal effect Effects 0.000 claims description 21
- 238000013459 approach Methods 0.000 claims description 5
- 238000004140 cleaning Methods 0.000 description 52
- 239000000428 dust Substances 0.000 description 35
- 238000001514 detection method Methods 0.000 description 31
- 238000005516 engineering process Methods 0.000 description 14
- 238000000926 separation method Methods 0.000 description 12
- 238000004891 communication Methods 0.000 description 11
- 230000006870 function Effects 0.000 description 9
- 230000009194 climbing Effects 0.000 description 8
- 230000003287 optical effect Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 238000013528 artificial neural network Methods 0.000 description 6
- 230000008901 benefit Effects 0.000 description 5
- 238000004422 calculation algorithm Methods 0.000 description 5
- 238000010801 machine learning Methods 0.000 description 5
- 238000012545 processing Methods 0.000 description 5
- 230000002093 peripheral effect Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 230000001678 irradiating effect Effects 0.000 description 3
- 230000000903 blocking effect Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000004590 computer program Methods 0.000 description 2
- 238000012790 confirmation Methods 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000013135 deep learning Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000003860 storage Methods 0.000 description 2
- 238000000342 Monte Carlo simulation Methods 0.000 description 1
- 235000004443 Ricinus communis Nutrition 0.000 description 1
- 238000004887 air purification Methods 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000003066 decision tree Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 230000005283 ground state Effects 0.000 description 1
- 238000010438 heat treatment Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 230000001151 other effect Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000002310 reflectometry Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
-
- 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/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
- B25J9/126—Rotary actuators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45098—Vacuum cleaning robot
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Automobile Manufacture Line, Endless Track Vehicle, Trailer (AREA)
- Manipulator (AREA)
Abstract
Description
본 발명은 이동 로봇에 관한 것으로 상세하게는 장애물의 경계 라인에 수직하게 등반할 수 있는 이동 로봇에 관한 것이다.The present invention relates to a mobile robot, and more particularly, to a mobile robot capable of climbing perpendicular to a boundary line of an obstacle.
로봇은 산업용으로 개발되어 공장 자동화의 일 부분을 담당하여 왔다. 최근에는 로봇을 응용한 분야가 더욱 확대되어, 의료용 로봇, 우주 항공 로봇 등이 개발되고, 일반 가정에서 사용할 수 있는 가정용 로봇도 만들어지고 있다. 이러한 로봇 중에서 자력으로 주행이 가능한 것을 이동 로봇이라고 한다. 가정에서 사용되는 이동 로봇의 대표적인 예는 로봇 청소기이다.Robots have been developed for industrial use and have been responsible for part of factory automation. In recent years, the field of application of robots has been further expanded, medical robots, aerospace robots, etc. are being developed, and home robots that can be used in general homes are also being made. Among these robots, those capable of driving by their own force are called mobile robots. A typical example of a mobile robot used at home is a robot vacuum cleaner.
로봇 청소기에 구비된 여러 센서를 통하여 로봇 청소기 주변의 환경 및 사용자를 감지하는 여러 기술들이 알려져 있다. 또한, 로봇 청소기가 스스로 주행 구역을 학습하여 맵핑하고, 맵 상에서 현재 위치를 파악하는 기술들이 알려져 있다. 주행 구역을 기 설정된 방식으로 주행하며 청소하는 로봇 청소기가 알려져 있다.[0003] Various technologies are known for detecting an environment around a robot cleaner and a user through various sensors provided in the robot cleaner. In addition, technologies are known in which a robot cleaner learns and maps a driving area by itself and identifies a current location on a map. A robot vacuum cleaner is known that cleans a driving area while driving in a preset manner.
종래의 로봇 청소기는 청소기의 주변 환경에서 장애물과 벽과의 거리 및 매핑을 위해, 거리판단, 지형 파악 및 장애물의 영상 파악이 용이한 광센서를 통해서 이를 식별해 왔다.Conventional robot cleaners have identified the distance and mapping between obstacles and walls in the surrounding environment of the cleaner through an optical sensor that makes it easy to determine the distance, identify the terrain, and grasp the image of the obstacle.
또한, 종래 기술(한국특허공개번호 10-2014-0138555)에는, 소정의 패턴 광을 조사하고, 상이 광이 조사된 영역의 영상을 획득하여 상기 패턴을 검출하여 청소기의 주변에 장애물의 존재 여부를 식별하였다.In addition, in the prior art (Korean Patent Publication No. 10-2014-0138555), a predetermined pattern light is irradiated, and an image of a region irradiated with a different light is acquired to detect the pattern to determine whether an obstacle exists around the cleaner. Identified.
그러나, 종래 기술에서 매트형 장애물을 식별하지 못하거나, 단순히 장애물을 높이 기준으로 등반여부를 결정하였다. 이에 따라 종래 기술에서는 장애물을 등반 시에 이동 로봇이 장애물의 경계라인과 수직하게 진입하지 않는 경우, 2개의 휠 중 어느 하나가 장애물 위에 위치될 때 다른 하나가 바닥에 위치되어서, 이동 로봇이 장애물 등반 중에 크게 기울어지거나 전복되는 문제가 존재한다.However, in the prior art, it was not possible to identify a mat-type obstacle, or it was simply determined whether to climb the obstacle based on the height. Accordingly, in the prior art, when the mobile robot does not enter perpendicular to the boundary line of the obstacle when climbing an obstacle, the other is located on the floor when one of the two wheels is located on the obstacle, so that the mobile robot climbs the obstacle. There is a problem in which it is greatly inclined or overturned.
또한, 장애물을 등반 시에 이동 로봇이 장애물의 경계라인과 수직하게 진입하지 않는 경우, 장애물을 등반하지 못하거나, 이동 로봇의 본체나 휠이 장애물에 구속되는 문제가 존재한다.In addition, when the mobile robot does not enter perpendicular to the boundary line of the obstacle when climbing the obstacle, there is a problem in that it cannot climb the obstacle or the body or wheel of the mobile robot is constrained by the obstacle.
본 발명이 해결하고자 하는 과제는, 등반 가능한 장애물을 구별하고, 등반 가능한 장애물을 본체가 구속되거나 크게 기울어지지 않고 등반하는 이동로봇을 제공하는 것이다.The problem to be solved by the present invention is to provide a mobile robot that distinguishes climbable obstacles and climbs climbable obstacles without being constrained or greatly inclined.
본 발명이 해결하고자 하는 다른 과제는, 장애물의 경계 라인에 대해 수직으로 진입할 수 있는 이동 로봇을 제공하는 것이다.Another problem to be solved by the present invention is to provide a mobile robot that can enter vertically with respect to the boundary line of an obstacle.
본 발명이 해결하고자 하는 또 다른 과제는, 작은 힘을 이용하여 장애물을 등반할 수 있는 이동 로봇을 제공하는 것이다.Another problem to be solved by the present invention is to provide a mobile robot capable of climbing obstacles using a small force.
상기 과제들을 해결하기 위하여, 본 발명은 본체 주변의 영상을 분석하거나 2개의 거리센서를 사용하여 이동 로봇이 장애물에 대한 진입각도를 조절하는 것이다.In order to solve the above problems, the present invention analyzes an image around a main body or uses two distance sensors to adjust the angle of entry of a mobile robot to an obstacle.
구체적으로, 본 발명은 좌측 휠을 구동시키는 제1 구동모터, 우측 휠을 구동시키는 제2 구동모터; 주변의 영상 및 장애물의 영상을 획득하는 영상획득부; 상기 영상획득부에서 획득한 영상을 분석하여 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 제어부를 포함하고, 상기 제어부는, 상기 영상획득부에서 획득한 영상을 분석하여 상기 장애물에 대한 이동 로봇의 진입각도를 검출하고, 상기 이동 로봇의 진입각도에 따라 상기 장애물을 등반하게 제어하는 것을 특징으로 한다. Specifically, the present invention includes a first driving motor for driving a left wheel and a second driving motor for driving a right wheel; An image acquisition unit for acquiring an image of a surrounding image and an obstacle; And a controller for controlling the first driving motor and the second driving motor by analyzing the image acquired by the image acquisition unit, wherein the controller analyzes the image acquired by the image acquisition unit to move to the obstacle It is characterized in that it detects the angle of entry of the robot and controls to climb the obstacle according to the angle of entry of the mobile robot.
상기 제어부는 상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 장애물을 등반하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어할 수 있다.When the entry angle of the mobile robot is a normal entry angle, the controller may control the first driving motor and the second driving motor so that the mobile robot climbs the obstacle.
상기 제어부는, 상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 되도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 것을 특징으로 한다.The controller may control the first driving motor and the second driving motor so that when the entry angle of the mobile robot is an abnormal entry angle, the entry angle of the mobile robot becomes a normal entry angle.
상기 제어부는, 상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정상속도 보다 낮은 저속으로 구동할 수 있다.The control unit may drive the first driving motor and the second driving motor at a lower speed than a normal speed when detecting the entry angle.
상기 제어부는, 상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정지시킬 수 있다.The controller may stop the first driving motor and the second driving motor when detecting the entry angle.
상기 제어부는, 상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 진입각도를 유지하면서 상기 장애물에 접근하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어할 수 있다.When the entry angle of the mobile robot is a normal entry angle, the controller may control the first driving motor and the second driving motor so that the mobile robot approaches the obstacle while maintaining the entry angle.
상기 제어부는, 상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 제1 구동모터 및 상기 제2 구동모터를 동일한 속도로 정회전되게 제어할 수 있다.The controller may control the first driving motor and the second driving motor to rotate forward at the same speed when the entry angle of the mobile robot is a normal entry angle.
상기 제어부는, 상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 될때 까지 상기 이동 로봇을 회전시키면서 상기 진입각도로를 검출할 수 있다.When the entry angle of the mobile robot is an abnormal entry angle, the controller may detect the entry angle while rotating the mobile robot until the entry angle of the mobile robot becomes a normal entry angle.
상기 제어부는 상기 영상획득부에서 획득한 영상을 분석하여 상기 장애물과 바닥의 경계선을 추출하고, 상기 경계선과 상기 이동 로봇의 진행 방향 사이의 각도를 상기 이동 로봇의 진입각도를 결정할 수 있다.The controller may analyze the image acquired by the image acquisition unit to extract a boundary line between the obstacle and the floor, and determine an angle between the boundary line and the moving direction of the mobile robot to determine an entry angle of the mobile robot.
또한, 본 발명은 좌측 휠을 구동시키는 제1 구동모터, 우측 휠을 구동시키는 제2 구동모터; 장애물과의 제1 거리를 측정하는 제1 거리센서; 상기 장애물과의 제2 거리를 측정하는 제2 거리센서; 및 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 제어부를 포함하고, 상기 제어부는, 상기 제1 거리와 상기 제2 거리를 비교하여 상기 장애물에 대한 이동 로봇의 진입각도를 검출하고, 상기 이동 로봇의 진입각도에 따라 상기 장애물을 등반하게 제어할 수 있다.In addition, the present invention includes a first drive motor for driving a left wheel and a second drive motor for driving a right wheel; A first distance sensor measuring a first distance to an obstacle; A second distance sensor measuring a second distance to the obstacle; And a control unit for controlling the first drive motor and the second drive motor, wherein the control unit detects an entry angle of the mobile robot to the obstacle by comparing the first distance and the second distance, and the It can be controlled to climb the obstacle according to the entry angle of the mobile robot.
상기 제1 거리센서 및 상기 제2 거리센서는 상기 좌측 휠과 상기 우측 휠을 연결한 선과 나란한 선 상에서 서로 이격하여 배치될 수 있다.The first distance sensor and the second distance sensor may be disposed to be spaced apart from each other on a line parallel to a line connecting the left wheel and the right wheel.
상기 제어부는 상기 장애물과의 제1 거리센서 사이에 제1 거리와 상기 장애물과 제2 거리센서 사이의 제2 거리를 추출하고, 상기 제1 거리와 상기 제2 거리의 차이 값을 바탕으로 상기 이동 로봇의 진입각도를 결정할 수 있다.The control unit extracts a first distance between a first distance sensor and a second distance sensor and a second distance between the obstacle and the second distance sensor, and moves the movement based on a difference value between the first distance and the second distance. The angle of entry of the robot can be determined.
상기 제어부는 상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 장애물을 등반하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어할 수 있다.When the entry angle of the mobile robot is a normal entry angle, the controller may control the first driving motor and the second driving motor so that the mobile robot climbs the obstacle.
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 되도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어할 수 있다.When the entry angle of the mobile robot is an abnormal entry angle, the first driving motor and the second driving motor may be controlled so that the entry angle of the mobile robot becomes a normal entry angle.
상기 제어부는, 상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 진입각도를 유지하며 상기 장애물에 접근하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어할 수 있다.When the entry angle of the mobile robot is a normal entry angle, the controller may control the first driving motor and the second driving motor so that the mobile robot maintains the entry angle and approaches the obstacle.
상기 제어부는, 상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 제1 구동모터 및 상기 제2 구동모터를 동일한 속도로 정회전되게 제어할 수 있다.The controller may control the first driving motor and the second driving motor to rotate forward at the same speed when the entry angle of the mobile robot is a normal entry angle.
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 될때 까지 상기 이동 로봇을 회전시키면서 상기 진입각도로를 검출할 수 있다.When the entry angle of the mobile robot is an abnormal entry angle, the entry angle may be detected while rotating the mobile robot until the entry angle of the mobile robot becomes a normal entry angle.
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 제1 거리와 상기 제2 거리 중 짧은 거리를 판단하고, 짧은 거리를 측정한 거리 센서가 위치하는 방향으로 상기 이동 로봇의 초기 회전을 시작할 수 있다.When the entry angle of the mobile robot is an abnormal entry angle, a shorter distance is determined among the first distance and the second distance, and the initial rotation of the mobile robot starts in the direction in which the distance sensor measuring the short distance is located. I can.
본 발명의 이동 로봇에 따르면 다음과 같은 효과가 하나 혹은 그 이상 있다.According to the mobile robot of the present invention, one or more of the following effects are provided.
첫째, 본 발명은 이동 로봇이 장애물에 수직하게 진입하므로, 장애물을 비스듬히 등반하여 생기는 본체의 구속을 방지할 수 있고, 샤시 등반 시에 휠이 레일에 구속되는 것을 방지하는 이점이 존재한다.First, in the present invention, since the mobile robot enters the obstacle vertically, it is possible to prevent the body from being constrained by climbing the obstacle at an angle, and there is an advantage of preventing the wheel from being constrained by the rail when climbing the chassis.
둘째, 본 발명은 이동 로봇이 장애물에 수직하게 진입하므로, 적은 힘으로 장애물을 쉽게 등반할 수 있고, 작은 모터를 사용하여서 제조비용을 줄이는 이점이 존재한다.Second, according to the present invention, since the mobile robot enters the obstacle vertically, it is possible to easily climb the obstacle with a small force, and there is an advantage of reducing the manufacturing cost by using a small motor.
셋째, 본 발명은 로봇 청소기에 원래 장착되는 카메라 또는 거리센서를 통해 진입각도를 판단하므로, 센서의 추가 없이 장애물의 진입각도를 파악할 수 있는 이점이 존재한다.Third, in the present invention, since the angle of entry is determined through a camera or a distance sensor originally installed in the robot cleaner, there is an advantage of being able to determine the entry angle of an obstacle without adding a sensor.
넷째, 이동 로봇이 등반 불가능한 장애물을 회피 기동하고, 등반 불가능한 장애물을 제외한 영역을 먼저 청소하므로, 빠른 청소가 가능한 이점이 존재한다.Fourth, since the mobile robot maneuvers to avoid obstacles that cannot be climbed and cleans the area excluding the obstacles that cannot be climbed first, there is an advantage of enabling rapid cleaning.
본 발명의 효과들은 이상에서 언급한 효과들로 제한되지 않으며, 언급되지 않은 또 다른 효과들은 청구범위의 기재로부터 당업자에게 명확하게 이해될 수 있을 것이다.The effects of the present invention are not limited to the effects mentioned above, and other effects that are not mentioned will be clearly understood by those skilled in the art from the description of the claims.
도 1은 본 발명에 따른 로봇 청소기의 일 예를 보인 사시도이다.
도 2는 도 1에 도시된 로봇 청소기의 평면도이다.
도 3은 도 1에 도시된 로봇 청소기의 측면도이다.
도 4는 본 발명의 일 실시예에 따른 로봇 청소기의 예시 구성요소를 나타내는 블록도이다.
도 5는 본 발명에 따른 제1 실시예에 따른 로봇 청소기가 진입각도를 연산하고 진입각도를 정상 진입각도로 변경하는 것을 도시한 도면이다.
도 6은 본 발명에 따른 제2 실시예에 따른 로봇 청소기가 진입각도를 연산하고 진입각도를 정상 진입각도로 변경하는 것을 도시한 도면이다.
도 7은 본 발명의 일 실시예에 따른 로봇 청소기의 제어방법을 설명하기 위한 순서도이다.
도 8은 본 발명의 일 실시예에 따른 로봇 청소기의 회피판단 방법을 설명하기 위한 순서도이다.1 is a perspective view showing an example of a robot cleaner according to the present invention.
2 is a plan view of the robot cleaner shown in FIG. 1.
3 is a side view of the robot cleaner illustrated in FIG. 1.
4 is a block diagram showing exemplary components of a robot cleaner according to an embodiment of the present invention.
5 is a diagram illustrating that the robot cleaner according to the first embodiment of the present invention calculates an entry angle and changes the entry angle to a normal entry angle.
6 is a diagram illustrating that the robot cleaner according to the second embodiment of the present invention calculates an entry angle and changes the entry angle to a normal entry angle.
7 is a flowchart illustrating a method of controlling a robot cleaner according to an embodiment of the present invention.
8 is a flowchart illustrating a method of determining avoidance of a robot cleaner according to an embodiment of the present invention.
본 발명의 이점 및 특징, 그리고 그것들을 달성하는 방법은 첨부되는 도면과 함께 상세하게 후술되어 있는 실시예들을 참조하면 명확해질 것이다. 그러나 본 발명은 이하에서 개시되는 실시예들에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 수 있으며, 단지 본 실시예들은 본 발명의 개시가 완전하도록 하고, 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에게 발명의 범주를 완전하게 알려주기 위해 제공되는 것이며, 본 발명은 청구항의 범주에 의해 정의될 뿐이다. 명세서 전체에 걸쳐 동일 참조 부호는 동일 구성 요소를 지칭한다.Advantages and features of the present invention, and a method of achieving them will become apparent with reference to the embodiments described below in detail together with the accompanying drawings. However, the present invention is not limited to the embodiments disclosed below, but may be implemented in a variety of different forms, and only these embodiments make the disclosure of the present invention complete, and are common knowledge in the technical field to which the present invention pertains. It is provided to completely inform the scope of the invention to those who have, and the invention is only defined by the scope of the claims. The same reference numerals refer to the same components throughout the specification.
공간적으로 상대적인 용어인 "아래(below)", "아래(beneath)", "하부(lower)", "위(above)", "상부(upper)" 등은 도면에 도시되어 있는 바와 같이 하나의 구성 요소들과 다른 구성 요소들과의 상관관계를 용이하게 기술하기 위해 사용될 수 있다. 공간적으로 상대적인 용어는 도면에 도시되어 있는 방향에 더하여 사용시 또는 동작 시 구성요소의 서로 다른 방향을 포함하는 용어로 이해되어야 한다. 예를 들면, 도면에 도시되어 있는 구성요소를 뒤집을 경우, 다른 구성요소의 "아래(below)"또는 "아래(beneath)"로 기술된 구성요소는 다른 구성요소의 "위(above)"에 놓여질 수 있다. 따라서, 예시적인 용어인 "아래"는 아래와 위의 방향을 모두 포함할 수 있다. 구성요소는 다른 방향으로도 배향될 수 있고, 이에 따라 공간적으로 상대적인 용어들은 배향에 따라 해석될 수 있다.Spatially relative terms "below", "beneath", "lower", "above", "upper", etc., as shown in the figure It can be used to easily describe the correlation between components and other components. Spatially relative terms should be understood as terms including different directions of components during use or operation in addition to the directions shown in the drawings. For example, if a component shown in a drawing is turned over, a component described as "below" or "beneath" of another component will be placed "above" the other component. I can. Accordingly, the exemplary term “below” may include both directions below and above. Components may be oriented in other directions, and thus spatially relative terms may be interpreted according to the orientation.
본 명세서에서 사용된 용어는 실시예들을 설명하기 위한 것이며 본 발명을 제한하고자 하는 것은 아니다. 본 명세서에서, 단수형은 문구에서 특별히 언급하지 않는 한 복수형도 포함한다. 명세서에서 사용되는 "포함한다(comprises)" 및/또는 "포함하는(comprising)"은 언급된 구성요소, 단계 및/또는 동작은 하나 이상의 다른 구성요소, 단계 및/또는 동작의 존재 또는 추가를 배제하지 않는다.The terms used in the present specification are for describing exemplary embodiments and are not intended to limit the present invention. In this specification, the singular form also includes the plural form unless specifically stated in the phrase. As used herein, “comprises” and/or “comprising” refers to the recited elements, steps and/or actions excluding the presence or addition of one or more other elements, steps and/or actions. I never do that.
다른 정의가 없다면, 본 명세서에서 사용되는 모든 용어(기술 및 과학적 용어를 포함)는 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에게 공통적으로 이해될 수 있는 의미로 사용될 수 있을 것이다. 또 일반적으로 사용되는 사전에 정의되어 있는 용어들은 명백하게 특별히 정의되어 있지 않은 한 이상적으로 또는 과도하게 해석되지 않는다.Unless otherwise defined, all terms (including technical and scientific terms) used in the present specification may be used as meanings that can be commonly understood by those of ordinary skill in the art to which the present invention belongs. In addition, terms defined in a commonly used dictionary are not interpreted ideally or excessively unless explicitly defined specifically.
본 발명인 이동 로봇(100)은 바퀴 등을 이용하여 스스로 이동이 가능한 로봇을 의미하고, 가정 도우미 로봇 및 로봇 청소기 등이 될 수 있다.The
이하, 본 발명에 관련된 로봇 청소기에 대하여 도면을 참조하여 보다 상세하게 설명한다.Hereinafter, a robot cleaner according to the present invention will be described in more detail with reference to the drawings.
첨부된 도면을 참조하여 본 명세서에 개시된 실시 예를 상세히 설명하되, 본 명세서에서 사용되는 기술적 용어는 단지 특정한 실시 예를 설명하기 위해 사용된 것으로, 본 명세서에 개시된 기술의 사상을 한정하려는 의도가 아님을 유의해야 한다.The embodiments disclosed in the present specification will be described in detail with reference to the accompanying drawings, but the technical terms used in the present specification are used only to describe specific embodiments, and are not intended to limit the spirit of the technology disclosed in the present specification. It should be noted.
본 발명에 따른 이동로봇(100)의 일 예를 보인 사시도이고, 도 2는 도 1에 도시된 이동로봇(100)의 평면도이며, 도 3은 도 1에 도시된 로봇 청소기(100)의 측면도이다.A perspective view showing an example of a
본 명세서에서 이동 로봇, 이동로봇 및 자율 주행을 수행하는 청소기가 동일한 의미로 사용될 수 있다. 또한, 본 명세서에서 복수의 청소기는 이하 도 1 내지 도 3에 도시된 구성 중 적어도 일부를 포함하여 이루어질 수 있다.In the present specification, a mobile robot, a mobile robot, and a vacuum cleaner that performs autonomous driving may be used interchangeably. In addition, in the present specification, the plurality of cleaners may include at least some of the components illustrated in FIGS. 1 to 3 below.
도 1 내지 도 3을 참조하면, 로봇 청소기(100)는 일정 영역을 스스로 주행하면서 바닥을 청소하는 기능을 수행한다. 여기서 말하는 바닥의 청소에는, 바닥의 먼지(이물질을 포함한다)를 흡입하거나 바닥을 걸레질하는 것이 포함된다.1 to 3, the
로봇 청소기(100)는 청소기 본체(110), 청소 유닛(120), 센싱유닛(130) 및 먼지통(140)을 포함할 수 있다. 청소기 본체(110)에는 로봇 청소기(100)의 제어를 위한 제어부(1800)를 포함하여 각종 부품들이 내장 또는 장착된다. 또한, 청소기 본체(110)에는 로봇 청소기(100)의 주행을 위한 휠 유닛(111)이 구비된다. 휠 유닛(111)에 의해 로봇 청소기(100)는 전후좌우로 이동되거나 회전될 수 있다.The
다른 일 실시예의 로봇 청소기(100)는 제1 구동모터(1310), 제2 구동모터(1320), 영상획득부, 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어하는 제어부(1800)를 포함할 수 있다.The
또 다른 실시예의 로봇 청소기(100)는 제1 구동모터(1310), 제2 구동모터(1320), 제1거리센서(1410a) 및 제2거리(F2)센서(1410b), 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어하는 제어부(1800)를 포함할 수 있다.In another embodiment, the
도 3을 참조하면, 휠 유닛(111)은 메인 휠(111a, 111b) 및 서브 휠(111c)을 포함한다. 물론, 휠 유닛(111)은 서브 휠(111c)이 생략되고 메인 휠(111a, 111b)만 구비될 수 있다.Referring to FIG. 3, the
메인 휠(111a, 111b)은 청소기 본체(110)의 양측에 각각 구비되는 좌측 휠(111a)과 우측 휠(111b)을 포함할 수 있다. 메인 휠(111a, 111b)은 제어부(1800)의 제어 신호에 따라 일 방향 또는 타 방향으로 회전 가능하게 구성된다. The
각각의 좌측 휠(111a)과 우측 휠(111b)은 서로 독립적으로 구동 가능하게 구성될 수 있다. 예를 들어, 좌측 휠(111a)과 우측 휠(111b)은 서로 다른 모터에 의해서 구동될 수 있다. 또는, 하나의 모터에 구비된 복수의 서로 다른 축에 의해서 구동될 수 있다. 예를 들면, 좌측 휠(111a)은 제1 구동모터(1310)에 의해 구동되고, 우측 휠(111b)은 제2 구동모터(1320)에 의해 구동될 수 있다.Each of the
좌측 휠(111a)과 우측 휠(111b)의 회전축(A1)을 중심으로 회전하는 데, 좌측 휠(111a)의 회전축과 우측 휠(111b)의 회전축은 서로 일치될 수 있다.The rotation axis A1 of the
서브 휠(111c)은 메인 휠(111a, 111b)과 함께 청소기 본체(110)를 지지하며, 메인 휠(111a, 111b)에 의한 로봇 청소기(100)의 주행을 보조하도록 이루어진다. 이러한 서브 휠(111c)은 후술하는 청소 유닛(120)에도 구비될 수 있다.The sub-wheel 111c supports the
제어부(1800)는 휠 유닛(111)의 구동을 제어함으로써, 로봇 청소기(100)는 바닥을 자율 주행하도록 이루어진다.The
한편, 청소기 본체(110)에는 로봇 청소기(100)에 전원을 공급하는 배터리(미도시)가 장착된다. 배터리는 충전 가능하게 구성되며, 청소기 본체(110)의 저면부에 착탈 가능하게 구성될 수 있다.Meanwhile, a battery (not shown) that supplies power to the
도 1에서, 청소 유닛(120)은 청소기 본체(110)의 일측으로부터 돌출된 형태로 배치되어, 먼지가 포함된 공기를 흡입하거나 또는 걸레질을 할 수 있다. 일측은 청소기 본체(110)가 정방향(F)으로 주행하는 측, 즉 청소기 본체(110)의 앞쪽이 될 수 있다.In FIG. 1, the
본 도면에서는, 청소 유닛(120)이 청소기 본체(110)의 일측에서 전방 및 좌우 양측방으로 모두 돌출된 형태를 가지는 것을 보이고 있다. 구체적으로, 청소 유닛(120)의 전단부는 청소기 본체(110)의 일측으로부터 전방으로 이격된 위치에 배치되고, 청소 유닛(120)의 좌우 양단부는 청소기 본체(110)의 일측으로부터 좌우 양측으로 각각 이격된 위치에 배치된다.In this drawing, it is shown that the
제1거리센서(1410a) 장애물(CA)과의 제1거리(F1)를 측정하고, 제2거리(F2)센서(1410b)는 장애물(CA)과의 제2거리(F2)를 측정한다. 구체적으로, 제1거리센서(1410a) 및 제2거리(F2)센서(1410b)는 청소기 본체(110)의 전방에 위치된 장애물(CA)과의 거리를 측정한다. 더욱 구체적으로, 제1거리센서(1410a) 및 제2거리(F2)센서(1410b)는 어느 하나가 다른 하나 보다 전방 또는 후방으로 배치될 수 있다. 이때, 후술하는 이동 로봇의 진입각도(θA)를 산정하는 데는, 제1거리센서(1410a)와 제2거리(F2)센서(1410b)의 위치가 고려된다. 제1거리센서(1410a) 및 제2거리(F2)센서(1410b)는 휠의 회전축(A1)과 수직한 전방(F)에 위치된 장애물(CA)(장애물(CA)의 일점)의 거리를 측정한다.The
다른 예로, 제1거리센서(1410a)와 제2거리(F2)센서(1410b)는 전후방 방향과 수직인 수평방향으로 서로 이격되어 배치될 수 있다. 즉, 제1거리센서(1410a) 및 제2거리(F2)센서(1410b)는 좌측 휠(111a)과 우측 휠(111b)을 연결한 선(A1)과 나란한 선(A2) 상에서 서로 이격하여 배치될 수 있다. 더욱 구체적으로, 제1거리센서(1410a)와 제2거리(F2)센서(1410b)는 청소 유닛(120)의 전방에 배치될 수 있다. 제1거리센서(1410a)는 제2거리센서(1410b) 보다 상대적으로 좌측에 배치될 수 있다.As another example, the
일 예로, 제1거리센서(1410a) 및 제2거리(F2)센서(1410b)는 적외선 센서, 초음파 센서, RF 센서, 지자기 센서 등일 수 있고, 이동 로봇은 전방 감지 센서로 한 가지 종류의 센서를 사용하거나 필요에 따라 두 가지 종류 이상의 센서를 함께 사용할 수 있다. 바람직하게는, 제1거리센서(1410a) 및 제2거리(F2)센서(1410b)는 적외선 센서이거나, 제1거리센서(1410a) 및 제2거리(F2)센서(1410b)는 전방(F)과 나란한 방향으로 적외선을 방출하고, 반사된 적외선을 수신하는 적외선 센서일 수 있다.As an example, the
청소기 본체(110)가 원형으로 형성되고, 청소 유닛(120)의 후단부 양측이 청소기 본체(110)로부터 좌우 양측으로 각각 돌출 형성됨에 따라, 청소기 본체(110)와 청소 유닛(120) 사이에는 빈 공간, 즉 틈이 형성될 수 있다. 빈 공간은 청소기 본체(110)의 좌우 양단부와 청소 유닛(120)의 좌우 양단부 사이의 공간으로서, 로봇 청소기(100)의 내측으로 리세스된 형태를 가진다.As the
상술한 빈 공간에 장애물(CA)이 끼이는 경우, 로봇 청소기(100)가 장애물(CA)에 걸려 움직이지 못하는 문제가 초래될 수 있다. 이를 방지하기 위하여, 커버 부재(129)가 빈 공간의 적어도 일부를 덮도록 배치될 수 있다.When the obstacle CA is caught in the above-described empty space, a problem in which the
커버부재(129)는 청소기 본체(110) 또는 청소 유닛(120)에 구비될수 있다. 본 실시예에서는, 청소 유닛(120)의 후단부 양측에 각각 커버부재(129)가 돌출 형성되어, 청소기 본체(110)의 외주면을 덮도록 배치된 것을 보이고 있다.The
커버부재(129)는 빈 공간, 즉 청소기 본체(110)와 청소 유닛(120) 간의 빈 공간의 적어도 일부를 메우도록 배치된다. 따라서, 빈 공간에 장애물(CA)이 끼이는 것이 방지되거나, 빈 공간에 장애물(CA)이 끼이더라도 장애물(CA)로 부터 용이하게 이탈 가능한 구조가 구현될 수 있다.The
청소 유닛(120)에서 돌출 형성된 커버부재(129)는 청소기 본체(110)의 외주면에 지지될 수 있다. 만일, 커버부재(129)가 청소기 본체(110)에서 돌출 형성되는 경우라면, 커버부재(129)는 청소 유닛(120)의 후면부에 지지될 수 있다. 구조에 따 르면, 청소 유닛(120)이 장애물(CA)과 부딪혀 충격을 받았을 때, 그 충격의 일부가 청소기 본체(110)로 전달되어 충격이 분산될 수 있다.The
청소 유닛(120)은 청소기 본체(110)에 착탈 가능하게 결합될 수 있다. 청소 유닛(120)이 청소기 본체(110)로 분리되면, 분리된 청소 유닛(120)을 대체하여 걸레 모듈(미도시)이 청소기 본체(110)에 착탈 가능하게 결합될 수 있다.The
따라서, 사용자는 바닥의 먼지를 제거하고자 하는 경우에는 청소기 본체(110)에 청소 유닛(120)을 장착하고, 바닥을 닦고자 하는 경우에는 청소기 본체(110)에 걸레 모듈을 장착할 수 있다.Accordingly, the user may mount the
청소 유닛(120)이 청소기 본체(110)에 장착시, 상술한 커버부재(129)에 의해 장착이 가이드될 수 있다. 즉, 커버부재(129)가 청소기 본체(110)의 외주면을 덮도록 배치됨으로써, 청소기 본체(110)에 대한 청소 유닛(120)의 상대적 위치가 결정될 수 있다.When the
청소 유닛(120)에는 캐스터(castor, 123)가 구비될 수 있다. 캐스터(123)는 로봇 청소기(100)의 주행을 보조하고, 또한 로봇 청소기(100)를 지지하도록 이루어진다. 청소기 본체(110)에는 센싱 유닛(130)이 배치된다. 도시된 바와 같이, 센싱 유닛(130)은 청소 유닛(120)이 위치하는 청소기 본체(110)의 일측, 즉 청소기 본체(110)의 앞쪽에 배치될 수 있다.The
센싱 유닛(130)은 청소기 본체(110)의 상하 방향으로 청소 유닛(120)과 오버랩되도록 배치될 수 있다. 센싱 유닛(130)은 청소 유닛(120)의 상부에 배치되어, 로봇 청소기(100)의 가장 앞쪽에 위치하는 청소 유닛(120)이 장애물(CA)과 부딪히지 않도록 전방의 장애물(CA)이나 지형지물 등을 감지하도록 이루어진다.The
센싱 유닛(130)은 이러한 감지 기능 외의 다른 센싱 기능을 추가로 수행하도록 구성될 수 있다. 예로써, 센싱 유닛(130)은 주변의 영상을 획득하기 위한 카메라(미도시)를 포함할 수 있다. 카메라(131)는 렌즈와 영상 센서(image sensor)를 포함할 수 있다. 또한, 카메라는 청소기 본체(110) 주변의 영상을 제어부(1800)가 처리할수 있는 전기적 신호로 변환하며, 예를 들어 상방 영상에 대응되는 전기적 신호를 제어부(1800)에 전달할 수 있다. 상방 영상에 대응되는 전기적 신호는 제어부(1800)가 청소기 본체(110)의 위치를 검출하는데 사용될 수 있다.The
물론, 센싱 유닛(130)은 영상획득부를 포함할 수 있다. 영상 획득부는 주변의 영상 및 본체와 장애물(CA)과의 원근거리를 획득하는 3차원 뎁스 카메라를 포함할 수 있다. 3차원 뎁스 카메라에 대해서는 후술한다.Of course, the
또한, 센싱 유닛(130)은 로봇 청소기(100)의 주행 면상 또는 주행 경로 상의 벽체, 가구, 및 낭떠러지 등의 장애물(CA)을 감지할 수 있다. 또한, 센싱 유닛(130)은 배터리 충전을 수행하는 도킹 기기의 존재를 감지할 수 있다. 또한, 센싱 유닛(130)은 천장 정보를 감지하여서, 로봇 청소기(100)의 주행 구역 또는 청소 구역을 맵핑(Mapping)할 수 있다.In addition, the
청소기 본체(110)에는 흡입된 공기 중의 먼지를 분리하여 집진하는 먼지통(140)이 착탈 가능하게 결합된다. 또한, 먼지통(140)에는 먼지통(140)을 덮는 먼지통 덮개(150)가 구비된다. 일 실시예로, 먼지통 덮개(150)는 청소기 본체(110)에 힌지 결합되어 회동 가능하게 구성될 수 있다. 먼지통 덮개(150)는 먼지통(140) 또는 청소기 본체(110)에 고정되어 먼지통(140)의 상면을 덮은 상태를 유지할 수 있다. 먼지통 덮개(150)가 먼지통(140)의 상면을 덮도록 배치된 상태에서는, 먼지통 덮개(150)에 의해 먼지통(140)이 청소기 본체(110)로부터 분리되는 것이 방지될 수 있다.A
먼지통(140)의 일부는 먼지통 수용부(113)에 수용되되, 먼지통(140)의 다른 일부는 청소기 본체(110)의 후방(즉, 정방향(F)에 반대되는 역방향(R))을 향하여 돌출되게 형성될 수 있다.A part of the
먼지통(140)에는 먼지가 포함된 공기가 유입되는 입구와 먼지가 분리된 공기가 배출되는 출구가 형성되며, 청소기 본체(110)에 먼지통(140)의 장착시 입구와 출구는 본체(110)의 내측벽에 형성된 개구(155)를 통해 연통되도록 구성된다. 이에 의하여, 청소기 본체(110) 내부의 흡기유로와 배기유로가 형성될 수 있다.In the
이러한 연결관계에 따라, 청소 유닛(120)을 통하여 유입된 먼지가 포함된 공기는 청소기 본체(110) 내부의 흡기유로를 거쳐, 먼지통(140)으로 유입되고, 먼지통(140)의 필터 내지는 사이클론을 거치면서 공기와 먼지가 상호 분리된다. 먼지는 먼지통(140)에 집진되며, 공기는 먼지통(140)에서 배출된 후 청소기 본체(110) 내부의 배기유로를 거쳐 최종적으로 배기구(112)를 통하여 외부로 배출된다.According to this connection relationship, the air containing dust introduced through the
이하의 도 4에서는 로봇 청소기(100)의 구성요소와 관련된 일 실시예가 설명된다.In FIG. 4 below, an embodiment related to the components of the
본 발명의 일 실시 예에 따른 로봇 청소기(100)는, 통신부(1100), 입력부(1200), 주행부(1300), 센싱부(1400), 출력부(1500), 전원부(1600), 메모리(1700), 제어부(1800), 청소부(1900) 중 적어도 하나 또는 이들의 조합을 포함할 수 있다.The
구?b적으로, 본 발명의 제1 실시예의 로봇 청소기(100)는 주행부(1300), 영상획득부, 제어부(1800)를 포함할 수 있다.Concretely, the
이때, 도 4에 도시한 구성요소들이 필수적인 것은 아니어서, 그보다 많은 구성요소들을 갖거나 그보다 적은 구성요소들을 갖는 이동로봇이 구현될 수 있음은 물론이다. 또한, 전술한 바와 같이, 본 발명에서 설명되는 복수의 로봇 청소기는 이하에서 설명된 구성요소들 중 일부만 동일한 구성요소를 포함할 수 있다. 즉, 복수의 이동로봇이 각각 서로 다른 구성요소로 이루어질 수 있다.At this time, since the components shown in FIG. 4 are not essential, it goes without saying that a mobile robot having more components or fewer components can be implemented. Further, as described above, the plurality of robot cleaners described in the present invention may include only some of the same components among the components described below. That is, a plurality of mobile robots may each be formed of different components.
이하, 각 구성요소들에 대해 살펴보기로 한다. 우선, 전원부(1600)는 외부 상용 전원에 의해 충전 가능한 배터리를 구비하여 이동 로봇 내로 전원을 공급한다. 전원부(1600)는 이동 로봇에 포함된 각 구성들에 구동 전원을 공급하여, 이동 로봇이 주행하거나 특정 기능을 수행하는데 요구되는 동작 전원을 공급할 수 있다.Hereinafter, each component will be described. First, the
이때, 제어부(1800)는 배터리의 전원 잔량을 감지하고, 전원 잔량이 부족하면 외부 상용 전원과 연결된 충전대로 이동하도록 제어하여, 충전대로부터 충전 전류를 공급받아 배터리를 충전할 수 있다. 배터리는 배터리 감지부와 연결되어 배터리 잔량 및 충전 상태가 제어부(1800)에 전달될 수 있다. 출력부(1500)은 제어부(1800)에 의해 배터리 잔량을 출력부(1500)에 표시할 수 있다.In this case, the
배터리는 이동로봇 중앙의 하부에 위치할 수도 있고, 좌, 우측 중 어느 한쪽에 위치할 수도 있다. 후자의 경우, 이동 로봇은 배터리의 무게 편중을 해소하기 위해 균형추를 더 구비할 수 있다.The battery may be located at the bottom of the center of the mobile robot, or it may be located on either the left or the right. In the latter case, the mobile robot may further include a counterweight to relieve the weight of the battery.
한편, 주행부(1300)는 모터를 구비하여, 모터를 구동함으로써, 좌, 우측 주바퀴를 양 방향으로 회전시켜 본체를 회전 또는 이동시킬 수 있다. 이때, 좌, 우측 주바퀴는 독립적으로 움직일 수 있다. 주행부(1300)는 이동 로봇의 본체를 전후좌우로 진행시키거나, 곡선주행시키거나, 제자리 회전시킬 수 있다.Meanwhile, the
한편, 입력부(1200)는 사용자로부터 이동로봇에 대한 각종 제어 명령을 입력받는다. 입력부(1200)는 하나 이상의 버튼을 포함할 수 있고, 예를 들어, 입력부(1200)는 확인버튼, 설정버튼 등을 포함할 수 있다. 확인버튼은 감지 정보, 장애물(CA) 정보, 위치 정보, 맵 정보를 확인하는 명령을 사용자로부터 입력 받기 위한 버튼이고, 설정버튼은 정보들을 설정하는 명령을 사용자로부터 입력받기 위한 버튼이다.Meanwhile, the
또한, 입력부(1200)는 이전 사용자 입력을 취소하고 다시 사용자 입력을 받기 위한 입력재설정버튼, 기 설정된 사용자 입력을 삭제하기 위한 삭제버튼, 작동 모드를 설정하거나 변경하는 버튼, 충전대로 복귀하도록 하는 명령을 입력받는 버튼 등을 포함할 수 있다.In addition, the
또한, 입력부(1200)는 하드 키나 소프트 키, 터치패드 등으로 이동로봇의 상부에 설치될 수 있다. 또, 입력부(1200)는 출력부(1500)와 함께 터치 스크린의 형태를 가질 수 있다.In addition, the
한편, 출력부(1500)는, 이동 로봇의 상부에 설치될 수 있다. 물론 설치 위치나 설치 형태는 달라질 수 있다. 예를 들어, 출력부(1500)는 배터리 상태 또는 주행 방식 등을 화면에 표시할 수 있다.Meanwhile, the
또한, 출력부(1500)는, 센싱부(1400)가 검출한 이동 로봇 내부의 상태 정보, 예를 들어 이동 로봇에 포함된 각 구성들의 현재 상태를 출력할 수 있다. 또, 출력부(1500)는 센싱부(1400)가 검출한 외부의 상태 정보, 장애물(CA) 정보, 위치 정보, 지도 정보 등을 화면에 디스플레이할 수 있다. In addition, the
출력부(1500)는 발광 다이오드(Light Emitting Diode; LED), 액정 표시 장치(Liquid Crystal Display; LCD), 플라즈마 표시 패널(Plasma Display Panel), 유기 발광 다이오드(Organic Light Emitting Diode; OLED) 중 어느 하나의 소자로 형성될 수 있다.The
출력부(1500)는, 제어부(1800)에 의해 수행되는 이동 로봇의 동작 과정 또는 동작 결과를 청각적으로 출력하는 음향 출력 수단을 더 포함할 수 있다. 예를 들어, 출력부(1500)는 제어부(1800)에 의해 생성된 경고 신호에 따라 외부에 경고음을 출력할 수 있다.The
이때, 음향 출력 수단(미도시)은 비퍼(beeper), 스피커 등의 음향을 출력하는 수단일 수 있고, 출력부(1500)는 메모리(1700)에 저장된 소정의 패턴을 가진 오디오 데이터 또는 메시지 데이터 등을 이용하여 음향 출력 수단을 통해 외부로 출력할 수 있다.At this time, the sound output means (not shown) may be a means for outputting sound such as a beeper or a speaker, and the
따라서, 본 발명의 일 실시예에 따른 이동 로봇은, 출력부(1500)를 통해 주행 영역에 대한 환경 정보를 화면에 출력하거나 음향으로 출력할 수 있다. 또 다른 실시예에 따라, 이동 로봇은 출력부(1500)를 통해 출력할 화면이나 음향을 단말 장치가 출력하도록, 지도 정보 또는 환경 정보를 통신부(1100)릍 통해 단말 장치에 전송할 수 있다.Accordingly, the mobile robot according to an exemplary embodiment of the present invention may output environmental information on a driving area on a screen through the
메모리(1700)는 이동로봇을 제어 또는 구동하는 제어 프로그램 및 그에 따른 데이터를 저장한다. 메모리(1700)는 오디오 정보, 영상 정보, 장애물(CA) 정보, 위치 정보, 지도 정보 등을 저장할 수 있다. 또, 메모리(1700)는 주행 패턴과 관련된 정보를 저장할 수 있다.The
메모리(1700)는 비휘발성 메모리를 주로 사용한다. 여기서, 비휘발성 메모리(Non-Volatile Memory, NVM, NVRAM)는 전원이 공급되지 않아도 저장된 정보를 계속 유지할 수 있는 저장 장치로서, 일 예로, 롬(ROM), 플래시 메모리(Flash Memory), 마그네틱 컴퓨터 기억 장치(예를 들어, 하드 디스크, 디스켓 드라이브, 마그네틱 테이프), 광디스크 드라이브, 마그네틱 RAM, PRAM 등일 수 있다.The
한편, 센싱부(1400)는, 외부 신호 감지 센서, 전방 감지 센서, 낭떠러지 감지 센서, 2차원 카메라 센서 및 3차원 카메라 센서 중 적어도 하나를 포함할 수 있다.Meanwhile, the
외부 신호 감지 센서는 이동 로봇의 외부 신호를 감지할 수 있다. 외부 신호 감지 센서는, 일 예로, 적외선 센서(Infrared Ray Sensor), 초음파 센서(Ultra Sonic Sensor), RF 센서(Radio Frequency Sensor) 등일 수 있다.The external signal detection sensor may detect an external signal of the mobile robot. The external signal detection sensor may be, for example, an infrared ray sensor, an ultra sonic sensor, or a radio frequency sensor.
이동 로봇은 외부 신호 감지 센서를 이용하여 충전대가 발생하는 안내 신호를 수신하여 충전대의 위치 및 방향을 확인할 수 있다. 이때, 충전대는 이동 로봇이 복귀 가능하도록 방향 및 거리를 지시하는 안내 신호를 발신할 수 있다. 즉, 이동 로봇은 충전대로부터 발신되는 신호를 수신하여 현재의 위치를 판단하고 이동 방향을 설정하여 충전대로 복귀할 수 있다.The mobile robot can check the location and direction of the charging station by receiving a guide signal generated by the charging station using an external signal detection sensor. At this time, the charging station may transmit a guide signal indicating a direction and a distance so that the mobile robot can return. That is, the mobile robot may receive a signal transmitted from the charging station, determine a current position, set a moving direction, and return to the charging station.
한편, 전방 감지 센서는, 이동 로봇의 전방, 구체적으로 이동 로봇의 측면 외주면을 따라 일정 간격으로 설치될 수 있다. 전방 감지 센서는 이동 로봇의 적어도 일 측면에 위치하여, 전방의 장애물(CA)을 감지하기 위한 것으로서, 전방 감지 센서는 이동 로봇의 이동 방향에 존재하는 물체, 특히 장애물(CA)을 감지하여 검출 정보를 제어부(1800)에 전달할 수 있다. 즉, 전방 감지 센서는, 이동 로봇의 이동 경로 상에 존재하는 돌출물, 집안의 집기, 가구, 벽면, 벽 모서리 등을 감지하여 그 정보를 제어부(1800)에 전달할 수 있다.Meanwhile, the front detection sensor may be installed at a predetermined interval in front of the mobile robot, specifically along the lateral outer peripheral surface of the mobile robot. The forward detection sensor is located on at least one side of the mobile robot to detect an obstacle CA in front, and the forward detection sensor detects an object, especially an obstacle CA, in the moving direction of the mobile robot to detect information. May be transmitted to the
전방 감지 센서는, 일 예로, 적외선 센서, 초음파 센서, RF 센서, 지자기 센서 등일 수 있고, 이동 로봇은 전방 감지 센서로 한 가지 종류의 센서를 사용하거나 필요에 따라 두 가지 종류 이상의 센서를 함께 사용할 수 있다.The forward detection sensor may be, for example, an infrared sensor, an ultrasonic sensor, an RF sensor, a geomagnetic sensor, and the like, and the mobile robot may use one type of sensor as the forward detection sensor or use two or more types of sensors together as necessary. have.
일 예로, 초음파 센서는 일반적으로 원거리의 장애물(CA)을 감지하는 데 에 주로 사용될 수 있다. 초음파 센서는 발신부와 수신부를 구비하여, 제어부(1800)는 발신부를 통해 방사된 초음파가 장애물(CA) 등에 의해 반사되어 수신부에 수신되는 지의 여부로 장애물(CA)의 존부를 판단하고, 초음파 방사 시간과 초음파 수신시간을 이용하여 장애물(CA)과의 거리를 산출할 수 있다.As an example, the ultrasonic sensor may be mainly used to detect a distant obstacle CA. The ultrasonic sensor has a transmitter and a receiver, and the
또한, 제어부(1800)는 발신부에서 방사된 초음파와, 수신부에 수신되는 초음파를 비교하여, 장애물(CA)의 크기와 관련된 정보를 검출할 수 있다. 예를 들어, 제어부(1800)는 수신부에 더 많은 초음파가 수신될수록, 장애물(CA)의 크기가 큰 것으로 판단할 수 있다.Also, the
일 실시 예에서, 복수(일 예로, 5개)의 초음파 센서가 이동 로봇의 전방 측면에 외주면을 따라 설치될 수 있다. 이때, 바람직하게 초음파 센서는 발신부와 수신부가 교대로 이동 로봇의 전면에 설치될 수 있다.In one embodiment, a plurality of (for example, five) ultrasonic sensors may be installed along the outer peripheral surface on the front side of the mobile robot. In this case, preferably, the ultrasonic sensor may be installed on the front of the mobile robot by alternating the transmitter and receiver.
즉, 발신부는 본체의 전면 중앙으로부터 좌, 우측에 이격되도록 배치될 수 있고, 수신부의 사이에 하나 또는 둘 이상의 발신부가 배치되어 장애물(CA) 등 으로부터 반사된 초음파 신호의 수신 영역을 형성할 수 있다. 이와 같은 배치로 센서의 수를 줄이면서 수신 영역을 확장할 수 있다. 초음파의 발신 각도는 크로스토크(crosstalk) 현상을 방지하도록 서로 다른 신호에 영향을 미치지 아니하는 범위의 각을 유지할 수 있다. 또한, 수신부들의 수신 감도는 서로 다르게 설정될 수 있다.That is, the transmitter may be disposed to be spaced apart from the front center of the main body to the left and right, and one or more transmitters may be disposed between the receiver to form a receiving area of the ultrasonic signal reflected from the obstacle (CA). . With this arrangement, it is possible to expand the receiving area while reducing the number of sensors. The transmission angle of the ultrasonic wave may maintain an angle within a range that does not affect different signals to prevent crosstalk. Also, the reception sensitivity of the reception units may be set differently.
또한, 초음파 센서에서 발신되는 초음파가 상향으로 출력되도록 초음파 센서는 일정 각도만큼 상향으로 설치될 수 있고, 이때, 초음파가 하향으로 방사되는 것을 방지하기 위해 소정의 차단 부재를 더 포함할 수 있다.In addition, the ultrasonic sensor may be installed upward by a certain angle so that the ultrasonic wave transmitted from the ultrasonic sensor is output upward, and at this time, a predetermined blocking member may be further included to prevent the ultrasonic wave from being radiated downward.
한편, 전방 감지 센서는, 전술한 바와 같이, 두 가지 종류 이상의 센서를 함께 사용할 수 있고, 이에 따라, 전방 감지 센서는 적외선 센서, 초음파 센서, RF 센서 등 중 어느 한 가지 종류의 센서를 사용할 수 있다.Meanwhile, as for the front sensor, as described above, two or more types of sensors may be used together, and accordingly, the front sensor may use any one of an infrared sensor, an ultrasonic sensor, and an RF sensor. .
일 예로, 전방 감지 센서는 초음파 센서 이외에 다른 종류의 센서로 적외선 센서를 포함할 수 있다. 적외선 센서는 초음파 센서와 함께 이동 로봇의 외주면에 설치될 수 있다. 적외선 센서 역시, 전방이나 측면에 존재하는 장애물(CA)을 감지하여 장애물(CA) 정보를 제어부(1800)에 전달할 수 있다. 즉, 적외선 센서는, 이동 로봇의 이동 경로 상에 존재하는 돌출물, 집안의 집기, 가구, 벽면, 벽 모서리 등을 감지하여 그 정보를 제어부(1800)에 전달한다. 따라서, 이동 로봇은 본체가 장애물(CA)과의 충돌없이 특정 영역 내에서 이동할 수 있다.For example, the front detection sensor may include an infrared sensor as other types of sensors other than an ultrasonic sensor. The infrared sensor may be installed on the outer peripheral surface of the mobile robot together with the ultrasonic sensor. The infrared sensor may also detect the obstacle CA existing in the front or the side and transmit the obstacle CA information to the
한편, 낭떠러지 감지 센서(또는 클리프 센서(Cliff Sensor))는, 다양한 형태의 광 센서를 주로 이용하여, 이동 로봇의 본체를 지지하는 바닥의 장애물(CA)을 감지할 수 있다. 즉, 낭떠러지 감지 센서는, 바닥의 이동 로봇의 배면에 설치되되, 이동 로봇의 종류에 따라 다른 위치에 설치될 수 있음은 물론이다. On the other hand, the cliff detection sensor (or Cliff Sensor) may detect an obstacle CA on the floor supporting the main body of the mobile robot by mainly using various types of optical sensors. That is, the cliff detection sensor is installed on the rear surface of the mobile robot on the floor, but may be installed at different locations depending on the type of the mobile robot.
낭떠러지 감지 센서는 이동 로봇의 배면에 위치하여, 바닥의 장애물(CA)을 감지하기 위한 것으로서, 낭떠러지 감지 센서는 장애물(CA) 감지 센서와 같이 발광부와 수광부를 구비한 적외선 센서, 초음파 센서, RF 센서, PSD(Position Sensitive Detector) 센서 등 일수 있다.The cliff detection sensor is located on the back of the mobile robot to detect an obstacle (CA) on the floor, and the cliff detection sensor is an infrared sensor having a light emitting part and a light receiving part like an obstacle (CA) detection sensor, ultrasonic sensor, RF It may be a sensor, a Position Sensitive Detector (PSD) sensor, and the like.
일 예로, 낭떠러지 감지 센서 중 어느 하나는 이동 로봇의 전방에 설치되고, 다른 두 개의 낭떠러지 감지 센서는 상대적으로 뒤쪽에 설치될 수 있다. 예를 들어, 낭떠러지 감지 센서는 PSD 센서일 수 있으나, 복수의 서로 다른 종류의 센서로 구성될 수도 있다.For example, one of the cliff detection sensors may be installed in front of the mobile robot, and the other two cliff detection sensors may be installed relatively behind the mobile robot. For example, the cliff detection sensor may be a PSD sensor, but may be composed of a plurality of different types of sensors.
PSD 센서는 반도체 표면저항을 이용해서 1개의 p-n접합으로 입사광의 단장거리 위치를 검출한다. PSD 센서에는 일축 방향만의 광을 검출하는 1차원 PSD 센서와, 평면상의 광위치를 검출할 수 있는 2차원 PSD 센서가 있으며, 모두 pin 포토 다이오드 구조를 가질 수 있다. PSD 센서는 적외선 센서의 일종으로서, 적외선을 이용하여, 적외선을 송신한 후 장애물(CA)에서 반사되어 돌아오는 적외선의 각도를 측정하여 거리를 측정한다. 즉, PSD 센서는 삼각측량방식을 이용하여, 장애물(CA)과의 거리를 산출한다.The PSD sensor detects the short and long distance position of incident light with one p-n junction using semiconductor surface resistance. The PSD sensor includes a one-dimensional PSD sensor that detects light in only one axis direction, and a two-dimensional PSD sensor that detects a light position on a plane, and both may have a pin photodiode structure. The PSD sensor is a kind of infrared sensor, and measures the distance by measuring the angle of infrared rays reflected from an obstacle CA after transmitting infrared rays using infrared rays. That is, the PSD sensor calculates the distance to the obstacle CA by using a triangulation method.
PSD 센서는 장애물(CA)에 적외선을 발광하는 발광부와, 장애물(CA)로부터 반사되어 돌아오는 적외선을 수광하는 수광부를 구비하되, 일반적으로 모듈 형태로 구성된다. PSD 센서를 이용하여, 장애물(CA)을 감지하는 경우, 장애물(CA)의 반사율, 색의 차이에 상관없이 안정적인 측정값을 얻을 수 있다.The PSD sensor includes a light emitting unit that emits infrared rays to the obstacle CA and a light receiving unit that receives infrared rays reflected from the obstacle CA, and is generally configured in a module form. When an obstacle CA is detected using a PSD sensor, a stable measurement value can be obtained regardless of a difference in reflectance and color of the obstacle CA.
청소부(1900)는 제어부(1800)로부터 전달되는 제어명령에 따라, 지정된 청소 영역을 청소한다. 청소부(1900)는 지정된 청소 영역의 먼지를 비산시키는 브러쉬(미도시)를 통해 주변의 먼지를 비산시킨 다음, 흡입 팬 및 흡입 모터를 구동하여 비산된 먼지를 흡입한다. 또한, 청소부(1900)는 구성의 교체에 따라 지정된 청소 영역에 걸레질을 수행할 수도 있다.The
또한, 제어부(1800)는 낭떠러지 감지 센서가 지면을 향해 발광한 적외선의 발광신호와 장애물(CA)에 의해 반사되어 수신되는 반사신호 간의 적외선 각도를 측정하여, 낭떠러지를 감지하고 그 깊이를 분석할 수 있다.In addition, the
한편, 제어부(1800)는 낭떠러지 감지 센서를 이용하여 감지한 낭떠 러지의 지면 상태에 따라 통과 여부를 판단할 수 있고, 판단 결과에 따라 낭떠러지의 통과 여부를 결정할 수 있다. 예를 들어, 제어부(1800)는 낭떠러지 감지 센서를 통해 낭떠러지의 존재 여부 및 낭떠러지 깊이를 판단한 다음, 낭떠러지 감지 센서를 통해 반사 신호를 감지한 경우에만 낭떠러지를 통과하도록 한다. 다른 예로, 제어부(1800)는 낭떠러지 감지 센서를 이용하여 이동 로봇의 들림 현상을 판단할 수도 있다. Meanwhile, the
한편, 2차원 카메라 센서는, 이동 로봇의 일면에 구비되어, 이동 중 본체 주변과 관련된 이미지 정보를 획득한다. 옵티컬 플로우 센서(Optical Flow Sensor)는, 센서 내에 구비된 이미지 센서로부터 입력되는 하방 영상을 변환하여 소정 형식의 영상 데이터를 생성한다. 생성된 영상 데이터는 메모리(1700)에 저장될 수 있다.Meanwhile, the 2D camera sensor is provided on one surface of the mobile robot to obtain image information related to the surroundings of the body during movement. An optical flow sensor converts a downward image input from an image sensor provided in the sensor to generate image data in a predetermined format. The generated image data may be stored in the
또한, 하나 이상의 광원이 옵티컬 플로우 센서에 인접하여 설치될 수 있다. 하나 이상의 광원은, 이미지 센서에 의해 촬영되는 바닥면의 소정 영역에 빛을 조사한다. 즉, 이동 로봇이 바닥면을 따라 특정 영역을 이동하는 경우에, 바닥면이 평탄하면 이미지 센서와 바닥면 사이에는 일정한 거리가 유지된다. In addition, one or more light sources may be installed adjacent to the optical flow sensor. At least one light source irradiates light onto a predetermined area of the floor surface photographed by the image sensor. That is, when the mobile robot moves a specific area along the floor surface, if the floor surface is flat, a certain distance is maintained between the image sensor and the floor surface.
반면, 이동 로봇이 불균일한 표면의 바닥면을 이동하는 경우에는 바닥면의 요철 및 장애물(CA)에 의해 일정 거리 이상 멀어지게 된다. 이때 하나 이상의 광원은 조사되는 빛의 양을 조절하도록 제어부(1800)에 의해 제어될 수 있다. 광원은 광량 조절이 가능한 발광 소자, 예를 들어 LED(Light Emitting Diode) 등일 수 있다.On the other hand, when the mobile robot moves the floor surface of the non-uniform surface, it is separated by a certain distance or more due to the irregularities and obstacles CA of the floor surface. At this time, one or more light sources may be controlled by the
옵티컬 플로우 센서를 이용하여, 제어부(1800)는 이동 로봇의 미끄러짐과 무관하게 이동 로봇의 위치를 검출할 수 있다. 제어부(1800)는 옵티컬 플로우 센서에 의해 촬영된 영상 데이터를 시간에 따라 비교 분석하여 이동 거리 및 이동 방향을 산출하고, 이를 근거로 이동 로봇의 위치를 산출할 수 있다. 옵티컬 플로우 센서를 이용하여 이동 로봇의 하방에 대한 이미지 정보를 이용함으로써, 제어부(1800)는 다른 수단에 의해 산출한 이동 로봇의 위치에 대하여 미끄러짐에 강인한 보정을 할 수 있다.Using the optical flow sensor, the
3차원 카메라 센서는 이동 로봇의 본체 일면 또는 일부분에 부착되어, 본체의 주위와 관련된 3차원 좌표 정보를 생성할 수 있다. 즉, 3차원 카메라 센서는 이동 로봇과 피촬영 대상체의 원근거리를 산출하는 3차원 뎁스 카메라(3D Depth Camera)일 수 있다.The 3D camera sensor may be attached to one surface or a part of the body of the mobile robot to generate 3D coordinate information related to the surroundings of the body. That is, the 3D camera sensor may be a 3D depth camera that calculates a far-field distance between the moving robot and the object to be photographed.
구체적으로, 3차원 카메라 센서는 본체의 주위와 관련된 2차원 영상을 촬영할 수 있으며, 촬영된 2차원 영상에 대응되는 복수의 3차원 좌표 정보를 생성할 수 있다.Specifically, the 3D camera sensor may capture a 2D image related to the circumference of the main body, and may generate a plurality of 3D coordinate information corresponding to the captured 2D image.
일 실시예에서 3차원 카메라 센서는 기존의 2차원 영상을 획득하는 카메라를 2개 이상 구비하여, 2개 이상의 카메라에서 획득되는 2개 이상의 영상을 조합하여, 3차원 좌표 정보를 생성하는 스테레오 비전 방식으로 형성될 수 있다.In one embodiment, the 3D camera sensor has two or more cameras for acquiring a conventional two-dimensional image, and a stereo vision method that generates three-dimensional coordinate information by combining two or more images obtained from two or more cameras. It can be formed as
구체적으로, 실시예에 따른 3차원 카메라 센서는 본체의 전방을 향해 하측으로 제1 패턴의 광을 조사하는 제1 패턴 조사부와, 본체의 전방을 향해 상측으로 제2 패턴의 광을 조사하는 제2 패턴 조사부 및 본체의 전방의 영상을 획득하는 영상 획득부를 포함할 수 있다. 이로써, 영상 획득부는 제1 패턴의 광과 제2 패턴의 광이 입사된 영역의 영상을 획득할 수 있다.Specifically, the 3D camera sensor according to the embodiment includes a first pattern irradiation unit that irradiates light of a first pattern downward toward the front of the main body, and a second pattern irradiation unit that irradiates light of a second pattern upward toward the front of the main body. It may include a pattern irradiation unit and an image acquisition unit for obtaining an image of the front of the body. Accordingly, the image acquisition unit may acquire an image of an area to which the light of the first pattern and the light of the second pattern are incident.
또 다른 실시예에서 3차원 카메라 센서는 단일 카메라와 함께 적외선 패턴을 조사하는 적외선 패턴 방출부를 구비하고, 적외선 패턴 방출부에서 조사된 적외선 패턴이 피촬영 대상체에 투영된 모양을 캡쳐함으로써, 3차원 카메라 센서와 피촬영 대상체 사이의 거리를 측정할 수 있다. 이러한 3차원 카메라 센서는 IR(Infra Red) 방식의 3차원 카메라 센서일 수 있다.In another embodiment, the 3D camera sensor includes an infrared pattern emitting unit for irradiating an infrared pattern together with a single camera, and capturing the shape of the infrared pattern irradiated from the infrared pattern emitting unit projected onto the object to be photographed, The distance between the sensor and the object to be photographed can be measured. Such a 3D camera sensor may be an IR (Infra Red) type 3D camera sensor.
또 다른 실시예에서 3차원 카메라 센서는 단일 카메라와 함께 빛을 방출하는 발광부를 구비하고, 발광부에서 방출되는 레이저 중 피촬영 대상체로부터 반사되는 일부를 수신하며, 수신된 레이저를 분석함으로써, 3차원 카메라 센서와 피촬영 대상체 사이의 거리를 측정할 수 있다. 이러한 3차원 카메라 센서는 TOF(Time of Flight) 방식의 3차원 카메라 센서일 수 있다.In another embodiment, the 3D camera sensor includes a light emitting unit that emits light together with a single camera, receives a part of the laser emitted from the light emitting unit that is reflected from the object to be photographed, and analyzes the received laser, The distance between the camera sensor and the object to be photographed can be measured. This 3D camera sensor may be a 3D camera sensor of a TOF (Time of Flight) method.
구체적으로, 위와 같은 3차원 카메라 센서의 레이저는 적어도 일 방향으로 연장된 형태의 레이저를 조사하도록 구성된다. 일 예에서, 3차원 카메라 센서는 제1 및 제2 레이저를 구비할 수 있으며, 제1 레이저는 서로 교차하는 직선 형태의 레이저를 조사하고, 제2 레이저는 단일의 직선 형태의 레이저를 조사할 수 있다. 이에 따르면, 최하단 레이저는 바닥 부분의 장애물(CA)을 감지하는 데에 이용되고, 최상단 레이저는 상부의 장애물(CA)을 감지하는 데에 이용되며, 최하단 레이저와 최상단 레이저 사이의 중간 레이저는 중간 부분의 장애물(CA)을 감지하는 데에 이용된다.Specifically, the laser of the 3D camera sensor as described above is configured to irradiate a laser extending in at least one direction. In one example, the 3D camera sensor may include first and second lasers, the first laser irradiating a linear laser intersecting each other, and the second laser irradiating a single linear laser. have. According to this, the lowermost laser is used to detect the obstacle (CA) in the bottom part, the uppermost laser is used to detect the obstacle (CA) in the upper part, and the intermediate laser between the lowermost laser and the uppermost laser is used in the middle part. It is used to detect the obstacle (CA) of the.
영상획득부는 청소기 본체(110)의 주변의 영상 또는/및 장애물(CA)의 영상을 획득하여 제어부(1800)에 제공한다. 영상획득부는 본체의 주위와 관련된 2차원 영상을 촬영할 수 있으며, 촬영된 2차원 영상에 대응되는 복수의 3차원 좌표 정보를 생성할 수 있다.The image acquisition unit acquires an image around the
예를 들면, 영상획득부는, 3차원 카메라 또는 뎁스 카메라를 포함할 수 있다.For example, the image acquisition unit may include a 3D camera or a depth camera.
한편, 통신부(1100)는 단말 장치 및/또는 특정 영역 내 위치한 타기기(본 명세서에서는 "가전 기기"라는 용어와 혼용하기로 한다)와 유선, 무선, 위성 통신 방식들 중 하나의 통신 방식으로 연결되어 신호와 데이터를 송수신한다.Meanwhile, the
통신부(1100)는 특정 영역 내에 위치한 타 기기와 데이터를 송수신할 수 있다. 이때, 타 기기는 네트워크에 연결하여 데이터를 송수신할 수 있는 장치이면 어느 것이어도 무방하며, 일 예로, 공기 조화 장치, 난방 장치, 공기 정화 장치, 전등, TV, 자동차 등과 같은 장치일 수 있다. 또한, 타 기기는, 문, 창문, 수도 밸브, 가스 밸브 등을 제어하는 장치 등일 수 있다. 또한, 타 기기는, 온도, 습도, 기압, 가스 등을 감지하는 센서 등일 수 있다.The
또한, 통신부(1100)는 특정 영역 또는 일정 범위 내에 위치한 다른 로봇 청소기(100)와 통신할 수 있다.In addition, the
비록 도시되지는 않았지만, 복수의 이동로봇이 네트워크 통신을 통해서는 단말기(미도시)와 통신을 수행하고, 상호간에 통신을 수행할 수 있다.Although not shown, a plurality of mobile robots can communicate with a terminal (not shown) and communicate with each other through network communication.
여기에서, 네트워크 통신은 WLAN(Wireless LAN), WPAN(Wireless Personal Area Network), Wi-Fi(Wireless-Fidelity), Wi-Fi(Wireless Fidelity)Direct, DLNA(Digital Living Network Alliance), WiBro(Wireless Broadband), WiMAX(World Interoperability for Microwave Access), Zigbee, Z-wave, Blue-Tooth, RFID(Radio Frequency Identification), 적외선 통신(Infrared Data Association; IrDA), UWB(Ultrawide-Band), Wireless USB(Wireless Universal Serial Bus) 등과 같은 무선 통신 기술 중 적어도 하나를 이용한 근거리 통신을 의미할 수 있다.Here, the network communication is WLAN (Wireless LAN), WPAN (Wireless Personal Area Network), Wi-Fi (Wireless-Fidelity), Wi-Fi (Wireless Fidelity) Direct, DLNA (Digital Living Network Alliance), WiBro (Wireless Broadband). ), WiMAX (World Interoperability for Microwave Access), Zigbee, Z-wave, Blue-Tooth, RFID (Radio Frequency Identification), Infrared Data Association (IrDA), UWB (Ultrawide-Band), Wireless USB (Wireless Universal) Serial Bus) may mean short-range communication using at least one of wireless communication technologies.
제어부(1800)는, 인공 지능 기술에 기반하여 정보들을 처리하는 역할을 수행하는 것으로, 정보의 학습, 정보의 추론, 정보의 지각, 자연 언어의 처리 중 적어도 하나를 수행하는 하나 이상의 모듈을 포함할 수 있다.The
제어부(1800)는 머신 러닝(machine running) 기술을 이용하여, 청소기 내에 저장된 정보, 이동 단말기 주변의 환경 정보, 통신 가능한 외부 저장소에 저장된 정보 등 방대한 양의 정보(빅데이터, big data)를 학습, 추론, 처리 중 적어도 하나를 수행할 수 있다. The
그리고, 제어부(1800)는 머신 러닝 기술을 이용하여 학습된 정보들을 이용하여, 실행 가능한 적어도 하나의 청소기의 동작을 예측(또는 추론)하고, 적어도 하나의 예측된 동작들 중 실현성이 가장 높은 동작이 실행되도록 청소기를 제어할 수 있다. 머신 러닝 기술은 적어도 하나의 알고리즘에 근거하여, 대규모의 정보들을 수집 및 학습하고, 학습된 정보를 바탕으로 정보를 판단 및 예측하는 기술이다. In addition, the
정보의 학습이란 정보들의 특징, 규칙, 판단 기준 등을 파악하여, 정보와 정보 사이의 관계를 정량화하고, 정량화된 패턴을 이용하여 새로운 데이터들을 예측 하는 동작이다.The learning of information is an operation of grasping the characteristics of information, rules, criteria, etc., quantifying the relationship between information and information, and predicting new data using the quantified pattern.
머신 러닝 기술이 사용하는 알고리즘은 통계학에 기반한 알고리즘이 될 수 있으며, 예를 들어, 트리 구조 형태를 예측 모델로 사용하는 의사 결정 나무(decision tree), 생물의 신경 네트워크 구조와 기능을 모방하는 인공 신경망(neural network), 생물의 진화 알고리즘에 기반한 유전자 프로그래밍(genetic programming), 관측된 예를 군집이라는 부분집합으로 분배하는 군집화(Clustering), 무작위로 추출된 난수를 통해 함수값을 확률로 계산하는 몬테카를로 방법(Monter carlo method) 등이 될 수 있다.The algorithm used by machine learning technology can be an algorithm based on statistics, for example, a decision tree using a tree structure as a predictive model, an artificial neural network that mimics the structure and function of a neural network in organisms. (neural network), genetic programming based on the evolutionary algorithm of living things, clustering that distributes observed examples into subsets called clusters, Monte Carlo method that calculates function values with probability through randomly extracted random numbers (Monter carlo method), etc.
머신 러닝 기술의 한 분야로써, 딥러닝 기술은 인공 신경망(Deap Neuron Network, DNN) 알고리즘을 이용하여, 정보들을 학습, 판단, 처리 중 적어도 하나를 수행하는 기술이다. 인공 신경망(DNN)은 레이어와 레이어 사이를 연결하고, 레이어와 레이어 사이의 데이터를 전달하는 구조를 가질 수 있다. 이러한 딥러닝 기술은 병렬 연산에 최적화된 GPU(graphic processing unit)를 이용하여 인공 신경망(DNN)을 통하여 방대한 양의 정보를 학습할 수 있다.As a field of machine learning technology, deep learning technology is a technology that performs at least one of learning, determining, and processing information using an artificial neural network (DNN) algorithm. The artificial neural network (DNN) may have a structure that connects layers and layers and transfers data between layers. Such a deep learning technology can learn a vast amount of information through an artificial neural network (DNN) using a graphic processing unit (GPU) optimized for parallel computation.
제어부(1800)는 외부의 서버 또는 메모리에 저장된 트레이닝 데이터를 이용하며, 소정의 물체를 인식하기 위한 특징을 검출하는 학습 엔진을 탑재할 수 있다. 이때, 물체를 인식하기 위한 특징에는 물체의 크기, 형태 및 음영 등을 포함할 수 있다.The
구체적으로, 제어부(1800)는 청소기에 구비된 영상획득부를 통해 획득된 영상 중 일부를 학습 엔진에 입력하면, 학습 엔진은 입력된 영상에 포함된 적어도 하나의 사물 또는 생명체를 인식할 수 있다. 더욱 구체적으로, 제어부(1800)는 사물로 인식된 것 중에 일반 장애물(CA)과, 매트형 장애물(CA)을 다양한 방법을 통해 인식할 수 있다.Specifically, when the
이와 같이, 학습 엔진을 청소기의 주행에 적용하는 경우, 제어부(1800)는 청소기의 주행에 방해되는 의자 다리, 선풍기, 특정 형태의 발코니 틈과 같은 장애물(CA)이 청소기 주변에 존재하는지 여부를 인식할 수 있으므로, 청소기 주행의 효율 및 신뢰도를 높일 수 있다.In this way, when the learning engine is applied to the driving of the cleaner, the
한편, 위와 같은 학습 엔진은 제어부(1800)에 탑재될 수도 있고, 외부 서버에 탑재될 수도 있다. 학습 엔진이 외부 서버에 탑재된 경우, 제어부(1800)는 분석의 대상인 적어도 하나의 영상을 외부 서버로 전송하도록 통신부(1100)를 제어할 수 있다.Meanwhile, the learning engine as described above may be mounted on the
외부 서버는 청소기로부터 전송받은 영상을 학습 엔진에 입력함으로서, 해당 영상에 포함된 적어도 하나의 사물 또는 생명체를 인식할 수 있다. 아울러, 외부 서버는 인식결과와 관련된 정보를 다시 청소기로 전송할 수 있다. 이때, 인식결과와 관련된 정보는 분석의 대상인 영상에 포함된 객체의 개수, 각 개체의 이름과 관련된 정보를 포함할 수 있다.The external server may recognize at least one object or living being included in the image by inputting the image transmitted from the cleaner into the learning engine. In addition, the external server may transmit information related to the recognition result back to the cleaner. In this case, the information related to the recognition result may include the number of objects included in the image to be analyzed and information related to the name of each object.
예를 들면, 제어부(1800)는 청소영역 내에서 영상획득부에 의해 획득한 영상 및 원근거리를 분석하여 본체의 주변에 위치된 장애물(CA)의 존재여부를 판단하고, 장애물(CA)의 높이가 기준 높이 이상 되는 장애물(CA)의 경우 이동 로봇의 회피를 결정하고, 장애물(CA)의 높이가 기준 높이 보다 작은 경우, 장애물(CA)의 평면적을 연산하고, 장애물(CA)의 평면적을 기준으로 본체의 등반 또는 회피를 결정할 수 있다.For example, the
제어부(1800)는 상술한 정보 학습 또는 주어진 기준에 따라 장애물(CA)을 일반 장애물(CA)과 매트형 장애물(CA)로 구별할 수 있다. 일 예로, 제어부(1800)는 빅 데이터 또는 머신 러닝에 의해 사물을 인지하고 각 사물별 특징에 따라 회피하거나 등반하게 로봇 청소기(100)를 제어할 수 있다. The
다른 예로, 제어부(1800)는 청소영역 내에서 영상획득부에 의해 획득한 영상 및 원근거리를 분석하여 장애물(CA)의 높이가 기 설정된 높이(0.3cm 내지 1cm) 이하인 경우, 매트형 장애물(CA)로 판단할 수 있다. 제어부(1800)는 청소영역 내에서 영상획득부에 의해 획득한 영상 및 원근거리를 분석하여 장애물(CA)의 높이가 기 설정된 높이(0.3cm 내지 1cm)를 초과하는 경우, 일반 장애물(CA)로 판단할 수 있다. 일반적으로 제어부(1800)는 일반 장애물(CA)의 경우 로봇 청소기(100)가 일반 장애물(CA)의 회피하도록 제어한다.As another example, the
또 다른 예로, 제어부(1800)는 기준 장애물(CA)의 이미지와 획득한 영상 속의 장애물(CA)의 이미지의 유사도를 기준으로 매트형 장애물(CA)을 판단할 수 있다. 여기서, 기준 장애물(CA)의 이미지는 학습되거나, 기 저장된 데이터일 수 있다. 구체적으로, 제어부(1800)는 다양한 매트형 장애물(CA)의 이미지 포함하는 기준 장애물(CA)의 이미지와 획득한 영상 속의 장애물(CA)의 이미지를 비교하여 유사도가 기 설정된 값(90%)를 초과하는 경우, 매트형 장애물(CA)이라고 판단할 수 있다.As another example, the
제어부(1800)는 획득한 영상의 장애물(CA)이 매트형 장애물(CA)로 판단되는 경우, 매트형 장애물(CA)의 등반여부를 결정한다. 구체적으로, 제어부(1800)는 매트형 장애물(CA)의 평면적이 기 설정된 평면적 값을 초과하는 경우, 본체가 매트형 장애물(CA)을 등반하도록 주행부(1300)를 제어할 수 있다. 또한, 제어부(1800)는 매트형 장애물(CA)의 평면적이 기 설정된 평면적 값 이하 경우, 본체가 매트형 장애물(CA)을 회피하도록 주행부(1300)를 제어한다.When the obstacle CA of the acquired image is determined to be a mat-type obstacle CA, the
여기서, 기 설정된 평면적 값은 1500~ 2300cm2일 수 있다. 로봇 청소기(100)는 대략 수건 정도의 크기 보다 작은 매트형 장애물(CA)(예를 들어, 발매트)의 경우 등반 시에 주행부(1300)에 끼이거나 청소부를 막을 수 있으므로 회피하고, 수건 보다 큰 매트형 장애물(CA)(예를 들어, 카펫)의 경우, 주행부(1300)에 끼일 염려가 없고, 청소부를 막을 염려도 없으므로 등반한다.Here, the preset planar value may be 1500-2300cm 2 . The
로봇 청소기(100)는 이러한 영상을 통해 입수한 정보를 통해 매트형 장애물(CA)의 평면적을 연산하고 이를 바탕으로 회피 또는 등반여부를 결정하므로, 로봇 청소기(100)의 파손을 줄일 수 있고, 발매트와 카펫을 신속하고 정확하게 구별할 수 있다.The
제어부(1800)는 본체가 매트형 장애물(CA) 상에 위치되는 경우, 매트형 장애물(CA)에 대응되는 청소를 수행하도록 청소부를 제어할 수 있다. 구체적으로, 제어부(1800)는 획득한 영상 및 센서에 의해 입력된 정보를 바탕으로 본체가 매트형 장애물(CA)을 등반하는 경우, 청소부를 제어하여 매트형 장애물(CA) 청소를 수행할 수 있다. 더욱 구체적으로, 제어부(1800)는 매트형 장애물(CA)의 상면의 거칠기, 모양, 반사도 등을 고려하여서, 청소부의 흡입 압력을 조절하거나, 스위핑 롤러 회전속도를 조절하거나, 본체의 주행속도를 조절할 수 있다.When the main body is positioned on the mat-shaped obstacle CA, the
제어부(1800)는 장애물(CA)의 높이기 기준 높이 보다 높은 경우, 로봇 청소기가 장애물(CA)을 등반하게 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어할 수 있다. 그러나, 로봇 청소기의 좌측 휠(111a)과 우측 휠(111b)이 동시에 장애물(CA)과 접촉하지 않는 경우, 상술한 바와 같이 로봇 청소기가 장애물(CA)에 구속되거나, 장애물(CA)을 등반하지 못하는 경우가 발생할 수 있다.When the height of the obstacle CA is higher than the reference height, the
이하, 상술한 문제점을 해결하기 위해 로봇 청소기의 진입각도(θA)를 장애물(CA)의 경계 라인(BL)과 수직하게 하기 위한 방법에 대해 상술한다.Hereinafter, in order to solve the above-described problem, a method for making the entry angle θA of the robot cleaner perpendicular to the boundary line BL of the obstacle CA will be described in detail.
도 5는 본 발명에 따른 제1 실시예에 따른 로봇 청소기가 진입각도(θA)를 연산하고 진입각도(θA)를 정상 진입각도로 변경하는 것을 도시한 도면이다.5 is a diagram illustrating that the robot cleaner according to the first embodiment according to the present invention calculates an entry angle θA and changes the entry angle θA to a normal entry angle.
도 5a를 참조하면, 제어부(1800)는 영상획득부에서 획득한 영상을 분석하여 장애물(CA)에 대한 이동 로봇의 진입각도(θA)를 검출하고, 이동 로봇의 진입각도(θA)에 따라 장애물(CA)을 등반하게 제어할 수 있다.Referring to FIG. 5A, the
여기서, 이동 로봇의 진입각도(θA)는 이동 로봇의 진행 방향과 장애물(CA)과 바닥의 경계선(BL)이 이루는 각도를 의미한다. 또는 이동 로봇의 진입각도(θA)는 휠의 회전축(A1)과 수직한 선과 장애물(CA) 측면과 이루는 각도를 의미할 수 있다.Here, the entry angle θA of the mobile robot refers to an angle formed by the moving direction of the mobile robot and the boundary line BL between the obstacle CA and the floor. Alternatively, the entry angle θA of the mobile robot may mean an angle formed by a line perpendicular to the rotation axis A1 of the wheel and a side surface of the obstacle CA.
여기서, 장애물(CA)과 바닥의 경계선(BL)은 장애물(CA)에서 이동 로봇의 진행방향과 마주보는 면의 바닥 사이의 경계선을 의미할 수 있다. 물론, 장애물(CA)과 바닥의 경계선(BL)이 곡선인 경우, 장애물(CA)과 바닥의 경계선(BL)의 양단을 연결한 직선 또는 장애물(CA)과 바닥의 경계선(BL)에서 서로 이격된 2개의 지점을 연결한 가상의 선일 수 있다.Here, the boundary line BL between the obstacle CA and the floor may mean a boundary line between the moving direction of the mobile robot in the obstacle CA and the floor of a surface facing the obstacle CA. Of course, if the boundary line BL between the obstacle CA and the floor is curved, a straight line connecting both ends of the boundary line BL between the obstacle CA and the floor, or separated from each other at the boundary line BL between the obstacle CA and the floor It may be a virtual line connecting the two points.
장애물(CA) 측면이 곡선인 경우, 화각 상에 들어온 장애물(CA)의 측면의 양단 사이를 연결한 가상의 면을 장애믈의 측면으로 결정할 수 있다.When the side of the obstacle CA is curved, a virtual surface connected between both ends of the side of the obstacle CA entering on the angle of view may be determined as the side of the obstacle.
본 실시예에서는 장애물(CA) 측면 및 장애물(CA)과 바닥의 경계선(BL)이 직선인 것을 기준으로 설명한다.In the present embodiment, a description will be made based on that the side of the obstacle CA and the boundary line BL between the obstacle CA and the floor are straight.
이동 로봇의 진입각도(θA)를 산정하는 방법은 다양한 방법이 가능하다. 일 예로, 진입각도(θA)는 본체의 주위와 관련된 2차원 영상과 2차원 영상에 대응되는 복수의 3차원 좌표 정보를 가지고 판별할 수 있다. 구체적으로, 제어부(1800)는, 복수의 3차원 좌표와 2차원 영상을 토대로, 장애물(CA)의 측면 및 장애물(CA)과 바닥의 경계선(BL)이 이동 로봇의 진행방향에 기울어진 각도를 산정할 수 있다. Various methods are available for calculating the entry angle (θA) of the mobile robot. For example, the angle of entry θA may be determined based on a 2D image related to the surroundings of the body and a plurality of 3D coordinate information corresponding to the 2D image. Specifically, the
일 예로, 상부에서 바라본 평면 상에서, 이동 로봇은 기준점(P)에서 전방 방향에 대해 좌측으로 제1 각도(θB)로 기울어진 방향으로 광을 조사하고 반사된 광을 수신하여 장애물(CA) 측면의 좌측 일 지점(P1)과 기준점(P) 사이의 제1 이격거리(L1)를 산정하고, 기준점(P)에서 전방 방향에 대해 우측으로 제1 각도(θB)와 동일한 제2 각도(θC)로 기울어진 방향으로 광을 조사하고 반사된 광을 수신하여 장애물(CA) 측면의 우측 일 지점(P2)과 기준점(P) 사이의 제2 이격거리(L2)를 산정한다.As an example, on a plane viewed from the top, the mobile robot irradiates light in a direction inclined at a first angle θB to the left from the reference point P and receives the reflected light to the side of the obstacle CA. Calculate the first separation distance (L1) between one point on the left (P1) and the reference point (P), and from the reference point (P) to the right with respect to the forward direction to a second angle (θC) equal to the first angle (θB). The light is irradiated in an inclined direction and the reflected light is received, and a second separation distance L2 between the one point P2 on the right side of the side of the obstacle CA and the reference point P is calculated.
제어부(1800)는 제1 이격거리(L1)와 제2 이격거리(L2)를 비교하여 진입각도(θA)를 산출할 수 있다. 제1 이격거리(L1)와 제2 이격거리(L2)가 같은 경우, 진입각도(θA)는 90 °가 된다.The
다른 예로, 제어부(1800)는 복수의 2차원 좌표와 2차원 영상을 토대로 생성된 맵(Map)에서, 장애물(CA)의 경계를 확정하고, 확정된 장애물(CA)의 경계의 일부분과 이동 로봇의 진행방향의 기울어진 각도를 산정할 수 있다.As another example, the
제어부(1800)는, 진입각도 검출 시에 이동 로봇의 진입 각도가 변하지 않도록 이동 로봇을 제어할 수 있다. 제어부(1800)는 상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정상속도 보다 낮은 저속으로 구동할 수 있고, 이때, 제1 구동모터와 제2 구동모터는 동일한 속도로 구동할 수 있다. 다른 예로, 제어부는, 상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정지시킬 수 있다. 진입각도 검출 시에 구동모터가 정지하면 정확한 진입각도를 검출 할 수 있다.The
제어부(1800)는 이동 로봇의 진입각도(θA)가 비 정상 진입각도 인 경우, 이동 로봇의 진입각도(θA)가 정상 진입각도가 되도록 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어할 수 있다.The
여기서, 정상 진입각도는 이동 로봇이 장애물(CA)의 경계와 수직에게 가깝게 진입하는 것을 의미한다. 구체적으로, 정상 진입각도는 87° 내지 93°의 진입각도(θA)일 수 있다. 바람직하게는, 정상 진입각도는 88° 내지 92°의 진입각도(θA)일 수 있다. 더욱 바람직하게는, 정상 진입각도는 89° 내지 91°로 설정될 수 있다.Here, the normal angle of entry means that the mobile robot enters close to the boundary and perpendicular to the obstacle CA. Specifically, the normal entry angle may be an entry angle θA of 87° to 93°. Preferably, the normal entry angle may be an entry angle (θA) of 88° to 92°. More preferably, the normal entry angle may be set to 89° to 91°.
비 정상 진입각도는 정상 진입각도 이외의 진입각도(θA)를 의미한다. 비 정상 진입각도는 이동 로봇이 장애물(CA)의 경계와 수직하지 않게 진입하는 것을 의미한다.The abnormal entry angle means an entry angle (θA) other than the normal entry angle. The abnormal entry angle means that the mobile robot enters not perpendicular to the boundary of the obstacle CA.
5a에 도시된 바와 같이, 제어부(1800)는 진입각도(θA)가 비 정상 진입각도 인 경우, 제1 구동모터(1310)와 제2 구동모터(1320)를 제어하여서, 이동 로봇을 제자리에서 일 방향으로 일정 각도 회전시키거나, 전진하면서, 제1 구동모터(1310) 및 제2 구동모터(1320) 중 어느 하나의 출력을 향상시키거나 줄일 수 있다. 이러한 제어부(1800)의 제어를 이동 로봇의 자세를 수정하는 것으로 정의할 수 있다. 물론, 제어부(180)는 진입각도(θA)가 비 정상 진입각도 인 경우, 제1 구동모터(1310)를 정회전시키고 제2 구동모터(1320)를 역회전시켜서 이동 로봇을 회전시킬 수 있다. 여기서, 모터의 정회전은 휠이 이동 로봇을 전진시키도록 회전되는 것을 의미하고, 모터의 역회전은 휠이 이동 로봇을 후진시키도록 회전되는 것을 의미한다.As shown in 5a, when the entry angle θA is an abnormal entry angle, the
또한, 제어부(180)는 진입각도(θA)가 비 정상 진입각도 인 경우, 이동 로봇의 진입각도가 정상 진입각도가 될때 까지 상기 이동 로봇을 회전시키면서 진입각도로를 검출할 수 있다.In addition, when the entry angle θA is an abnormal entry angle, the controller 180 may detect the entry angle while rotating the mobile robot until the entry angle of the mobile robot becomes the normal entry angle.
구체적으로, 제어부(1800)는 제1 이격거리(L1)가 제2 이격거리(L2) 보다 작은 경우, 제2 구동모터(1320)를 정회전시켜 우측 휠(111b)을 전진시켜서 이동 로봇을 회전시킬 수 있다. 제어부(1800)는 제1 이격거리(L1)와 제2 이격거리(L2)가 오차 범위 이내에서 동일해 질 때까지 이러한 동작을 반복할 수 있다.Specifically, when the first separation distance L1 is smaller than the second separation distance L2, the
도 5b 및 도 5c를 참조하면, 제어부(1800)는 이동 로봇의 진입각도(θA)가 정상 진입각도 인 경우, 이동로봇이 장애물(CA)을 등반하도록 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어할 수 있다. 제어부(1800)는 이동 로봇의 진입각도(θA)가 정상 진입각도 인 경우, 이동 로봇이 진입각도(θA)를 유지하면서, 장애물(CA)에 접근하도록 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어할 수 있다. 구체적으로, 제어부(1800)는 이동 로봇의 진입각도(θA)가 정상 진입각도 인 경우, 제1 구동모터(1310) 및 제2 구동모터(1320)를 같은 속도로 동시에 제어하여서, 이동 로봇이 원래 방향(진행방향)을 유지하며 진행하게 할 수 있다. 물론, 제어부(1800)는 장애물(CA)에 휠이 접촉 시에 제1 구동모터(1310) 및 제2 구동모터(1320)의 출력을 증가시킬 수 있다. 5B and 5C, the
제어부(1800)는 이동 로봇의 진입각도(θA)가 정상 진 입각도 인 경우, 제1 구동모터(1310) 및 제2 구동모터(1320)를 같은 속도로 정회전 되도록 동시에 제어하여서, 이동 로봇이 원래 방향(진행방향)을 유지하며 진행하게 하는데, 이때, 제어부(1800)는 장애물(CA)에 휠이 접촉을 감지하여서, 미세한 진입각도를 추가적으로 조절할 수 있다. 구체적으로, 제어부(1800)는 장애물(CA)에 휠이 접촉하는 것을 제1 구동모터(1310) 및 제2 구동모터(1320)의 부하를 통해 감지하여 판단하고, 제1 구동모터(1310) 및 제2 구동모터(1320) 중 어느 하나의 부하가 임계치가 되면, 부하가 커진 구동모터를 정지하고, 다른하나의 구동모터의 부하가 임계치가 되도록 구동시킨 후에 제1 구동모터(1310) 및 제2 구동모터(1320)를 동시에 구동할 수 있다. The
또한, 제1 구동모터(1310) 및 제2 구동모터(1320)의 부하가 동시에 임계치가 되면, 제어부(1800)는 제1 구동모터(1310) 및 제2 구동모터(1320)를 동시에 출력을 증가시켜서 이동로봇이 장애물을 등반하게 할 수 있다.In addition, when the loads of the
이하, 복수의 거리센서를 사용해서 로봇 청소기의 진입각도(θA)를 장애물(CA)의 경계 라인과 수직하게 하기 위한 방법에 대해 상술한다.Hereinafter, a method for making the entry angle θA of the robot cleaner perpendicular to the boundary line of the obstacle CA using a plurality of distance sensors will be described in detail.
도 6은 본 발명에 따른 제2 실시예에 따른 로봇 청소기가 진입각도(θA)를 연산하고 진입각도(θA)를 정상 진입각도로 변경하는 것을 도시한 도면이다.6 is a diagram illustrating that the robot cleaner according to the second embodiment of the present invention calculates an entry angle θA and changes the entry angle θA to a normal entry angle.
도 6a를 참조하면, 제어부(1800)는 제1거리(F1)와 제2거리(F2)를 비교하여 장애물(CA)에 대한 이동 로봇의 진입각도(θA)를 검출하고, 이동 로봇의 진입각도(θA)에 따라 장애물(CA)을 등반하게 제어할 수 있다.6A, the
이동 로봇의 진입각도(θA)를 산정하는 방법은 복수 개의 거리센서를 사용할 수 있다. 구체적으로, 제1거리센서(1410a)와 서로 제2거리(F2)센서(1410b)가 진행방향과 나란한 방향의 전방에 위치된 장애물(CA)의 일부분과의 거리를 측정하여 이들의 거리를 비교하여 진입각도(θA)를 산정할 수 있다.A method of calculating the entry angle θA of the mobile robot may use a plurality of distance sensors. Specifically, the distance between the
일 예로, 상부에서 바라본 평면 상에서, 이동 로봇은 제1거리센서(1410a)와 장애물(CA) 측면의 좌측 일 지점(P1) 사이의 제1거리(F1)를 산정하고, 제2거리(F2)센서(1410b)와 장애물(CA) 측면의 우측 일 지점(P2) 사이의 제2거리(F2)를 산정한다.For example, on the plane viewed from the top, the mobile robot calculates the first distance F1 between the
제어부(1800)는, 진입각도 검출 시에 이동 로봇의 진입 각도가 변하지 않도록 이동 로봇을 제어할 수 있다. 제어부(1800)는 상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정상속도 보다 낮은 저속으로 구동할 수 있고, 이때, 제1 구동모터와 제2 구동모터는 동일한 속도로 구동할 수 있다. The
다른 예로, 제어부는, 상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정지시킬 수 있다. 진입각도 검출 시에 구동모터가 정지하면 정확한 진입각도를 검출 할 수 있다. 이 때, 로봇 청소기는 장애물과 일정 거기 이내에 위치되는 것이 바람직하다.As another example, the controller may stop the first driving motor and the second driving motor when the entrance angle is detected. If the drive motor stops when detecting the angle of entry, the correct entry angle can be detected. At this time, the robot cleaner is preferably located within a certain amount of the obstacle.
제어부(1800)는 제1거리(F1)와 제2거리(F2)를 비교하여 진입각도(θA)를 산출할 수 있다. 제1거리(F1)와 제2거리(F2)가 같은 경우, 진입각도(θA)는 90 °가 된다. The
제어부(1800)는 이동 로봇의 진입각도(θA)가 비 정상 진입각도 인 경우, 이동 로봇의 진입각도(θA)가 정상 진입각도가 되도록 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어할 수 있다.The
도 6a에 도시된 바와 같이, 제어부(1800)는 진입각도(θA)가 비 정상 진입각도 인 경우, 제1 구동모터(1310)와 제2 구동모터(1320)를 제어하여서, 이동 로봇을 제자리에서 일 방향으로 일정 각도 회전시키거나, 전진하면서, 제1 구동모터(1310) 및 제2 구동모터(1320) 중 어느 하나의 출력을 향상시키거나 줄일 수 있다. 또는 제어부(180)는 진입각도(θA)가 비 정상 진입각도 인 경우, 제1 구동모터(1310)를 정회전시키고 제2 구동모터(1320)를 역회전시켜서 이동 로봇을 회전시킬 수 있다. As shown in FIG. 6A, when the entry angle θA is an abnormal entry angle, the
또한, 회전 시간을 줄이기 위해, 제어부(180)는 진입각도(θA)가 비 정상 진입각도 인 경우, 제1 거리(F1)와 제2 거리F2) 중 짧은 거리를 판단하고, 짧은 거리를 측정한 거리 센서가 위치하는 방향으로 상기 이동 로봇의 초기 회전을 시작할 수 있다.In addition, in order to reduce the rotation time, when the entry angle θA is an abnormal entry angle, the controller 180 determines a short distance among the first distance F1 and the second distance F2, and measures the short distance. Initial rotation of the mobile robot may be started in the direction in which the distance sensor is located.
구체적으로, 제어부(1800)는 제1거리(F1)가 제2거리(F2) 보다 작은 경우, 제2 구동모터(1320)를 통해 우측 휠(111b)을 전진시켜서 이동 로봇을 회전시킬 수 있다. 제어부(1800)는 제1 이격거리(L1)와 제2 이격거리(L2)가 오차 범위 이내에서 동일해 질 때까지 이러한 동작을 반복할 수 있다.Specifically, when the first distance F1 is smaller than the second distance F2, the
도 6b 및 도 6c를 참조하면, 제어부(1800)는 이동 로봇의 진입각도(θA)가 정상 진입각도 인 경우, 이동로봇이 장애물(CA)을 등반하도록 제1 구동모터(1310) 및 제2 구동모터(1320)를 제어할 수 있다. 구체적으로, 제어부(1800)는 이동 로봇의 진입각도(θA)가 정상 진입각도 인 경우, 제1 구동모터(1310)와 제2 구동모터(1320)를 동일한 속도로 정회전되게 제어할 수 있다.6B and 6C, the
도 7은 본 발명의 일 실시예에 따른 로봇 청소기의 제어방법을 설명하기 위한 순서도, 도 8은 본 발명의 일 실시예에 따른 로봇 청소기의 회피판단 방법을 설명하기 위한 순서도이다.7 is a flowchart illustrating a method of controlling a robot cleaner according to an embodiment of the present invention, and FIG. 8 is a flowchart illustrating a method of determining avoidance of a robot cleaner according to an embodiment of the present invention.
이하, 도 7 및 도 8을 참조하여 본 발명의 로봇 청소기(100)의 제어방법을 상술한다. 각 순서도들에서 서로 중복되는 내용은 동일한 도면 부호로 표기하고, 중복되는 설명은 생략한다.Hereinafter, a method of controlling the
제어방법은 제어부(1800)에 의해 수행될 수 있다. 본 발명은, 로봇 청소기(100)의 제어방법이 될 수 있고, 제어방법을 수행하는 제어부(1800)를 포함하는 로봇 청소기(100)가 될 수도 있다. 본 발명은, 제어방법의 각 단계를 포함하는 컴퓨터 프로그램이 될 수도 있고, 제어방법을 컴퓨터로 구현하기 위한 프로그램이 기록된 기록매체가 될 수도 있다. '기록매체'는 컴퓨터로 판독 가능한 기록매체를 의미한다. 본 발명은, 하드웨어와 소프트웨어를 모두 포함하는 로봇 청소기(100) 제어 시스템이 될 수도 있다. The control method may be performed by the
제어방법의 순서도 도면들의 각 단계와 순서도 도면들의 조합들은 컴퓨터 프로그램 인스트럭션(instruction)들에 의해 수행될 수 있다. 인스트럭션들은 범용 컴퓨터 또는 특수용 컴퓨터 등에 탑재될 수 있고, 인스트럭션들이 순서도 단계(들)에서 설명된 기능들을 수행하는 수단을 생성하게 된다.Each step of the flowchart diagrams of the control method and combinations of the flowchart diagrams may be performed by computer program instructions. The instructions may be mounted on a general purpose computer or a special purpose computer, etc., and the instructions generate a means for performing the functions described in the flowchart step(s).
또한, 몇 가지 실시예들에서는 단계들에서 언급된 기능들이 순서를 벗어나서 발생하는 것도 가능하다. 예컨대, 잇달아 도시되어 있는 두 개의 단계들은 사실 실질적으로 동시에 수행되는 것도 가능하고 또는 그 단계들이 때때로 해당하는 기능에 따라 역순으로 수행되는 것도 가능하다.In addition, in some embodiments, it is possible that the functions mentioned in the steps occur out of order. For example, two steps shown in succession may in fact be performed substantially simultaneously, or the steps may sometimes be performed in the reverse order depending on the corresponding function.
본 발명의 일 실시예의 이동 로봇 제어방법은 장애물(CA)에 대한 이동 로봇의 진입각도(θA)를 검출하는 진입각도(θA) 검출단계(S140) 및 이동 로봇의 진입각도(θA)에 따라 장애물(CA)을 등반여부를 결정하는 결정단계(S150, S160, S170)를 포함할 수 있다.The method of controlling a mobile robot according to an embodiment of the present invention is an obstacle according to an entry angle (θA) detection step (S140) of detecting an entry angle (θA) of the mobile robot to the obstacle CA and the entry angle (θA) of the mobile robot. It may include a determining step (S150, S160, S170) of determining whether to climb (CA).
또한. 이동 로봇의 제어방법은 이동 로봇의 주변의 영상 및 이동 로봇과 장애물(CA)과의 원근거리, 장애물(CA)의 일지점과의 원근거리를 획득하는 영상 획득단계(S110), 획득한 영상과 원근거리를 바탕으로 장애물(CA)을 판단하고(S120), 장애물(CA)의 회피 여부를 결정하는 단계(S130)를 더 포함한다.In addition. The control method of the mobile robot includes an image acquisition step (S110) of acquiring an image around the mobile robot, a distant distance between the mobile robot and an obstacle CA, and a distant distance between a point of the obstacle CA, and It further includes a step (S130) of determining whether to avoid the obstacle (CA) and determining whether to avoid the obstacle (CA) based on the distant distance (S120).
영상 획득단계(S110)에서, 로봇 청소기(100)는 주행과 동시에 실시간으로 로봇 청소기(100) 주변의 영상과 장애물(CA)과의 원근거리 및 이동 로봇의 주변의 3차원 좌표를 획득한다. 제어부(1800)는 영상 획득부를 제어하여서 주행 중 일정한 간격으로 로봇 청소기(100)의 주변의 영상 및 3차원 좌표를 획득할 수 있다. 여기서, 로봇 청소기(100) 주변의 영상은 로봇 청소기(100)의 정면과 측면을 포함할 수 있다.In the image acquisition step (S110), the
장애물(CA)을 판단하는 단계(S120)에서, 로봇 청소기(100)는 장애물(CA)과 주변의 영상 및 3차원 좌표 정보를 바탕으로 청소 영역에 장애물(CA)이 존재하는 지 판단한다.In step S120 of determining the obstacle CA, the
회피 결정 단계(S130)에서 로봇 청소기가 장애물(CA)이라고 판단하는 경우, 장애물(CA)의 높이를 바탕으로 장애물(CA)의 회피여부를 결정한다(S1310). 구체적으로, 제어부(1800)는 장애물(CA)의 3차원 좌표와 2차원 영상을 바탕으로 장애물(CA)의 높이를 산정하고, 장애물(CA)의 높이가 기준 높이 보다 큰 경우, 이동 로봇이 장애물(CA)을 회피 주행하도록 주행부(1300)를 제어한다. 여기서, 장애물(CA)을 회피한다는 것은 제어부(1800)가 주행부(1300)를 제어하여서, 로봇 청소기(100)가 장애물(CA)을 제외한 청소 영역을 주행 또는 청소하는 것을 의미한다.When the robot cleaner determines that the robot cleaner is the obstacle CA in the avoidance determination step S130, it determines whether or not the obstacle CA is avoided based on the height of the obstacle CA (S1310). Specifically, the
회피 결정 단계(S130)에서 장애물(CA)의 높이만으로 회피를 결정할 수 있지만, 장애물(CA)의 높이가 낮은 경우에 수건 같이 등반할 수 없는 장애물(CA)의 경우를 판단하기 위해 장애물(CA)의 평면적을 연산하여 장애물(CA)의 회피여부를 결정할 수 있다.In the avoidance determination step (S130), it is possible to determine avoidance only by the height of the obstacle CA, but when the height of the obstacle CA is low, the obstacle CA to determine the case of an obstacle CA that cannot be climbed like a towel. It is possible to determine whether to avoid the obstacle CA by calculating the plane area of.
회피 결정 단계(S130)에서, 로봇 청소기는 로봇 청소기(100)는 장애물(CA)의 평면적을 연산한다. 장애물(CA)의 평면적은 영상획득부에 의해 장애물(CA)의 전체 형상 및 장애물(CA)의 경계를 특정하고, 장애물(CA)의 폭, 길이, 높이 정보를 조합하여 매트형 장애물(CA)의 형상을 평면 좌표계에 표시하고, 매트형 장애물(CA)의 평면적을 연산할 수 있다. 로봇 청소기(100)는 장애물(CA)의 평면적이 기 설정된 평면적 값을 초과하는 경우(S1330), 장애물(CA)을 등반 가능한 장애물(CA)로 판단할 수 있다. In the avoidance determination step S130, the
진입각도(θA) 검출단계(S140)에서, 로봇 청소기는 장애물(CA)이 회피할 필요가 없는 장애물(CA)인 경우, 로봇 청소기의 장애물(CA)에 대한 진입각도(θA)를 검출한다. 진입각도(θA)를 검출하는 것은 도 5 및 6에서 상술한 바와 같다.In step S140 of detecting the entry angle θA, the robot cleaner detects the entry angle θA for the obstacle CA of the robot cleaner when the obstacle CA is an obstacle CA that does not need to be avoided. Detecting the entry angle θA is as described above with reference to FIGS. 5 and 6.
장애물(CA)을 등반여부를 결정하는 결정단계(S150, S160, S170)에서, 로봇 청소기의 진입각도(θA)에 따라 장애물(CA)을 등반여부를 결정한다. 구체적으로, 장애물(CA)을 등반여부를 결정하는 결정단계(S150, S160, S170)에서, 로봇 청소기는 진입각도(θA)가 정상 진입각도인지 여부를 판단하고(S150), 진입각도(θA)가 정상 진입각도 인 경우, 로봇 청소기가 장애물(CA)을 등반한다(S160). 로봇 청소기는 로봇 청소기의 진입각도(θA)가 비 정상 진입각도 인 경우, 로봇 청소기는 자세를 수정하여서, 진입각도(θA)를 변경한다(S170). 로봇 청소기는 수정된 자세에서, 다시 진입각도(θA) 검출단계(S140) 및 장애물(CA)을 등반여부를 결정하는 결정단계(S150, S160, S170)를 실행할 수 있다.In the determining step (S150, S160, S170) of determining whether to climb the obstacle CA, it is determined whether to climb the obstacle CA according to the entry angle θA of the robot cleaner. Specifically, in the determining step (S150, S160, S170) of determining whether to climb the obstacle CA, the robot cleaner determines whether the entry angle θA is a normal entry angle (S150), and the entry angle θA When is the normal entry angle, the robot cleaner climbs the obstacle CA (S160). In the robot cleaner, when the entry angle θA of the robot cleaner is an abnormal entry angle, the robot cleaner modifies the posture and changes the entry angle θA (S170). In the corrected posture, the robot cleaner may execute the step of detecting the angle of entry θA (S140) and the step of determining whether to climb the obstacle CA (S150, S160, and S170).
물론, 로봇 청소기는 여러 번 자세 수정을 한 경우에도 진입각도(θA)가 정상 진입각도가 되지 못하는 경우, 정상 진입각도의 각도 범위를 수정하여서, 다시 진입각도(θA) 검출단계(S140) 및 장애물(CA)을 등반여부를 결정하는 결정단계(S150, S160, S170)를 실행할 수 있다. Of course, the robot cleaner corrects the angle range of the normal entry angle when the entry angle θA is not the normal entry angle even when the posture is modified several times, and again, the entry angle θA detection step (S140) and the obstacle It is possible to execute the determining step (S150, S160, S170) of determining whether to climb (CA).
구체적으로, 로봇 청소기는 여러 번 자세 수정을 한 경우에도 진입각도(θA)가 정상 진입각도가 되지 못하는 경우, 정상 진입각도의 각도 범위를 86° 내지 94 °수정하여서, 다시 진입각도(θA) 검출단계(S140) 및 장애물(CA)을 등반여부를 결정하는 결정단계(S150, S160, S170)를 실행할 수 있다. Specifically, the robot cleaner detects the entry angle (θA) again by correcting the angle range of the normal entry angle from 86° to 94° when the entry angle (θA) is not the normal entry angle even after several posture corrections are made. The step S140 and the determining step S150, S160, and S170 of determining whether to climb the obstacle CA may be performed.
예를 들면, 진입각도(θA) 검출단계(S140)는 로봇 청소기의 주변의 영상 및 장애물(CA)의 영상을 획득하는 영상 획득단계(S110) 및 장애물(CA)의 영상에서 로봇 청소기의 진입각도(θA)를 연산하는 진입각도(θA) 연산단계를 포함할 수 있다. For example, the entrance angle (θA) detection step (S140) is an image acquisition step (S110) of acquiring an image of the surrounding of the robot cleaner and an image of the obstacle CA, and the entrance angle of the robot cleaner from the image of the obstacle CA. It may include an entry angle (θA) calculation step of calculating (θA).
진입각도(θA) 연산단계는 장애물(CA)의 영상에서, 장애물(CA)과 바닥의 경계선(BL)을 추출하고, 경계선과 로봇 청소기의 진행 방향 사이의 각도를 로봇 청소기의 진입각도(θA)를 결정할 수 있다. 로봇 청소기 주변의 영상을 기준으로 진입각도(θA)를 연산하는 것은 도 5에서 설명한 바와 같다.In the step of calculating the entrance angle (θA), the boundary line BL between the obstacle CA and the floor is extracted from the image of the obstacle CA, and the angle between the boundary line and the moving direction of the robot cleaner is calculated as the entry angle θA of the robot cleaner. Can be determined. Calculating the entrance angle θA based on the image around the robot cleaner is as described in FIG. 5.
다른 예로, 진입각도(θA) 검출단계(S140)는 도 6에서 상술한 바와 같이, 장애물(CA)과의 제1거리센서(1410a) 사이에 제1거리(F1)와 장애물(CA)과 제2거리센서(1410b) 사이의 제2거리(F2)를 추출하고, 제1거리(F1)와 제2거리(F2)의 차이 값을 바탕으로 로봇 청소기의 진입각도(θA)를 결정할 수 있다.As another example, in the step of detecting the entrance angle θA (S140), as described above in FIG. 6, the first distance F1 and the obstacle CA and the first distance between the
또한, 로봇 청소기(100)는 장애물(CA)의 등반 가능 여부에 대한 정보와, 장애물(CA)의 2차원 경계선을 장애물(CA) 지도에 저장하고, 이를 다른 로봇 청소기(100)에 전송할 수도 있다.In addition, the
이상에서는 본 발명의 바람직한 실시예에 대하여 도시하고 설명하였지만, 본 발명은 상술한 특정의 실시예에 한정되지 아니하며, 특허청구범위에서 청구하는 본 발명의 요지를 벗어남이 없이 당해 발명이 속하는 기술분야에서 통상의 지식을 가진 자에 의해 다양한 변형실시가 가능한 것은 물론이고, 이러한 변형실시들은 본 발명의 기술적 사상이나 전망으로부터 개별적으로 이해되어서는 안될 것이다.In the above, preferred embodiments of the present invention have been shown and described, but the present invention is not limited to the specific embodiments described above, and without departing from the gist of the present invention claimed in the claims, Various modifications are possible by those of ordinary skill in the art, and these modifications should not be individually understood from the technical spirit or prospect of the present invention.
100: 로봇 청소기
110: 청소기 본체
120: 청소 유닛
130: 센싱유닛
140: 먼지통100: robot vacuum cleaner 110: vacuum cleaner body
120: cleaning unit 130: sensing unit
140: dust bin
Claims (18)
주변의 영상 및 장애물의 영상을 획득하는 영상획득부;
상기 영상획득부에서 획득한 영상을 분석하여 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 제어부를 포함하고,
상기 제어부는,
상기 영상획득부에서 획득한 영상을 분석하여 상기 장애물에 대한 이동 로봇의 진입각도를 검출하고, 상기 이동 로봇의 진입각도에 따라 상기 장애물을 등반하게 제어하는 이동 로봇.A first driving motor driving a left wheel and a second driving motor driving a right wheel;
An image acquisition unit for acquiring an image of a surrounding image and an obstacle;
And a control unit for controlling the first driving motor and the second driving motor by analyzing the image acquired by the image acquisition unit,
The control unit,
A mobile robot configured to analyze an image acquired by the image acquisition unit to detect an entry angle of the mobile robot to the obstacle, and to control to climb the obstacle according to the entry angle of the mobile robot.
상기 제어부는
상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 장애물을 등반하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 이동 로봇.The method of claim 1,
The control unit
When the entry angle of the mobile robot is a normal entry angle, the mobile robot controls the first driving motor and the second driving motor so that the mobile robot climbs the obstacle.
상기 제어부는,
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 되도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 이동 로봇.The method of claim 1,
The control unit,
When the entry angle of the mobile robot is an abnormal entry angle, the mobile robot controls the first driving motor and the second driving motor so that the entry angle of the mobile robot is a normal entry angle.
상기 제어부는,
상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정상속도 보다 낮은 저속으로 구동하는 이동 로봇.The method of claim 1,
The control unit,
A mobile robot that drives the first driving motor and the second driving motor at a lower speed than a normal speed when the entry angle is detected.
상기 제어부는,
상기 진입각도 검출 시에, 상기 제1 구동모터 및 상기 제2 구동모터를 정지시키는 이동 로봇.The method of claim 1,
The control unit,
A mobile robot that stops the first driving motor and the second driving motor when the entry angle is detected.
상기 제어부는,
상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 진입각도를 유지하면서 상기 장애물에 접근하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 이동 로봇.The method of claim 1,
The control unit,
When the entry angle of the mobile robot is a normal entry angle, the mobile robot controls the first driving motor and the second driving motor so that the mobile robot approaches the obstacle while maintaining the entry angle.
상기 제어부는,
상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 제1 구동모터 및 상기 제2 구동모터를 동일한 속도로 정회전되게 제어하는 이동 로봇.The method of claim 1,
The control unit,
When the entry angle of the mobile robot is a normal entry angle, the mobile robot controls the first driving motor and the second driving motor to rotate forward at the same speed.
상기 제어부는,
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 될때 까지 상기 이동 로봇을 회전시키면서 상기 진입각도로를 검출하는 이동 로봇.The method of claim 1,
The control unit,
When the entry angle of the mobile robot is an abnormal entry angle, the mobile robot detects the entry angle while rotating the mobile robot until the entry angle of the mobile robot becomes a normal entry angle.
상기 제어부는,
상기 영상획득부에서 획득한 영상을 분석하여 상기 장애물과 바닥의 경계선을 추출하고, 상기 경계선과 상기 이동 로봇의 진행 방향 사이의 각도를 상기 이동 로봇의 진입각도를 결정하는 이동 로봇.The method of claim 1,
The control unit,
A mobile robot that analyzes the image acquired by the image acquisition unit to extract a boundary line between the obstacle and the floor, and determines an entry angle of the mobile robot by an angle between the boundary line and a moving direction of the mobile robot.
장애물과의 제1 거리를 측정하는 제1 거리센서;
상기 장애물과의 제2 거리를 측정하는 제2 거리센서; 및
상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 제어부를 포함하고,
상기 제어부는,
상기 제1 거리와 상기 제2 거리를 비교하여 상기 장애물에 대한 이동 로봇의 진입각도를 검출하고, 상기 이동 로봇의 진입각도에 따라 상기 장애물을 등반하게 제어하는 이동 로봇.A first driving motor driving a left wheel and a second driving motor driving a right wheel;
A first distance sensor measuring a first distance to an obstacle;
A second distance sensor measuring a second distance to the obstacle; And
And a control unit for controlling the first driving motor and the second driving motor,
The control unit,
A mobile robot that compares the first distance and the second distance to detect an entry angle of the mobile robot to the obstacle, and controls to climb the obstacle according to the entry angle of the mobile robot.
상기 제1 거리센서 및 상기 제2 거리센서는 상기 좌측 휠과 상기 우측 휠을 연결한 선과 나란한 선 상에서 서로 이격하여 배치되는 이동 로봇.The method of claim 10,
The first distance sensor and the second distance sensor are disposed to be spaced apart from each other on a line parallel to a line connecting the left wheel and the right wheel.
상기 제어부는
상기 장애물과의 제1 거리센서 사이에 제1 거리와 상기 장애물과 제2 거리센서 사이의 제2 거리를 추출하고,
상기 제1 거리와 상기 제2 거리의 차이 값을 바탕으로 상기 이동 로봇의 진입각도를 결정하는 이동 로봇.The method of claim 10,
The control unit
Extracting a first distance between the obstacle and the first distance sensor and a second distance between the obstacle and the second distance sensor,
A mobile robot that determines an entry angle of the mobile robot based on a difference value between the first distance and the second distance.
상기 제어부는
상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 장애물을 등반하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 이동 로봇.The method of claim 10,
The control unit
When the entry angle of the mobile robot is a normal entry angle, the mobile robot controls the first driving motor and the second driving motor so that the mobile robot climbs the obstacle.
상기 제어부는,
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 되도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 이동 로봇.The method of claim 1,
The control unit,
When the entry angle of the mobile robot is an abnormal entry angle, the mobile robot controls the first driving motor and the second driving motor so that the entry angle of the mobile robot is a normal entry angle.
상기 제어부는,
상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 이동로봇이 상기 진입각도를 유지하며 상기 장애물에 접근하도록 상기 제1 구동모터 및 상기 제2 구동모터를 제어하는 이동 로봇.The method of claim 10,
The control unit,
When the entry angle of the mobile robot is a normal entry angle, the mobile robot maintains the entry angle and controls the first driving motor and the second driving motor to approach the obstacle.
상기 제어부는,
상기 이동 로봇의 진입각도가 정상 진입각도 인 경우, 상기 제1 구동모터 및 상기 제2 구동모터를 동일한 속도로 정회전되게 제어하는 이동 로봇.The method of claim 10,
The control unit,
When the entry angle of the mobile robot is a normal entry angle, the mobile robot controls the first driving motor and the second driving motor to rotate forward at the same speed.
상기 제어부는,
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 이동 로봇의 진입각도가 정상 진입각도가 될때 까지 상기 이동 로봇을 회전시키면서 상기 진입각도로를 검출하는 이동 로봇.The method of claim 10,
The control unit,
When the entry angle of the mobile robot is an abnormal entry angle, the mobile robot detects the entry angle while rotating the mobile robot until the entry angle of the mobile robot becomes a normal entry angle.
상기 제어부는,
상기 이동 로봇의 진입각도가 비 정상 진입각도 인 경우, 상기 제1 거리와 상기 제2 거리 중 짧은 거리를 판단하고, 짧은 거리를 측정한 거리 센서가 위치하는 방향으로 상기 이동 로봇의 초기 회전을 시작하는 이동 로봇.
The method of claim 17,
The control unit,
When the entry angle of the mobile robot is an abnormal entry angle, a shorter distance is determined among the first distance and the second distance, and the initial rotation of the mobile robot starts in the direction in which the distance sensor measuring the short distance is located. Moving robot.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190033339A KR102424536B1 (en) | 2019-03-25 | 2019-03-25 | a Moving robot and Controlling method for the moving robot |
PCT/KR2020/003467 WO2020197135A1 (en) | 2019-03-25 | 2020-03-12 | Moving robot and controlling method for the same |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190033339A KR102424536B1 (en) | 2019-03-25 | 2019-03-25 | a Moving robot and Controlling method for the moving robot |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20200119375A true KR20200119375A (en) | 2020-10-20 |
KR102424536B1 KR102424536B1 (en) | 2022-07-22 |
Family
ID=72610213
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020190033339A KR102424536B1 (en) | 2019-03-25 | 2019-03-25 | a Moving robot and Controlling method for the moving robot |
Country Status (2)
Country | Link |
---|---|
KR (1) | KR102424536B1 (en) |
WO (1) | WO2020197135A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115437388A (en) * | 2022-11-09 | 2022-12-06 | 成都朴为科技有限公司 | Method and device for escaping from poverty of omnidirectional mobile robot |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113189992B (en) * | 2021-04-26 | 2023-05-12 | 四川大学 | Group intelligent obstacle avoidance method based on local orientation |
CN114227711B (en) * | 2021-12-24 | 2024-06-07 | 杭州申昊科技股份有限公司 | Underground power grid inspection robot |
CN115639820B (en) * | 2022-10-18 | 2023-08-01 | 未岚大陆(北京)科技有限公司 | Virtual wall setting method, autonomous mobile device, and computer-readable storage medium |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100635828B1 (en) * | 2005-04-25 | 2006-10-19 | 엘지전자 주식회사 | Method for controlling navigation of a cleaning robot |
KR101165969B1 (en) * | 2011-04-27 | 2012-07-18 | 목포대학교산학협력단 | Position measuring device having distance and angle measuring function |
KR20140138555A (en) | 2014-10-24 | 2014-12-04 | 김태윤 | Eco magnesium alloy manufacturing method and manufacturing apparatus thereof |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR0156722B1 (en) * | 1995-08-08 | 1998-11-16 | 김광호 | The control method and device for self-recognition of robot |
JP2006178664A (en) * | 2004-12-21 | 2006-07-06 | Funai Electric Co Ltd | Self-propelled cleaning robot |
KR101409987B1 (en) * | 2007-12-11 | 2014-06-23 | 삼성전자주식회사 | Method and apparatus for correcting pose of moving robot |
-
2019
- 2019-03-25 KR KR1020190033339A patent/KR102424536B1/en active IP Right Grant
-
2020
- 2020-03-12 WO PCT/KR2020/003467 patent/WO2020197135A1/en active Application Filing
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100635828B1 (en) * | 2005-04-25 | 2006-10-19 | 엘지전자 주식회사 | Method for controlling navigation of a cleaning robot |
KR101165969B1 (en) * | 2011-04-27 | 2012-07-18 | 목포대학교산학협력단 | Position measuring device having distance and angle measuring function |
KR20140138555A (en) | 2014-10-24 | 2014-12-04 | 김태윤 | Eco magnesium alloy manufacturing method and manufacturing apparatus thereof |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115437388A (en) * | 2022-11-09 | 2022-12-06 | 成都朴为科技有限公司 | Method and device for escaping from poverty of omnidirectional mobile robot |
CN115437388B (en) * | 2022-11-09 | 2023-01-24 | 成都朴为科技有限公司 | Method and device for escaping from poverty of omnidirectional mobile robot |
Also Published As
Publication number | Publication date |
---|---|
KR102424536B1 (en) | 2022-07-22 |
WO2020197135A1 (en) | 2020-10-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102234641B1 (en) | Moving robot and Controlling method for the same | |
KR102210360B1 (en) | a Moving robot and Controlling method for the moving robot | |
KR102424536B1 (en) | a Moving robot and Controlling method for the moving robot | |
KR20200103203A (en) | A plurality of autonomous mobile robots and a controlling method for the same | |
KR102309303B1 (en) | Robot Cleaner and Controlling Method for the same | |
KR102096564B1 (en) | A plurality of autonomous cleaner and a controlling method for the same | |
KR102369661B1 (en) | Moving robot and Controlling method for the same | |
KR102198187B1 (en) | Moving robot | |
KR102179057B1 (en) | A plurality of autonomous cleaner and a controlling method for the same | |
KR102217540B1 (en) | Moving robot and Controlling method for the same | |
KR102535719B1 (en) | a Moving robot and Controlling method for the moving robot | |
KR102081340B1 (en) | A plurality of autonomous cleaner and a controlling method for the same | |
KR102234642B1 (en) | a Moving robot and Controlling method for the moving robot | |
KR102309898B1 (en) | Docking equipment and Moving robot system | |
KR102348963B1 (en) | Robot cleaner and Controlling method for the same | |
KR20210146141A (en) | Moving robot and method for driving in corner areas thereof | |
KR20200133544A (en) | A moving robot and an controlling method for the same | |
KR102390040B1 (en) | Robot Cleaner and Controlling Method for the same | |
KR102115193B1 (en) | A robot cleaner and an operation method for the same | |
KR102361982B1 (en) | Moving robot and method for controlling thereof | |
KR102390039B1 (en) | Robot cleaner and Controlling method for the same | |
KR102398332B1 (en) | Cleaner and controlling method thereof | |
KR102277650B1 (en) | Cleaner and controlling method thereof | |
KR20200137263A (en) | A moving robot and an controlling method for the same | |
KR20240118698A (en) | Moving robot and controlling method for the moving robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AMND | Amendment | ||
E601 | Decision to refuse application | ||
AMND | Amendment | ||
X601 | Decision of rejection after re-examination | ||
J201 | Request for trial against refusal decision | ||
J301 | Trial decision |
Free format text: TRIAL NUMBER: 2021101001285; TRIAL DECISION FOR APPEAL AGAINST DECISION TO DECLINE REFUSAL REQUESTED 20210520 Effective date: 20220323 |
|
GRNO | Decision to grant (after opposition) | ||
GRNT | Written decision to grant |