JPH0884696A - Cleaning robot control method and device therefor - Google Patents

Cleaning robot control method and device therefor

Info

Publication number
JPH0884696A
JPH0884696A JP6221766A JP22176694A JPH0884696A JP H0884696 A JPH0884696 A JP H0884696A JP 6221766 A JP6221766 A JP 6221766A JP 22176694 A JP22176694 A JP 22176694A JP H0884696 A JPH0884696 A JP H0884696A
Authority
JP
Japan
Prior art keywords
distance
wall
corridor
cleaning robot
traveling
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP6221766A
Other languages
Japanese (ja)
Inventor
Hajime Aoyama
山 元 青
Shigeki Tajima
島 茂 樹 田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Subaru Corp
Original Assignee
Fuji Heavy Industries Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fuji Heavy Industries Ltd filed Critical Fuji Heavy Industries Ltd
Priority to JP6221766A priority Critical patent/JPH0884696A/en
Publication of JPH0884696A publication Critical patent/JPH0884696A/en
Pending legal-status Critical Current

Links

Abstract

PURPOSE: To prevent a robort from touching with and colliding against a wall, by performing a switching control so as to make the robot run by holding a certain distance up to the wall when the robot is running along the wall, and to make the robot run straight based on the direction when a reccessed part is present on the wall. CONSTITUTION: Distance sensors 14a and 14b by which a running distance of a cleaning robot 41 is measured and distance data are outputted are provided on rotationary axes of driving motors 11a and 11b. A forward obstacle sensor 17b for detecting forward obstacles and right/left sides obstacle sensors 17b and 17c for detecting obstacles of the respective direction, and furthermore, a direction sensor 18 for detecting directions and outputting the direction data are provided on the forward side of the cleaning robot 41. Also, a right wall detecting sensor 21a and a left wall detecting sensor 21b are provided in front of the cleaning robot and these sensors detect distances to right/left walls and output distance data. Signals outputted respectively from these sensors are given to a control part 16.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、自動清掃機能と自律走
行機能とを備える清掃ロボットを制御する方法及びその
装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a method and apparatus for controlling a cleaning robot having an automatic cleaning function and an autonomous traveling function.

【0002】[0002]

【従来の技術】近年、自動清掃機能と自律走行機能とを
有する清掃ロボットが開発されている。このような清掃
ロボットは、自律走行が可能なように蓄電池を電源とす
るモータと、モータにより駆動される駆動車輪と、障害
物や方位等の検知を行うセンサと、センサの出力を用い
てモータの動作を制御するマイクロコンピュータとを車
両に搭載している。また、自動清掃が可能なように、塵
埃を吸い込む吸引ノズルや清掃ブラシを備えている。こ
のような清掃ロボットとして、例えば特開平5−158
536号公報や特開平5−161577号公報に開示さ
れたものがある。
2. Description of the Related Art In recent years, cleaning robots having an automatic cleaning function and an autonomous traveling function have been developed. Such cleaning robots use a motor that uses a storage battery as a power source to enable autonomous traveling, drive wheels that are driven by the motor, a sensor that detects an obstacle or a direction, and a motor that uses the output of the sensor. The vehicle is equipped with a microcomputer that controls the operation of the. Further, a suction nozzle for sucking dust and a cleaning brush are provided so that automatic cleaning can be performed. As such a cleaning robot, for example, Japanese Patent Laid-Open No. 5-158
There are those disclosed in Japanese Patent No. 536 and Japanese Patent Laid-Open No. 161577/1993.

【0003】[0003]

【発明が解決しようとする課題】しかし、従来の清掃ロ
ボットの制御によれば、長い廊下の清掃を行うと次のよ
うな問題が生じていた。
However, according to the conventional control of the cleaning robot, when cleaning a long corridor, the following problems occur.

【0004】先ず、図11に示されるように、清掃ロボ
ット51を壁32沿いに長い距離を走行させると、途中
で壁に接触して清掃動作を行うことができなくなる場合
があった。これは、清掃ロボット51の走行開始時点
で、壁32に対して完全に平行に設定することが事実上
不可能なことに起因していた。例えば、壁32から20
0mm離れた位置から、壁32に対して0.5度ずれた方
向へ清掃ロボット51が走行し始めると、22917
(=200/tan0.5度)mm走行した時点で清掃ロ
ボット51が壁32に接触して停止する。
First, as shown in FIG. 11, when the cleaning robot 51 travels along the wall 32 for a long distance, the cleaning robot 51 may come into contact with the wall and cannot perform the cleaning operation. This is because it is practically impossible to set the cleaning robot 51 completely parallel to the wall 32 when the cleaning robot 51 starts traveling. For example, walls 32 to 20
When the cleaning robot 51 starts traveling from a position 0 mm away from the wall 32 in a direction shifted by 0.5 degrees, 22917
The cleaning robot 51 comes into contact with the wall 32 and stops when traveling (= 200 / tan 0.5 degrees) mm.

【0005】また、清掃ロボット51が壁32までの距
離を一定に保つように走行している最中に、図12に示
されたように壁32の途中に出入口等で凹部32aが存
在すると、清掃ロボット51が凹部32aの内壁までの
距離を一定に保つべく凹部32a内へ入りこんで衝突す
ることがあった。
Further, when the cleaning robot 51 travels so as to keep the distance to the wall 32 constant, as shown in FIG. 12, if a recess 32a exists in the middle of the wall 32 such as an entrance / exit, The cleaning robot 51 sometimes enters the recess 32a and collides with it in order to keep the distance to the inner wall of the recess 32a constant.

【0006】本発明は上記事情に鑑みてなされたもの
で、長い廊下の清掃を可能にする清掃ロボットの制御方
法及びその装置を提供することを目的とする。
The present invention has been made in view of the above circumstances, and an object of the present invention is to provide a cleaning robot control method and apparatus for cleaning a long corridor.

【0007】[0007]

【課題を解決するための手段】本発明の清掃ロボットの
制御方法は、清掃すべき廊下の縦方向寸法を操作部に入
力され、障害物、方位及び走行距離をセンサにより検出
し、入力された前記縦方向寸法と検出された障害物、方
位及び走行距離に基づいて車両駆動機構を制御部により
制御し車両を自律走行させる方法であって、走行開始前
に、操作者が清掃ロボットを廊下の第1の壁に平行に設
置し、廊下の縦方向寸法を操作部に入力するステップ
と、第1又は第2の壁を検出する壁検出センサを用い
て、清掃ロボットから第1の壁までの距離を測定して基
準距離として制御部に入力するステップと、清掃ロボッ
トを90度旋回させ、廊下を横方向に走行させ、第2の
壁を検知して停止するまでに走行した距離を廊下横幅距
離として制御部に入力するステップと、清掃ロボットを
90度旋回させ、第2の壁までの距離が基準距離を維持
するように第2の壁に沿って走行させるステップと、第
2の壁に沿って縦方向寸法だけ走行させた後停止させる
ステップと、清掃ロボットを90度旋回させ、廊下を横
方向に所定距離だけ走行させていく過程で横方向に走行
した距離の合計値が廊下横幅距離に到達したときは90
度旋回させて廊下を第1の壁沿いに縦方向寸法だけ走行
させて終了し、横方向に走行した距離の合計値が廊下横
幅距離に到達しないときは所定距離だけ走行した後停止
させるステップと、所定距離だけ走行した後停止したと
きは、清掃ロボットを90度旋回させ、センサにより検
出された方位に基づいて直進走行させた後停止させるス
テップと、清掃ロボットを90度旋回させ、廊下を横方
向に所定距離だけ走行させていく過程で横方向に走行し
た距離の合計値が廊下横幅距離に到達したときは90度
旋回させて廊下を第1の壁沿いに縦方向寸法だけ走行さ
せて終了し、横方向に走行した距離の合計値が廊下横幅
距離に到達しないときは所定距離だけ走行した後停止さ
せるステップとを備える。
According to the control method of the cleaning robot of the present invention, the vertical dimension of the corridor to be cleaned is input to the operation unit, and the obstacle, direction and traveling distance are detected by the sensor and input. A method for controlling a vehicle drive mechanism by a control unit based on the vertical dimension and detected obstacles, azimuth, and traveling distance to allow a vehicle to travel autonomously, in which an operator controls a cleaning robot in a corridor before starting traveling. From the cleaning robot to the first wall, using the step of installing in parallel to the first wall and inputting the vertical dimension of the corridor into the operation unit, and the wall detection sensor detecting the first or second wall. The step of measuring the distance and inputting it to the control unit as the reference distance, the cleaning robot is turned 90 degrees, and the corridor is moved laterally, and the distance traveled until the second wall is detected and stopped is detected. Input to controller as distance And a step of rotating the cleaning robot 90 degrees and traveling along the second wall so that the distance to the second wall maintains the reference distance, and a vertical dimension along the second wall. When the total value of the distance traveled in the lateral direction reaches the corridor lateral width distance in the process of moving the cleaning robot 90 degrees after turning the cleaning robot and moving the cleaning robot 90 degrees laterally in the corridor.
Turn to make the corridor run along the first wall for the lengthwise dimension to finish, and if the total value of the distance traveled in the horizontal direction does not reach the width of the corridor, stop after running a predetermined distance. When the vehicle stops after traveling for a predetermined distance, the cleaning robot turns 90 degrees, and the vehicle travels straight based on the direction detected by the sensor and then stops. When the total value of the distance traveled in the lateral direction reaches the corridor width in the process of traveling a predetermined distance in the direction, turn 90 degrees and run the corridor along the first wall by the vertical dimension to finish. If the total value of the distance traveled in the lateral direction does not reach the corridor lateral width distance, the vehicle travels a predetermined distance and then stops.

