KR101056935B1 - Control method of automatic driving cleaner - Google Patents
Control method of automatic driving cleaner Download PDFInfo
- Publication number
- KR101056935B1 KR101056935B1 KR1020030102257A KR20030102257A KR101056935B1 KR 101056935 B1 KR101056935 B1 KR 101056935B1 KR 1020030102257 A KR1020030102257 A KR 1020030102257A KR 20030102257 A KR20030102257 A KR 20030102257A KR 101056935 B1 KR101056935 B1 KR 101056935B1
- Authority
- KR
- South Korea
- Prior art keywords
- mode
- wall
- cleaner
- driving
- priority
- Prior art date
Links
Images
Classifications
-
- 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/2836—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means characterised by the parts which are controlled
- A47L9/2852—Elements for displacement of the vacuum cleaner or the accessories therefor, e.g. wheels, casters or nozzles
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
본 발명은 자동주행 청소기의 제어 방법에 관한 것으로, 자동 주행 청소기가 청소 시작시, 주어진 공간의 경계 영역을, 벽면에 최대한 근접해서 청소하면서, 주변 환경에 따른 진입조건의 우선순위에 의해 자동주행 청소기의 운전모드를 결정하여 월팔로윙함으로써, 주어진 공간을 안전하게 주행하면서 청소가능 영역을 정확하게 파악하도록 한 것이다. 이를 위하여 본 발명은 기저장된 복수의 모드 중에서 진입조건에 해당하는 적어도 하나 이상의 모드를 확인하는 단계; 상기 확인된 적어도 하나 이상의 모드 중에서 우선순위가 가장 높은 모드를 후보 운전모드로 선택하는 단계; 상기 선택된 후보 운전모드의 우선순위를 현재 운전모드의 우선순위와 비교하는 단계; 상기 비교 결과, 상기 후보 운전모드의 우선순위가 상기 현재 운전모드의 우선순위보다 작거나 같으면 상기 현재 운전모드를 실행하는 단계; 및 상기 비교 결과, 상기 후보 운전모드의 우선순위가 상기 현재 운전모드의 우선순위보다 크면 상기 후보 운전모드를 현재 운전모드로 설정하고, 상기 설정된 현재 운전모드를 실행하는 단계를 포함하여 이루어진다.The present invention relates to a control method of an autonomous cleaner, and when the autonomous cleaner starts cleaning, the autonomous cleaner is cleaned according to the priority of the entry conditions according to the surrounding environment while cleaning the boundary area of a given space as close as possible to the wall surface. By deciding the driving mode of the moon, it is possible to accurately grasp the cleanable area while driving safely in a given space. To this end, the present invention comprises the steps of identifying at least one mode corresponding to the entry condition among a plurality of previously stored modes; Selecting a mode having the highest priority among the at least one identified mode as a candidate driving mode; Comparing a priority of the selected candidate driving mode with a priority of a current driving mode; Executing the current operation mode if the priority of the candidate operation mode is less than or equal to the priority of the current operation mode as a result of the comparison; And setting the candidate driving mode as the current driving mode and executing the set current driving mode when the priority of the candidate driving mode is greater than the priority of the current driving mode as a result of the comparison.
Description
도1은 본 발명 자동 주행 청소기의 월 팔로윙 방법이 적용되는 자동주행 청소기의 개략도.1 is a schematic diagram of an automatic driving cleaner to which the wall following method of the present invention is applied.
도2는 본 발명 자동 주행 청소기의 월 팔로윙 방법에 대한 동작흐름도.Figure 2 is an operation flow diagram for the wall following method of the present invention automatic traveling cleaner.
도3은 도2에 있어서, 각 운전모드를 보인 개략도.Figure 3 is a schematic diagram showing each operation mode in Figure 2;
도4는 본 발명의 월 팔로윙 방법이 적용된 시뮬레이션을 보인 개략도.Figure 4 is a schematic diagram showing a simulation applied to the wall following method of the present invention.
본 발명은 자동주행 청소기에 관한 것으로, 특히 자동 주행 청소기가 청소 시작시, 주어진 공간의 경계 영역을, 벽면에 최대한 근접해서 청소하면서, 주변 환경에 따른 진입조건의 우선순위에 의해 자동주행 청소기의 운전모드를 결정하여 월팔로윙하도록 한 자동주행 청소기의 제어 방법에 관한 것이다.BACKGROUND OF THE
인간 친화형 로봇에 대한 연구는 최근 가정용 서비스 로봇에 관심이 집중되어 다양한 결과물들을 시장에 내어놓고 있다. Research on human-friendly robots has recently focused on home service robots, bringing various results to market.
그 중에 자동주행 청소기는 빠른 시일 안에 상품화 가능한 아이템으로 인식되어 여러 기업체들이 도전해 왔는데, 최근 스웨덴, 영국, 미국 및 일본 등에서 전시회를 통해서 다양한 모델을 선보이고 있다. Among them, auto-driving cleaners have been recognized as items that can be commercialized as soon as possible, and many companies have challenged them. Recently, various models are exhibited at exhibitions in Sweden, the United Kingdom, the United States, and Japan.
상품화에 성공한 기존의 자동주행 청소기는 충전을 위하여 충전스테이션을 제공하고 있는데, 청소 도중 배터리 전압이 기준 전압보다 낮거나(Battery Low) 혹은 청소가 끝난 후에는 청소기가 멈춰버리는 것으로 종료하게 되어있다. Existing autonomous vacuum cleaners have been provided with a charging station for charging, and the battery voltage is lower than the reference voltage (Battery Low) during the cleaning or the vacuum cleaner stops after the cleaning is finished.
상술한 자동 주행 청소기는, 청소 시작시, 벽면을 따라 이동하면서 벽면 주변을 청소하고 다시 청소 시작위치로 돌아오는 월 팔로윙(wall following:이하 '월 팔로윙'이라함)을 실행한다.The above-described automatic driving cleaner executes a wall following (hereinafter, referred to as 'wall following') that moves along the wall and cleans around the wall and returns to the cleaning start position at the start of cleaning.
즉, 상기 자동 주행 청소기의 청소 작업은 벽면을 따라 청소하는 월 팔로윙 단계와, 그 월 팔로윙에 의해서 파악된 청소 가능 영역을 분석하여 청소 경로를 계획하여 청소하는 단계, 청소가 끝나면 충전기로 돌아가는 단계로 구성된다.That is, the cleaning operation of the automatic traveling cleaner includes a wall following step of cleaning along the wall surface, and analyzing and cleaning a cleaning area identified by the wall following, planning and cleaning a cleaning path, and returning to the charger after cleaning. It consists of steps.
이때, 상기 자동 주행 청소기의 청소능력은 주어진 공간에 대하여 빠른 시간 내에 빠짐없이 청소하는 능력으로 볼 수 있는데, 월 팔로윙이 충분히 수행되지 않으면 주어진 공간의 경계 부분이 제대로 청소되지 않고, 또한 부실한 월 팔로윙 동작에 의해, 청소 가능 영역을 정확하게 파악하지 못하여 잘못된 청소 경로를 계획하게 되어 청소 작업 효율이 떨어지게 된다.At this time, the cleaning capability of the automatic driving cleaner may be regarded as an ability to clean the given space quickly within a short time. If the wall following is not sufficiently performed, the boundary portion of the given space may not be properly cleaned, and the poor wall arm may be used. Due to the wing operation, it is not possible to accurately grasp the cleanable area, thereby planning the wrong cleaning path, thereby reducing the cleaning operation efficiency.
본 발명은 상기와 같은 문제점을 해결하기 위하여 안출된 것으로, 자동 주행 청소기가 청소 시작시, 주어진 공간의 경계 영역을, 벽면에 최대한 근접해서 청소하면서, 주변 환경에 따른 진입조건의 우선순위에 의해 자동주행 청소기의 운전모드를 결정하여 월팔로윙함으로써, 주어진 공간을 안전하게 주행하면서 청소가능 영역을 정확하게 파악하도록 한 자동주행 청소기의 제어 방법을 제공함에 그 목적이 있다.The present invention has been made to solve the above problems, and when the automatic running cleaner starts cleaning, it automatically cleans the boundary area of a given space as close as possible to the wall, and the priority is given to the entry conditions according to the surrounding environment. It is an object of the present invention to provide a control method of an autonomous cleaner that accurately grasps a cleanable area while safely driving a given space by determining an operation mode of the cleaner.
상기와 같은 목적을 달성하기 위한 본 발명은, 기저장된 복수의 모드 중에서 진입조건에 해당하는 적어도 하나 이상의 모드를 확인하는 단계; 상기 확인된 적어도 하나 이상의 모드 중에서 우선순위가 가장 높은 모드를 후보 운전모드로 선택하는 단계; 상기 선택된 후보 운전모드의 우선순위를 현재 운전모드의 우선순위와 비교하는 단계; 상기 비교 결과, 상기 후보 운전모드의 우선순위가 상기 현재 운전모드의 우선순위보다 작거나 같으면 상기 현재 운전모드를 실행하는 단계; 및 상기 비교 결과, 상기 후보 운전모드의 우선순위가 상기 현재 운전모드의 우선순위보다 크면 상기 후보 운전모드를 현재 운전모드로 설정하고, 상기 설정된 현재 운전모드를 실행하는 단계를 포함하여 이루어진 것을 특징으로 한다.The present invention for achieving the above object, the step of identifying at least one mode corresponding to the entry condition of a plurality of pre-stored mode; Selecting a mode having the highest priority among the at least one identified mode as a candidate driving mode; Comparing a priority of the selected candidate driving mode with a priority of a current driving mode; Executing the current operation mode if the priority of the candidate operation mode is less than or equal to the priority of the current operation mode as a result of the comparison; And setting the candidate driving mode as the current driving mode and executing the set current driving mode when the priority of the candidate driving mode is greater than the priority of the current driving mode as a result of the comparison. do.
이하, 본 발명에 의한 자동주행 청소기의 제어 방법에 대한 작용과 효과를 첨부한 도면을 참조하여 상세히 설명한다.Hereinafter, with reference to the accompanying drawings, the operation and effects of the control method of the automatic driving cleaner according to the present invention will be described in detail.
도1은 본 발명 자동 주행 청소기의 월 팔로윙 방법이 적용되는 장치의 구성을 보인 개략도이다.Figure 1 is a schematic diagram showing the configuration of a device to which the wall following method of the present invention automatic traveling cleaner is applied.
도1에 도시한 바와 같이, 자동 주행 청소기(10)는 2개의 구동륜(31, 32)이 있어서 회전 및 직진 운동을 할 수 있고, 자동 주행 청소기(10)의 뒷부분 밑면에 청소 흡입기(20)가 설치되어 있다. As shown in FIG. 1, the
그리고 상기 자동주행 청소기의 전면에 충돌 감지를 위한 터치 센서(40)가 부착되고, 벼랑 감지를 위한 센서(61, 62, 63)가 각각 구동륜 앞부분과 전면 하단에 설치된다.A
또한, 주변의 장애물 인식과 벽면과의 거리 및 각도를 측정하는 초음파 센서 (51, 52, 53, 53, 55, 56, 57, 58)는 반원 형태로 전면부에 설치되고, 오른쪽 구동륜(31)쪽에 설치된 초음파 센서(51)부터 차례로 1부터 번호를 매기면 1번 초음파 센서 (51) 2번 초음파 센서(52)는 30도 각도 간격으로 배치가 되어 있고 나머지 초음파 센서들은 각각 20도 간격으로 배치된다.In addition, the
도2는 본 발명 자동 주행 청소기의 월 팔로윙 방법에 대한 실시예의 동작 흐름도이다.2 is an operation flowchart of an embodiment of a wall following method of the automatic traveling cleaner of the present invention.
도2에 도시한 바와 같이, 본 발명은 자동주행 청소기의 진입조건에 따른 벽타기 모드, 제자리 회전모드, 이동회전모드, 벽찾기 모드, 섬탈출 모드, 충돌 회피 모드, 벼랑 회피모드와, 그 각각의 운전모드에 따른 우선순위를 기설정하는 과정(SP1)과; 사용자에 의해, 월 팔로윙이 선택되면, 이동할 공간의 진입조건을 조사하여 후보 운전모드를 선택하는 과정(SP2, SP3)과; 상기 과정에서 선택된 후보 운전모드가, 하나 이상이면 우선순위가 가장 높은 후보 운전모드를 선택하는 과정(SP5)과; 상기 선택된 후보 운전모드의 우선순위를 현재 운전모드의 우선순위를 비교하는 과정 (SP6)과; 상기 비교결과, 후보 운전모드의 우선순위가 현재 운전모드의 우선순위보다 작거나 같으면 그대로 현재 운전모드를 실행하고, 후보 운전모드의 우선순위가 현재 운전모드의 우선순위보다 크면 후보 운전모드를 현재 운전모드로 실행하는 과정 (SP7, SP8)과; 현재 운전모드의 종료조건이 되면, 월팔로윙 종료 여부에 따라 상기 과정을 반복 수행하거나, 월팔로윙을 종료하는 과정(SP10)으로 이루어지며, 이와 같은 본 발명의 동작을 설명한다.As shown in FIG. 2, the present invention provides a wall riding mode, a seat rotation mode, a moving rotation mode, a wall search mode, an island escape mode, a collision avoidance mode, a cliff avoidance mode, and the like, respectively according to the entry conditions of the automatic driving cleaner. Presetting a priority according to an operation mode of the device (SP1); Selecting, by the user, a candidate driving mode by investigating entry conditions of the space to be moved (SP2, SP3) when the wall following is selected; Selecting at least one candidate driving mode having the highest priority when the candidate driving mode is selected in the step (SP5); Comparing the priority of the selected candidate driving mode with the priority of the current driving mode (SP6); As a result of the comparison, if the priority of the candidate driving mode is less than or equal to the priority of the current driving mode, the current driving mode is executed as it is. Running in mode (SP7, SP8); When the current driving mode is terminated, the process is repeated according to whether or not the monthly follow-up ends or the process of ending the monthly follow-up (SP10) is described.
먼저, 자동주행 청소기의 진입조건에 따른 벽타기 모드, 제자리 회전모드, 이동회전모드, 벽찾기 모드, 섬탈출 모드, 충돌 회피 모드, 벼랑 회피모드와, 그 각각의 운전모드에 따른 우선순위를 기설정한다(SP1).First, the wall riding mode, the in-situ rotation mode, the moving rotation mode, the wall search mode, the island escape mode, the collision avoidance mode, the cliff avoidance mode according to the entry conditions of the automatic driving cleaner, and the priority according to the respective driving modes are described. (SP1).
상기 벽타기 모드의 진입조건은, 하기의 수학식과 같이, 우측면에 벽이 존재하고, 그 우측면과 자동주행 청소기의 거리가 일정값 보다 작은 경우로 설정한다. The entry condition of the wall riding mode is set to a case where a wall exists on the right side and the distance between the right side and the autonomous cleaner is smaller than a predetermined value, as shown in the following equation.
[수학식1][Equation 1]
또한, 상기 벽타기 모드를 한번 실행한 후, 그 벽타기 모드를 종료하도록 설정한다.In addition, after executing the wall riding mode once, the wall riding mode is set to end.
상기 제자리 회전모드의 진입조건은, 전방에 장애물이 존재하고, 측정된 거리값이 각각의 기준값 이하이면 더 이상 앞으로 진행할 수 없는 경우로 설정한다.The entry condition of the in-situ rotation mode is set to a case where an obstacle exists in the front and when the measured distance value is equal to or less than each reference value, it cannot proceed further.
또한, 상기 제자리 회전모드를 공간이 확보될 때까지 제자리에서 회전하여 벽면의 방향과 평행이 되면 종료하도록 설정한다.In addition, the in-situ rotation mode is set to end in rotation until the space is secured in parallel with the direction of the wall surface.
상기 이동회전모드의 진입조건은, 우측전방의 벽이 사라지는 경우, 자동 주행 청소기의 정우측면에 위치한 제1 초음파센서의 값이 기준값 보다 작고, 우측면에 위치한 제2 초음파 센서의 값이 기준값 보다 큰 경우로 설정한다.In the entry condition of the moving rotation mode, when the wall of the right front disappears, when the value of the first ultrasonic sensor located on the right and right sides of the automatic driving cleaner is smaller than the reference value, and the value of the second ultrasonic sensor located on the right side is larger than the reference value, Set to.
또한, 이동회전모드를, 우측 정방향에 벽이 나타날 때까지 회전하여, 우측 전면벽에 일정 거리 이내로 근접되면 종료하도록 설정하거나, 상기 자동주행 청소기가 한바퀴 이상 회전하면 이동회전모드를 종료하도록 설정한다.In addition, the moving rotation mode is rotated until the wall appears in the right forward direction, and is set to end when approaching the right front wall within a predetermined distance, or set to end the moving rotation mode when the automatic driving cleaner rotates more than one turn.
상기 벽찾기 모드의 진입조건은, 우측면에 벽이 존재하는 않는 경우, 자동주행 청소기의 우측면에 위치한 제1, 제2 초음파센서(51)(52)의 값이 기준값 보다 큰 경우로 설정하고, 벽을 찾은 후, 벽면과 평행이 유지되면 종료하도록 설정한다.The entry condition of the wall search mode is set to the case where the value of the first and second
상기 섬탈출 모드의 진입조건은, 하기의 수학식2와 같이, 오른쪽 벽타기를 실행하여 섬 형태의 장애물을 한바퀴 회전하는 경우로 설정하고, 이 섬탈출 모드의 동작이 완료되면 섬탈출 모드를 종료시키도록 설정한다.The entrance condition of the island escape mode is set to a case in which the island-type obstacle is rotated one turn by executing the right wall ride as shown in
[수학식2]&Quot; (2) "
상기 충돌 회피모드의 진입조건은, 자동주행 청소기의 전면부에 부착된 접촉센서를 통해 장애물과의 충돌하는 경우로 설정하고, 이 충돌 회피 모드의 동작이 완료되면 충돌회피 모드를 종료시키도록 설정한다. The collision avoidance mode entry condition is set to a case of collision with an obstacle through a contact sensor attached to the front part of the automatic driving cleaner, and set to end the collision avoidance mode when the operation of the collision avoidance mode is completed. .
상기 벼랑회피 모드의 진입조건은, 자동주행 청소기의 벼랑감지센서에 의해 감지된 거리값이 기준값 이상인 경우로 설정하고, 그 벼랑회피 모드의 동작이 완료되면 벼랑 회피모드를 종료시키도록 설정한다.The entry condition of the cliff avoidance mode is set to a case where the distance value detected by the cliff detection sensor of the automatic driving cleaner is equal to or greater than a reference value, and the cliff avoidance mode is terminated when the cliff avoidance mode is completed.
그리고 운전모드의 우선순위는 벼랑회피모드, 충돌회피모드, 제자리 회전모드, 섬탈출모드, 벽타기모드 순으로 설정하고, 상기 벽타기 모드와 이동회전모드, 벽찾기 모드는 같은 우선순위를 같도록 설정한다.The priority of the driving mode is set in order of cliff avoidance mode, collision avoidance mode, in-place rotation mode, island escape mode, wall riding mode, and the wall riding mode, moving rotation mode, and wall search mode have the same priority. Set it.
그 다음, 사용자에 의해, 월 팔로윙이 선택되면, 이동할 공간의 진입조건을 조사하여 후보 운전모드를 선택한다(SP2, SP3).Then, when the wall following is selected by the user, the candidate driving mode is selected by checking the entry condition of the space to be moved (SP2, SP3).
만약, 상기 과정에서 상기 과정에서 선택된 후보 운전모드가, 하나 이상이면 기설정된 우선순위에 의해, 우선순위가 가장 높은 후보 운전모드를 선택한다(SP4, SP5).If at least one candidate driving mode is selected in the above process, the candidate driving mode having the highest priority is selected according to a preset priority (SP4, SP5).
그 다음, 상기 후보 운전모드의 우선순위를 현재 운전모드의 우선순위와 비교하고(SP6), 그 비교결과 후보 운전모드의 우선순위가 현재 운전모드의 우선순위보다 작거나 같으면 그대로 현재 운전모드를 실행하고, 후보 운전모드의 우선순위가 현재 운전모드의 우선순위보다 크면 후보 운전모드를 현재 운전모드로 실행한다(SP7, SP8).Next, the priority of the candidate driving mode is compared with the priority of the current driving mode (SP6), and if the priority of the candidate driving mode is less than or equal to the priority of the current driving mode, the current driving mode is executed as it is. If the priority of the candidate operation mode is greater than that of the current operation mode, the candidate operation mode is executed in the current operation mode (SP7, SP8).
여기서, 상기 각각의 운전모드의 동작을 설명한다.Here, the operation of each operation mode will be described.
먼저, 벽타기 운전 모드인 경우, 도3의 (a)와 같이, 벽과의 각도 차이와 거리 차이로부터 회전속도를 구하여 벽을 따라 이동하는데, 즉 제1, 제2 초음파센서 (51, 52)를 이용하여 벽과의 각도 차이와 거리 차이로부터 하기의 수학식3에 의해 회전속도를 계산한다.First, in the wall riding operation mode, as shown in FIG. 3 (a), the rotational speed is obtained from the angle difference and the distance difference from the wall, and moves along the wall, that is, the first and second
[수학식3]&Quot; (3) "
그리고 제자리 회전모드인 경우, 도3의 (b)와 같이, 주위 벽면과의 거리를 조사하여 최소한으로 회전해야 할 각도를 계산하여 회전하는데, 이때 측정된 거리 값 모두가 각각의 기준 값(전진이 가능한 최소값) 보다 커야 진행 가능한 것으로 판단하고, 그 기준 값(전진이 가능한 최소값) 설정 시 감속할 때의 이동 거리도 고려하며, 상기 벽 타기 모드가 더 발현될 수 있도록 초음파 센서(53)의 기준 값을 벽면의 상태에 따라 다른 값을 가지도록 한다.In the in-situ rotation mode, as shown in FIG. 3 (b), the distance to the surrounding wall is investigated and the minimum rotation angle is calculated, and all the measured distance values correspond to the respective reference values. The maximum value of the
그리고 이동회전모드의 경우, 도3의 (c)와 같이, 일정거리를 직진한 후, 일정한 곡률반경의 크기로 회전하는데, 이때 상기 곡률 반경의 크기는 로봇 반경에 벽면과의 유지 거리를 합한 값이다.In the case of the moving rotation mode, as shown in (c) of FIG. 3, after a predetermined distance, the motor rotates to a constant radius of curvature, wherein the radius of curvature is the value of the robot radius plus the holding distance from the wall. to be.
그리고 벽찾기 모드의 경우, 도3의 (d)와 같이, 벽이 나타날 때까지 직진한 후 벽면과 평행하도록 제자리 회전하는데, 즉 자동 주행 청소기가 벽면의 근처에 있는 경우에 벽면쪽으로 회전한 후 직진하고, 이전의 월 팔로윙 모드가 이동회전 모드, 벼랑회피모드, 충돌회피모드인 경우는 직진하지 않고 오른쪽 방향으로 회전하면서 이동한다.In the wall search mode, as shown in (d) of FIG. 3, the device proceeds straight until the wall appears and then rotates in place to be parallel to the wall, that is, when the automatic driving cleaner is near the wall, then goes straight to the wall. If the previous wall following mode is the moving rotation mode, the cliff avoidance mode, or the collision avoidance mode, the vehicle moves in the right direction without going straight.
그리고 섬탈출모드의 경우, 도3의 (e)와 같이, 섬이 없는 방향을 향하도록 일정 각도 제자리 회전시키고, 충돌회피모드의 경우, 도3의 (f)와 같이 뒤로 일정거리만큼 이동한 후, 일정 각도를 제자리 회전시키며, 벼랑회피모드의 경우, 도3의 (g)와 같이, 뒤로 일정거리만큼 이동한 후, 일정 각도를 제자리 회전시킨다.In case of the island escape mode, as shown in Fig. 3 (e), it rotates at an angle to face the island-free direction, and in the case of the collision avoidance mode, it moves back a certain distance as shown in Fig. 3 (f). , Rotates a certain angle in place, in the case of the cliff avoidance mode, as shown in Figure 3 (g), after moving a certain distance back, and rotates a certain angle in place.
그 다음, 상기 각각의 운전모드의 종료 조건이 되면 해당 운전모드를 해제하고, 하기의 수학식(4)와 같은 종료조건을 만족하면 월 팔로윙 운전을 종료시킨다.Then, when the end condition of each operation mode is reached, the operation mode is canceled, and when the end condition as shown in Equation (4) is satisfied, the month following operation is terminated.
[수학식4]&Quot; (4) "
여기서, 도4는 본 발명의 월 팔로윙방법이 적용된 시뮬레이션을 보인 개략도이다.4 is a schematic view showing a simulation to which the wall following method of the present invention is applied.
상기 본 발명의 상세한 설명에서 행해진 구체적인 실시 양태 또는 실시예는 어디까지나 본 발명의 기술 내용을 명확하게 하기 위한 것으로 이러한 구체적 실시예에 한정해서 협의로 해석해서는 안되며, 본 발명의 정신과 다음에 기재된 특허 청구의 범위내에서 여러가지 변경 실시가 가능한 것이다.Specific embodiments or examples made in the detailed description of the present invention are intended to clarify the technical contents of the present invention to the extent that they should not be construed as limited to these specific embodiments and should not be construed in consultation. Various changes can be made within the scope of.
이상에서 상세히 설명한 바와 같이 본 발명은, 자동 주행 청소기가 청소 시작시, 주어진 공간의 경계 영역을, 벽면에 최대한 근접해서 청소하면서, 주변 환경에 따른 진입조건의 우선순위에 의해 자동주행 청소기의 운전모드를 결정하여 월팔로윙함으로써, 주어진 공간을 안전하게 주행하면서 청소가능 영역을 정확하게 파악하여 청소효율을 향상시키는 효과가 있다.As described in detail above, in the present invention, when the automatic traveling cleaner starts cleaning, the driving mode of the automatic driving cleaner according to the priority of the entry conditions according to the surrounding environment while cleaning the boundary region of the given space as close as possible to the wall surface. By deciding to follow the wall, it is effective to grasp the cleanable area while driving safely in a given space to improve the cleaning efficiency.
Claims (27)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020030102257A KR101056935B1 (en) | 2003-12-31 | 2003-12-31 | Control method of automatic driving cleaner |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020030102257A KR101056935B1 (en) | 2003-12-31 | 2003-12-31 | Control method of automatic driving cleaner |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20050071239A KR20050071239A (en) | 2005-07-07 |
KR101056935B1 true KR101056935B1 (en) | 2011-08-12 |
Family
ID=37261210
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020030102257A KR101056935B1 (en) | 2003-12-31 | 2003-12-31 | Control method of automatic driving cleaner |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR101056935B1 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20150009048A (en) * | 2013-07-11 | 2015-01-26 | 삼성전자주식회사 | Cleaning robot and method for controlling the same |
KR20190134714A (en) * | 2017-04-11 | 2019-12-04 | 아미크로 세미컨덕터 씨오., 엘티디. | Robot Motion Control Method Based on Map Prediction |
WO2020116948A1 (en) * | 2018-12-06 | 2020-06-11 | Samsung Electronics Co., Ltd. | Robot vacuum cleaner and cleaning route planning method thereof |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101281512B1 (en) | 2007-04-06 | 2013-07-03 | 삼성전자주식회사 | Robot cleaner and control method thereof |
KR100963700B1 (en) * | 2007-12-05 | 2010-06-14 | 주식회사 포스코아이씨티 | Method for Controlling Driving of Moving Robot and Moving Robot Using the Same |
CN111208785B (en) * | 2020-04-20 | 2020-07-14 | 浙江欣奕华智能科技有限公司 | Motion control method and device |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR940023433A (en) * | 1993-04-28 | 1994-11-17 | 이헌조 | Driving Control Method of Automatic Travel Cleaner Using Neural Network |
JPH11212642A (en) * | 1998-01-21 | 1999-08-06 | Honda Motor Co Ltd | Method and device for controlling self-traveling robot |
KR20020076153A (en) * | 2001-03-27 | 2002-10-09 | 가부시키가이샤 히타치세이사쿠쇼 | Self-propelled Cleaner |
-
2003
- 2003-12-31 KR KR1020030102257A patent/KR101056935B1/en active IP Right Grant
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR940023433A (en) * | 1993-04-28 | 1994-11-17 | 이헌조 | Driving Control Method of Automatic Travel Cleaner Using Neural Network |
JPH11212642A (en) * | 1998-01-21 | 1999-08-06 | Honda Motor Co Ltd | Method and device for controlling self-traveling robot |
KR20020076153A (en) * | 2001-03-27 | 2002-10-09 | 가부시키가이샤 히타치세이사쿠쇼 | Self-propelled Cleaner |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20150009048A (en) * | 2013-07-11 | 2015-01-26 | 삼성전자주식회사 | Cleaning robot and method for controlling the same |
KR102082757B1 (en) | 2013-07-11 | 2020-02-28 | 삼성전자주식회사 | Cleaning robot and method for controlling the same |
KR20190134714A (en) * | 2017-04-11 | 2019-12-04 | 아미크로 세미컨덕터 씨오., 엘티디. | Robot Motion Control Method Based on Map Prediction |
KR102260529B1 (en) * | 2017-04-11 | 2021-06-03 | 아미크로 세미컨덕터 씨오., 엘티디. | Robot motion control method based on map prediction |
US11144064B2 (en) | 2017-04-11 | 2021-10-12 | Amicro Semiconductor Co., Ltd. | Method for controlling motion of robot based on map prediction |
WO2020116948A1 (en) * | 2018-12-06 | 2020-06-11 | Samsung Electronics Co., Ltd. | Robot vacuum cleaner and cleaning route planning method thereof |
US11647885B2 (en) | 2018-12-06 | 2023-05-16 | Samsung Electronics Co., Ltd. | Robot vacuum cleaner and cleaning route planning method thereof |
Also Published As
Publication number | Publication date |
---|---|
KR20050071239A (en) | 2005-07-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107544517B (en) | Control method of intelligent cleaning robot | |
CN214484411U (en) | Autonomous floor cleaner | |
US7085624B2 (en) | Autonomous machine | |
CN103705178B (en) | Robot cleaner and its control method | |
KR101566207B1 (en) | Robot cleaner and control method thereof | |
US7053580B2 (en) | Autonomous machine | |
US7248951B2 (en) | Method and device for determining position of an autonomous apparatus | |
CN107678429B (en) | Robot control method and chip | |
JP7012238B2 (en) | Autonomous vacuum cleaner | |
WO2003040846A1 (en) | An autonomous machine | |
CN103251358A (en) | Control method of sweeping robot | |
KR20050072300A (en) | Cleaning robot and control method thereof | |
AU2002337343A1 (en) | An autonomous machine | |
JPS62263508A (en) | Autonomous type work track | |
KR20210131290A (en) | Robot Cleaner and Controlling method for the same | |
KR101938703B1 (en) | Robot cleaner and control method for the same | |
KR101056935B1 (en) | Control method of automatic driving cleaner | |
KR100549042B1 (en) | The control method of cleaning action for cleaning robot | |
JP2020095666A (en) | Autonomous cleaner travel control method | |
KR100641119B1 (en) | Furniture bottom clean apparatus and method for robot cleaner | |
KR101226397B1 (en) | Cleaning method of robot cleaner | |
KR100863248B1 (en) | Robot cleaner and control method of the same of | |
KR100677253B1 (en) | Spot cleaning method for robot cleaner | |
KR100792834B1 (en) | Moving Robot and driving method for the moving robot | |
CN111897336A (en) | Method and chip for judging ending of robot edgewise behavior and robot |
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: 20140724 Year of fee payment: 4 |
|
FPAY | Annual fee payment |
Payment date: 20150724 Year of fee payment: 5 |
|
FPAY | Annual fee payment |
Payment date: 20160722 Year of fee payment: 6 |