KR20060014715A - Control method of automatic floor cleaner - Google Patents
Control method of automatic floor cleaner Download PDFInfo
- Publication number
- KR20060014715A KR20060014715A KR1020040063384A KR20040063384A KR20060014715A KR 20060014715 A KR20060014715 A KR 20060014715A KR 1020040063384 A KR1020040063384 A KR 1020040063384A KR 20040063384 A KR20040063384 A KR 20040063384A KR 20060014715 A KR20060014715 A KR 20060014715A
- Authority
- KR
- South Korea
- Prior art keywords
- cleaning
- vertex
- corner
- area
- robot
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 88
- 238000004140 cleaning Methods 0.000 claims abstract description 500
- 238000012545 processing Methods 0.000 claims description 31
- 230000008569 process Effects 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 3
- 230000015572 biosynthetic process Effects 0.000 claims 1
- 238000001514 detection method Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000003749 cleanliness Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000015654 memory Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000004745 nonwoven fabric Substances 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Images
Classifications
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L9/00—Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
- A47L9/28—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
- A47L9/2805—Parameters or conditions being sensed
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- 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/06—Control of the cleaning action for autonomous devices; Automatic detection of the surface condition before, during or after cleaning
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
전체적으로 고른 청소가 가능하며 제어가 용이하도록, 청소용 로봇이 청소를 행하고자 하는 영역을 벽면을 따라 일정한 방향으로 벽면에 근접된 상태로 이동하면서 벽면의 위치정보를 획득하여 복수의 꼭지점과 선분으로 이루어지는 폐곡선의 청소지도를 생성하고, 생성된 청소지도를 기준으로 어느 한 꼭지점을 시작점으로 하여 벽면을 따라 일정한 방향으로 벽면에 흡입구가 근접된 상태로 청소용 로봇이 이동하면서 모서리부분에 대한 모서리 청소를 행하고, 하나 이상의 선분에 해당하는 모서리 청소를 행한 다음 이들 선분에 의하여 이루어지는 삼각형 또는 사각형의 내부에 대한 영역 청소를 행하고, 모서리 청소와 영역 청소를 반복하여 행하도록 이루어지는 청소용 로봇의 제어방법을 제공한다.Closed curve composed of a plurality of vertices and line segments by moving the area to be cleaned by the cleaning robot in a state close to the wall in a predetermined direction along the wall so that the cleaning robot can be uniformly cleaned and easy to control. Generates a cleaning map of the cleaning machine, and cleans the corners of the corners while moving the cleaning robot with the suction port proximate to the wall in a constant direction along the wall with one vertex as the starting point based on the generated cleaning map. After cleaning the edges corresponding to the above-described line segment, the cleaning method for the cleaning robot is provided, which performs area cleaning on the inside of the triangle or quadrangle formed by these line segments, and repeats the corner cleaning and the area cleaning.
청소, 로봇, 자동 청소기, 흡입구, 청소지도, 청소방법, 제어, 센서, 모서리, 영역Cleaning, robot, auto cleaner, intake, cleaning map, cleaning method, control, sensor, corner, area
Description
도 1은 본 발명에 따른 청소용 로봇의 제어방법의 제1실시예를 설명하기 위하여 "L"형상 청소지도를 개념적으로 나타내는 평면도이다.1 is a plan view conceptually showing an "L" shape cleaning map for explaining a first embodiment of a control method of a cleaning robot according to the present invention.
도 2는 본 발명에 따른 청소용 로봇의 제어방법의 제1실시예에 있어서 청소용 로봇이 모서리 청소를 행하는 상태를 설명하기 위한 평면도이다.2 is a plan view for explaining a state in which the cleaning robot performs the corner cleaning in the first embodiment of the control method of the cleaning robot according to the present invention.
도 3은 본 발명에 따른 청소용 로봇의 제어방법의 제1실시예에 있어서 청소용 로봇이 영역 청소를 행하는 상태를 설명하기 위한 평면도이다.3 is a plan view for explaining a state in which the cleaning robot performs area cleaning in the first embodiment of the control method of the cleaning robot according to the present invention.
도 4는 본 발명에 따른 청소용 로봇의 제어방법의 제1실시예를 나타내는 순서도이다.4 is a flowchart showing a first embodiment of a control method of a cleaning robot according to the present invention.
도 5는 본 발명에 따른 청소용 로봇의 제어방법의 제1실시예에 있어서 청소용 로봇의 제어부 구성을 나타내는 블럭도이다.Fig. 5 is a block diagram showing a control unit configuration of the cleaning robot in the first embodiment of the control method of the cleaning robot according to the present invention.
도 6은 본 발명에 따른 청소용 로봇의 제어방법의 제1실시예에 있어서 영역 청소를 수행하는 다른 방법을 설명하는 평면도이다.6 is a plan view for explaining another method of performing area cleaning in the first embodiment of the control method of the cleaning robot according to the present invention.
도 7은 본 발명에 따른 청소용 로봇의 제어방법의 제2실시예를 설명하기 위한여 "L"형상 청소지도를 개념적으로 나타내는 평면도이다.Fig. 7 is a plan view conceptually showing a “L” shape cleaning map for explaining the second embodiment of the control method of the cleaning robot according to the present invention.
도 8은 본 발명에 따른 청소용 로봇의 제어방법의 제3실시예를 나타내는 순서도이다.8 is a flowchart illustrating a third embodiment of a control method of a cleaning robot according to the present invention.
도 9는 본 발명에 따른 청소용 로봇의 제어방법의 제3실시예를 설명하기 위하여 "L"형상 청소지도를 개념적으로 나타내는 평면도이다.9 is a plan view conceptually showing an "L" shape cleaning map for explaining the third embodiment of the control method of the cleaning robot according to the present invention.
도 10은 본 발명에 따른 청소용 로봇의 제어방법의 제3실시예를 설명하기 위하여 "ㄷ"형상 청소지도를 개념적으로 나타내는 평면도이다.10 is a plan view conceptually showing a "c" shape cleaning map for explaining a third embodiment of a control method of a cleaning robot according to the present invention.
도 11은 본 발명에 따른 청소용 로봇의 제어방법의 제3실시예를 설명하기 위하여 "T"형상 청소지도를 개념적으로 나타내는 평면도이다.Fig. 11 is a plan view conceptually showing a “T” shape cleaning map for explaining the third embodiment of the control method of the cleaning robot according to the present invention.
도 12은 본 발명에 따른 청소용 로봇의 제어방법의 제4실시예를 설명하기 위하여 비정형화된 청소지도의 일예를 개념적으로 나타내는 평면도이다.12 is a plan view conceptually illustrating an example of an atypical cleaning map in order to explain a fourth embodiment of a control method of a cleaning robot according to the present invention.
도 13은 본 발명에 따른 청소용 로봇의 제어방법의 제4실시예를 설명하기 위하여 비정형화된 청소지도의 다른예를 개념적으로 나타내는 평면도이다.FIG. 13 is a plan view conceptually illustrating another example of an atypical cleaning map for explaining a fourth embodiment of a control method of a cleaning robot according to the present invention.
본 발명은 청소용 로봇의 제어방법에 관한 것으로, 보다 상세하게는 모서리 청소를 우선적으로 시행하고 내부 영역에 대한 영역 청소를 행하며 내부 영역을 다수의 작은 사각형이나 삼각형 등으로 나누어 청소하도록 제어하므로 전체적으로 고른 청소가 가능하며 제어가 용이한 청소용 로봇의 제어방법에 관한 것이다.The present invention relates to a control method of a robot for cleaning, and more particularly, the corner cleaning is performed first, the area cleaning for the inside area is controlled, and the inside area is controlled to be divided into a plurality of small squares or triangles to clean the whole area. The present invention relates to a control method of a robot for cleaning that can be easily controlled.
일반적으로 청소용 로봇은 사용자의 조작이 없이 스스로 이동하면서 정해진 구역 내를 청소하는 자동 청소기를 말한다. 이러한 청소용 로봇에 있어서 주어진 청소영역에 대하여 어떠한 경로로 청소를 행하도록 제어하는가의 여부는 청소효율 과 청소품질의 면에서 매우 중요하다.In general, a cleaning robot refers to an automatic cleaner that cleans a predetermined area while moving by itself without a user's manipulation. In such a cleaning robot, how to control the cleaning for a given cleaning area is very important in terms of cleaning efficiency and cleaning quality.
종래 청소용 로봇의 제어방법으로 정해진 경로를 따라 직선으로 왕복이동하면서 청소를 행하도록 제어하는 방법이 대한민국 특허공고공보 제1995-005403호에 개시되어 있으며, 정해진 경로가 아닌 무작위로 청소를 행하도록 제어하는 방법이 공개특허공보 제2003-66010호에 개시되어 있다.A method for controlling cleaning by performing a reciprocating movement in a straight line along a predetermined path as a control method of a conventional cleaning robot is disclosed in Korean Patent Publication No. 1995-005403, which controls to perform cleaning at random rather than a predetermined path. The method is disclosed in publication 2003-66010.
그러나 상기와 같은 종래 청소용 로봇의 제어방법에 있어서는 벽면에 접한 모서리부분에 대한 청소가 충분하게 이루어지지 않게 된다. 즉 종래 청소용 로봇의 제어방법에 의하면 청소용 로봇이 모서리부분에서 방향을 전환하는 경우에 부분적으로 청소가 이루어지지 않는 구역이 발생할 가능성이 매우 높다.However, in the control method of the conventional cleaning robot as described above, the cleaning of the edge portion in contact with the wall is not sufficiently performed. That is, according to the control method of the cleaning robot according to the related art, when the cleaning robot changes its direction at the corner portion, there is a high possibility that an area where the cleaning robot is not partially cleaned occurs.
그리고 종래 청소용 로봇의 제어방법에 의하면 전체적인 청소영역이 복잡한 구조로 이루어진 경우 청소가 이루어지지 않는 구역이 발생하거나 청소시간이 오래 걸릴 우려가 있다.In addition, according to the control method of the cleaning robot according to the related art, when the entire cleaning area has a complicated structure, there is a possibility that an area in which cleaning is not made occurs or the cleaning time may take a long time.
본 발명의 목적은 상기와 같은 문제점을 해결하기 위한 것으로서, 벽면을 따라 이동하면서 청소지도를 생성하고 이를 기준으로 모서리 청소를 우선적으로 시행하고 내부 영역에 대한 영역 청소를 행하며 내부 영역을 다수의 작은 사각형이나 삼각형 등으로 나누어 순차적으로 청소하도록 제어하므로 전체적으로 고른 청소가 가능하며 제어가 용이한 청소용 로봇의 제어방법을 제공하기 위한 것이다.SUMMARY OF THE INVENTION An object of the present invention is to solve the above problems, and generates a cleaning map while moving along a wall surface, and performs corner cleaning on the basis of the above, and cleans an area for an inner area, and covers an inner area with a plurality of small squares. It is to provide a control method of the cleaning robot that can be cleaned evenly as a whole because it is controlled to clean sequentially by dividing into a triangle or the like.
본 발명이 제안하는 청소용 로봇의 제어방법은 청소용 로봇이 청소를 행하고 자 하는 영역을 벽면을 따라 일정한 방향(시계방향 또는 시계반대방향)으로 벽면에 근접된 상태로 이동하면서 외곽 테두리(벽면)의 위치정보(좌표값)를 획득하여 복수의 꼭지점과 선분으로 이루어지는 폐곡선의 청소지도를 생성하고, 생성된 청소지도를 기준으로 어느 한 꼭지점을 시작점으로 하여 벽면(선분)을 따라 일정한 방향으로 벽면에 흡입구가 근접된 상태로 청소용 로봇이 이동하면서 모서리부분에 대한 모서리 청소를 행하고, 하나 이상의 선분에 해당하는 모서리 청소를 행한 다음 이들 선분에 의하여 이루어지는 삼각형 또는 사각형의 내부에 대한 영역 청소를 행하고, 상기 모서리 청소와 영역 청소를 반복하여 행하도록 이루어진다.In the control method of the cleaning robot proposed by the present invention, the position of the outer edge (wall surface) while moving the area to be cleaned by the cleaning robot close to the wall surface in a predetermined direction (clockwise or counterclockwise) along the wall surface Acquire information (coordinate values) to generate a cleaning map of the closed curve consisting of a plurality of vertices and line segments, and the suction port is provided on the wall in a predetermined direction along the wall (line segment) based on one of the vertices based on the generated cleaning map. As the cleaning robot moves in close proximity, it cleans the edges of the edges, cleans the edges corresponding to one or more line segments, and then cleans the area of the inside of the triangle or rectangle formed by these lines. The area cleaning is performed repeatedly.
상기에서 청소지도를 이루는 꼭지점은 이웃하는 2개의 선분이 내부를 기준으로 180°보다 큰 각도로 만나는 개방 꼭지점과, 이웃하는 2개의 선분이 180°보다 작은 각도로 만나는 내향 꼭지점으로 각각 정의되어 인식된다.The vertices of the cleaning map are defined as open vertices where two neighboring segments meet at an angle greater than 180 ° from the inside, and inward vertices where two neighboring segments meet at an angle less than 180 °, respectively. .
상기에서 청소지도를 이루는 모든 꼭지점이 내향 꼭지점인 경우에는 전체 모서리에 대한 모서리 청소를 시행하고, 내부의 영역에 대한 영역 청소를 시행한다.In the case where all the vertices of the cleaning map are inward vertices, the edge cleaning is performed on all the corners, and the area cleaning on the inside area is performed.
상기 시작점은 내향 꼭지점으로 설정하는 것도 가능하고, 개방 꼭지점으로 설정하는 것도 가능하다.The starting point may be set to an inward vertex or may be set to an open vertex.
또 상기 시작점을 내향 꼭지점으로 설정하는 경우에는 이웃하는 꼭지점중 적어도 전진하는 방향에 위치하는 꼭지점이 내향 꼭지점이 되도록 설정하는 것이 최초의 영역 청소를 행하기 위한 내부 영역을 설정하는 것이 편리하므로 바람직하다.When the starting point is set as an inward vertex, it is preferable to set the vertex located at least in the advancing direction among neighboring vertices to be an inward vertex because it is convenient to set an internal area for the first area cleaning.
그리고 본 발명의 청소용 로봇의 제어방법은 모서리 청소를 행하는 도중에 개방 꼭지점을 만나는 경우에는 지나온 선분(모서리)에 대하여 소정의 각도로 회전 하여 내부 영역을 설정하기 위하여 다른 꼭지점 또는 선분과 만나기까지 구분선 청소를 행하도록 이루어진다.In addition, the control method of the cleaning robot of the present invention cleans the dividing line until it meets another vertex or line segment in order to set an internal area by rotating at a predetermined angle with respect to the past line segment (edge) during the corner cleaning. To be done.
상기에서 모서리 청소, 영역 청소, 구분선 청소가 행해진 부분은 완료영역으로 인식하도록 설정하여 중복으로 청소를 행하는 것을 방지하는 것이 바람직하다.In the above, it is preferable that the edge cleaning, the area cleaning, and the division line cleaning are set to be recognized as the completed area to prevent the cleaning from being repeated.
다음으로 본 발명에 따른 청소용 로봇의 제어방법의 바람직한 실시예를 도면을 참조하여 상세하게 설명한다.Next, a preferred embodiment of a control method of a cleaning robot according to the present invention will be described in detail with reference to the drawings.
먼저 본 발명에 따른 청소용 로봇의 제어방법의 제1실시예는 도 1∼도 4에 나타낸 바와 같이, 청소용 로봇(10)이 청소를 행하고자 하는 영역을 벽면(2)을 따라 일정한 방향(예들 들면 시계반대방향)으로 벽면(2)에 근접된 상태로 이동하면서 외곽 테두리(벽면)의 위치정보(좌표값)를 획득하여 복수의 꼭지점(O1), (O2), (O3
), (O4), (O5), (O6)과 선분으로 이루어지는 폐곡선의 청소지도를 생성하는 지도생성단계(S10)와, 생성된 청소지도를 기준으로 어느 한 꼭지점(O1)을 시작점으로 설정하는 시작점설정단계(S20)와, 시작점으로부터 시작하여 벽면(선분)을 따라 일정한 방향으로 벽면(2)에 흡입구(12)가 근접된 상태로 청소용 로봇(10)이 이동하면서 모서리부분(L1), (L2)에 대한 모서리 청소를 행하는 모서리청소단계(S30)와, 하나 이상의 선분에 해당하는 모서리 청소를 행한 다음 이들 선분에 의하여 이루어지는 삼각형 또는 사각형의 내부(I1)에 대한 영역 청소를 행하는 영역청소단계(S40)와, 상기 모서리 청소와 영역 청소를 반복하여 행하는 과정으로 이루어진다.First, as shown in FIGS. 1 to 4, a first embodiment of a method for controlling a cleaning robot according to the present invention is arranged in a predetermined direction (for example, along a wall surface 2) of an area to be cleaned by the
상기 청소용 로봇(10)은 도 2 및 도 3에 나타낸 바와 같이, 한쪽에 흡입구 (12)가 설치되며, 바닥부분에는 한쌍의 주행바퀴(16)가 설치된다.As shown in FIGS. 2 and 3, the
상기 흡입구(12)는 일정한 각도로 좌우회전이 가능하거나 360°자유회전이 가능한 상태로 설치되고, 도면에 나타내지 않은 진공펌프에 연결된 흡입관이 연결 설치된다.The
상기 흡입구(12)에는 부직포 등으로 이루어지는 걸레를 부착하는 것도 가능하다.It is also possible to attach a mop made of a nonwoven fabric or the like to the
상기 한쌍의 주행바퀴(16) 각각에 회전력을 부여하는 모터(도면에 나타내지 않음)의 회전여부 및 회전속도, 회전방향 등을 제어하는 것에 의하여 청소용 로봇(10)의 전후진, 좌우회전 등을 행하는 것이 가능하다.By controlling the rotation of the motor (not shown) and the rotational speed, direction of rotation, etc., which impart rotational force to each of the pair of
상기 청소용 로봇(10)의 흡입구(12), 주행바퀴(16) 등의 구체적인 구성은 일반적인 청소용 로봇의 다양한 구성을 모두 적용하여 실시하는 것이 가능하고, 본 발명에 있어서 특징적인 부분이 아니므로 상세한 설명은 생략한다.Specific configuration of the
그리고 상기 청소용 로봇(10)에는 도 5에 나타낸 바와 같이, 근접센서, 거리센서, 조도센서, CCD 카메라, 충돌감지센서, 초음파센서, 적외선센서 등의 다양한 센서가 단독으로 또는 조합되어 사용되는 센서부(24)와, ROM, RAM 등의 다양한 메모리로 이루어지는 저장부(22)와, 주행용 모터, 흡입구회전용 모터 등의 다양한 구동기구나 동력원으로 이루어지는 구동부(26)와, 상기 센서부(24)의 감지신호를 처리하고 구동부(26)를 제어하기 위한 제어신호를 전송하며 상기 저장부(22)에 데이터값의 저장 등을 행하는 중앙처리부(20)가 설치된다.And the
상기 중앙처리부(20)는 IC칩 등의 반도체와 인쇄회로기판(PCB) 등을 이용하 여 이루어지고, 청소용 로봇(10)의 본체에 설치된다.The
상기 저장부(22)는 인쇄회로기판에 중앙처리부(20)와 전기적으로 연결되도록 설치된다.The
상기와 같이 구성되는 청소용 로봇(10)을 이용하여 청소지도를 생성하는 지도생성단계(S10)에 대하여 설명한다.A map generation step S10 for generating a cleaning map using the
먼저 상기 청소용 로봇(10)을 청소를 행하고자 하는 구역의 임의의 위치에 놓은 다음 구동시키면, 청소용 로봇(10)은 최초로 구동된 위치에서 임의의 방향으로 벽면(2)에 근접될 때까지 전진하고, 벽면(2)에 근접(또는 접촉)된 것을 상기 센서부(24)가 감지하면 상기 중앙처리부(20)는 그 지점을 최초 원점(0,0)으로 설정하고, 이 최초 원점(0,0)으로부터 출발하여 청소용 로봇(10)이 벽면(2)을 따라 시계반대방향으로 이동함에 따라 상기 센서부(24)를 통하여 측정되는 전진 거리만큼 선분을 그리고, 벽면(2)의 구석부를 만나 청소용 로봇(10)이 벽면(2)을 따라 소정의 각도로 회전하게 되면 이 지점을 첫번째 꼭지점으로 인식하여 좌표값(x,y)을 저장하고, 계속하여 청소용 로봇(10)이 진행함에 따라 선분과 꼭지점으로 이루어지는 청소지도를 생성한다.First, when the
상기에서는 청소용 로봇(10)이 시계반대방향으로 이동하면서 청소지도를 생성하는 것으로 설명하였지만, 시계방향으로 이동하면서 청소지도를 생성하는 것도 가능하다.In the above description, the
상기와 같은 과정을 거쳐 벽면(2)을 일주하여 청소용 로봇(10)이 최초 원점(0,0)으로 복귀하게 되면, 1차 청소지도의 생성작업을 완료하고 중앙처리부(20)는 이 청소지도의 데이터값(꼭지점의 좌표값 및 선분의 길이, 회전각도 등) 및 도면을 저장부(22)에 저장한다.When the
상기 최초 원점(0,0)은 첫번째 꼭지점으로 설정하도록 구성하는 것도 가능하다. 이 때에는 첫번째 꼭지점부터 거리와 회전 각도 등을 측정하여 차례로 선분과 꼭지점을 인식하여 청소지도를 생성한다. 상기 청소지도를 생성하는 방법 및 프로그램(소프트웨어)은 일반적으로 널리 알려진 다양한 그래픽 프로그램, CAD 프로그램, 네비게이션 프로그램 등의 로직이나 알고리즘, 원리 등을 이용하여 구성하는 것이 가능하므로, 상세한 설명은 생략한다. 예를 들면 컴퓨터와 연결된 마우스나 타블렛 등을 이동함에 따라 모니터 상에서 포인터가 이동하는 방식을 이용하여 마우스의 기능을 하는 상기 센서부(24)로부터 감지되는 신호의 변화에 대응하여 상기 중앙처리부(20)에서 포인터가 이동하듯이 선분을 작성하면서 청소지도를 생성하도록 구성하는 것도 가능하다.The first origin (0, 0) can also be configured to set as the first vertex. In this case, the distance and rotation angle are measured from the first vertex, and the cleaning segment is generated by recognizing the line segments and vertices in turn. Since the method and program (software) for generating the cleaning map can be configured using logic, algorithms, principles, and the like, which are generally known as various graphic programs, CAD programs, and navigation programs, detailed descriptions thereof will be omitted. For example, the
상기에서 청소지도를 이루는 꼭지점은 이웃하는 2개의 선분이 내부를 기준으로 180°보다 큰 각도로 만나는 개방 꼭지점(O3)과, 이웃하는 2개의 선분이 180°보다 작은 각도로 만나는 내향 꼭지점(O1), (O2), (O4), (O5), (O6)으로 각각 정의되어 인식된다.The vertex forming the cleaning map is an open vertex (O 3 ) where two neighboring segments meet at an angle greater than 180 ° relative to the inside, and an inward vertex where two neighboring segments meet at an angle smaller than 180 ° (O). 1 ), (O 2 ), (O 4 ), (O 5 ), and (O 6 ), respectively.
그리고 청소지도에 있어 각 선분도 일정 간격을 두고 위치하는 점의 집합으로 인식하여 각 점의 좌표값에 대한 데이터를 디지털값으로 저장하는 것이 여러가지 작업을 행함에 있어 매우 편리하다.In the cleaning map, it is very convenient for each line segment to be recognized as a set of points located at regular intervals, and to store data about the coordinate values of each point as digital values.
상기와 같이 청소지도를 생성하여 이를 도면화한 데이터값은 일반적으로 그래픽 프로그램이나 CAD 프로그램, 네비게이션 프로그램 등에서 사용하는 알고리즘 등을 이용하여 필요에 따라 자유롭게 변환하는 것이 가능하다.As described above, the data values generated by drawing the cleaning maps and drawing them can be freely converted as needed using algorithms used in graphic programs, CAD programs, navigation programs, and the like.
상기에서는 청소용 로봇(10)이 벽면(2)을 따라 이동하면서 청소지도를 생성하는 것으로 설명하였지만, 청소를 행할 영역에 대한 설계도면을 갖고 있는 경우 청소지도를 사용자가 청소용 로봇(10)에 직접 입력시키는 것도 가능하다.In the above description, the cleaning
다음으로 시작점설정단계(S20)에서 시작점을 설정하는 과정을 설명한다.Next, the process of setting the starting point in the starting point setting step (S20) will be described.
상기 시작점은 내향 꼭지점(O1), (O2), (O4), (O5), (O6 ) 중에서 하나를 선택하여 설정한다.The starting point is set by selecting one of inward vertices (O 1 ), (O 2 ), (O 4 ), (O 5 ), and (O 6 ).
또 상기 시작점은 이웃하는 꼭지점중 적어도 청소용 로봇(10)이 전진하는 방향에 위치하는 꼭지점이 내향 꼭지점이 되도록 설정하는 것이 최초의 영역 청소를 행하기 위한 내부 영역을 설정하기가 용이하므로 바람직하다. 예를 들면 개방 꼭지점(O3)의 뒤쪽에 있는 내향 꼭지점(O2)은 시작점으로 설정하지 않는다.In addition, the starting point is preferably set so that at least one of the neighboring vertices located in the direction in which the cleaning
특히 상기 시작점은 개방 꼭지점(O3)의 청소용 로봇(10) 진행방향 뒤쪽 두번째 내향 꼭지점(O1)으로 설정하는 것이 2개의 선분에 의한 사각형의 내부 영역을 설정하기가 용이하므로 바람직하다.In particular, the starting point is preferably set to the second inward vertex O 1 behind the running direction of the cleaning
상기와 같이 시작점이 설정되면, 중앙처리부(20)에서는 시작점으로 설정된 내향 꼭지점(O1)의 좌표값(x1,y1)을 (0,0)으로 변경하여 새로운 원점인 시작 원점(0,0)으로 설정하고, 청소지도의 각 꼭지점 및 선분의 좌표값에 대한 변환을 행한 다. 상기에서 변환은 최초 원점과 시작 원점 사이의 좌표값 차이만큼 모든 점에 대하여 좌표값 변환을 행하는 것으로 이루어진다. 이와 같이 변환이 완료된 새로운 청소지도를 저장부(22)에 기존에 저장된 청소지도에 대체하여 저장한다.When the starting point is set as described above, the
다음으로 상기 모서리청소단계(S30)의 진행과정을 설명한다.Next, the progress of the corner cleaning step (S30) will be described.
상기와 같은 과정을 거쳐 시작점으로 설정된 내향 꼭지점(O1)으로부터 청소용 로봇(10)이 시계반대방향으로 진행하면서 모서리 청소를 수행한다. 상기 모서리 청소는 시계방향으로 진행하면서 수행하는 것도 가능하며, 이하에서는 시계반대방향으로 진행하면서 수행하는 것을 기준으로 설명한다.The cleaning
상기 모서리 청소는 도 2에 나타낸 바와 같이, 청소용 로봇(10)이 벽면(2)으로부터 소정의 간격을 유지한 상태(도 2에서 점선으로 나타냄)에서 시계반대방향으로 진행하면서 소정의 폭으로 제1차 청소를 행하고, 두번째 내향 꼭지점(O2) 또는 첫번째 모서리부분(L1)의 끝부분에 도달하면 반대방향으로 회전하면서 흡입구(12)가 벽면(2)에 근접(또는 접촉)된 상태(도 2에서 이점쇄선으로 나타냄)에서 시계방향으로 진행하면서 제2차 청소를 행하고, 시작점인 첫번째 내향 꼭지점(O1) 또는 첫번째 모서리부분(L1)의 처음 부분에 도달하면 반대방향으로 회전하면서 흡입구(12)가 벽면(2)에 근접(또는 접촉)된 상태(도 2에서 실선으로 나타냄)에서 시계반대방향으로 진행하면서 제3차 청소를 행하는 것으로 이루어진다.As shown in FIG. 2, the corner cleaning is performed at a predetermined width while the cleaning
상기에서 제1차 청소는 제2차 청소 및 제3차 청소를 행할 때에 청소용 로봇(10)이 지나갈 경로를 사전에 청소하는 예비 청소의 개념이다. 즉 청소가 행해지 지 않은 구역을 청소용 로봇(10)이 이동하면서 모서리 청소를 행하게 되면 청소용 로봇(10)의 바닥이나 주행바퀴(16)에 먼지 등의 이물질이 부착하여 청소가 이루어진 구역을 다시 오염시키게 되므로, 청소용 로봇(10)이 지나갈 경로를 예비적으로 청소하도록 구성하는 것이 바람직하다.In the above, the 1st cleaning is the concept of the preliminary cleaning which cleans the path | route which the cleaning
또 상기에서 제2차 청소 및 제3차 청소는 동일한 영역에 대하여 중복하여 청소를 행하도록 이루어진다. 즉 상기 제1차 청소를 행한 후에 첫번째 모서리부분(L1)에 대한 청소를 행하고 다음 모서리부분(L2)의 청소를 위하여 두번째 꼭지점(O2)까지 청소용 로봇(10)이 이동하여야 하므로 왕복하는 경로가 필요하여 제2차 청소 및 제3차 청소를 행하도록 구성한다.Further, in the above, the second cleaning and the third cleaning are made to perform cleaning on the same area in duplicate. That is, after the first cleaning is performed, the cleaning
따라서 상기 제2차 청소 또는 제3차 청소는 실제로 청소를 행하지 않으면서 청소용 로봇(10)의 이동만이 이루어지도록 구성하는 것도 가능하다. 그러나 동일한 영역에 대하여 2회 청소를 행하는 경우에는 청결도가 향상되고, 1회에 소요되는 청소시간을 짧게 설정(청소용 로봇(10)의 이동속도를 빠르게 설정)하는 경우 전체적인 청소시간은 크게 증가하지 않게 된다.Therefore, the second cleaning or the third cleaning can be configured such that only the movement of the cleaning
상기 제1차 청소는 흡입구(12)를 좌우로 소정의 각도로 회전시키는 것에 의하여 가능하면 넓은 영역을 청소하도록 이루어지고, 제2차 청소 및 제3차 청소는 흡입구(12)를 청소용 로봇(10)의 진행방향에 대하여 소정의 각도로 회전된 상태를 유지시켜 흡입구(12)의 끝부분이 벽면(2)에 근접(또는 접촉)된 상태로 일정 영역을 청소하도록 이루어진다.The first cleaning is performed to clean a wide area if possible by rotating the
상기 중앙처리부(20)는 흡입구(12)의 회전을 위한 구동부(26)의 제어와, 이 동(주행)을 위한 주행바퀴(16)의 구동부(26) 제어와, 흡입구(12)에 흡입력을 작용시키기 위한 제어 등을 행한다.The
상기 센서부(24)에서는 흡입구(12)가 벽면(2)에 근접(또는 접촉)된 상태를 유지하면서 전진 이동이 이루어지는 지의 여부를 감지하여 중앙처리부(20)로 전송하며, 중앙처리부(20)는 센서부(24)의 감지신호에 대응하여 제어신호를 구동부(26)에 전송하는 것에 의하여 전진 이동을 제어한다.The
그리고 중앙처리부(20)에서는 모서리 청소가 이루어진 모서리부분(L1)을 청소지도 상에서 소정의 폭으로 완료영역으로 표시하여 저장부(22)에 저장한다.In addition, the
그리고 모서리 청소를 상기와 달리 도 2에서 실선으로 나타낸 제3차 청소만을 행하도록 구성(제1차 청소 및 제2차 청소를 생략)하는 것도 가능하다. 이 경우에는 청소시간이 크게 절감된다.It is also possible to configure the edge cleaning to perform only the third cleaning shown by the solid line in FIG. 2 unlike the above (omitting the first cleaning and the second cleaning). In this case, the cleaning time is greatly reduced.
상기와 같이 첫번째 모서리부분(L1)에 청소를 행한 다음, 첫번째 모서리부분(L1)의 끝점(O2)이 내향 꼭지점이므로, 계속하여 두번째 모서리부분(L2)에 대한 모서리 청소를 수행하고 이 부분도 완료영역을 표시하여 저장부(22)에 저장한다.Since subjected to cleaning on a first edge portion (L 1) as described above, and then, the end points (O 2) is the inward apex of the first edge portion (L 1), and continues to perform edge cleaning on the second edge portion (L 2) This part also marks the completion area and stores it in the
상기와 같이 모서리 청소를 행하여 하나 이상(본 실시예에서는 2개)의 모서리부분(L1), (L2)에 대한 청소가 완료되고 개방 꼭지점(O3)을 만나게 되면, 완료영역으로 표시된 첫번째 모서리부분(L1) 및 두번째 모서리부분(L2)과 대칭인 가상의 선분으로 이루어지는 사각형의 내부 영역(I1)에 대한 영역 청소를 행하는 영역청소 단계(S40)로 진행한다.When the edge cleaning is performed as described above, the cleaning of one or more corners (L 1 ) and (L 2 ) of one or more corners (two in this embodiment) is completed and the opening vertex (O 3 ) is met, the first marked as the completed area. Proceeding to the area cleaning step S40, the area cleaning is performed on the rectangular inner area I 1 composed of imaginary line segments symmetrical with the corner part L 1 and the second corner part L 2 .
본 발명에 따른 청소용 로봇의 제어방법의 제1실시예에서는 상기 모서리청소단계(S30)에서 영역청소단계(S40)로 진행하는 조건은 모서리 청소를 행하는 도중에 개방 꼭지점(O3)을 만나는 경우와 시작점을 만나는 경우로 설정한다.In the first embodiment of the control method of the cleaning robot according to the present invention, the condition of the edge cleaning step (S30) to the area cleaning step (S40) is the case where the opening vertex (O 3 ) and the starting point meets during the corner cleaning step It is set when it meets.
상기 영역청소단계(S40)에서는 도 1에 나타낸 바와 같이 청소용 로봇(10)이 지그재그방식으로 왕복이동하면서 영역 청소를 행하는 것도 가능하고, 도 6에 나타낸 바와 같이 청소용 로봇(10)이 모서리(첫번째 모서리부분(L1), 두번째 모서리부분(L2), 2개의 가상 선분)를 따라 나선형상으로 내부로 감아들어가면서 영역 청소를 행하는 것도 가능하다.In the area cleaning step (S40), as shown in FIG. 1, the cleaning
즉 상기 영역청소단계(S40)는 모서리청소단계(S30)에서 개방 꼭지점(O3)을 만나기 이전에 모서리 청소를 행한 모서리부분(L1), (L2) 및 이들과 대응되는 1개 이상의 가상 선분으로 이루어지는 내부 영역(I1)에 대한 청소를 행하도록 이루어진다.That is, the area cleaning step (S40) is a corner portion (L 1 ), (L 2 ) and the one or more virtual corresponding to the corner cleaning before meeting the open vertex (O 3 ) in the corner cleaning step (S30) The cleaning is performed on the inner region I 1 made of line segments.
상기와 같이 진행하여 첫번째 내부 영역(I1)에 대한 청소가 완료되면, 청소지도 상에 첫번째 내부 영역(I1)을 완료영역을 표시하여 저장부(22)에 저장하고, 영역 청소를 행하기 직전의 위치인 세번째 꼭지점(O3)으로 이동한다.When the above-described cleaning of the first inner region I 1 is completed, the first inner region I 1 is displayed on the cleaning map, the completed region is displayed in the
상기에서 영역 청소를 행하기 직전의 위치인 세번째 꼭지점(O3)을 중앙처리 부(20)에서 새로운 시작점으로 변경(이 때에는 좌표값에 대한 변환을 행하지 않고 시작점처럼 취급하는 것으로 변경)하여 취급하면, 상기와 동일한 방식으로 모서리청소단계(S30)를 행하게 된다. 즉 모서리청소단계(S30)에서 영역청소단계(S40)로 넘어가지 전에 마지막 꼭지점을 새로운 시작점으로 변경하여 저장하고, 영역 청소가 완료되면 새로운 시작점으로 이동하여 다시 모서리청소단계(S30)를 수행하도록 구성하는 것도 가능하다.If the third vertex (O 3 ), which is the position just before the area cleaning, is changed to the new starting point by the central processing unit 20 (in this case, it is changed to treat it as a starting point without converting the coordinate values) and handle it. In the same manner as above, the edge cleaning step (S30) is performed. That is, change the last vertex to a new starting point and save it before moving from the corner cleaning step (S30) to the area cleaning step (S40), and when the area cleaning is completed, move to the new starting point and perform the corner cleaning step (S30) again. It is also possible.
그리고 계속하여 상기와 마찬가지의 방법으로 세번째 모서리부분(L3), 네번째 모서리부분(L4), 다섯번째 모서리부분(L5), 여섯번째 모서리부분(L6)에 대한 모서리 청소를 차례대로 행한다.Then, in the same manner as above, the edge cleaning for the third corner portion (L 3 ), the fourth corner portion (L 4 ), the fifth corner portion (L 5 ), and the sixth corner portion (L 6 ) is performed in this order. .
상기와 같이 모서리 청소를 행하여 마지막 모서리부분인 여섯번째 모서리부분(L6)에 대한 모서리 청소를 완료하여 청소지도 상에서 첫번째 꼭지점(O1)인 시작점으로 복귀가 된 것을 감지하면, 중앙처리부(20)에서는 청소지도 상에서 완료영역으로 표시되지 않은 나머지 내부 영역(I2)에 대한 청소를 행하도록 구동부(26)에 제어신호를 전송한다.When the edge cleaning is performed as described above and the edge cleaning for the sixth corner portion (L 6 ), which is the last corner portion, is detected and returned to the starting point of the first vertex (O 1 ) on the cleaning map, the
상기에서는 개방 꼭지점이나 시작점을 만나기 전까리 모서리부분에 대한 모서리 청소를 행한 다음 내부 영역에 대한 영역 청소를 행하는 것으로 설명하였지만, 개방 꼭지점이 없는 경우에는 전체 둘레에 대한 모서리 청소를 행한 다음 내부 영역에 대한 청소를 행하도록 중앙처리부(20)를 프로그래밍하는 것도 가능하다. 즉 청소지도를 이루는 모든 꼭지점이 내향 꼭지점인 경우에는 전체 모서리에 대한 모서리 청소를 시행하고, 내부 영역에 대한 영역 청소를 시행하도록 구성하는 것도 가능하다.In the above, it is described that the edge cleaning is performed on the corner of the foreshore before the opening vertex or the starting point, and then the area cleaning on the inner area is performed. However, when there is no open vertex, the edge cleaning on the entire circumference is performed, and then the inner area is cleaned. It is also possible to program the
그리고 본 발명에 따른 청소용 로봇의 제어방법의 제2실시예는 도 7에 나타낸 바와 같이, 모서리청소단계(S30)에서 2개의 선분인 2개의 모서리부분(L1), (L2)에 대한 청소가 완료되면, 완료영역으로 표시된 첫번째 모서리부분(L1) 및 두번째 모서리부분((L2)과 대칭인 가상의 선분으로 이루어지는 사각형의 내부 영역(I1)에 대한 영역 청소를 행하는 영역청소단계(S40)로 진행하도록 구성한다.In the second embodiment of the method for controlling the cleaning robot according to the present invention, as shown in FIG. 7, the cleaning of the two corner parts L1 and L2 which are two line segments in the corner cleaning step S30 is completed. If so, the process proceeds to the area cleaning step (S40) for performing area cleaning on the inner area (I1) of the quadrangle consisting of imaginary line segments symmetrical with the first corner part (L1) and the second corner part (L2) indicated as the complete area. Configure.
상기한 제2실시예에서는 개방 꼭지점(O3)을 만났느냐의 여부를 영역청소단계(S40)로 진행하는 조건으로 설정하는 상기한 제1실시예와 달리 모서리청소단계(S30)에서 2개의 선분에 해당하는 2개의 모서리부분에 대한 모서리 청소가 행해졌느냐의 여부를 영역청소단계(S40)로 진행하는 조건으로 설정하는 것도 가능하다.In the second embodiment, unlike the above-described first embodiment in which the opening vertex O 3 is met as a condition to proceed to the area cleaning step S40, two line segments in the corner cleaning step S30 are performed. It is also possible to set whether or not corner cleaning has been performed on the two corner portions corresponding to the condition to proceed to the area cleaning step S40.
본 발명에 따른 제2실시예에 있어서, 상기 모서리청소단계(S30)에서 1개의 모서리부분에 대한 모서리 청소를 행한 다음 개방 꼭지점을 만나는 경우에는 90°회전하여 다른 모서리 또는 꼭지점에 만나기까지 진행한 다음 1개의 모서리부분과 진행한 경로로 이루어지는 내부 영역에 대한 영역 청소를 행하도록 이루어지며, 이 내부 영역이 이미 완료영역으로 표시된 경우에는 개방 꼭지점부터 다시 모서리청소단계(S30)를 시작하는 것으로 구성한다. 즉 개방 꼭지점부터 다시 2개의 모서리부분에 대한 청소를 완료한 다음 영역청소단계(S40)로 진행하도록 구성한다.In the second embodiment according to the present invention, in the corner cleaning step (S30) after performing the corner cleaning for one corner portion and then meet the open vertex, proceeds to meet the other corner or vertex by rotating 90 ° Area cleaning is performed for the inner area consisting of one corner portion and the advanced path. If the inner area has already been marked as a completed area, the corner cleaning step S30 is started again from the open vertex. That is, after the cleaning of the two corners from the open corner again to complete the configuration to proceed to the area cleaning step (S40).
그리고 계속하여 도 7에 나타낸 바와 같이, 상기와 마찬가지의 방법으로 세 번째 모서리부분(L3) 및 네번째 모서리부분(L4)에 대한 모서리 청소를 행하고, 두번째 내부 영역(I2)에 대한 영역 청소를 행한다. 이어서 다섯번째 모서리부분(L5)과 여섯번째 모서리부분(L6)에 대한 모서리 청소를 행한다.Subsequently, as shown in FIG. 7, edge cleaning is performed on the third corner portion L 3 and the fourth corner portion L 4 in the same manner as described above, and the area cleaning on the second inner region I 2 is performed. Is done. Subsequently, corner cleaning is performed on the fifth corner portion L 5 and the sixth corner portion L 6 .
상기와 같이 마지막 모서리부분인 여섯번째 모서리부분(L6)에 대한 모서리 청소를 완료하여 청소지도 상에서 첫번째 꼭지점(O1)인 시작점으로 복귀가 된 것을 감지하면, 중앙처리부(20)에서는 청소지도 상에서 완료영역으로 표시되지 않은 나머지 내부 영역(I3)에 대한 청소를 행하도록 구동부(26)에 제어신호를 전송한다.As described above, when the edge cleaning for the sixth corner portion (L 6 ), which is the last corner portion, is completed and the return point is returned to the start point of the first vertex (O 1 ) on the cleaning map, the
그리고 본 발명에 따른 청소용 로봇의 제어방법의 제3실시예는 도 8 및 도 9에 나타낸 바와 같이, 두번째 모서리부분(L2)에 대한 모서리 청소를 행하는 도중에 개방 꼭지점(O3)을 만나는 경우에는 내부 영역(I1)에 대한 영역 청소를 행하기 전에 지나온 선분인 두번째(또는 2개째) 모서리부분(L2)에 대하여 소정의 각도(예를 들면 90°)로 회전하여 내부 영역(I1)을 설정하기 위하여 다른 선분(모서리)과 만나기까지 구분선 청소를 행하는 구분선청소단계(S35)를 더 포함한다.And the third embodiment of the control method of the cleaning robot according to the present invention, as shown in Figures 8 and 9, when encountering the opening vertex O 3 during the corner cleaning for the second corner portion (L 2 ) The inner region I 1 is rotated at a predetermined angle (for example, 90 °) with respect to the second (or second) corner portion L 2 , which is a line segment passed before the region cleaning for the inner region I 1 . In order to set a further comprises a dividing line cleaning step (S35) for cleaning the dividing line until it meets the other line segment (edge).
상기에서 구분선 청소는 모서리 청소와 동일한 폭으로 설정하여 행하고, 청소지도 상에서는 구분선 청소가 행해진 구분선(P1)을 모서리부분(L1), (L2), (L3), (L4), (L5), (L6)과 동일하게 완료영역으로 표시하여 저장부(22)에 저장한다.
In the above, the dividing line cleaning is performed by setting the same width as the edge cleaning, and on the cleaning map, the dividing line P 1 on which the dividing line cleaning is performed is performed at the corner portions L 1 , (L 2 ), (L 3 ), (L 4 ), Similarly to (L 5 ) and (L 6 ), it is displayed as a complete area and stored in the
그리고 상기한 바와 같이 모서리 청소, 영역 청소, 구분선 청소가 행해진 부 분을 완료영역으로 인식하도록 설정하면, 중복으로 청소를 행하는 것을 방지하는 것이 가능하다.As described above, if the edge cleaning, the area cleaning, and the dividing line cleaning are set so as to recognize the completed area, it is possible to prevent the cleaning from being duplicated.
상기와 같이 구분선(P1)을 형성한 개방 꼭지점(O3)에서 시작하는 세번째 모서리부분(L3)은 구분선(P1)까지 연장된 것으로 취급하여 다음의 내부 영역(I2 )을 설정하도록 구성한다.The third corner portion (L 3), starting from the open apex (O 3) to form a dividing line (P 1) as described above is to set a dividing line (P 1), and then the interior region of the handle to be extended to the (I 2) Configure.
상기와 같이 구분선(P1)을 형성하는 경우에는 내부 영역(I1), (I2)의 수가 구분선(P1)을 형성하지 않은 경우에 비하여 감소하며, 내부 영역(I1), (I2) 사이의 접경지역에서 청소가 행해지지 않은 영역이 발생할 가능성을 차단하는 것이 가능하다.In the case of forming the dividing line P 1 as described above, the number of the inner regions I 1 and I 2 decreases as compared to the case in which the dividing line P1 is not formed, and the inner regions I 1 and I 2. It is possible to block the possibility of unoccupied areas occurring at the border between them.
또 모서리 청소를 행하는 도중에 개방 꼭지점(O3)을 만나는 경우 벽면(2)으로부터 다음에 모서리 청소를 진행할 모서리부분(L3)의 폭만큼 더 청소하도록 구성하는 것이 청소가 행해지지 않는 부분이 존재하지 않게 되므로 바람직하다.In addition, when the opening vertex O 3 is encountered while the edge is being cleaned, there is no part where the cleaning is not performed by configuring the width to be cleaned further from the
나아가 영역 청소를 행하는 경우에는 모서리부분 및 구분선과 일정 정도 겹치도록 영역을 설정하여 청소를 행하도록 구성하는 것이 이동시의 오차 등에 의하여 청소가 행해지지 않는 부분이 존재하지 않게 되므로 바람직하다.Further, when cleaning the area, it is preferable to set the area so as to overlap the corner portion and the dividing line to a certain degree so that the cleaning is performed since there is no part where the cleaning is not performed due to an error during movement.
도 9에서 청소가 이루어지는 순서를 나열하면, 시작점인 맨 아래쪽 수평선의 오른쪽 끝점인 내향 꼭지점(O1)으로부터 청소용 로봇(10)이 모서리 청소를 시작하여 첫번째 모서리부분(L1)과 두번째 모서리부분(L2)에 대한 모서리 청소를 행하고, 개 방 꼭지점(O3)에서 수직으로 회전하여 구분선(P1)을 형성하기 위한 구분선 청소를 행하고, 첫번째 모서리부분(L1)과 두번째 모서리부분(L2), 구분선(P1)으로 이루어지는 내부 영역(I1)에 대한 영역 청소를 행하고, 다시 개방 꼭지점(O3)에서 시작하여 세번째 모서리부분(L3) 및 네번째 모서리부분(L4)에 대한 모서리 청소를 행하고, 구분선(P1) 및 세번째 모서리부분(L3)과 네번째 모서리부분(L4)으로 이루어지는 내부 영역(I2)에 대한 영역 청소를 행하고, 다시 네번째 모서리부분(L4)의 끝점인 내향 꼭지점(O5)에서 시작하여 다섯번째 모서리부분(L5)과 여섯번째 모서리부분(L6
)에 대한 모서리 청소를 행한다.9, the cleaning
상기와 같이 여섯번째 모서리부분(L6)에 대한 모서리 청소가 완료되어 시작점(O1)에 도달되면, 청소지도 상에서 모든 영역이 완료영역으로 표시되었는지 완료영역으로 표시되지 않은 내부 영역이 존재하는지를 중앙처리부(20)에서 확인하고, 모든 영역이 완료영역으로 표시된 경우에는 청소작업이 완료된 것으로 인식하고, 완료영역으로 표시되지 않은 내부 영역이 존재하는 경우에는 그 영역으로 이동하여 영역 청소를 행한다.As described above, when the edge cleaning for the sixth corner portion L 6 is completed and the starting point O 1 is reached, all the regions on the cleaning map are marked as complete regions or whether there are internal regions not indicated as complete regions. When the
상기에서는 개방 꼭지점(O3)에서 내부쪽으로 90° 회전하여 진행하는 것으로 설명하였지만, 본 발명은 이에 한정되는 것이 아니고 필요에 따라 구분선 청소를 개방 꼭지점(O3)에서 지나온 모서리부분(L2)의 연장선을 따라 직진하여 구분선을 형 성하도록 구성하는 것도 가능하고, 소정의 꼭지점을 향하여 소정의 각도로 회전하여 진행하면서 구분선 청소를 수행하도록 구성하는 것도 가능하다.In the above it was described as proceeding by rotating 90 ° inward from the opening vertex (O 3 ), but the present invention is not limited to this, the cleaning of the dividing line as necessary, the edge of the corner (L 2 ) passed from the opening vertex (O 3 ) The dividing line may be configured to straighten along the extension line to form a dividing line, and may be configured to perform dividing line cleaning while rotating and proceeding at a predetermined angle toward a predetermined vertex.
상기에서는 청소지도가 대략 소정의 폭을 갖는 "L"형상으로 생성되는 경우에 대하여 설명하였지만, 본 발명은 이에 한정되는 것이 아니고 소정의 폭을 갖는 "ㄷ"형상, "ㄹ"형상, "T"형상 등의 다양한 규칙적인 형상이나 직각으로 꼭지점이 형성되는 형상(수직선과 수평선으로 이루어지는 정형화된 형상)으로 청소지도가 생성되는 경우에도 적용하는 것도 가능하고, 수평선 및 수직선과 사선이 조합된 불규칙적인 형상(비정형화된 형상)으로 청소지도가 생성되는 경우에도 적용하는 것도 가능하다.In the above, the case where the cleaning map is generated in an "L" shape having a predetermined width is described. However, the present invention is not limited thereto, and the present invention is not limited thereto, and the "d" shape, the "d" shape, and the "t" shape have a predetermined width. Various regular shapes such as shapes, or shapes where vertices are formed at right angles (a regular shape consisting of a vertical line and a horizontal line) can also be applied when a cleaning map is generated, and irregular shapes in which horizontal lines, vertical lines and diagonal lines are combined. It is also possible to apply when the cleaning map is generated with (unstructured shape).
도 10에는 "ㄷ"형상의 청소지도가 생성된 경우를 나타낸다.FIG. 10 shows a case where a cleaning map having a shape of "c" is generated.
도 10에 나타낸 바와 같이, "ㄷ"형상의 청소지도가 생성된 경우에는, 도면에서 맨 아래쪽에 위치하는 수평선의 오른쪽 끝에 위치하는 꼭지점(O1)을 시작점으로 설정하고, 첫번째 모서리부분(L1)과 두번째 모서리부분(L2)에 대한 모서리 청소를 행하고, 두번째 모서리부분(L2)의 끝점인 개방 꼭지점(O3)에서 수직으로 회전하여 구분선(P1)을 형성하는 구분선 청소를 행하고, 첫번째 모서리부분(L1)과 두번째 모서리부분(L2), 구분선(P1)으로 이루어지는 내부 영역(I1)에 대한 영역 청소를 행한다.As shown in FIG. 10, when a cleaning map having a shape of "c" is generated, a vertex (O 1 ) located at the right end of the horizontal line located at the bottom of the drawing is set as a starting point, and the first corner portion (L 1). ) And the second corner portion (L 2 ) to clean the corners, and the vertical line at the opening vertex (O 3 ) of the second corner portion (L 2 ) to perform a vertical line cleaning to form a divider (P 1 ), The area cleaning is performed on the inner region I 1 consisting of the first corner portion L 1 , the second corner portion L 2 , and the dividing line P 1 .
이어서 다시 개방 꼭지점(O3)으로 이동하여 세번째 모서리부분(L3)에 대한 모서리 청소를 행하고, 세번째 모서리부분(L3)의 끝점인 개방 꼭지점(O4)에서 수직으로 회전하여 구분선(P2)을 형성하는 구분선 청소를 행하고, 구분선(P2)과 세번째 모서리부분(L3) 및 구분선(P1)으로 이루어지는 내부 영역(I2)에 대한 영역 청소를 행한다.Then again open apex (O 3) to move to the third corner portion (L 3) subjected to the edge cleaning on, and the third corner portion (L 3) end in an open vertex (O 4) with vertical rotation in the dividing line (P 2 ) performing a dividing line forming a cleaning, cleaning is carried out a region of the dividing line (P 2) and the third corner portion (L 3) and the dividing line (inside region (I 2) formed of a P 1).
상기에서 구분선(P1)을 형성한 개방 꼭지점(O3)에서 시작하는 세번째 모서리부분(L3)은 구분선(P1)까지 연장된 것으로 취급하여 내부 영역(I2)을 설정하도록 구성한다.The third corner portion, starting from the open apex (O 3) to form a dividing line (P 1) in the (L 3) is configured to set a dividing line (P 1) inside the area (I 2) and treated as extending to.
그리고 내부 영역(I2)에 대한 영역 청소가 완료되면, 다시 개방 꼭지점(O4)으로 이동하여 네번째 모서리부분(L4) 및 다섯번째 모서리부분(L5)에 대한 모서리 청소를 행하고, 구분선(P2)과 네번째 모서리부분(L4) 및 다섯번째 모서리부분(L5 )으로 이루어지는 내부 영역(I3)에 대한 영역 청소를 행한다. 이 때에서 구분선(P2)을 형성한 개방 꼭지점(O4)에서 시작하는 네번째 모서리부분(L4)은 구분선(P2)까지 연장된 것으로 취급한다.When the area cleaning for the inner region I 2 is completed, the process moves to the open vertex O 4 again to perform corner cleaning on the fourth corner portion L 4 and the fifth corner portion L 5 , and divides the line ( Area cleaning is performed on the inner region I 3 consisting of P 2 ), the fourth corner portion L 4 , and the fifth corner portion L 5 . At this time, standing divider fourth corner portion, starting from the open vertex (O 4) form a (P 2) (L 4) is treated as an extension to the dividing line (P 2).
상기와 같이 내부 영역(I3)에 대한 영역 청소가 완료되면, 다시 다섯번째 모서리부분(L5)의 끝점인 내향 꼭지점(O6)으로 이동하여 여섯번째 모서리부분(L6 ) 및 일곱번째 모서리부분(L7), 여덟번째 모서리부분(L8)에 대한 모서리 청소를 행한다. When the area cleaning for the inner region (I 3 ) is completed as described above, it moves back to the inward vertex (O 6 ), which is the end point of the fifth corner portion (L 5 ), and the sixth corner portion (L 6 ) and the seventh corner. Corner cleaning is performed on the part L 7 and the eighth corner part L 8 .
상기에서 여덟번째 모서리부분(L8)에 모서리 청소를 완료하는 경우 시작점(O1)에 도달하게 되며, 중앙처리부(20)에서는 청소지도 상에서 모든 영역이 완료영역으로 표시되었는지를 확인하고 작업을 종료한다.When the edge cleaning is completed in the eighth corner portion (L 8 ) in the above, the start point (O 1 ) is reached, and the
상기 여섯번째 모서리부분(L6)과 일곱번째 모서리부분(L7)에 대한 모서리 청소를 완료한 상태에서는 여섯번째 모서리부분(L6)과 일곱번째 모서리부분(L7)이 접하는 내부 영역(I2), (I3)에 대한 영역 청소가 완료된 상태이므로, 계속하여 여덟번째 모서리부분(L8)에 대한 모서리 청소를 행한다.The sixth edge part (L 6) and the seventh corner part in the state of complete corner cleaning for the (L 7) The sixth edge part (L 6) and the seventh corner part (L 7) is in contact with the inner region (I 2 ), since the area cleaning for (I 3 ) is completed, the corner cleaning for the eighth corner portion L 8 is continued.
그리고 "T"형상의 청소지도가 생성된 경우의 청소 과정을 도 11을 참조하여 설명한다.The cleaning process in the case where the cleaning map of the "T" shape is generated will be described with reference to FIG.
먼저 "T"형상의 청소지도가 생성된 경우에는, 도면에서 오른쪽으로 돌출된 부분의 아래쪽 수평선 오른쪽 끝에 위치하는 꼭지점(O1)을 시작점으로 설정한다.First, when a "T" shape cleaning map is generated, a vertex O 1 positioned at the right end of the lower horizontal line of the portion projecting to the right in the drawing is set as a starting point.
이서서 첫번째 모서리부분(L1)과 두번째 모서리부분(L2)에 대한 모서리 청소를 행하고, 첫번째 모서리부분(L1)과 두번째 모서리부분(L2)으로 이루어지는 내부 영역(I1)에 대한 영역 청소를 행하고, 다시 두번째 모서리부분(L2)의 끝점인 내향 꼭지점(O3)으로 이동하여 세번째 모서리부분(L3) 및 네번째 모서리부분(L4)에 대한 모서리 청소를 행한다.Up standing in the first edge portion (L 1) and subjected to the edge cleaning on the second edge portion (L 2), the area of the first edge portion (L 1) and a second edge portion (L 2) inside the region (I 1) consisting of The cleaning is performed, and then the inward vertex O 3 , which is the end point of the second corner portion L 2 , is moved to perform corner cleaning on the third corner portion L 3 and the fourth corner portion L 4 .
상기에서 세번째 모서리부분(L3)과 네번째 모서리부분(L4)에 대한 모서리 청 소를 완료한 경우 세번째 모서리부분(L3)과 네번째 모서리부분(L4)에 의하여 형성되는 내부 영역에 대한 영역 청소를 행하여야 하지만, 이미 이 영역을 포함하는 내부 영역(I1)에 대한 청소가 완료되어 완료영역으로 표시되어 있으므로, 영역 청소는 생략한다. 또한 네번째 모서리부분(L4)에 대한 모서리 청소가 완료된 경우 개방 꼭지점(O5)과 만나므로 90°회전하여 구분선을 형성하는 구분선 청소를 행하여야 하지만, 상기와 마찬가지의 이유인 이미 청소가 완료된 완료영역으로 표시되어 있으므로, 구분선 청소도 생략한다.The area for the inner region formed by the third corner portion (L 3 ) and the fourth corner portion (L 4 ) when the corner cleaning for the third corner portion (L 3 ) and the fourth corner portion (L 4 ) is completed. Although cleaning has to be performed, cleaning of the internal region I 1 including this region has already been completed and is marked as a completed region, so the region cleaning is omitted. In addition, when the edge cleaning for the fourth corner portion (L 4 ) is completed, it meets the open vertex (O 5 ), so it is necessary to clean the dividing line to form a dividing line by rotating 90 °, but the cleaning for the same reason as above is completed. Since the area is marked, cleaning of the dividing line is also omitted.
따라서 네번째 모서리부분(L4)에 대한 모서리 청소가 완료된 경우, 계속하여 다섯번째 모서리부분(L5) 및 여섯번째 모서리부분(L6)에 대한 모서리 청소를 행하고, 다섯번째 모서리부분(L5) 및 여섯번째 모서리부분(L6)으로 이루어지는 내부 영역(I2)에 대한 영역 청소를 행한다.Therefore, when the corner cleaning for the fourth corner portion (L 4 ) is completed, continue to clean the corners for the fifth corner portion (L 5 ) and the sixth corner portion (L 6 ), and the fifth corner portion (L 5 ) And area cleaning for the inner region I 2 consisting of the sixth corner portion L 6 .
상기와 같이 내부 영역(I2)에 대한 청소가 완료된 경우, 다시 여섯번째 모서리부분(L6)의 끝점인 내향 꼭지점(O7)으로 이동하여 일곱번째 모서리부분(L7 )에 대한 모서리 청소를 행하고, 일곱번째 모서리부분(L7)의 끝점이 개방 꼭지점(O8)이므로 90°회전하여 구분선(P2)을 형성하기 위한 구분선 청소를 행한다. 여기에서 구분선(P2)이 형성되는 영역은 첫번째 모서리부분(L1) 및 두번째 모서리부분(L2 )에 의 하여 이루어지는 내부 영역(I1)과 다섯번째 모서리부분(L5) 및 여섯번째 모서리부분(L6)에 의하여 이루어지는 내부 영역(I2)의 경계선에 위치하여 청소가 불충분하게 이루어지므로 완료영역으로 표시되어 있지 않게 되고, 일부 중복되는 상태로 구분선(P2)을 형성하는 구분선 청소를 행하여 충분한 청소가 이루어지도록 구성한다.When the cleaning of the inner region (I 2 ) is completed as described above, the cleaning of the corners of the seventh corner portion (L 7 ) is performed by moving to the inward vertex (O 7 ), which is the end point of the sixth corner portion (L 6 ). Since the end point of the seventh corner portion L 7 is an open vertex O 8 , the separator line is cleaned by rotating 90 ° to form the divider line P 2 . Here, the region where the dividing line P 2 is formed is an inner region I 1 formed by the first corner portion L 1 and the second corner portion L 2 , the fifth corner portion L 5 , and the sixth corner. Since the cleaning is performed inadequately at the boundary of the inner region I 2 formed by the portion L 6 , it is not marked as a complete region, and the dividing line cleaning which forms the dividing line P 2 in a partially overlapping state is performed. And sufficient cleaning is performed.
이어서 개방 꼭지점(O8)으로 이동하여 여덟번째 모서리부분(L8)에 대한 모서리 청소를 행한다. 상기에서 여덟번째 모서리부분(L8)에 모서리 청소를 완료하는 경우 시작점(O1)에 도달하게 되며, 청소용 로봇(10)의 중앙처리부(20)에서는 청소지도 상에서 모든 영역이 완료영역으로 표시되었는지를 확인하고 작업을 종료한다.Subsequently, it moves to the open vertex (O 8 ) and performs edge cleaning on the eighth corner portion (L 8 ). In the above, when the edge cleaning is completed at the eighth corner portion L 8 , the starting point O 1 is reached. In the
상기한 바와 같이 "L"형상, "ㄷ"형상, "T"형상 등 규격화가 가능하고, 청소 순서에 대한 표준화가 가능한 형상의 청소지도에 대해서는 시작점의 위치, 청소 순서와 규칙 등을 상기 저장부(22)에 미리 저장하여 놓고, 청소지도가 생성되면 생성된 청소지도와 저장된 형상을 비교하여 규격화 및 표준화된 모델과 유사한 경우 시작점의 설정 및 청소를 미리 설정된 프로그램을 따라 진행하도록 구성하는 것도 가능하다. 이와 같이 구성하면 중앙처리부(20)의 연산처리 부하가 경감되고, 효율성이 크게 향상된다.As described above, for the cleaning map of the shape such as the "L" shape, the "c" shape, and the "T" shape, and the shape which can be standardized about the cleaning order, the position of a starting point, the cleaning order, a rule, etc. are stored in the said storage part. If the cleaning map is generated in advance, and the cleaning map is generated, the generated cleaning map is compared with the stored shape, and when the cleaning map is similar to the standardized and standardized model, the setting of the starting point and the cleaning may be performed according to the preset program. . In this configuration, the computation processing load of the
그리고 "ㄹ"형상, "F"형상, "ㅌ"형상 등으로 청소지도가 생성되는 경우에는 상기 규격화 및 표준화된 형상을 갖는 2∼3개의 부분으로 나누어 청소를 진행하도록 구성하면, 보다 다양한 형상을 패턴화하여 효율적으로 청소를 행하는 것이 가능 하다.In the case where the cleaning map is generated in the “d” shape, the “F” shape, the “ㅌ” shape, or the like, the cleaning map may be divided into two or three parts having the standardized and standardized shapes to perform the cleaning. It is possible to pattern and clean efficiently.
다음으로 도 12 및 도 13에 나타낸 바와 같이, 본 발명에 따른 청소용 로봇의 제어방법을 수직선과 수평선 만으로 이루어지는 정형화된 청소지도가 아닌 수평선, 수직선, 사선 등이 조합되어 이루어지는 비정형화된 청소지도가 생성되는 경우에 적용하여 설명한다.Next, as shown in FIGS. 12 and 13, the control method of the cleaning robot according to the present invention generates an atypical cleaning map that is composed of a combination of a horizontal line, a vertical line, and an oblique line instead of a standardized cleaning map comprising only a vertical line and a horizontal line. If applicable, the description will be made.
본 발명에 따른 청소용 로봇의 제어방법의 제4실시예는 지도생성단계(S10)에서 청소용 로봇(10)이 청소를 행하고자 하는 영역을 벽면(2)을 따라 일정한 방향(예들 들면 시계반대방향)으로 벽면(2)에 근접된 상태로 이동하면서 외곽 테두리(벽면)의 위치정보(좌표값)를 획득하여 복수의 꼭지점(O1), (O2), (O3), …, (O22), (O23)과 선분으로 이루어지는 도 12와 같은 폐곡선의 청소지도를 생성하면, 시작점설정단계(S20)에서는 생성된 청소지도를 기준으로 어느 한 꼭지점(O1)을 시작점으로 설정한다.In the fourth embodiment of the control method of the cleaning robot according to the present invention, in the map generation step (S10), a certain direction (for example, counterclockwise) along the
상기와 같이 비정형화된 폐곡선의 청소지도가 생성되는 경우에는 시작점을 개방 꼭지점(O1), (O4), (O7), (O8), (O11), (O 14), (O15), (O19), (O21) 중에서 선택하여 설정하며, 진행방향으로 이웃하여 내부 꼭지점(O2), (O5), (O9), (O 12), (O16), (O20), (O22)이 있는 개방 꼭지점(O1), (O4), (O8), (O11), (O15), (O19), (O21) 중에서 선택하여 설정한다.When the cleaning map of the atypical closed curve is generated as described above, the starting point is an open vertex (O 1 ), (O 4 ), (O 7 ), (O 8 ), (O 11 ), (O 14 ), ( O 15 ), (O 19 ), (O 21 ) to choose from, set in the adjoining direction (O 2 ), (O 5 ), (O 9 ), (O 12 ), (O 16 ) selected from, (O 20), (O 22) is open vertex (O 1), (O 4 ), (O 8), (O 11), (O 15), (O 19), (O 21) in To set.
상기 모서리청소단계(S30)는 시작점인 첫번째 개방 꼭지점(O1)으로부터 시작 하여 벽면(선분)을 따라 일정한 방향(도 12에서는 시계반대방향)으로 벽면(2)에 흡입구(12)가 근접된 상태로 청소용 로봇(10)이 이동하면서 다음(두번째) 개방 꼭지점(O4)이 나오기까지 모서리부분(L1), (L2), (L3)에 대한 모서리 청소를 진행하도록 이루어진다.The corner cleaning step (S30) is a state in which the
상기와 같이 모서리 청소를 진행하다가 개방 꼭지점(O4)을 만나게 되면, 지나온 마지막 개방 꼭지점(O1)을 향하여 구분선(P1)을 형성하기 위하여 구분선 청소를 행하는 구분선청소단계(S35)를 수행한다.When cleaning the corners as described above and meets the opening vertex (O 4 ), performing a dividing line cleaning step (S35) for cleaning the dividing line to form a dividing line (P 1 ) toward the last open vertex (O 1 ) passed through. .
그런데 개방 꼭지점(O7), (O14)에서 모서리 청소를 시작하여 처음 만나는 꼭지점이 개방 꼭지점(O8), (O15)인 경우에는 구분선이 방금 지나온 모서리부분(L7 ), (L14)과 중첩되므로, 구분선청소단계(S35)를 생략하고, 계속하여 모서리 청소를 행하는 모서리청소단계(S30)를 수행하도록 구성한다.However, if the corners where the first vertices are open vertices (O 8 ) and (O 15 ) start the edge cleaning at the open vertices (O 7 ) and (O 14 ), the edges just passed by the dividing line (L 7 ), (L 14) ) So that the dividing line cleaning step (S35) is omitted, and is configured to perform the edge cleaning step (S30) to continue the edge cleaning.
상기와 같이 첫번째 개방 꼭지점(O1)으로부터 시작하여 첫번째 모서리부분(L1), 두번째 모서리부분(L2), 세번째 모서리부분(L3), 첫번째 구분선(P 1)에 대한 청소가 완료되면, 이들로 이루어지는 내부 영역(I1)에 대한 영역 청소를 행하는 영역청소단계(S40)를 수행한다.When the cleaning for the first corner (L 1 ), the second corner (L 2 ), the third corner (L 3 ), the first dividing line (P 1 ) starting from the first opening vertex (O 1 ) as described above, An area cleaning step S40 for performing area cleaning on the internal area I 1 consisting of these is performed.
상기와 같이 첫번째 내부 영역(I1)에 대한 영역 청소가 완료되면, 직전의 개방 꼭지점(O4)으로 이동하여, 모서리 청소와 구분선 청소 및 영역 청소를 반복하여 수행한다. 즉 모서리부분(L4), (L5), (L6)-구분선(P2)-내부 영역(I2)-모서리부분(L7), (L8), (L9), (L10)-구분선(P3)-내부 영역(I 3)-모서리부분(L11), (L12), (L13)-구분선(P4)-내부 영역(I4)-모서리부분(L14), (L15), (L16 ), (L17), (L18)-구분선(P5)-내부 영역(I5)-모서리부분(L19), (L20)-구분선(P6)-내부 영역(I 6)-모서리부분(L21), (L22), (L23)-구분선(P7)-내부 영역(I7)의 순서로 청소를 수행한다.When the area cleaning for the first inner area I 1 is completed as described above, the area is moved to the immediately open vertex O 4 , and the edge cleaning, the dividing line cleaning, and the area cleaning are repeatedly performed. Corner parts (L 4 ), (L 5 ), (L 6 ) -division line (P 2 ) -inner area (I 2 ) -edge part (L 7 ), (L 8 ), (L 9 ), (L 10 ) -Dividing line (P 3 ) -Inner region (I 3 ) -Corner portion (L 11 ), (L 12 ), (L 13 ) -Dividing line (P 4 ) -Inner region (I 4 ) -Corner portion (L 14 ), (L 15 ), (L 16 ), (L 17 ), (L 18 ) -division line (P 5 ) -inner region (I 5 ) -edge portion (L 19 ), (L 20 ) -division line ( Cleaning is performed in the order of P 6 ) -inner region (I 6 ) -edge portion (L 21 ), (L 22 ), (L 23 ) -division line (P 7 ) -inner region (I 7 ).
상기와 같이 청소를 수행하여 시작점인 첫번째 개방 꼭지점(O1)으로부터 출발하여 마지막 개방 꼭지점(O21)으로 연장되는 구분선(P7)을 형성하고, 내부 영역(I7)에 대한 청소를 완료한 다음, 개방 꼭지점(O1), (O4), (O7), (O8), (O11), (O14), (O15), (O19), (O21)을 전체적으로 연결하는 구분선(P1), (P 2), (P3), (P4), (P5), (P6), (P7)과 모서리부분(L7), (L14)으로 이루어지는 내부 영역(I 8)에 대한 영역 청소를 행하고, 청소지도 상에서 완료영역으로 표시되지 않은 부분이 있는지를 확인하고 작업을 종료하도록 구성한다.The cleaning is performed as described above to form a dividing line P 7 starting from the first opening vertex O 1 , which is a starting point, and extending to the last opening vertex O 21 , and completing the cleaning of the inner region I 7 . Next, open vertices (O 1 ), (O 4 ), (O 7 ), (O 8 ), (O 11 ), (O 14 ), (O 15 ), (O 19 ), and (O 21 ) To connect dividing line (P 1 ), (P 2 ), (P 3 ), (P 4 ), (P 5 ), (P 6 ), (P 7 ) and corners (L 7 ), (L 14 ) Area cleaning is performed for the internal area I 8 to be made, to check whether there is any part not indicated as the complete area on the cleaning map, and to terminate the work.
그리고 도 13과 같이 청소지도가 형성되는 경우에 있어서도 상기 도 12의 경우와 마찬가지로, 시작점인 첫번째 개방 꼭지점(O1)으로부터 시작하여 모서리부분(L1), (L2), (L3), (L4)-구분선(P1)-내부 영역(I 1)-모서리부분(L5), (L6)-구분선(P2)-내부 영역(I2)-모서리부분(L7), (L8), (L9), (L10)-구분선(P 3)-내부 영역(I3)-모서리 부분(L11), (L12)-구분선(P4)-내부 영역(I4)의 순서로 청소를 수행한 다음, 마지막으로 내부 영역(I5)에 대한 영역 청소를 행하고, 청소지도 상에서 완료영역으로 표시되지 않은 부분이 있는지를 확인하고 작업을 종료하도록 구성한다.Also in the case where the cleaning map is formed as shown in FIG. 13, the edge parts L 1 , L 2 , L 3 , starting from the first opening vertex O 1 , which is a starting point, as in the case of FIG. 12, (L 4 ) -division line (P 1 ) -inner region (I 1 ) -edge portion (L 5 ), (L 6 ) -division line (P 2 ) -inner region (I 2 ) -edge portion (L 7 ), (L 8 ), (L 9 ), (L 10 ) -division line (P 3 ) -inner region (I 3 ) -edge portion (L 11 ), (L 12 ) -division line (P 4 ) -inner region (I After the cleaning is performed in the order of 4 ), the area is finally cleaned for the inner region I 5 , and the operation is finished by checking whether there is any part not indicated as the completed area on the cleaning map and ending the work.
상기 도 12 및 도 13에 나타낸 바와 같이, 정형화(표준화, 규격화)되지 않은 비정형화된 형상으로 청소지도가 생성되는 경우(특히 개방 꼭지점이 3개 이상 형성되는 경우)에는 개방 꼭지점을 서로 연결하는 구분선을 형성하고, 이를 이용하여 내부 영역을 복수로 나누어 영역 청소를 행하도록 구성하는 것이 바람직하다. 상기에서 개방 꼭지점이 2개인 경우에는 내부 영역이 단순하게 2부분으로 나뉘어지게 된다.As shown in FIGS. 12 and 13, when a cleaning map is generated in an unstructured shape that is not standardized (standardized or standardized) (particularly when three or more open vertices are formed), a dividing line connecting the open vertices to each other. It is preferable to form a structure, and to use this to divide the internal region into a plurality and to clean the region. In the case of two open vertices, the inner region is simply divided into two parts.
그리고 상기와 같이 이루어지는 본 발명에 따른 청소용 로봇의 제어방법에 있어서는 벽면(2)이 직선형상을 갖는 것으로 가정하여 설명하였지만, 기둥이나 조형미 등에 의하여 부분적으로 곡선형상을 갖는 경우에도 직선형상에 준하여 청소를 수행하는 것이 가능하다.In the method of controlling the robot for cleaning according to the present invention, the
상기에서는 청소용 로봇(10)이 벽면(2)을 따라 시계반대방향으로 진행하면서 청소를 수행하는 것으로 설명하였지만, 본 발명은 이에 한정되는 것이 아니고 시계방향으로 진행하면서 청소를 수행하는 것이 가능하다. 그러나 어느 방향이든지 항상 동일한 방향으로 진행하면서 청소를 수행하도록 구성한다.Although the cleaning
그리고 본 발명에 따른 청소용 로봇의 제어방법으로 제어되는 청소용 로봇(10)은 항상 전진하면서 청소를 수행하도록 중앙처리부(20)에서 제어신호를 구동부 (26)에 전송하도록 구성하고, 후방에 장애물이 없는 것을 알고 있는 경우에만 후진하도록 구성한다.In addition, the cleaning
상기 청소용 로봇(10)은 간격이 좁아 진입할 수 없거나 단차(절벽)의 존재 등에 의하여 진입이 금지되는 구역은 장애물 또는 벽면(2)으로 중앙처리부(20)에서 처리하여 청소지도 상에 표시하도록 구성한다.The cleaning
또 상기 청소용 로봇(10)은 벽면(2)에 밀착(또는 근접)되어 설치되는 가구, 화분, 프린터나 복사기 등의 사무기기 등의 물건은 중앙처리부(20)에서 벽면으로 처리하여 청소지도 상에 표시하도록 구성한다.In addition, the cleaning
그리고 상기 청소용 로봇(10)은 벽면(2)으로부터 청소용 로봇(10)이 통과할 수 있는 간격을 두고 위치하는 가구, 화분, 사무기기, 조각 등의 장식물, 기둥 등은 중앙처리부(20)에서 장애물로 처리하여 청소지도 상에 표시하도록 구성한다.And the cleaning
상기 구분선청소단계(S35)에서 구분선을 형성하는 도중에 장애물을 만나는 경우에는 청소용 로봇(10)이 장애물의 둘레를 따라 진행하면서 장애물의 모서리부분에 대한 모서리 청소를 행하고, 구분선의 연장선을 따라 계속하여 구분선을 형성하도록 구성한다. 이 때 장애물의 모서리부분에 대한 모서리 청소를 행하면서 얻어지는 장애물에 대한 위치정보를 이용하여 청소지도 상에 장애물의 형상 및 위치를 표시하고, 장애물의 내부는 청소용 로봇(10)이 접근할 수 없는 청소불가영역으로 설정하여 추후에 내부 영역에 대한 영역 청소를 행할 때에 청소용 로봇(10)이 장애물에 충돌하는 것을 방지하는 것이 바람직하다.When encountering an obstacle in the middle of forming the dividing line in the dividing line cleaning step (S35), the cleaning
그리고 상기 영역청소단계(S40)에서 영역 청소를 수행하는 도중에 장애물을 만나는 경우에도 청소용 로봇(10)이 장애물의 둘레를 따라 진행하면서 장애물의 모서리부분에 대한 모서리 청소를 행하고, 나머지 부분의 내부영역에 대한 영역 청소를 행하도록 구성한다. 이 때에도 청소지도 상에 장애물의 형상 및 위치를 표시하고, 청소불가영역으로 설정한다.In addition, even when the obstacle is encountered while performing the area cleaning in the area cleaning step (S40), the cleaning
그리고 상기 청소용 로봇(10)은 각 꼭지점에서의 위치정보를 정확하게 판단하고 수정할 수 있도록, 센서부(24)의 CCD 카메라 등을 이용하여 각 꼭지점의 벽면 및/천정 등의 주변 영상을 촬영하여 이를 저장부(22)에 저장하도록 구성하는 것이 바람직하다. 상기와 같이 저장된 영상은 청소용 로봇(10)이 내부 영역에 대한 영역 청소를 행한 후에 다시 모서리 청소를 수행하기 위하여 해당 꼭지점으로 이동한 경우, 꼭지점의 위치를 확인하여 수정하기 위하여 사용한다.In addition, the cleaning
상기와 같이 주변 영상을 이용하여 그 때마다 청소지도 상의 위치와 실제 청소용 로봇(10)의 위치를 보정하여 청소를 행하면, 청소용 로봇(10)의 이동에 따라 발생하는 궤적오차를 최소화하는 것이 가능하다.When the cleaning is performed by correcting the position on the cleaning map and the position of the
상기에서는 청소용 로봇의 제어방법의 바람직한 실시예에 대하여 설명하였지만, 본 발명은 이에 한정되는 것이 아니고 특허청구범위와 발명의 상세한 설명 및 첨부한 도면의 범위 안에서 여러가지로 변형하여 실시하는 것이 가능하고, 이 또한 본 발명의 범위에 속한다.In the above, a preferred embodiment of a control method of a cleaning robot has been described. However, the present invention is not limited thereto, and various modifications can be made within the scope of the claims and the detailed description of the invention and the accompanying drawings. It belongs to the scope of the present invention.
상기와 같이 이루어지는 본 발명에 따른 청소용 로봇의 제어방법에 의하면, 모서리 청소를 행한 다음 내부 영역에 대한 영역청소를 행하므로 벽면에 근접한 모 서리부분에 대한 청소가 완벽하게 이루어진다.According to the control method of the robot for cleaning according to the present invention made as described above, since the edge cleaning and the area cleaning for the inner area is performed, the cleaning of the edge portion close to the wall is completed.
그리고 본 발명에 따른 청소용 로봇의 제어방법에 의하면, 모서리 청소를 3단계로 나누어 행하므로, 구석진 부분에 대한 청소를 확실하게 행하는 것이 가능하다.And according to the control method of the cleaning robot which concerns on this invention, since corner cleaning is performed by three steps, it is possible to reliably clean a corner part.
또 본 발명에 따른 청소용 로봇의 제어방법에 의하면, 내부 영역을 다수의 작은 사각형이나 삼각형 등의 형상으로 나누어 모서리 청소와 함께 수행하므로 전체 청소영역에 걸쳐 고르게 청소가 이루어지고, 청소가 이루어지지 않는 영역이 존재할 가능성이 최소화된다.In addition, according to the control method of the cleaning robot according to the present invention, since the inner area is divided into a plurality of small squares or triangles, and the edge cleaning is performed, the cleaning is performed evenly over the entire cleaning area, and the area is not cleaned. The possibility of this being minimized.
그리고 본 발명에 따른 청소용 로봇의 제어방법에 의하면, 표준화 및 규격화된 방식으로 청소지도를 생성하고 이를 분석하여 가장 효과적인 방법으로 모서리 청소와 영역 청소를 행하므로 청소가 효과적으로 이루어진다.In addition, according to the control method of the cleaning robot according to the present invention, since the cleaning map is generated and analyzed in a standardized and standardized manner, the edge cleaning and the area cleaning are performed in the most effective manner.
Claims (20)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020040063384A KR100596481B1 (en) | 2004-08-12 | 2004-08-12 | Control Method of Mobile Robot with Function for Cleaning |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020040063384A KR100596481B1 (en) | 2004-08-12 | 2004-08-12 | Control Method of Mobile Robot with Function for Cleaning |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20060014715A true KR20060014715A (en) | 2006-02-16 |
KR100596481B1 KR100596481B1 (en) | 2006-07-03 |
Family
ID=37123622
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020040063384A KR100596481B1 (en) | 2004-08-12 | 2004-08-12 | Control Method of Mobile Robot with Function for Cleaning |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR100596481B1 (en) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100919698B1 (en) * | 2007-08-14 | 2009-09-29 | 포항공과대학교 산학협력단 | Cleaning method using cleaning robot |
KR101011687B1 (en) * | 2008-07-24 | 2011-01-28 | 주식회사 한울로보틱스 | Method of controlling clean path in robot cleaner |
US7916931B2 (en) | 2006-07-05 | 2011-03-29 | Samsung Electronics Co., Ltd. | Apparatus, method, and medium for dividing regions by using feature points and mobile robot using the same |
US7933686B2 (en) | 2006-08-18 | 2011-04-26 | Samsung Electronics Co., Ltd. | Method of dividing coverage area for robot and device thereof |
KR101524020B1 (en) * | 2009-03-06 | 2015-05-29 | 엘지전자 주식회사 | Method for gradually building map by mobile robot and correcting position of mobile robot |
US9149167B2 (en) | 2011-06-28 | 2015-10-06 | Samsung Electronics Co., Ltd. | Robot cleaner and control method thereof |
KR20160090568A (en) * | 2015-01-22 | 2016-08-01 | 주식회사 파인로보틱스 | Robot cleaning apparatus and method for controlling the same |
EP2932876A4 (en) * | 2012-12-07 | 2017-03-22 | Ecovacs Robotics Co., Ltd. | Window cleaning robot and operation mode control method thereof |
CN109700391A (en) * | 2019-03-13 | 2019-05-03 | 周妍杉 | A kind of sweeping robot and the method for improving sweeping robot corner coverage |
CN111374598A (en) * | 2018-12-28 | 2020-07-07 | 珠海市一微半导体有限公司 | Control method and device for cleaning hair of sweeping robot and chip |
CN111693045A (en) * | 2019-03-13 | 2020-09-22 | 北京奇虎科技有限公司 | Sweeping route generation method and device of sweeper |
CN112596518A (en) * | 2020-12-07 | 2021-04-02 | 深圳拓邦股份有限公司 | Robot cleaning path planning method and device and floor washing robot |
CN112634402A (en) * | 2020-12-30 | 2021-04-09 | 苏州三六零机器人科技有限公司 | Sweeper area setting method, sweeper area setting device, sweeper area setting equipment and computer storage medium |
CN114272417A (en) * | 2021-12-25 | 2022-04-05 | 千立生物技术(杭州)有限公司 | Disinfection method and system of intelligent disinfection robot, intelligent terminal and storage medium |
CN114610006A (en) * | 2020-11-24 | 2022-06-10 | 广东博智林机器人有限公司 | Working method and device of terrace equipment, terrace equipment and storage medium |
CN115429154A (en) * | 2021-06-04 | 2022-12-06 | 尚科宁家(中国)科技有限公司 | Cleaning control method of cleaning robot and cleaning robot |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101048098B1 (en) * | 2008-09-03 | 2011-07-11 | 한국과학기술원 | Robot route planning device and method |
KR101970191B1 (en) * | 2016-11-30 | 2019-04-18 | 주식회사 유진로봇 | Apparatus and method for controlling cleaning function and robotic cleaner with the apparatus |
-
2004
- 2004-08-12 KR KR1020040063384A patent/KR100596481B1/en not_active IP Right Cessation
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7916931B2 (en) | 2006-07-05 | 2011-03-29 | Samsung Electronics Co., Ltd. | Apparatus, method, and medium for dividing regions by using feature points and mobile robot using the same |
US8326019B2 (en) | 2006-07-05 | 2012-12-04 | Samsung Electronics Co., Ltd. | Apparatus, method, and medium for dividing regions by using feature points and mobile robot using the same |
US7933686B2 (en) | 2006-08-18 | 2011-04-26 | Samsung Electronics Co., Ltd. | Method of dividing coverage area for robot and device thereof |
KR100919698B1 (en) * | 2007-08-14 | 2009-09-29 | 포항공과대학교 산학협력단 | Cleaning method using cleaning robot |
KR101011687B1 (en) * | 2008-07-24 | 2011-01-28 | 주식회사 한울로보틱스 | Method of controlling clean path in robot cleaner |
KR101524020B1 (en) * | 2009-03-06 | 2015-05-29 | 엘지전자 주식회사 | Method for gradually building map by mobile robot and correcting position of mobile robot |
US9149167B2 (en) | 2011-06-28 | 2015-10-06 | Samsung Electronics Co., Ltd. | Robot cleaner and control method thereof |
US9796088B2 (en) | 2011-06-28 | 2017-10-24 | Samsung Electronics Co., Ltd. | Robot cleaner and control method thereof |
EP2932876A4 (en) * | 2012-12-07 | 2017-03-22 | Ecovacs Robotics Co., Ltd. | Window cleaning robot and operation mode control method thereof |
KR20160090568A (en) * | 2015-01-22 | 2016-08-01 | 주식회사 파인로보틱스 | Robot cleaning apparatus and method for controlling the same |
CN111374598B (en) * | 2018-12-28 | 2022-03-04 | 珠海一微半导体股份有限公司 | Control method and device for cleaning hair of sweeping robot and chip |
CN111374598A (en) * | 2018-12-28 | 2020-07-07 | 珠海市一微半导体有限公司 | Control method and device for cleaning hair of sweeping robot and chip |
CN111693045A (en) * | 2019-03-13 | 2020-09-22 | 北京奇虎科技有限公司 | Sweeping route generation method and device of sweeper |
CN109700391A (en) * | 2019-03-13 | 2019-05-03 | 周妍杉 | A kind of sweeping robot and the method for improving sweeping robot corner coverage |
CN114610006A (en) * | 2020-11-24 | 2022-06-10 | 广东博智林机器人有限公司 | Working method and device of terrace equipment, terrace equipment and storage medium |
CN112596518A (en) * | 2020-12-07 | 2021-04-02 | 深圳拓邦股份有限公司 | Robot cleaning path planning method and device and floor washing robot |
CN112596518B (en) * | 2020-12-07 | 2024-06-11 | 深圳拓邦股份有限公司 | Robot cleaning path planning method and device and floor cleaning robot |
CN112634402A (en) * | 2020-12-30 | 2021-04-09 | 苏州三六零机器人科技有限公司 | Sweeper area setting method, sweeper area setting device, sweeper area setting equipment and computer storage medium |
CN115429154A (en) * | 2021-06-04 | 2022-12-06 | 尚科宁家(中国)科技有限公司 | Cleaning control method of cleaning robot and cleaning robot |
CN114272417A (en) * | 2021-12-25 | 2022-04-05 | 千立生物技术(杭州)有限公司 | Disinfection method and system of intelligent disinfection robot, intelligent terminal and storage medium |
CN114272417B (en) * | 2021-12-25 | 2024-05-14 | 千立生物技术(杭州)有限公司 | Disinfection method and system of intelligent disinfection robot, intelligent terminal and storage medium |
Also Published As
Publication number | Publication date |
---|---|
KR100596481B1 (en) | 2006-07-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR100596481B1 (en) | Control Method of Mobile Robot with Function for Cleaning | |
EP2540203B1 (en) | Robot cleaner and control method thereof | |
EP4043988B1 (en) | Method for planning surface cleaning for a robot travelling along the border, chip and robot | |
US20220244739A1 (en) | Cleaning partition planning method for robot walking along boundry, chip and robot | |
KR930000081B1 (en) | Cleansing method of electric vacuum cleaner | |
CN110362079B (en) | Traversal control method and chip of robot and cleaning robot | |
JP4479101B2 (en) | Self-propelled vacuum cleaner | |
EP4059407B1 (en) | Cleaning control method based on dense obstacles | |
EP1715399B1 (en) | Robot cleaner driving method | |
KR100788791B1 (en) | The control method of cleaning action for cleaning robot | |
CN106805856A (en) | The method for controlling clean robot | |
JP7174505B2 (en) | vacuum cleaner | |
JP2008198191A (en) | Robot cleaner using edge detection and its control method | |
CN110801183B (en) | Cleaning task execution method and device, intelligent robot and storage medium | |
CN111202471A (en) | Full-coverage path generation method and generation device, intelligent robot and storage medium | |
CN111061270B (en) | Full coverage method, system and operation robot | |
US20230200611A1 (en) | Robot cleaner and driving method thereof | |
KR100549042B1 (en) | The control method of cleaning action for cleaning robot | |
CN114995458A (en) | Full-coverage real-time path planning method and device for cleaning robot | |
JP3583588B2 (en) | Mobile unit control device | |
JP7345132B2 (en) | Autonomous vacuum cleaner, autonomous vacuum cleaner control method, and program | |
JP2008108210A (en) | Self-traveling type cleaner | |
CN117215295A (en) | Control method for cleaning of cleaning robot dividing area, chip and robot | |
CN115047873A (en) | Floor mopping machine path planning method and system | |
CN112815945A (en) | Unmanned floor washing machine path planning method and system for increasing corner cleaning area |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant | ||
FPAY | Annual fee payment |
Payment date: 20090629 Year of fee payment: 4 |
|
LAPS | Lapse due to unpaid annual fee |