【0008】ここで、第1又は第2の壁沿いに走行する
ステップにおいて、壁検出センサにより検出された第1
又は第2の壁までの距離が基準距離よりも一定の距離以
上に長い場合には、方位センサにより検出された方位に
基づいて直進走行するように制御を切り替えてもよい。
Here, in the step of traveling along the first or second wall, the first detected by the wall detection sensor.
Alternatively, when the distance to the second wall is longer than the reference distance by a certain distance or more, the control may be switched so that the vehicle travels straight based on the azimuth detected by the azimuth sensor.

【0009】本発明の清掃ロボットの制御装置は、清掃
すべき廊下の縦方向寸法を入力される操作部と、清掃ロ
ボットから第1又は第2の壁までの距離を測定する壁検
出センサと、方位を検出する方位センサと、走行した距
離の検出を行う走行距離検出部と、廊下の横方向の距離
を廊下横幅距離として記憶し、第1又は第2の壁ぎわを
縦方向に走行するときは、壁検出センサにより検出され
た第1又は第2の壁までの距離が基準距離を維持するよ
うに走行させ、第1又は第2の壁ぎわ以外を縦方向に走
行するときは、方位センサにより検出された方位に基づ
いて直進するように走行させ、廊下を横方向に走行する
ときは、横方向に所定距離だけ走行する過程で走行した
距離の合計値が廊下横幅距離に到達した場合はその後第
1又は第2の壁までの距離が基準距離を維持するように
縦方向に走行させ、横方向に走行した距離の合計値が廊
下横幅距離に到達しない場合は横方向に所定距離だけ走
行させた後方位センサにより検出された方位に基づいて
縦方向に直進するように車両駆動機構を制御する制御部
とを備える。
The control device for the cleaning robot according to the present invention comprises an operation unit for inputting the vertical dimension of the corridor to be cleaned, a wall detection sensor for measuring the distance from the cleaning robot to the first or second wall, A direction sensor for detecting the direction, a running distance detection unit for detecting the distance traveled, a lateral distance of the corridor is stored as a corridor lateral width distance, and the first or second wall wrinkle is longitudinally traveled. Is the direction sensor when traveling such that the distance to the first or second wall detected by the wall detection sensor maintains the reference distance, and when traveling in the vertical direction other than the first or second wall ridge. When traveling in a straight line based on the azimuth detected by, and traveling horizontally in the corridor, if the total value of the distance traveled in the process of traveling a predetermined distance in the horizontal direction reaches the corridor lateral width distance, Then the first or second wall Is run vertically to maintain the reference distance, and if the total value of the distances run horizontally does not reach the corridor width, the vehicle is run a predetermined distance in the horizontal direction and is detected by the azimuth sensor. And a control unit that controls the vehicle drive mechanism so as to move straight in the vertical direction based on the azimuth.

【0010】制御部は、壁検出センサにより検出された
第1又は第2の壁までの距離が基準距離を維持して第1
又は第2の壁沿いを走行するように車両駆動機構を制御
しているときに、検出された第1又は第2の壁までの距
離が基準距離よりも一定の距離以上に長い場合は、方位
センサにより検出された方位に基づいて直進走行するよ
うに車両駆動機構の制御を切り替えるものであってもよ
い。
The control unit maintains the first distance while the distance to the first or second wall detected by the wall detection sensor maintains the reference distance.
Alternatively, when the detected distance to the first or second wall is longer than the reference distance by a certain distance or more while controlling the vehicle drive mechanism so as to travel along the second wall, The control of the vehicle drive mechanism may be switched so that the vehicle travels straight based on the azimuth detected by the sensor.

【0011】[0011]

【作用】第1又は第2の壁に沿って走行するときは、壁
までの距離を検出しこの距離が基準距離を維持するよう
に走行することで、方向のずれが次第に増大していき第
1又は第2の壁に接触し停止することを防ぐことができ
る。
When the vehicle travels along the first or second wall, the distance to the wall is detected and the vehicle travels so that this distance maintains the reference distance. It is possible to prevent contact with the first or second wall and stop.

【0012】また、第1又は第2の壁に沿って走行して
いる最中に、検出された壁までの距離が基準距離よりも
一定の距離以上に長い場合は、壁に凹部が存在すると判
断し、検出された方位に基づいて直進走行するように制
御を切り換えることで、凹部の内側へ入り込んで衝突す
る事態が回避される。
Further, when the detected distance to the wall is longer than the reference distance by a certain distance or more while traveling along the first or second wall, there is a recess in the wall. By making a determination and switching the control so that the vehicle travels straight based on the detected azimuth, the situation of entering into the inside of the recess and colliding is avoided.

【0013】[0013]

【実施例】以下、本発明の一実施例による清掃ロボット
の制御方法およびその装置について、図面を参照して説
明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS A cleaning robot control method and apparatus according to an embodiment of the present invention will be described below with reference to the drawings.

【0014】先ず、図1に本実施例において制御対象と
なる清掃ロボット41の走行機構及び清掃機構の概略構
成を示す。
First, FIG. 1 shows a schematic configuration of a traveling mechanism and a cleaning mechanism of a cleaning robot 41 to be controlled in this embodiment.

【0015】車両の両側に一対の駆動車輪12a及び1
2bが設けられ、それぞれの駆動車輪12a及び12b
に対応して駆動モータ11a及び11bが設けられてい
る。また、駆動モータ11a及び11bにそれぞれ対応
して、モータドライバ15a及び15bが設けられてい
る。モータドライバ15a及び15bは、制御部16か
ら与えられる指令信号に基づいて駆動モータ11a及び
11bの動作をそれぞれ制御する。また、車両の後部に
は回転自在な3つの清掃ブラシ13a〜13cと、清掃
後の汚水を吸引するスクイジ23が配置されている。
A pair of drive wheels 12a and 1 on either side of the vehicle.
2b are provided for each drive wheel 12a and 12b
The drive motors 11a and 11b are provided corresponding to. Further, motor drivers 15a and 15b are provided corresponding to the drive motors 11a and 11b, respectively. The motor drivers 15a and 15b control the operation of the drive motors 11a and 11b, respectively, based on the command signal given from the control unit 16. Further, three rotatable cleaning brushes 13a to 13c and a squeegee 23 for sucking dirty water after cleaning are arranged at the rear portion of the vehicle.

【0016】駆動モータ11a及び11bの回転軸には
清掃ロボット41の走行距離を測定し距離データを出力
する距離センサ14a及び14bが設けられている。清
掃ロボット41の前方側には前方の障害物を検知する前
方障害物センサ17bと、清掃ロボット41の左右側方
にはそれぞれ方位の障害物を検知する前方障害物センサ
17a及び17cとが設けられ、さらに方位を検知し方
位データを出力する方位センサ18が設けられている。
ここで、三個の前方障害物センサ17a〜17cが設け
られているが、これは前方の障害物の検知をより確実に
行うためであって、1個若しくは2個であってもよい。
また、清掃ロボット41の前方には右壁検出センサ21
aと左壁検出センサ21bとが設けられており、これは
左右の壁までの距離を検出して距離データを出力する。
Distance sensors 14a and 14b for measuring the traveling distance of the cleaning robot 41 and outputting distance data are provided on the rotary shafts of the drive motors 11a and 11b. The front side of the cleaning robot 41 is provided with a front obstacle sensor 17b for detecting a front obstacle, and the left and right sides of the cleaning robot 41 are provided with front obstacle sensors 17a and 17c for detecting an azimuth obstacle, respectively. Further, an azimuth sensor 18 for detecting the azimuth and outputting the azimuth data is provided.
Here, three front obstacle sensors 17a to 17c are provided, but this is for more reliably detecting the front obstacle, and may be one or two.
Further, in front of the cleaning robot 41, the right wall detection sensor 21
a and a left wall detection sensor 21b are provided, which detect the distance to the left and right walls and output distance data.

【0017】これらの距離センサ14a及び14b、前
方障害物センサ17a〜17c、方位センサ18、及び
左右壁検出センサ21及び21bからそれぞれ出力され
た信号は、制御部16に与えられる。
The signals output from the distance sensors 14a and 14b, the front obstacle sensors 17a to 17c, the azimuth sensor 18, and the left and right wall detection sensors 21 and 21b are given to the control unit 16.

【0018】さらに、清掃ロボット41の上部には、清
掃区域の縦及び横方向の長さの設定を行うスイッチ、走
行の起動又は停止を行うスイッチ等が配置された図示さ
れていない操作パネルが設けられており、この操作パネ
ルは制御部16に接続されている。
Further, on the upper part of the cleaning robot 41, there is provided an operation panel (not shown) on which a switch for setting the length of the cleaning area in the vertical and horizontal directions, a switch for starting or stopping the traveling, and the like are arranged. This operation panel is connected to the control unit 16.

【0019】制御部16内のより詳細な回路構成は、図
2に示されるようである。制御部16は、インタフェー
ス19a〜19c、メインコントローラ20、カウンタ
24、及びAD変換器19dを備えている。
A more detailed circuit configuration in the control unit 16 is as shown in FIG. The control unit 16 includes interfaces 19a to 19c, a main controller 20, a counter 24, and an AD converter 19d.

【0020】インタフェース19aは、前方障害物セン
サ17a〜17cから出力された検知信号に増幅、レベ
ルシフト等の処理を行い、メインコントローラ20へ出
力する。インタフェース19bは、方位センサ18から
出力された方位データを与えられて増幅等の処理を行
い、メインコントローラ20へ出力する。左右壁検出セ
ンサ21a及び21bから出力された壁までの距離を示
す距離データは、AD変換器19dによりアナログ信号
からディジタル信号の形態に変換されてメインコントロ
ーラ20に入力される。
The interface 19a performs processing such as amplification and level shift on the detection signals output from the front obstacle sensors 17a to 17c, and outputs the detection signals to the main controller 20. The interface 19b is given the azimuth data output from the azimuth sensor 18, performs processing such as amplification, and outputs the data to the main controller 20. The distance data indicating the distance to the wall output from the left and right wall detection sensors 21a and 21b is converted from an analog signal to a digital signal by the AD converter 19d and input to the main controller 20.

【0021】右駆動モータ11a及び左駆動モータ11
bの回転軸に取り付けられた距離センサ14a及び14
bは、単位時間当りの回転数を検知してその検知した結
果を制御部16内のカウンタ24に与える。カウンタ2
4はこの回転数の計数を行い走行距離を算出し、その結
果をメインコントローラ20に与える。
Right drive motor 11a and left drive motor 11
distance sensors 14a and 14 attached to the rotating shaft of FIG.
In b, the number of rotations per unit time is detected and the detection result is given to the counter 24 in the control unit 16. Counter 2
4 counts the number of rotations to calculate the traveling distance, and gives the result to the main controller 20.

【0022】また、上述した操作パネル22には清掃区
域の縦及び横方向の長さの設定を行うスイッチや走行の
起動又は停止を行うスイッチ等が配置されており、この
操作パネル22は制御部16のメインコントローラ20
に接続されている。
The operation panel 22 described above is provided with a switch for setting the length of the cleaning area in the vertical and horizontal directions, a switch for starting or stopping the traveling, and the like. 16 main controllers 20
It is connected to the.

【0023】メインコントローラ20は、操作パネル2
2に入力された清掃区域の寸法や走行の起動等に関する
情報を与えられる。さらにメインコントローラ20は、
前方障害物センサ17a〜17cが検知した前方障害物
の有無と、方位センサ18が検知した方位と、カウンタ
24が算出した走行距離と、左右壁検出センサ21a及
び21bが検出した左側又は右側の壁までの距離に基づ
いて、右駆動モータ11a及び左駆動モータ11bの駆
動を制御するための指令信号をインタフェース19cに
出力する。インタフェース19cは、この指令信号に増
幅等の処理を行いドライバ15a及び15bに出力す
る。ドライバ15a及び15bは、指令信号に基づいて
それぞれ右駆動モータ11a及び左駆動モータ11bを
制御する。
The main controller 20 is the operation panel 2
The information about the size of the cleaning area and the start of running, which are input in 2, are given. Furthermore, the main controller 20
The presence or absence of a front obstacle detected by the front obstacle sensors 17a to 17c, the azimuth detected by the azimuth sensor 18, the traveling distance calculated by the counter 24, and the left or right wall detected by the left and right wall detection sensors 21a and 21b. A command signal for controlling the driving of the right drive motor 11a and the left drive motor 11b is output to the interface 19c based on the distance to. The interface 19c performs processing such as amplification on this command signal and outputs it to the drivers 15a and 15b. The drivers 15a and 15b control the right drive motor 11a and the left drive motor 11b, respectively, based on the command signal.

【0024】次に、本実施例による清掃ロボット41を
用いて長い廊下を清掃するときの手順について、図3、
図4及び図5のフローチャートを用いて説明する。さら
に、図6に壁31及び32の間に存在する長い清掃区域
を清掃ロボット41が走行する経路を図6に示す。
Next, the procedure for cleaning a long corridor using the cleaning robot 41 according to this embodiment will be described with reference to FIG.
This will be described with reference to the flowcharts of FIGS. 4 and 5. Further, FIG. 6 shows a path along which the cleaning robot 41 travels in a long cleaning area existing between the walls 31 and 32 in FIG.

【0025】先ず、操作者が清掃ロボット41を壁31
に近接しかつ壁31に対して平行になるように置く。ス
テップ101として、操作パネル22上で電源を投入
し、廊下における清掃すべき区域の縦方向の距離を入力
する。
First, the operator installs the cleaning robot 41 on the wall 31.
Close to and parallel to the wall 31. As step 101, the power is turned on on the operation panel 22 and the vertical distance of the area to be cleaned in the corridor is input.

【0026】ステップ102として、方位センサ18の
出力をリセットする。具体的には、清掃開始時点では清
掃ロボット41と壁31とは平行になっているものとし
て、方位センサ18の出力する方位データを0.00度
に設定する。
At step 102, the output of the azimuth sensor 18 is reset. Specifically, assuming that the cleaning robot 41 and the wall 31 are parallel to each other at the start of cleaning, the azimuth data output from the azimuth sensor 18 is set to 0.00 degrees.

【0027】ステップ103として、清掃ロボット41
の右側に位置する壁31と清掃ロボット41の中心線と
の間の距離l1 を、右壁検出センサ21aを用いて検出
し、この距離データをメインコントローラ20に取り込
む。この距離l1 を清掃ロボット41が壁31又は32
に対して維持しながら走行するように、距離データを目
標距離として記憶する。但し、壁31又は32までの距
離l1 が100mm以下のときは、100mmの距離を保つ
ことを目標とする。
As step 103, the cleaning robot 41
The distance l1 between the wall 31 located on the right side of and the center line of the cleaning robot 41 is detected by the right wall detection sensor 21a, and this distance data is fetched into the main controller 20. The cleaning robot 41 moves the distance 31 to the wall 31 or 32.
The distance data is stored as the target distance so that the vehicle travels while maintaining. However, when the distance l1 to the wall 31 or 32 is 100 mm or less, the target is to keep the distance of 100 mm.

【0028】ステップ104として、矢印A1に示され
たように左方向に90度スピンターンする。壁32へ向
かって廊下を直角に横切るように、清掃ロボット41を
走行させる。詳細には、ステップ105として走行距離
をカウントするカウンタ24をクリアする。ステップ1
06として、矢印A2に示されたように壁32へ向かっ
て直進する。ステップ107として左壁検出センサ21
bが壁32を検出するまで直進し、検出するとステップ
108として停止する。さらにステップ109として、
壁32へ向かって走行したときにカウンタ24により計
測した走行距離l2 を、廊下横幅距離データとする。
As step 104, the spin-turn is performed 90 degrees to the left as indicated by arrow A1. The cleaning robot 41 is run so as to cross the corridor at a right angle toward the wall 32. Specifically, in step 105, the counter 24 that counts the traveling distance is cleared. Step 1
At 06, proceed straight toward the wall 32 as indicated by arrow A2. As the step 107, the left wall detection sensor 21
It goes straight until b detects the wall 32, and when it detects it, it stops at step 108. Further, as step 109,
The traveling distance l2 measured by the counter 24 when traveling toward the wall 32 is used as the corridor width data.

【0029】ステップ110として、矢印A3に示され
たように右方向へ90度回転する。
As a step 110, it is rotated 90 degrees to the right as shown by the arrow A3.

【0030】ステップ111のように、矢印A4の方向
に壁32に沿って走行する。詳細には、左壁検出センサ
21bの検出した壁32までの距離が、上述した距離l
1 を維持するように、右駆動モータ11a及び左駆動モ
ータ11bの回転速度を制御しながら前進する。これに
より、図7に示されたように壁32までの距離がl1に
なるまで接近し、この距離l1 を維持するように直進走
行する。また、壁32に沿って走行するときの距離は、
走行開始時に設定した清掃区域の縦方向の長さとなる。
さらに、清掃ロボット41の左側に設けられた前方障害
物センサ17cの検出は無効となるように設定する必要
がある。これは、前方障害物センサ17cにより壁32
が障害物として検出されて、清掃ロボット41が停止す
ることを防ぐためである。また、壁32に出入り口等が
設けられており、壁32がとぎれて凹部が存在する場合
のトリミング走行への切り替えについては後述する。
As in step 111, the vehicle runs along the wall 32 in the direction of arrow A4. Specifically, the distance to the wall 32 detected by the left wall detection sensor 21b is the above-mentioned distance l.
The vehicle moves forward while controlling the rotational speeds of the right drive motor 11a and the left drive motor 11b so as to maintain 1. As a result, as shown in FIG. 7, the wall 32 is approached until the distance becomes l1, and the vehicle runs straight so as to maintain this distance l1. In addition, the distance when traveling along the wall 32 is
The length of the cleaning area is the vertical length set at the start of travel.
Further, the detection of the front obstacle sensor 17c provided on the left side of the cleaning robot 41 needs to be set to be invalid. This is the wall 32 by the front obstacle sensor 17c.
This is to prevent the cleaning robot 41 from being stopped by being detected as an obstacle. Further, switching to the trimming traveling when the wall 32 is provided with an entrance / exit and the wall 32 is interrupted and a concave portion is present will be described later.

【0031】ステップ112として、矢印A5のように
右方向へ90度スピンターンする。
At step 112, a 90 degree spin turn is made to the right as indicated by arrow A5.

【0032】ステップ113として、カウンタ24をリ
セットする。ステップ114として前方障害物センサ1
7a〜17cの取り込みを開始する。このとき、清掃ロ
ボット41の左側に位置する前方障害物センサ17cの
検出は有効となるように切り替える。ステップ115と
して、カウンタ24から出力される走行距離データの取
り込みを開始する。
As step 113, the counter 24 is reset. Forward obstacle sensor 1 as step 114
Start the uptake of 7a-17c. At this time, the detection of the front obstacle sensor 17c located on the left side of the cleaning robot 41 is switched to be effective. As step 115, the loading of the travel distance data output from the counter 24 is started.

【0033】ステップ116として、矢印A6の方向へ
シフト走行した距離が500mmに到達したか否かが判断
され、到達するまでの間はステップ117へ以降する。
In step 116, it is judged whether or not the distance traveled in the direction of arrow A6 has reached 500 mm, and the process proceeds to step 117 and thereafter until the distance is reached.

【0034】ステップ117において、シフト走行中に
前方障害物センサ17a〜17cが前方に障害物を検出
したか否かが判断される。障害物が検出されない間は、
ステップ118としてシフト走行を継続し、ステップ1
14へ戻る。障害部が検出されたときは、ステップ11
9として清掃ロボット41の走行を停止する。
In step 117, it is judged whether or not the front obstacle sensors 17a to 17c have detected an obstacle ahead during the shift running. While no obstacle is detected,
Shifting is continued as step 118, and step 1
Return to 14. When the obstacle is detected, step 11
As a result, the cleaning robot 41 stops running.

【0035】次に、ステップ120として総シフト走行
距離データLを更新する。ステップ121として、この
総シフト走行距離データLと上述した廊下横幅距離デー
タl2 とを比較する。総シフト走行距離データLが廊下
横幅距離データl2 よりも小さい間、即ち廊下の右端に
到達していない間は検出した障害物は通行人であるとみ
なし、通行人がどいて障害物が検出されなくなるまで清
掃ロボット41を停止し、ステップ114へ戻る。総シ
フト走行距離データLが廊下横幅距離データl2 に到達
したときは、廊下の右端まで到達したと判断し、ステッ
プ123において廊下到達判断フラッグROKTFを1
に設定する。
Next, at step 120, the total shift traveling distance data L is updated. In step 121, the total shift travel distance data L and the above-mentioned corridor width data 12 are compared. While the total shift mileage data L is smaller than the corridor lateral distance data l2, that is, while the right end of the corridor is not reached, the detected obstacle is regarded as a passerby, and the passerby returns and the obstacle is detected. The cleaning robot 41 is stopped until it disappears, and the process returns to step 114. When the total shift mileage data L reaches the corridor lateral width data l2, it is determined that the right end of the corridor has been reached, and in step 123, the corridor arrival determination flag ROKTF is set to 1
Set to.

【0036】上述したステップ116において、シフト
走行距離が500mmに到達したときはステップ124へ
移行する。ステップ124として、1回分のシフト走行
は終了したと判断し、廊下到達判断フラッグROKTF
をクリアし0に設定する。そして総シフト距離データL
を更新し、ステップ126へ移行する。
When the shift travel distance reaches 500 mm in step 116 described above, the process proceeds to step 124. In step 124, it is determined that one shift has been completed, and the corridor arrival determination flag ROKTF
Is cleared and set to 0. And the total shift distance data L
Is updated and the process proceeds to step 126.

【0037】ステップ126として、廊下到達判断フラ
ッグROKTFが1か否かを判断し、0であるときは廊
下の右端に到達していないと判断する。ステップ129
として、矢印A7のように右方向へ90度スピンターン
する。ステップ130として、矢印A8の方向、即ち1
80度の方向へ直進走行を行う。壁31及び32から清
掃ロボット41が離れた位置にあるときは、方位センサ
18が検出する方位データに基づいて走行制御を行う。
このときの走行距離は、走行開始時に設定した縦方向の
寸法となる。
In step 126, it is determined whether the corridor arrival determination flag ROKTF is 1, and when it is 0, it is determined that the right end of the corridor has not been reached. Step 129
As a result, a 90 degree spin turn is performed to the right as indicated by arrow A7. In step 130, the direction of arrow A8, that is, 1
Go straight in the direction of 80 degrees. When the cleaning robot 41 is located away from the walls 31 and 32, traveling control is performed based on the orientation data detected by the orientation sensor 18.
The travel distance at this time is the vertical dimension set at the start of travel.

【0038】ステップ131として左方向へ90度スピ
ンターンし、廊下右端に到達したか否かの判断を行う。
ステップ133として廊下到達判断フラッグROKTF
が1か否かを判断し、1でないときはステップ136と
して左方向へ90度スピンターンする。ステップ137
として、0度の方向へ直進走行する。ステップ112へ
移行し、上述した制御を再び行う。
At step 131, a left 90 degree spin turn is performed to determine whether or not the right end of the corridor has been reached.
As a step 133, corridor arrival judgment flag ROKTF
If it is not 1, it is spin-turned 90 degrees to the left as step 136. Step 137
As a result, the vehicle runs straight in the direction of 0 degree. The process proceeds to step 112 and the above control is performed again.

【0039】ステップ126及び133において、それ
ぞれ廊下到達判断フラッグROKTFが1か否かを判断
し、ステップ126において1であると判断したときは
ステップ127へ移行し、ステップ133において1で
あると判断したときはステップ134へ移行する。いず
れの場合も廊下到達判断フラッグROKTFが1のとき
は、廊下の端に到達したと判断して壁に沿って最終走行
を行うが、フラッグROKTFが1になったときのタイ
ミングが相違する。これにより、ステップ128では図
8(a)に示されたように清掃ロボット41にとり壁3
1を左側に見ながら走行し、ステップ135では図8
(b)のように壁31を右側に見ながら走行することに
なる。
In steps 126 and 133, it is determined whether or not the corridor arrival determination flag ROKTF is 1, and when it is determined to be 1 in step 126, the process proceeds to step 127, and it is determined to be 1 in step 133. If so, the process proceeds to step 134. In either case, when the corridor arrival determination flag ROKTF is 1, it is judged that the end of the corridor has been reached and the final traveling is performed along the wall, but the timing when the flag ROKTF becomes 1 is different. As a result, in step 128, the cleaning robot 41 is moved to the wall 3 as shown in FIG.
While looking at 1 on the left side, drive in FIG.
As shown in (b), the vehicle runs while looking at the wall 31 to the right.

【0040】次に、図9に示されたように壁32の途中
に凹部32aが存在したときには次のような手順でトリ
ミング走行を行う。ステップ201に示されたように、
カウンタ24をクリアし、ステップ202として縦方向
に走行した距離が縦方向設定距離に到達したか否かを判
断する。走行距離が縦方向設定距離に到達した場合に
は、ステップ203として停止する。
Next, as shown in FIG. 9, when the recess 32a exists in the middle of the wall 32, the trimming traveling is performed in the following procedure. As shown in step 201,
The counter 24 is cleared, and in step 202, it is determined whether the distance traveled in the vertical direction has reached the vertical set distance. When the travel distance reaches the vertical set distance, the process stops at step 203.

【0041】走行距離が縦方向設定距離に到達しない場
合は、ステップ204として右壁に沿って走行している
かを判断する。右壁に沿った走行であるときは、ステッ
プ205として右壁検出センサ21aの検出した距離デ
ータを一定値l3 と比較する。この値l3 は、例えば上
述した距離l1 を用いてl3 =2・l1 −50というよ
うに設定してもよい。検出された距離データが一定値l
3 よりも小さい間は壁の途中に凹部は存在しないと判断
し、ステップ209として右壁に沿う走行を継続し、さ
らにステップ214として走行距離データの取り込みを
行いステップ202に戻る。
When the traveling distance does not reach the set distance in the vertical direction, it is determined in step 204 whether the vehicle is traveling along the right wall. If the vehicle is traveling along the right wall, the distance data detected by the right wall detection sensor 21a is compared with a constant value l3 in step 205. This value l3 may be set as l3 = 2 · l1-50 using the above-mentioned distance l1. The detected distance data is a constant value l
While it is smaller than 3, it is determined that there is no recess in the middle of the wall, the traveling along the right wall is continued as step 209, the traveling distance data is fetched as step 214, and the process returns to step 202.

【0042】ステップ207において、右壁検出センサ
21aの検出した距離データが一定値l3 以上の場合
は、ステップ210へ以降する。ステップ210におい
て、0度方向へ進行中であるか否かを判断し、0度方向
へ進行中の場合は0度方向へのトリミング走行を行いス
テップ214へ以降する。ステップ210において、0
度方向へ進行中でないと判断したときは、ステップ21
2のように180度方向へのトリミングを行う。
In step 207, if the distance data detected by the right wall detecting sensor 21a is not less than the constant value l3, the process proceeds to step 210 and thereafter. In step 210, it is determined whether or not the vehicle is proceeding in the 0 degree direction. If the vehicle is traveling in the 0 degree direction, trimming traveling in the 0 degree direction is performed, and the process proceeds to step 214 and thereafter. 0 in step 210
Step 21
Trimming is performed in the 180 degree direction as in 2.

【0043】ステップ204において、左壁に沿う走行
を行っていると判断したときは、ステップ206におい
て一定値l3 (=2・l1 −50)を求める。ステップ
208において、左壁検出センサ21bの検出した距離
データがl3 以上か否かを判断する。距離データがl3
以上の場合は壁に凹部が存在しており、ステップ210
へ移行する。ステップ210において、上述したように
0度方向へ進行中であるか否かを判断し、0度方向へ進
行中の場合は図9に示されたように0度方向へのトリミ
ング走行を行いステップ214へ移行する。0度方向へ
進行中でないと判断したときは、ステップ212のよう
に180度方向へのトリミングを行う。距離データが一
定値l3 に到達していない場合は、ステップ213のよ
うに左壁に沿う走行を継続し、ステップ214へ移行す
る。
When it is determined in step 204 that the vehicle is traveling along the left wall, a constant value l3 (= 2.l1-50) is determined in step 206. In step 208, it is determined whether or not the distance data detected by the left wall detection sensor 21b is 13 or more. Distance data is l3
In the above case, there is a recess in the wall, and step 210
Move to. In step 210, it is determined whether or not the vehicle is proceeding in the 0 degree direction as described above. If the vehicle is traveling in the 0 degree direction, trimming traveling in the 0 degree direction is performed as shown in FIG. Transition to 214. When it is determined that the process is not proceeding in the 0 degree direction, trimming in the 180 degree direction is performed as in step 212. If the distance data has not reached the constant value l3, the vehicle continues traveling along the left wall as in step 213, and the process proceeds to step 214.

【0044】本実施例によれば、壁に沿って走行すると
きは壁までの距離を測定しこの距離が一定値を維持する
ように走行することで、方向のずれが増大して壁に接触
して停止することを防止することができる。また、壁の
途中に凹部が存在し壁までの距離が一定の距離より長い
ことが検出された場合は、壁までの距離を一定に保とう
としたのでは凹部の中へ入りこんで衝突するため、この
場合には方位センサの検知した方位に基づいて直進走行
するように切り替える。このような走行制御により、清
掃区域の長手方向の距離を操作パネルに入力するだけ
で、長い廊下を清掃ロボットで自動清掃することが可能
となる。
According to this embodiment, when traveling along a wall, the distance to the wall is measured and the traveling is performed so that this distance maintains a constant value, so that the deviation in the direction increases and the contact with the wall occurs. Can be prevented from stopping. Also, if a recess is present in the middle of the wall and it is detected that the distance to the wall is longer than a certain distance, attempting to keep the distance to the wall constant will cause a collision by entering into the recess, In this case, the vehicle is switched to travel straight based on the azimuth detected by the azimuth sensor. With such traveling control, it becomes possible to automatically clean a long corridor with a cleaning robot simply by inputting the longitudinal distance of the cleaning area on the operation panel.

【0045】上述した実施例は一例であり、本発明を限
定するものではない。例えば、壁に凹部が存在し壁沿走
行からトリミング走行へ切り替えるときの判断基準は、
実施例では壁沿走行時の清掃ロボットの中心線から壁ま
での距離をl1 とした場合の値2l1 −50よりも大き
い場合としたが、この値に限定されることはない。但
し、壁沿走行時における壁までの距離よりも大きい値で
あって、かつこの値以上に窪んだ凹部の付近で壁沿走行
を行うと図12のように衝突の虞れがあるような距離を
考慮した上で、判断基準となる値を設定することが望ま
しい。
The above-described embodiments are merely examples and do not limit the present invention. For example, when there is a recess in the wall and the criteria for switching from running along the wall to running around the trimming are:
In the embodiment, the value is set to be larger than the value 2l1-50 when the distance from the center line of the cleaning robot to the wall when traveling along the wall is l1. However, the value is not limited to this value. However, a distance that is greater than the distance to the wall when traveling along the wall and that may cause a collision as shown in FIG. Considering the above, it is desirable to set the value that will be the criterion.

【0046】[0046]

【発明の効果】以上説明したように、本発明の清掃ロボ
ットの制御方法及びその装置は、壁沿いに走行するとき
は壁までの距離を一定に保つように走行することで方向
のずれが増大して壁に接触することを防止し、壁に凹部
が存在する場合は方位に基づいて直進走行するように切
り替えることで凹部の内側へ入り込んで衝突することを
防ぐため、清掃区域の長手方向の距離を操作パネルに入
力するだけで長い廊下の自動清掃が可能である。
As described above, according to the cleaning robot control method and apparatus of the present invention, when traveling along a wall, the displacement of the direction increases by keeping the distance to the wall constant. To prevent contact with the wall, and if there is a recess in the wall, switch to traveling straight based on the azimuth to prevent entering and colliding with the inside of the recess. A long corridor can be automatically cleaned by simply inputting the distance on the operation panel.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明の一実施例による清掃ロボットの制御装
置の構成を示したブロック図。
FIG. 1 is a block diagram showing a configuration of a control device for a cleaning robot according to an exemplary embodiment of the present invention.

【図2】同制御装置のより詳細な構成を示したブロック
図。
FIG. 2 is a block diagram showing a more detailed configuration of the control device.

【図3】本発明の一実施例による清掃ロボットの制御方
法により清掃ロボットの走行を制御する手順を示したフ
ローチャート。
FIG. 3 is a flowchart showing a procedure of controlling the traveling of the cleaning robot by the method of controlling the cleaning robot according to the embodiment of the present invention.

【図4】同制御方法により清掃ロボットの走行を制御す
る手順を示したフローチャート。
FIG. 4 is a flowchart showing a procedure for controlling the traveling of the cleaning robot by the control method.

【図5】同制御方法により清掃ロボットの走行を制御す
る手順を示したフローチャート。
FIG. 5 is a flowchart showing a procedure for controlling the traveling of the cleaning robot by the control method.

【図6】同制御方法により清掃ロボットの走行を制御す
るときの走行経路を示した説明図。
FIG. 6 is an explanatory view showing a travel route when the travel of the cleaning robot is controlled by the control method.

【図7】同制御方法により清掃ロボットの走行を制御す
るときの走行開始時における経路を示した説明図。
FIG. 7 is an explanatory view showing a route at the start of traveling when the traveling of the cleaning robot is controlled by the control method.

【図8】同制御方法により清掃ロボットの走行を制御す
るときの廊下の右端到達時における経路を示した説明
図。
FIG. 8 is an explanatory view showing a route when the right end of the corridor is reached when the traveling of the cleaning robot is controlled by the control method.

【図9】同制御方法により清掃ロボットの走行を制御す
るときのトリミング走行時における経路を示した説明
図。
FIG. 9 is an explanatory diagram showing a route during trimming traveling when the traveling of the cleaning robot is controlled by the control method.

【図10】同制御方法により清掃ロボットをトリミング
走行させるときの制御手順を示したフローチャート。
FIG. 10 is a flowchart showing a control procedure when the cleaning robot is trimmed by the control method.

【図11】従来の制御方法により清掃ロボットを走行さ
せた場合に廊下の壁に接触する様子を示した説明図。
FIG. 11 is an explanatory diagram showing how a cleaning robot is brought into contact with a wall of a corridor when the cleaning robot is run by a conventional control method.

【図12】従来の制御方法により清掃ロボットを走行さ
せた場合に廊下の凹部に衝突する様子を示した説明図。
FIG. 12 is an explanatory view showing a state in which the cleaning robot collides with a recess in a corridor when the cleaning robot is run by a conventional control method.

【符号の説明】[Explanation of symbols]

11a,11b 駆動モータ 12a,12b 駆動車輪 13a〜13b 清掃ブラシ 14a,14b 距離センサ 15a,15b モータドライバ 16 制御部 17a〜17c 前方障害物センサ 18 方位センサ 19a〜19c インタフェース 19d AD変換器 20 メインコントローラ 21a 右壁検出センサ 21b 左壁検出センサ 22 操作パネル 23 スクイジ 24 カウンタ 41 清掃ロボット 11a, 11b Drive motor 12a, 12b Drive wheel 13a-13b Cleaning brush 14a, 14b Distance sensor 15a, 15b Motor driver 16 Control part 17a-17c Front obstacle sensor 18 Direction sensor 19a-19c Interface 19d AD converter 20 Main controller 21a Right wall detection sensor 21b Left wall detection sensor 22 Operation panel 23 Squeegee 24 Counter 41 Cleaning robot

Claims (4)

【特許請求の範囲】[Claims] 【請求項1】清掃すべき廊下の縦方向寸法を操作部に入
力され、障害物、方位及び走行距離をセンサにより検出
し、入力された前記縦方向寸法と検出された障害物、方
位及び走行距離に基づいて車両駆動機構を制御部により
制御し車両を自律走行させる清掃ロボットの制御方法に
おいて、 走行開始前に、操作者が前記清掃ロボットを廊下の第1
の壁に平行に設置し、廊下の縦方向寸法を前記操作部に
入力するステップと、 前記第1又は第2の壁を検出する壁検出センサを用い
て、前記清掃ロボットから前記第1の壁までの距離を測
定して基準距離として前記制御部に入力するステップ
と、 前記清掃ロボットを90度旋回させ、廊下を横方向に走
行させ、前記第2の壁を検知して停止するまでに走行し
た距離を廊下横幅距離として前記制御部に入力するステ
ップと、 前記清掃ロボットを90度旋回させ、前記第2の壁まで
の距離が前記基準距離を維持するように前記第2の壁に
沿って走行させるステップと、 前記第2の壁に沿って前記縦方向寸法だけ走行させた後
停止させるステップと、 前記清掃ロボットを90度旋回させ、廊下を横方向に前
記所定距離だけ走行させていく過程で横方向に走行した
距離の合計値が前記廊下横幅距離に到達したときは90
度旋回させて廊下を第1の壁沿いに前記縦方向寸法だけ
走行させて終了し、横方向に走行した距離の合計値が前
記廊下横幅距離に到達しないときは前記所定距離だけ走
行した後停止させるステップと、 前記所定距離だけ走行した後停止したときは、前記清掃
ロボットを90度旋回させ、前記センサにより検出され
た方位に基づいて直進走行させた後停止させるステップ
と、 前記清掃ロボットを90度旋回させ、廊下を横方向に前
記所定距離だけ走行させていく過程で横方向に走行した
距離の合計値が前記廊下横幅距離に到達したときは90
度旋回させて廊下を第1の壁沿いに前記縦方向寸法だけ
走行させて終了し、横方向に走行した距離の合計値が前
記廊下横幅距離に到達しないときは前記所定距離だけ走
行した後停止させるステップと、 を備えたことを特徴とする清掃ロボットの制御方法。
1. A vertical dimension of a corridor to be cleaned is input to an operation unit, an obstacle, an azimuth and a traveling distance are detected by a sensor, and the input vertical dimension and the detected obstacle, azimuth and traveling are detected. In a control method for a cleaning robot that controls a vehicle drive mechanism based on a distance by a control unit to autonomously move a vehicle, an operator controls the cleaning robot to move the cleaning robot to a first position in a corridor before starting traveling.
Installed parallel to the walls of the cleaning robot and inputting the vertical dimension of the corridor into the operation unit, and using the wall detection sensor for detecting the first or second wall, Measuring the distance to and inputting it to the control unit as a reference distance; traveling the cleaning robot 90 degrees, traveling horizontally in the corridor, detecting the second wall and stopping. Inputting the determined distance to the control unit as a corridor width distance, the cleaning robot is turned 90 degrees, and the distance to the second wall is maintained along the second wall so as to maintain the reference distance. A step of traveling, a step of traveling along the second wall for the lengthwise dimension and a stop, and a step of rotating the cleaning robot 90 degrees and traveling the corridor laterally by the predetermined distance. so 90 When the sum of the distance traveled in the direction has reached the corridor width distance
Turns once and runs the corridor along the first wall by the lengthwise dimension to finish, and when the total value of the distance traveled in the horizontal direction does not reach the width of the corridor, stop after traveling the predetermined distance A step of causing the cleaning robot to turn 90 degrees when the vehicle has stopped after traveling the predetermined distance, and a straight traveling based on the direction detected by the sensor, and then stopping the cleaning robot. 90 degrees when the total value of the distance traveled in the lateral direction reaches the corridor lateral width distance in the process of turning the corridor and traveling the corridor in the lateral direction by the predetermined distance.
Turns once and runs the corridor along the first wall by the lengthwise dimension to finish, and when the total value of the distance traveled in the horizontal direction does not reach the width of the corridor, stop after traveling the predetermined distance A method of controlling a cleaning robot, comprising:
【請求項2】前記第1又は第2の壁沿いに走行するステ
ップにおいて、前記壁検出センサにより検出された前記
第1又は第2の壁までの距離が前記基準距離よりも一定
の距離以上に長い場合には、前記方位センサにより検出
された方位に基づいて直進走行するように制御を切り替
えることを特徴とする請求項1記載の清掃ロボットの制
御方法。
2. In the step of traveling along the first or second wall, the distance to the first or second wall detected by the wall detection sensor is a certain distance or more than the reference distance. The control method for the cleaning robot according to claim 1, wherein when the length is long, the control is switched so that the vehicle travels straight based on the azimuth detected by the azimuth sensor.
【請求項3】車両駆動機構を有する清掃ロボットを自律
走行させる清掃ロボットの制御装置において、 清掃すべき廊下の縦方向寸法を入力される操作部と、 前記清掃ロボットから第1又は第2の壁までの距離を測
定する壁検出センサと、 方位を検出する方位センサと、 走行した距離の検出を行う走行距離検出部と、 廊下の横方向の距離を廊下横幅距離として記憶し、第1
又は第2の壁ぎわを縦方向に走行するときは、前記壁検
出センサにより検出された前記第1又は第2の壁までの
距離が基準距離を維持するように走行させ、前記第1又
は第2の壁ぎわ以外を縦方向に走行するときは、前記方
位センサにより検出された方位に基づいて直進するよう
に走行させ、廊下を横方向に走行するときは、横方向に
所定距離だけ走行する過程で走行した距離の合計値が前
記廊下横幅距離に到達した場合はその後前記第1又は第
2の壁までの距離が前記基準距離を維持するように縦方
向に走行させ、横方向に走行した距離の合計値が前記廊
下横幅距離に到達しない場合は横方向に所定距離だけ走
行させた後前記方位センサにより検出された方位に基づ
いて縦方向に直進するように前記車両駆動機構を制御す
る制御部と、 を備えたことを特徴とする清掃ロボットの制御装置。
3. A controller for a cleaning robot that autonomously runs a cleaning robot having a vehicle drive mechanism, wherein an operating section for inputting a vertical dimension of a corridor to be cleaned is provided, and the cleaning robot has a first or second wall. The wall detection sensor that measures the distance to, the azimuth sensor that detects the azimuth, the mileage detection unit that detects the distance traveled, and the lateral distance of the corridor are stored as the corridor width distance.
Alternatively, when traveling in the vertical direction on the second wall, the vehicle is caused to travel such that the distance to the first or second wall detected by the wall detection sensor maintains a reference distance, and the first or second wall is moved. When traveling in the vertical direction other than the wall between the two walls, the vehicle is made to travel straight based on the orientation detected by the orientation sensor, and when traveling in the corridor in the lateral direction, it travels for a predetermined distance in the lateral direction. When the total value of the distance traveled in the process reaches the corridor widthwise distance, then the vehicle is caused to travel vertically so that the distance to the first or second wall maintains the reference distance, and traveled laterally. When the total value of the distances does not reach the corridor width distance, the vehicle drive mechanism is controlled so that the vehicle drive mechanism is moved straight in the vertical direction based on the direction detected by the direction sensor after traveling a predetermined distance in the horizontal direction. Department and A cleaning robot control device characterized by the above.
【請求項4】前記制御部は、前記壁検出センサにより検
出された前記第1又は第2の壁までの距離が前記基準距
離を維持して前記第1又は第2の壁沿いを走行するよう
に前記車両駆動機構を制御しているときに、検出された
前記第1又は第2の壁までの距離が前記基準距離よりも
一定の距離以上に長い場合は、前記方位センサにより検
出された方位に基づいて直進走行するように前記車両駆
動機構の制御を切り替えることを特徴とする請求項3記
載の清掃ロボットの制御装置。
4. The control unit causes the distance to the first or second wall detected by the wall detection sensor to maintain the reference distance and to travel along the first or second wall. When the detected distance to the first or second wall is longer than the reference distance by a certain distance or more while controlling the vehicle drive mechanism, the azimuth detected by the azimuth sensor The control device for the cleaning robot according to claim 3, wherein the control of the vehicle drive mechanism is switched so as to travel straight based on the above.
JP6221766A 1994-09-16 1994-09-16 Cleaning robot control method and device therefor Pending JPH0884696A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP6221766A JPH0884696A (en) 1994-09-16 1994-09-16 Cleaning robot control method and device therefor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP6221766A JPH0884696A (en) 1994-09-16 1994-09-16 Cleaning robot control method and device therefor

Publications (1)

Publication Number Publication Date
JPH0884696A true JPH0884696A (en) 1996-04-02

Family

ID=16771872

Family Applications (1)

Application Number Title Priority Date Filing Date
JP6221766A Pending JPH0884696A (en) 1994-09-16 1994-09-16 Cleaning robot control method and device therefor

Country Status (1)

Country Link
JP (1) JPH0884696A (en)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004054423A1 (en) * 2002-12-16 2004-07-01 Care Fresh Corporation Unattended cleaner
KR100500839B1 (en) * 2002-11-05 2005-07-12 삼성광주전자 주식회사 Robot cleaner having wall following function and method for following wall
JP2009099137A (en) * 2001-06-12 2009-05-07 Irobot Corp Multimode processing method and system for autonomous robot
JP2009142652A (en) * 2007-12-17 2009-07-02 Vorwerk & Co Interholding Gmbh Dust collector for floor cleaning
JP2009534737A (en) * 2006-04-18 2009-09-24 マースランド エヌ・ヴィ Unmanned autonomous vehicle for feed movement
JP2010211512A (en) * 2009-03-10 2010-09-24 Toshiba Tec Corp Autonomous moving device
US8380350B2 (en) 2005-12-02 2013-02-19 Irobot Corporation Autonomous coverage robot navigation system
US8838274B2 (en) 2001-06-12 2014-09-16 Irobot Corporation Method and system for multi-mode coverage for an autonomous robot
US9622635B2 (en) 2001-01-24 2017-04-18 Irobot Corporation Autonomous floor-cleaning robot
WO2017215581A1 (en) * 2016-06-12 2017-12-21 苏州宝时得电动工具有限公司 Dust collector, and dust collecting system and method for controlling self-starting of dust collection of dust collector
US9949608B2 (en) 2002-09-13 2018-04-24 Irobot Corporation Navigational control system for a robotic device
US9955841B2 (en) 2006-05-19 2018-05-01 Irobot Corporation Removing debris from cleaning robots
US10299652B2 (en) 2007-05-09 2019-05-28 Irobot Corporation Autonomous coverage robot
CN114234345A (en) * 2021-12-28 2022-03-25 徐州中科艾易西环保科技研究院有限公司 Household air purification device

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59121408A (en) * 1982-12-24 1984-07-13 Honda Motor Co Ltd Controller of mobile robot
JPS62293320A (en) * 1986-06-12 1987-12-19 Kajima Corp Self-traveling robot
JPH0281210A (en) * 1988-09-19 1990-03-22 Hitachi Ltd Controller for free-running robot
JPH0322108A (en) * 1989-06-20 1991-01-30 Shinko Electric Co Ltd Mobile robot
JPH04338433A (en) * 1991-05-14 1992-11-25 Matsushita Electric Ind Co Ltd Automatic traveling cleaner
JPH0546239A (en) * 1991-08-10 1993-02-26 Nec Home Electron Ltd Autonomously travelling robot
JPH05324060A (en) * 1992-05-15 1993-12-07 East Japan Railway Co Cleaning robot

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS59121408A (en) * 1982-12-24 1984-07-13 Honda Motor Co Ltd Controller of mobile robot
JPS62293320A (en) * 1986-06-12 1987-12-19 Kajima Corp Self-traveling robot
JPH0281210A (en) * 1988-09-19 1990-03-22 Hitachi Ltd Controller for free-running robot
JPH0322108A (en) * 1989-06-20 1991-01-30 Shinko Electric Co Ltd Mobile robot
JPH04338433A (en) * 1991-05-14 1992-11-25 Matsushita Electric Ind Co Ltd Automatic traveling cleaner
JPH0546239A (en) * 1991-08-10 1993-02-26 Nec Home Electron Ltd Autonomously travelling robot
JPH05324060A (en) * 1992-05-15 1993-12-07 East Japan Railway Co Cleaning robot

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9622635B2 (en) 2001-01-24 2017-04-18 Irobot Corporation Autonomous floor-cleaning robot
JP2012064240A (en) * 2001-06-12 2012-03-29 Irobot Corp Mobile robot cleaner
JP2009099137A (en) * 2001-06-12 2009-05-07 Irobot Corp Multimode processing method and system for autonomous robot
US20160354931A1 (en) * 2001-06-12 2016-12-08 Irobot Corporation Method and System for Multi-Mode Coverage For An Autonomous Robot
US8838274B2 (en) 2001-06-12 2014-09-16 Irobot Corporation Method and system for multi-mode coverage for an autonomous robot
US9949608B2 (en) 2002-09-13 2018-04-24 Irobot Corporation Navigational control system for a robotic device
KR100500839B1 (en) * 2002-11-05 2005-07-12 삼성광주전자 주식회사 Robot cleaner having wall following function and method for following wall
WO2004054423A1 (en) * 2002-12-16 2004-07-01 Care Fresh Corporation Unattended cleaner
US8380350B2 (en) 2005-12-02 2013-02-19 Irobot Corporation Autonomous coverage robot navigation system
JP2009534737A (en) * 2006-04-18 2009-09-24 マースランド エヌ・ヴィ Unmanned autonomous vehicle for feed movement
US9955841B2 (en) 2006-05-19 2018-05-01 Irobot Corporation Removing debris from cleaning robots
US10244915B2 (en) 2006-05-19 2019-04-02 Irobot Corporation Coverage robots and associated cleaning bins
US10299652B2 (en) 2007-05-09 2019-05-28 Irobot Corporation Autonomous coverage robot
US11498438B2 (en) 2007-05-09 2022-11-15 Irobot Corporation Autonomous coverage robot
JP2009142652A (en) * 2007-12-17 2009-07-02 Vorwerk & Co Interholding Gmbh Dust collector for floor cleaning
JP2010211512A (en) * 2009-03-10 2010-09-24 Toshiba Tec Corp Autonomous moving device
WO2017215581A1 (en) * 2016-06-12 2017-12-21 苏州宝时得电动工具有限公司 Dust collector, and dust collecting system and method for controlling self-starting of dust collection of dust collector
CN114234345A (en) * 2021-12-28 2022-03-25 徐州中科艾易西环保科技研究院有限公司 Household air purification device

Similar Documents

Publication Publication Date Title
JP3660042B2 (en) Cleaning robot control method
US5402051A (en) Floor cleaning robot and method of controlling same
JPH0884696A (en) Cleaning robot control method and device therefor
CN102939223A (en) Parking assistance device and method
JP2006026028A (en) Cleaner
WO2005036292A1 (en) Self-propelled working robot
WO2017135191A1 (en) Parking assistance method
JPS6093522A (en) Controller of moving robot
JPH09266871A (en) Method for controlling cleaning robot
JPH04160609A (en) Automatic parking device
JP2002323926A (en) Autonomous travel vehicle
JP2000276228A (en) Control method for movable dolly
JPH04160608A (en) Automatic parking device
JP3314469B2 (en) Self-propelled vacuum cleaner
JPH06131044A (en) Controller for unmanned traveling car
JP3166250B2 (en) Cleaning robot
JP3277980B2 (en) Control method for unmanned vehicles
JPH09204224A (en) Autonomous mobile working vehicle
JPH06149364A (en) Controller for unmanned traveling car
JPH0358105A (en) Stering controller of self-running car
JPH0962354A (en) Traveling vehicle control method
JPH05158536A (en) Control method for cleaning robot
JP3036863B2 (en) Traveling robot
JP3045435B2 (en) Travel stop control device for unmanned working vehicles
JPH09114523A (en) Autonomously traveling vehicle and driving method for the vehicle

Legal Events

Date Code Title Description
A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20040427