JP2006011845A - Self-propelled cleaner - Google Patents

Self-propelled cleaner Download PDF

Info

Publication number
JP2006011845A
JP2006011845A JP2004188370A JP2004188370A JP2006011845A JP 2006011845 A JP2006011845 A JP 2006011845A JP 2004188370 A JP2004188370 A JP 2004188370A JP 2004188370 A JP2004188370 A JP 2004188370A JP 2006011845 A JP2006011845 A JP 2006011845A
Authority
JP
Japan
Prior art keywords
flame
imaging
brightness
self
distance
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.)
Withdrawn
Application number
JP2004188370A
Other languages
Japanese (ja)
Inventor
Akitaka Shimizu
昭貴 清水
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.)
Funai Electric Co Ltd
Original Assignee
Funai Electric Co 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 Funai Electric Co Ltd filed Critical Funai Electric Co Ltd
Priority to JP2004188370A priority Critical patent/JP2006011845A/en
Publication of JP2006011845A publication Critical patent/JP2006011845A/en
Withdrawn legal-status Critical Current

Links

Images

Landscapes

  • Electric Suction Cleaners (AREA)
  • Fire-Detection Mechanisms (AREA)
  • Alarm Systems (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a self-propelled cleaner capable of cleaning as it propels itself, and of being used for fire alarms while utilizing its self-propelled function. <P>SOLUTION: A distance-measuring AF passive sensor 31FM provided in the self-propelled cleaner is used to detect flames. This eliminates the need to newly install a camera or the like for detection of fires. The AF passive sensor 31FM performs imaging at least twice or more (step S510, S530), and since an increase or decrease in an image pixel area corresponding to a flame is used as criteria, it is possible to securely detect only flames. In this way, the possibility of detecting any obstacles that resemble flames in color as flames is eliminated. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は、掃除機構を備えた本体と、障害物との距離を検出する測距機構と、同測距機構により測定された距離に基づいて操舵と駆動を実現する駆動機構とを備える自走式掃除機に関するものである。   The present invention provides a self-propelled body including a main body including a cleaning mechanism, a distance measuring mechanism that detects a distance from an obstacle, and a drive mechanism that realizes steering and driving based on the distance measured by the distance measuring mechanism. This relates to a vacuum cleaner.

従来、この種の火災報知器として、カラーカメラで撮像したカラー画像データを解析することにより火災の検知を行うものが知られている(例えば、特許文献1参照。)。 かかる構成によれば、炎の位置変化の空間周波数特性に着目することにより、カラー画像データに含まれる炎の成分の検出を正確に行うことが可能であった。従って、カラー画像データにイルミネーション等の画像成分が含まれる場合であっても、火災の有無を正確に判定することができた。
特開平10−126765号公報
2. Description of the Related Art Conventionally, as this type of fire alarm, one that detects a fire by analyzing color image data captured by a color camera is known (for example, see Patent Document 1). According to such a configuration, it is possible to accurately detect the flame component included in the color image data by paying attention to the spatial frequency characteristics of the flame position change. Therefore, even when image components such as illumination are included in the color image data, it is possible to accurately determine the presence or absence of a fire.
Japanese Patent Laid-Open No. 10-126765

しかしながら、上述した火災報知器は固定して設置されるため、視野が一定となる。従って、広範囲にわたって火災の監視を行うためには、複数のカラーカメラを設置しなければならない。この場合、カラーカメラの設置台数が増加し、設置コストが増加するという課題があたった。また、障害物等により死角が生じ、視野内であっても実質的に火災の監視を行うことができない部分が存在するという課題があった。   However, since the above-described fire alarm is fixedly installed, the field of view is constant. Therefore, in order to monitor fire over a wide area, a plurality of color cameras must be installed. In this case, there is a problem that the number of color cameras installed increases and the installation cost increases. In addition, there is a problem that a blind spot is caused by an obstacle or the like, and there is a portion where the fire cannot be monitored substantially even within the field of view.

本発明は、上記課題にかんがみてなされたもので、自走して清掃が可能であるとともに、自走の機能を利用しつつ火災報知にも利用可能な自走式掃除機を提供することを目的とする。   The present invention has been made in view of the above problems, and provides a self-propelled cleaner that can be self-propelled and cleaned, and that can also be used for fire alarm while utilizing the self-propelled function. Objective.

上記目的を達成するため、請求項1にかかる発明は、掃除機構を備えた本体と、障害物との距離を検出する測距機構と、同測距機構により測定された距離に基づいて操舵と駆動を実現する駆動機構とを備える自走式掃除機において、
上記測距機構は、それぞれ複数の撮像画素によって構成され、異なる位置に備えられた2個以上のCCDラインセンサにおける撮像ずれから上記障害物との距離を測定する測距手段と、上記CCDラインセンサの各撮像画素に蓄積される電荷の蓄積度合いを取得し、同取得した蓄積度合いが炎に対応する値域となる撮像画素を、炎を受像した撮像画素として検出する炎検出手段と、明るさを取得する明るさ検出手段と、同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる値域変動手段と、上記炎検出手段により炎を受像した撮像画素が検出されたとき、上記駆動機構による操舵および駆動を停止させるとともに、上記CCDラインセンサにより再度撮像し、その撮像結果から炎を受像した撮像画素領域の変動を検出する火災検出手段と、上記火災検出手段が炎を受像した撮像画素領域の変動を認識したとき、上記駆動機構に操舵および駆動を行わせつつ、警報を発する警報手段とを具備する構成としてある。
In order to achieve the above object, the invention according to claim 1 is directed to a main body having a cleaning mechanism, a distance measuring mechanism for detecting a distance from an obstacle, and steering based on a distance measured by the distance measuring mechanism. In a self-propelled cleaner provided with a drive mechanism that realizes driving,
The distance measuring mechanism is composed of a plurality of imaging pixels, and a distance measuring means for measuring a distance from the obstacle from imaging deviations in two or more CCD line sensors provided at different positions; and the CCD line sensor Flame detection means for acquiring an accumulation degree of charge accumulated in each of the imaging pixels, and detecting an imaging pixel in which the acquired accumulation degree is in a value range corresponding to the flame as an imaging pixel receiving the flame; and brightness Brightness detection means to be acquired, value range changing means for changing the value range corresponding to the flame according to the brightness acquired by the brightness detection means, and imaging pixels that have received the flame are detected by the flame detection means. In this case, the steering and driving by the driving mechanism are stopped, and the CCD line sensor captures an image again. A fire detecting means for detecting movement, and an alarm means for issuing an alarm while causing the drive mechanism to perform steering and driving when recognizing a change in an imaging pixel area where the fire detecting means has received a flame. It is as.

上記のように構成した請求項1の発明において、自走式掃除機が掃除機構により掃除を行うにあたり、駆動機構が操舵と駆動を実現する。また、測距機構が障害物との距離を検出することにより、障害物を避けつつ操舵と駆動を実現することができる。上記測距機構は、異なる位置に備えられた2個以上のCCDラインセンサによって構成され、同CCDラインセンサのそれぞれが複数の撮像画素によって構成されている。そして、各CCDラインセンサの撮像ずれに基づいて上記障害物との距離を測定することができる。   In the invention of claim 1 configured as described above, when the self-propelled cleaner performs cleaning by the cleaning mechanism, the drive mechanism realizes steering and driving. Further, when the distance measuring mechanism detects the distance to the obstacle, steering and driving can be realized while avoiding the obstacle. The distance measuring mechanism is constituted by two or more CCD line sensors provided at different positions, and each of the CCD line sensors is constituted by a plurality of imaging pixels. Then, the distance to the obstacle can be measured based on the imaging deviation of each CCD line sensor.

上記CCDラインセンサにより撮像を行う際に各撮像画素には入力に応じた電荷が蓄積される。炎検出手段は蓄積された電荷の蓄積度合いを取得する。そして、この蓄積度合いと炎に対応する値域とを比較し、この蓄積度合いが同値域内となる撮像素子を炎を受像した撮像画素として検出する。一方、明るさ検出手段は、明るさを取得する。そして、値域変動手段は、同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる。   When imaging is performed by the CCD line sensor, charges corresponding to inputs are accumulated in each imaging pixel. The flame detecting means acquires the accumulated charge accumulation degree. Then, the accumulation degree is compared with a value range corresponding to the flame, and an image sensor in which the accumulation degree is within the same value range is detected as an imaging pixel that has received the flame. On the other hand, the brightness detection means acquires brightness. Then, the value range changing means changes the value range corresponding to the flame according to the brightness acquired by the brightness detection means.

火災検出手段は、上記炎検出手段により炎を受像した撮像画素が検出されたとき、上記駆動機構による操舵および駆動を停止させる。これにより、上記CCDラインセンサの撮像視野が一定に保持される。そして、上記CCDラインセンサにより再度撮像し、その撮像結果から炎を受像した撮像画素領域の変動を検出する。炎を受像した撮像画素領域の変動があった場合には、警報手段が警報を発する。警報を発する際には上記駆動機構により操舵および駆動が行われる。すなわち、経時的に炎を受像した撮像画素領域が変動した場合、これをもって炎のゆらぎを認識し、火災の警報を行うことができる。   The fire detection means stops the steering and driving by the drive mechanism when the imaging pixel receiving the flame is detected by the flame detection means. Thereby, the imaging field of view of the CCD line sensor is kept constant. Then, the image is picked up again by the CCD line sensor, and the fluctuation of the image pickup pixel area where the flame is received is detected from the image pickup result. When there is a change in the imaging pixel area that has received the flame, the alarm means issues an alarm. When an alarm is issued, steering and driving are performed by the drive mechanism. That is, when the imaging pixel area that has received the flame changes with time, the fluctuation of the flame can be recognized and a fire alarm can be issued.

本体に備えられる掃除機構については、吸引タイプによる掃除機構を採用しても良いし、ブラシにより掻き込むタイプの掃除機構を採用しても良いし、両者を組み合わせて採用しても良い。   As for the cleaning mechanism provided in the main body, a suction type cleaning mechanism may be adopted, a cleaning mechanism of a type scraped with a brush may be adopted, or a combination of both may be adopted.

また、操舵及び駆動が可能な駆動機構についても、本体における左右に配置された駆動輪の回転を個別に制御することにより、前進、後進、左右への方向転換及び同一場所での回転といった操舵及び駆動が可能である。なおこの場合、前後などに補助輪を備えても良いことはいうまでもない。また、駆動輪は、車輪のみならず、無端ベルトを駆動する構成で実現しても良い。むろん、これ以外にも、4輪、6輪など、各種の構成で駆動機構を実現可能である。   Also, with respect to a drive mechanism capable of steering and driving, by separately controlling the rotation of the drive wheels arranged on the left and right in the main body, the steering and the forward, backward, left and right direction change and rotation at the same place It can be driven. In this case, it goes without saying that auxiliary wheels may be provided at the front and rear. Further, the drive wheel may be realized by a configuration that drives not only the wheel but also an endless belt. Of course, besides this, the drive mechanism can be realized with various configurations such as four wheels and six wheels.

また、請求項2にかかる発明は、掃除機構を備えた本体と、障害物との距離を検出する測距機構と、同測距機構により測定された距離に基づいて操舵と駆動を実現する駆動機構とを備える自走式掃除機において、
上記測距機構は、それぞれ複数の撮像画素によって構成され、異なる位置に備えられた2個以上のラインセンサにおける撮像ずれから上記障害物との距離を測定する測距手段と、上記ラインセンサによる撮像結果から炎を受像した撮像画素を検出する炎検出手段と、上記炎検出手段により炎を受像した撮像画素が検出されたとき、上記ラインセンサにより再度撮像し、その撮像結果から炎を受像した撮像画素領域の変動を検出する火災検出手段と、上記火災検出手段が炎を受像した撮像画素領域の変動を認識したとき、警報を発する警報手段とを具備する構成としてある。
According to a second aspect of the present invention, there is provided a distance measuring mechanism for detecting a distance between a main body having a cleaning mechanism, an obstacle, and a drive for realizing steering and driving based on the distance measured by the distance measuring mechanism. In a self-propelled vacuum cleaner equipped with a mechanism,
The distance measuring mechanism is composed of a plurality of imaging pixels, and distance measuring means for measuring a distance from the obstacle from an imaging deviation in two or more line sensors provided at different positions, and imaging by the line sensor Flame detection means for detecting an imaging pixel that has received a flame from the result, and when the imaging pixel that has received the flame is detected by the flame detection means, imaging is performed again by the line sensor, and imaging is performed by receiving the flame from the imaging result. A fire detection unit that detects a change in the pixel area and an alarm unit that issues a warning when the fire detection unit recognizes a change in the imaging pixel region that has received a flame are configured.

上記のように構成した請求項2の発明において、自走式掃除機が掃除機構により掃除を行うにあたり、駆動機構が操舵と駆動を実現する。また、測距機構が障害物との距離を検出することにより、障害物を避けつつ操舵と駆動を実現することができる。上記測距機構は、異なる位置に備えられた2個以上のラインセンサによって構成され、同ラインセンサのそれぞれが複数の撮像画素によって構成されている。そして、各ラインセンサの撮像ずれに基づいて上記障害物との距離を測定することができる。   In the invention of claim 2 configured as described above, when the self-propelled cleaner performs cleaning by the cleaning mechanism, the drive mechanism realizes steering and driving. Further, when the distance measuring mechanism detects the distance to the obstacle, steering and driving can be realized while avoiding the obstacle. The distance measuring mechanism is composed of two or more line sensors provided at different positions, and each of the line sensors is composed of a plurality of imaging pixels. And the distance with the said obstruction can be measured based on the imaging shift of each line sensor.

炎検出手段は、上記ラインセンサによる撮像結果から炎を受像した撮像画素を検出する。火災検出手段は、上記炎検出手段により炎を受像した撮像画素が検出されたとき、、上記ラインセンサにより再度撮像し、その撮像結果から炎を受像した撮像画素領域の変動を検出する。炎を受像した撮像画素領域の変動があった場合には、警報手段が警報を発する。   The flame detection means detects an imaging pixel that has received a flame from the imaging result of the line sensor. The fire detection means, when an image pickup pixel that has received a flame is detected by the flame detection means, picks up an image again by the line sensor, and detects a change in the image pickup pixel area that has received the flame from the image pickup result. When there is a change in the imaging pixel area that has received the flame, the alarm means issues an alarm.

さらに、請求項3にかかる発明は、上記炎検出手段は、上記ラインセンサに蓄積される電荷の蓄積度合いを取得し、同取得した蓄積度合いが炎に対応する値域となる撮像画素を、炎を受像した撮像画素として検出する構成としてある。
上記のように構成した請求項3の発明において、上記ラインセンサにより撮像を行う際に各撮像画素には入力に応じた電荷が蓄積される。炎検出手段は蓄積された電荷の蓄積度合いを取得する。そして、この蓄積度合いと炎に対応する値域とを比較し、この蓄積度合いが同値域内となる撮像素子を炎を受像した撮像画素として検出する。このようにすることにより、測距機構として障害物との距離の測定を行いながら、炎を示すもを検出することも可能となる。
Further, in the invention according to claim 3, the flame detecting means acquires the accumulation degree of the electric charge accumulated in the line sensor, and sets the image pickup pixels in which the obtained accumulation degree falls within a value range corresponding to the flame. It is configured to detect the received image pickup pixel.
In the invention of claim 3 configured as described above, when imaging is performed by the line sensor, charges corresponding to input are accumulated in each imaging pixel. The flame detecting means acquires the accumulated charge accumulation degree. Then, the accumulation degree is compared with a value range corresponding to the flame, and an image sensor in which the accumulation degree is within the same value range is detected as an imaging pixel that has received the flame. By doing in this way, it becomes possible to detect what shows a flame while measuring the distance to an obstacle as a distance measuring mechanism.

さらに、請求項4にかかる発明は、明るさを取得する明るさ検出手段と、同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる値域変動手段とを具備する構成としてある。
上記のように構成した請求項4の発明において、明るさ検出手段は、明るさを取得する。そして、値域変動手段は、同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる。このようにすることにより、明るさに応じた上記閾値を設定することができる。
Further, the invention according to claim 4 includes brightness detection means for acquiring brightness, and value range changing means for changing the value range corresponding to the flame according to the brightness acquired by the brightness detection means. It is as composition to do.
In the invention of claim 4 configured as described above, the brightness detection means acquires brightness. Then, the value range changing means changes the value range corresponding to the flame according to the brightness acquired by the brightness detection means. By doing in this way, the said threshold value according to the brightness can be set.

また、請求項5にかかる発明は、上記駆動機構は、上記炎検出手段が炎を検出した後、上記火災検出手段が再度の撮像を完了させるまで操舵および駆動を停止させる構成としてある。
上記のように構成した請求項5の発明において、上記炎検出手段により炎を受像した撮像画素が検出されたとき、上記駆動機構による操舵および駆動が停止する。これにより、上記ラインセンサの撮像視野が一定に保持される。従って、一定の視野について炎を受像した撮像画素領域の変動を評価することができる。
According to a fifth aspect of the present invention, the driving mechanism is configured to stop steering and driving until the fire detecting unit completes another imaging after the flame detecting unit detects a flame.
In the invention of claim 5 configured as described above, when the imaging pixel receiving a flame is detected by the flame detecting means, the steering and driving by the driving mechanism are stopped. Thereby, the imaging field of view of the line sensor is kept constant. Therefore, it is possible to evaluate the variation of the imaging pixel area that receives the flame for a certain visual field.

また、請求項6にかかる発明は、上記ラインセンサは、CCDセンサである構成としてある。
上記のように構成した請求項6の発明において、上記ラインセンサとしてCCDセンサを適用することも可能である。
According to a sixth aspect of the present invention, the line sensor is a CCD sensor.
In the invention of claim 6 configured as described above, a CCD sensor can be applied as the line sensor.

また、請求項7にかかる発明は、上記警報手段は、上記駆動機構に上記自走式掃除機の操舵および駆動を行わせつつ、警報を発する構成としてある。
上記のように構成した請求項7の発明において、警報を発する際に、上記駆動機構により操舵および駆動を行うことにより、離れた位置にいる使用者にも近づいて警報を発することができる。
The invention according to claim 7 is configured such that the alarm means issues an alarm while causing the drive mechanism to steer and drive the self-propelled cleaner.
In the invention of claim 7 configured as described above, when a warning is issued, the warning can be issued by approaching a user at a distant position by performing steering and driving by the drive mechanism.

以上説明したように請求項1および請求項2にかかる発明によれば、自走して清掃が可能であるとともに、自走の機能を利用しつつ火災報知にも利用可能な自走式掃除機を提供することができる。
また、請求項3にかかる発明によれば、ラインセンサにおける電荷の蓄積度合いに基づいて炎を検出することができる。
さらに、請求項4にかかる発明によれば、外部の明るさに影響されることなく炎を検出することができる。
As described above, according to the first and second aspects of the invention, the self-propelled cleaner can be self-propelled and cleaned, and can be used for fire alarm while utilizing the self-propelled function. Can be provided.
According to the invention of claim 3, the flame can be detected based on the charge accumulation degree in the line sensor.
Furthermore, according to the invention concerning Claim 4, a flame can be detected without being influenced by external brightness.

さらに、請求項5にかかる発明によれば、同一視野にて炎の変動を比較することができる。
さらに、請求項6にかかる発明によれば、感度の良い撮像を行うことができる。
また、請求項7にかかる発明によれば、確実に火災の発生を知らせることができる。
Furthermore, according to the invention concerning Claim 5, the fluctuation | variation of a flame can be compared in the same visual field.
Furthermore, according to the sixth aspect of the invention, it is possible to perform imaging with high sensitivity.
Moreover, according to the invention concerning Claim 7, generation | occurrence | production of a fire can be notified reliably.

図1は、本発明にかかる自走式掃除機の概略構成をブロック図により示している。
同図に示すように、各ユニットを制御する制御ユニット10と、周囲に人間がいるか否かを検知する人体感知ユニット20と、周囲の障害物を検知するための障害物監視ユニット30と、移動を実現する走行系ユニット40と、掃除を行うためのクリーナ系ユニット50と、所定範囲を撮影するカメラ系ユニット60と、無線でLANに接続するための無線LANユニット70と、追加センサなどからなるオプションユニット80とから構成されている。なお、本体BDは薄型の略円筒形状をなしている。
FIG. 1 is a block diagram showing a schematic configuration of a self-propelled cleaner according to the present invention.
As shown in the figure, a control unit 10 for controlling each unit, a human body sensing unit 20 for detecting whether or not a person is in the vicinity, an obstacle monitoring unit 30 for detecting surrounding obstacles, and movement A traveling system unit 40 for cleaning, a cleaner system unit 50 for cleaning, a camera system unit 60 for photographing a predetermined range, a wireless LAN unit 70 for wirelessly connecting to a LAN, an additional sensor, and the like. An option unit 80 is included. The main body BD has a thin and substantially cylindrical shape.

図2は、各ユニットを具体的に実現する電気系の構成をブロック図により示している。
制御ユニット10として、CPU11と、ROM13と、RAM12がバス14を介して接続されている。CPU11は、ROM13に記録されている制御用プログラムおよび各種パラメータテーブルに従い、RAM12をワークエリアとして使用して各種の制御を実行する。上記制御用プログラムの内容については後述する。
FIG. 2 is a block diagram showing the configuration of an electric system that specifically realizes each unit.
As the control unit 10, a CPU 11, a ROM 13, and a RAM 12 are connected via a bus 14. The CPU 11 executes various controls using the RAM 12 as a work area according to the control program and various parameter tables recorded in the ROM 13. The contents of the control program will be described later.

また、バス14には操作パネルユニット15が備えられ、同操作パネルユニット15には、各種の操作用スイッチ15aと、液晶表示パネル15bと、表示用LED15cが備えられている。液晶表示パネルは多階調表示が可能なモノクロ液晶パネルを使用しているが、カラー液晶パネルなどを使用することも可能である。   The bus 14 is provided with an operation panel unit 15. The operation panel unit 15 is provided with various operation switches 15a, a liquid crystal display panel 15b, and a display LED 15c. As the liquid crystal display panel, a monochrome liquid crystal panel capable of multi-gradation display is used, but a color liquid crystal panel or the like can also be used.

本自走式掃除機はバッテリー17を有しており、CPU11はバッテリー監視回路16を介してバッテリー17の残量をモニター可能となっている。なお、同バッテリー17は誘導コイル18aを介して非接触で供給される電力を用いて充電する充電回路18を備えている。バッテリー監視回路16は主にバッテリー17の電圧を監視して残量を検知する。   This self-propelled cleaner has a battery 17, and the CPU 11 can monitor the remaining amount of the battery 17 via the battery monitoring circuit 16. The battery 17 includes a charging circuit 18 that charges using electric power supplied in a non-contact manner via an induction coil 18a. The battery monitoring circuit 16 mainly monitors the voltage of the battery 17 and detects the remaining amount.

人体感知ユニット20として、四つの人体センサ21(21fr,21rr,21fl,21rl)が前方左右斜め方向と後方左右斜め方向に対面させて備えられている。各人体センサ21は赤外線の受光センサを備えるとともに受光した赤外線の光量の変化に基づいて人体の有無を検知するものであり、変化する赤外線照射物体を検知したとき出力用のステータスを変化させるため、CPU11は上記バス14を介して同人体センサ21の検知を取得することが可能となっている。すなわち、CPU11は所定時間毎に各人体センサ21fr,21rr,21fl,21rlのステータスを取得しにいき、取得したステータスが変化していれば、同人体センサ21fr,21rr,21fl,21rlの対向方向に人体の存在を検知することが可能となる。   As the human body sensing unit 20, four human body sensors 21 (21fr, 21rr, 21fl, 21rl) are provided facing each other in the front left / right diagonal direction and the rear left / right diagonal direction. Each human body sensor 21 includes an infrared light receiving sensor and detects the presence or absence of a human body based on a change in the amount of received infrared light. In order to change an output status when a changing infrared irradiation object is detected, The CPU 11 can acquire the detection of the human body sensor 21 via the bus 14. That is, the CPU 11 goes to acquire the status of each human body sensor 21fr, 21rr, 21fl, 21rl every predetermined time. If the acquired status changes, the CPU 11 moves in the opposite direction of the human body sensors 21fr, 21rr, 21fl, 21rl. The presence of the human body can be detected.

ここでは赤外線の光量変化に基づくセンサによって人体センサを構成しているが、人体センサはこれに限られるものではない。例えば、CPUの処理量が上がればカラー画像を撮影し、人体に特徴的な肌色の領域を探し、同領域の大きさ、変化に基づいて人体を検知するという構成を実現することもできる。   Here, the human body sensor is configured by a sensor based on a change in the amount of infrared light, but the human body sensor is not limited to this. For example, if the processing amount of the CPU increases, a configuration can be realized in which a color image is taken, a skin color region characteristic of the human body is searched, and the human body is detected based on the size and change of the region.

障害物監視ユニット30は、オートフォーカス(以下、AFと呼ぶ。)用測距センサとしてのAF用パッシブセンサ31(31R,31FR,31FM,31FL,31L,31CL))とその通信用インターフェイスであるAFセンサ通信I/O32と、照明用LED33と、各LEDに駆動電流を供給するLEDドライバ34とから構成されている。まず、AF用パッシブセンサ31の構成について説明する。図3はAF用パッシブセンサ31の概略構成を示している。二軸のほぼ平行な光学系31a1,31a2と、同光学系31a1,31a2の結像位置にほぼそれぞれ配設されたCCDラインセンサ31b1,31b2と、各CCDラインセンサ31b1,31b2の撮像イメージデータを外部に出力するための出力I/O31cとを備えている。   The obstacle monitoring unit 30 includes an AF passive sensor 31 (31R, 31FR, 31FM, 31FL, 31L, 31CL) as a distance measuring sensor for autofocus (hereinafter referred to as AF), and an AF serving as an interface for the communication. It comprises a sensor communication I / O 32, an illumination LED 33, and an LED driver 34 that supplies a drive current to each LED. First, the configuration of the AF passive sensor 31 will be described. FIG. 3 shows a schematic configuration of the AF passive sensor 31. The biaxially parallel optical systems 31a1 and 31a2, the CCD line sensors 31b1 and 31b2 disposed substantially at the imaging positions of the optical systems 31a1 and 31a2, and the image data of the CCD line sensors 31b1 and 31b2, respectively. And an output I / O 31c for outputting to the outside.

CCDラインセンサ31b1,31b2は光エネルギーを電気エネルギーに変換する160〜170画素の撮像画素で構成され、各撮像画素ごとに生成した電気エネルギーを電荷として蓄積することが可能となっている。そして、それぞれの撮像画素において蓄積された電荷の量に応じて8ビットのデータを出力することが可能となっている。一定時間に蓄積される電荷の量は、入力された光エネルギーに応じた量となるため、入力された光の光量や波長等に応じて異なる値の電荷が各撮像画素に蓄積されることとなる。すなわち、各CCDラインセンサ31b1,31b2は入力したイメージを表現可能なデータを生成することが可能となっている。   The CCD line sensors 31b1 and 31b2 are composed of 160 to 170 pixel imaging pixels that convert light energy into electrical energy, and can store the electrical energy generated for each imaging pixel as a charge. Then, 8-bit data can be output according to the amount of charge accumulated in each imaging pixel. Since the amount of charge accumulated in a certain time is an amount corresponding to the input light energy, different values of charge are accumulated in each imaging pixel depending on the amount of light, wavelength, etc. of the input light. Become. That is, the CCD line sensors 31b1 and 31b2 can generate data that can represent the input image.

また、光学系が二軸であるので、結像イメージには距離に応じたずれが生じており、それぞれのCCDラインセンサ31b1,31b2が出力するデータのずれに基づいて距離を計測できる。例えば、近距離になるほど結像イメージのずれが大きく、遠距離になるほど結像イメージのずれはなくなっていく。従って、一方の出力データにおける4〜5画素毎のデータ列を他方の出力データ中でスキャンし、元のデータ列のアドレスと発見されたデータ列のアドレスとの相違を求め、相違量で予めROM13に記憶しておいた相違量−距離変換テーブルT1を参照し、実際の距離を求めることになる。   In addition, since the optical system is biaxial, the formed image has a shift corresponding to the distance, and the distance can be measured based on the shift of data output from the CCD line sensors 31b1 and 31b2. For example, the shift of the image is larger as the distance is shorter, and the shift of the image is eliminated as the distance is longer. Accordingly, the data string for every 4 to 5 pixels in one output data is scanned in the other output data, the difference between the address of the original data string and the address of the discovered data string is obtained, and the ROM 13 is preliminarily stored with the difference amount. The actual distance is obtained by referring to the difference amount-distance conversion table T1 stored in (1).

一方のCCDラインセンサ31b1の近傍には、数画素分の撮像画素で構成されたモニターセル31b3が備えられている。モニターセル31b3はCCDラインセンサ31b1,31b2よりも広角な光学系31a3により結像されている。また、モニターセル31b3も撮像画素によって構成されているため、入力した光エネルギーに応じた電荷を蓄積することができる。ただし、モニターセル31b3に光を入力する光学系31a3は広角とされており、モニターセル31b3は数画素分の撮像画素で構成されるため、CCDラインセンサ31b1,31b2よりも解像度が低い。すなわち、モニターセル31b3によって、ぼんやりとしたイメージが撮像されるようにされている。さらに、モニターセル31b3は、同モニターセル31b3を構成する各撮像画素に蓄積された電荷の平均を算出し、同平均値に対応するデータを出力する。   In the vicinity of one CCD line sensor 31b1, a monitor cell 31b3 composed of several pixels is provided. The monitor cell 31b3 is imaged by an optical system 31a3 having a wider angle than the CCD line sensors 31b1 and 31b2. Further, since the monitor cell 31b3 is also constituted by the imaging pixels, it is possible to accumulate charges according to the input light energy. However, the optical system 31a3 for inputting light to the monitor cell 31b3 has a wide angle, and the monitor cell 31b3 is composed of several pixels, so the resolution is lower than that of the CCD line sensors 31b1 and 31b2. That is, a blurred image is captured by the monitor cell 31b3. Further, the monitor cell 31b3 calculates the average of the charges accumulated in each imaging pixel constituting the monitor cell 31b3, and outputs data corresponding to the average value.

このようにすることにより、モニターセル31b3に入力可能な広範囲の視野における平均的な光量をデータとして出力することができる。言い換えれば、モニターセル31b3によって本自走式掃除機が設置された部屋の広範囲にわたる平均的な明るさを取得することができる。なお、モニターセル31b3にて取得した明るさデータも出力I/O31cによってCPU11等に出力される。ROM13には上述した相違量−距離変換テーブルT1の他に、明るさ−色−電荷テーブルT2が備えられている。この明るさ−色−電荷テーブルT2は、モニターセル31b3にて取得された明るさと、各CCDラインセンサ31b1,31b2にて蓄積された電荷が示す色との対応関係を規定したテーブルである。   By doing in this way, the average light quantity in the wide visual field which can be input into the monitor cell 31b3 can be output as data. In other words, average brightness over a wide range of the room in which the self-propelled cleaner is installed can be acquired by the monitor cell 31b3. The brightness data acquired by the monitor cell 31b3 is also output to the CPU 11 and the like by the output I / O 31c. The ROM 13 is provided with a brightness-color-charge table T2 in addition to the above-described difference amount-distance conversion table T1. The brightness-color-charge table T2 is a table that defines the correspondence between the brightness acquired by the monitor cell 31b3 and the color indicated by the charges accumulated in the CCD line sensors 31b1 and 31b2.

様々な明るさにおいて、各色の被写体をCCDラインセンサ31b1,31b2にて撮像する実験を行う。そして、明るさ−色−電荷テーブルT2は、そのとき各撮像画素に蓄積される各色についての電荷の量と、モニターセル31b3にて取得される明るさデータとの対応関係をテーブル化することにより作成されている。図4は、明るさ−色−電荷テーブルT2を模式的に示している。同図において、横軸は明るさを示し、縦軸は一定時間に撮像画素に蓄積される電荷の量を電圧として示している。同図において、各明るさ(25%,50%,100%)において、それぞれ緑色とオレンジ色と赤色の対象物を撮像した場合の電荷の値が取りうる値域を示している。同図から、撮像画素に入力される光の量と電荷とは線形的な関係にあり、波長が大きいほど電荷が小さくなることが分かる。   An experiment is performed in which the CCD line sensors 31b1 and 31b2 image subjects of various colors at various brightnesses. The brightness-color-charge table T2 tabulates the correspondence between the amount of charge for each color stored in each imaging pixel and the brightness data acquired by the monitor cell 31b3. Has been created. FIG. 4 schematically shows a brightness-color-charge table T2. In the figure, the horizontal axis indicates the brightness, and the vertical axis indicates the amount of charge accumulated in the imaging pixel for a certain time as a voltage. In the same figure, the range of values that can be taken by the charge values when green, orange and red objects are imaged at each brightness (25%, 50%, 100%) is shown. From the figure, it can be seen that the amount of light input to the imaging pixel and the charge are in a linear relationship, and the charge decreases as the wavelength increases.

明るさ−色−電荷テーブルT2を参照することにより、例えば明るさが50%においてオレンジ色を撮像したときの電荷が取りうる値域を特定することができる。従って、CCDラインセンサ31b1,31b2にて距離を測定しつつモニターセル31b3にて明るさデータを取得することにより、明るさ−色−電荷テーブルT2を参照してCCDラインセンサ31b1,31b2にて撮像された画像の色を各撮像画素について特定することが可能となっている。   By referring to the brightness-color-charge table T2, for example, it is possible to specify a range of charges that can be taken when an orange image is captured at a brightness of 50%. Therefore, by acquiring the brightness data in the monitor cell 31b3 while measuring the distance with the CCD line sensors 31b1 and 31b2, the CCD line sensors 31b1 and 31b2 pick up images with reference to the brightness-color-charge table T2. The color of the captured image can be specified for each imaging pixel.

AF用パッシブセンサ31R,31FR,31FM,31FL,31L,31CLのうち、AF用パッシブセンサ31FR,31FM,31FLは正面の障害を検知するために利用され、AF用パッシブセンサ31R,31Lは前方左右直前の障害を検知するために利用され、AF用パッシブセンサ31CLは前方天井までの距離を検知するために利用されている。また、モニターセル31b3は正面の障害を検知するために利用されるAF用パッシブセンサ31CLにおいてのみ明るさを取得している。従って、正面前方についてのみ障害物の色を検出することが可能となっている。   Of the AF passive sensors 31R, 31FR, 31FM, 31FL, 31L, and 31CL, the AF passive sensors 31FR, 31FM, and 31FL are used to detect frontal obstructions. The AF passive sensor 31CL is used to detect the distance to the front ceiling. The monitor cell 31b3 acquires brightness only in the AF passive sensor 31CL used for detecting a frontal obstacle. Therefore, it is possible to detect the color of the obstacle only in front of the front.

なお、上述のとおり各AF用パッシブセンサ31R,31FR,31FM,31FL,31L,31CLが測距を行う際には、CCDラインセンサ31b1,31b2における4〜5画素毎のデータ列のアドレスの相違量が分かれば良く、各撮像画素がどの色を示すか分からなくても良い。従って、モニターセル31b3が明るさを取得しないAF用パッシブセンサ31R,31FR,31FM,31FL,31Lにおいても測距が可能であることはいうまでもない。   As described above, when the AF passive sensors 31R, 31FR, 31FM, 31FL, 31L, and 31CL perform distance measurement, the difference in the address of the data string for every 4 to 5 pixels in the CCD line sensors 31b1 and 31b2. And it is not necessary to know which color each imaging pixel indicates. Therefore, it goes without saying that ranging is possible even with the passive sensors for AF 31R, 31FR, 31FM, 31FL, 31L for which the monitor cell 31b3 does not acquire brightness.

図5は正面と前方左右直前の障害をAF用パッシブセンサ31で検知する際の原理を示している。これらのAF用パッシブセンサ31は周囲の床面に対して斜めに向けて配置されている。対向方向に障害物が無い場合、AF用パッシブセンサ31による測距距離はほぼ全撮像範囲においてL1となる。しかし、図面で一点鎖線で示すように段差がある場合、その測距距離はL2となる。測距距離が伸びたら下がる段差があると判断できる。また、二点鎖線で示すように上がる段差があれば測距距離はL3となる。障害物があるときも上がる段差と同様に測距距離は同障害物までの距離として計測され、床面よりも短くなる。   FIG. 5 shows the principle when the AF passive sensor 31 detects an obstacle immediately before the front and front left and right. These AF passive sensors 31 are arranged obliquely with respect to the surrounding floor surface. When there is no obstacle in the facing direction, the distance measured by the AF passive sensor 31 is L1 in almost the entire imaging range. However, when there is a step as shown by the alternate long and short dash line in the drawing, the distance measurement distance is L2. It can be determined that there is a step that decreases as the distance is increased. If there is a step that rises as shown by the two-dot chain line, the distance measurement distance is L3. When there is an obstacle, the distance measuring distance is measured as the distance to the obstacle, as is the step that goes up, and is shorter than the floor.

本実施形態においては、AF用パッシブセンサ31を前方の床面に斜めに配向した場合、その撮像範囲は約10cmとなった。本自走式クリーナの幅が30cmであったので、三つのAF用パッシブセンサ31FR,31FM,31FLについては撮像範囲が重ならないように僅かに角度を変えて配置している。これにより、三つのAF用パッシブセンサ31FR,31FM,31FLにより前方方向の30cmの範囲での障害物と段差を検知できるようになっている。むろん、検知幅はセンサの仕様や取付位置などに応じて変化し、実際に必要となる幅に応じた数のセンサを利用すればよい。   In the present embodiment, when the AF passive sensor 31 is oriented obliquely on the front floor surface, the imaging range is about 10 cm. Since the width of the self-propelled cleaner is 30 cm, the three passive sensors for AF 31FR, 31FM, and 31FL are arranged at slightly different angles so that the imaging ranges do not overlap. As a result, the three AF passive sensors 31FR, 31FM, and 31FL can detect an obstacle and a step in a range of 30 cm in the forward direction. Of course, the detection width varies depending on the sensor specification, the mounting position, and the like, and the number of sensors corresponding to the actually required width may be used.

一方、前方左右直前の障害を検知するAF用パッシブセンサ31R,31Lについては撮像範囲を垂直方向を基準として床面に対して斜めに配置している。また、AF用パッシブセンサ31Rを本体左方に取り付けつつ本体中央を横切って右方直前位置から本体幅を超えた右方の範囲を撮像するように対向させてあり、AF用パッシブセンサ31Lを本体右方に取り付けつつ本体中央を横切って左方直前位置から本体幅を超えた左方の範囲を撮像するように対向させてある。   On the other hand, the AF passive sensors 31R and 31L that detect obstacles immediately before and after the front left and right are arranged obliquely with respect to the floor surface with respect to the vertical direction. In addition, the AF passive sensor 31R is mounted on the left side of the main body and is opposed so as to capture the right range beyond the main body width from the position immediately before the right across the center of the main body. While being attached to the right, it is opposed so as to image the left range exceeding the width of the main body from the position immediately before the left across the center of the main body.

クロスさせないで左右の直前位置を撮影するようにすると、センサは急角度で床面に対面させなければならず、このようにすると撮像範囲が極めて狭くなってしまうので、複数のセンサが必要となる。このため、敢えてクロスさせる配置とし、撮像範囲を広げて少ない数のセンサで必要範囲をカバーできるようにしている。また、撮像範囲を垂直方向を基準として斜めに配置するのは、CCDラインセンサの並び方向が垂直方向に向くことを意味しており、図6に示すように撮像できる幅がW1となる。ここで、撮像範囲の右側で床面までの距離L4は短く、左側で距離L5が長くなっている。本体BDの側面の境界ラインが図面上の波線位置Bであると、境界ラインまでの撮像範囲は段差の検知などに利用され、境界ラインを超える撮像範囲は壁面の有無を検知するために利用される。   If the left and right positions are photographed without crossing, the sensor must face the floor surface at a steep angle, and in this case, the imaging range becomes extremely narrow, so a plurality of sensors are required. . For this reason, the arrangement is made to cross, and the imaging range is widened so that the required range can be covered with a small number of sensors. In addition, arranging the imaging range obliquely with respect to the vertical direction means that the arrangement direction of the CCD line sensors is oriented in the vertical direction, and the width that can be imaged is W1, as shown in FIG. Here, the distance L4 to the floor surface is short on the right side of the imaging range, and the distance L5 is long on the left side. If the boundary line on the side surface of the main body BD is a wavy position B on the drawing, the imaging range up to the boundary line is used for detecting a step, and the imaging range exceeding the boundary line is used for detecting the presence or absence of a wall surface. The

前方天井までの距離を検知するAF用パッシブセンサ31CLは天井に対面している。通常はAF用パッシブセンサ31CLが検知する床面から天井までの距離が一定であるが、壁面に近づいてくると撮像範囲が天井ではなく壁面となるので、測距距離が短くなってくる。従って、前方壁面の存在をより正確に検知できる   The AF passive sensor 31CL that detects the distance to the front ceiling faces the ceiling. Normally, the distance from the floor surface to the ceiling detected by the AF passive sensor 31CL is constant. However, when approaching the wall surface, the imaging range becomes the wall surface instead of the ceiling, and the distance measurement distance becomes shorter. Therefore, the presence of the front wall surface can be detected more accurately.

図7は各AF用パッシブセンサ31R,31FR,31FM,31FL,31L,31CLの本体BDへの取り付け位置を示すとともに、それぞれの床面での撮像範囲を括弧付きの符号で対応させて示している。なお、天井については撮像範囲を省略している。AF用パッシブセンサ31R,31FR,31FM,31FL,31Lの撮像を証明するように白色LEDからなる右照明用LED33Rと、左照明用LED33Lと、前照明用LED33Mを備えており、LEDドライバ34はCPU11からの制御指示に基づいて駆動電流を供給して照明できるようになっている。これにより、夜間であったり、テーブルの下などの暗い場所でもAF用パッシブセンサ31から有効な撮像イメージのデータを得ることができるようになる。   FIG. 7 shows the attachment positions of the AF passive sensors 31R, 31FR, 31FM, 31FL, 31L, and 31CL to the main body BD, and the imaging ranges on the floors are shown in correspondence with the reference numerals in parentheses. . The imaging range is omitted for the ceiling. In order to prove the imaging of the AF passive sensors 31R, 31FR, 31FM, 31FL, 31L, a right illumination LED 33R composed of white LEDs, a left illumination LED 33L, and a front illumination LED 33M are provided, and the LED driver 34 is a CPU 11. Based on a control instruction from the device, a drive current is supplied to enable illumination. This makes it possible to obtain effective captured image data from the AF passive sensor 31 even at night or in a dark place such as under a table.

走行系ユニット40は、モータドライバ41R,41Lと、駆動輪モータ42R,42Lと、この駆動輪モータ42R,42Lにて駆動される図示しないギアユニットと駆動輪を備えている。駆動輪は本体BDの左右に一輪ずつ配置されており、この他に駆動源を持たない自由転動輪が本体の前方側中央下面に取り付けられている。駆動輪モータ42R,42Lは回転方向と回転角度をモータドライバ41R,41Lによって詳細に駆動可能であり、各モータドライバ41R,41LはCPU11からの制御指示に応じて対応する駆動信号を出力する。また、駆動輪モータ42R,42Lと一体的に取り付けられているロータリーエンコーダの出力から現実の駆動輪の回転方向と回転角度が正確に検知できるようになっている。なお、ロータリーエンコーダは駆動輪と直結させず、駆動輪の近傍に自由回転可能な従動輪を取り付け、同従動輪の回転量をフィードバックさせることによって駆動輪にスリップが生じているような場合でも現実の回転量を検知できるようにしても良い。走行系ユニット40には、この他に地磁気センサ43が備えられており、地磁気に照らし合わせて走行方向を判断できるようになっている。また、加速度センサ44はXYZ三軸方向における加速度を検知し、検知結果を出力する。   The travel system unit 40 includes motor drivers 41R and 41L, drive wheel motors 42R and 42L, and a gear unit (not shown) and drive wheels that are driven by the drive wheel motors 42R and 42L. One drive wheel is arranged on each of the left and right sides of the main body BD. In addition, a free rolling wheel having no drive source is attached to the front lower center lower surface of the main body. The drive wheel motors 42R and 42L can be driven in detail by the motor drivers 41R and 41L with respect to the rotation direction and rotation angle, and each motor driver 41R and 41L outputs a corresponding drive signal in accordance with a control instruction from the CPU 11. In addition, the actual rotation direction and rotation angle of the drive wheel can be accurately detected from the output of the rotary encoder that is integrally attached to the drive wheel motors 42R and 42L. Note that the rotary encoder is not directly connected to the drive wheel, and a driven wheel that can be freely rotated is mounted in the vicinity of the drive wheel, and the drive wheel slips by feeding back the rotation amount of the driven wheel. It may be possible to detect the amount of rotation. In addition to this, the traveling system unit 40 is provided with a geomagnetic sensor 43 so that the traveling direction can be determined in light of the geomagnetism. The acceleration sensor 44 detects the acceleration in the XYZ triaxial directions and outputs the detection result.

ギアユニットや駆動輪は各種のものを採用可能であり、円形のゴム製タイヤを駆動させるようにしたり、無端ベルトを駆動させるようにして実現しても良い。   Various types of gear units and drive wheels can be employed, and may be realized by driving a circular rubber tire or driving an endless belt.

本自走式掃除機における掃除機構は、前方両サイドに配置されて本体BDの進行方向における両側寄りのゴミなどを当該本体BDにおける中央付近にかき寄せるサイドブラシと、本体の中央付近にかき寄せられたゴミをすくい上げるメインブラシと、同メインブラシによりすく上げられるゴミを吸引してダストボックス内に収容する吸引ファンとから構成されている。クリーナ系ユニット50は、各ブラシを駆動するサイドブラシモータ51R,51Lとメインブラシモータ52、それぞれのモータに駆動電力を供給するモータドライバ53R,53L,54と、吸引ファンを駆動する吸引モータ55と、同吸引モータに駆動電力を供給するモータドライバ56とから構成されている。サイドブラシやメインブラシを使用した掃除は床面の状況やバッテリーの状況やユーザーの指示などに応じてCPU11が適宜判断して制御するようにしている。   The cleaning mechanism in the self-propelled cleaner is disposed on both front sides and scrapes near the center of the main body BD near the center of the main body BD and the side brush that scrapes dust and the like on both sides in the traveling direction of the main body BD. The main brush scoops up the dust and a suction fan that sucks up the dust scooped up by the main brush and stores it in the dust box. The cleaner unit 50 includes side brush motors 51R and 51L that drive each brush, a main brush motor 52, motor drivers 53R, 53L, and 54 that supply driving power to the respective motors, and a suction motor 55 that drives a suction fan. The motor driver 56 supplies driving power to the suction motor. The cleaning using the side brush and the main brush is controlled by the CPU 11 as appropriate according to the floor condition, the battery condition, the user instruction, and the like.

カメラ系ユニット60は、それぞれ視野角の異なる二つのCMOSカメラ61,62を備えており、本体BDの正面方向であってそれぞれことなる仰角にセットされている。また、各カメラ61,62への撮像を指示するとともに撮像イメージを出力するためのカメラ通信I/O63も備えられている。さらに、カメラ61,62の撮像方向に対面させて15コの白色LEDからなるカメラ用照明LED64と、同LEDに照明用駆動電力を供給するためのLEDドライバ65を備えている。   The camera system unit 60 includes two CMOS cameras 61 and 62 having different viewing angles, and is set at different elevation angles in the front direction of the main body BD. A camera communication I / O 63 is also provided for instructing the cameras 61 and 62 to capture images and outputting captured images. Furthermore, a camera illumination LED 64 composed of 15 white LEDs facing the imaging direction of the cameras 61 and 62 and an LED driver 65 for supplying illumination drive power to the LEDs are provided.

無線LANユニット70は、無線LANモジュール71を有しており、CPU11は所定のプロトコルに従って外部LANと無線によって接続可能となっている。無線LANモジュール71は、図示しないアクセスポイントの存在を前提として、同アクセスポイントはルータなどを介して外部の広域ネットワーク(例えばインターネット)に接続可能な環境となっていることとする。従って、インターネットを介した通常のメールの送受信やWEBサイトの閲覧といったことが可能である。なお、無線LANモジュール71は、規格化されたカードスロットと、同スロットに接続される規格化された無線LANカードなどから構成されている。むろん、カードスロットは他の規格化されたカードを接続することも可能である。   The wireless LAN unit 70 has a wireless LAN module 71, and the CPU 11 can be connected to an external LAN wirelessly according to a predetermined protocol. Assume that the wireless LAN module 71 is connected to an external wide area network (for example, the Internet) via a router or the like on the assumption that an access point (not shown) exists. Therefore, it is possible to send and receive normal mail via the Internet and browse the WEB site. The wireless LAN module 71 includes a standardized card slot and a standardized wireless LAN card connected to the slot. Of course, other standardized cards can be connected to the card slot.

オプションユニット80は、図11に示すように、通信ユニットなどからなる。本実施形態においては、赤外線通信ユニット83と火災警報装置84とを備えている。赤外線通信ユニット83は後述するマーカーから送信される位置情報をコーディングした赤外線信号を受信可能であり、上記位置情報をデコードしてCPU11に送出可能となっている。火災警報装置84は使用者に対して火災の発生を警報により知らせることができるものであり、スピーカを備えている。音声やブザー音等を発することにより、使用者に火災発生を通知することができる。応答判断装置86は使用者が火災発生の有無を確認した後に操作されるスイッチを備えており、このスイッチが操作されることにより火災警報装置84は警報を停止させる。   The option unit 80 includes a communication unit as shown in FIG. In the present embodiment, an infrared communication unit 83 and a fire alarm device 84 are provided. The infrared communication unit 83 can receive an infrared signal in which position information transmitted from a marker described later is coded, and can decode the position information and send it to the CPU 11. The fire alarm device 84 can notify the user of the occurrence of a fire by an alarm, and includes a speaker. The user can be notified of the occurrence of a fire by emitting a sound, a buzzer sound, or the like. The response determination device 86 includes a switch that is operated after the user confirms whether or not a fire has occurred, and the fire alarm device 84 stops the alarm when the switch is operated.

図12は上記マーカー85の外観を示しており、外部には、液晶表示パネル85aと、十字キー85bと、決定キー85cと、戻るキー85dとを備えている。内部には、1チップマイクロコンピュータと赤外線送受信ユニットとバッテリーなどが備えられており、1チップマイクロコンピュータは、上記決定キー85cと戻るキー85dとの操作に応じて液晶表示パネル85aでの表示を制御させつつ、同操作に応じた設定パラメータを生成し、同設定パラメータに応じた位置情報を上記赤外線送受信ユニットから出力できるようになっている。本実施形態において設定できるのは、部屋番号「1〜7と廊下」、清掃選択の「する」「しない」、特別指定としての「EXIT(出口)」「ENT(入口)」「SP1(特別位置1)」「SP2(特別位置2)」「SP3(特別位置3)」「SP4(特別位置4)」である。以下の実施形態では、特別位置1〜4は出火原因となりうる火災監視対象物の所在地等であり、予め設定されている。なお、これらの設定に要するフローチャートは特別なものではなく当業者において通常の知識で生成可能なものである。   FIG. 12 shows the appearance of the marker 85, which includes a liquid crystal display panel 85a, a cross key 85b, an enter key 85c, and a return key 85d. Inside, a one-chip microcomputer, an infrared transmission / reception unit, a battery, and the like are provided. The one-chip microcomputer controls display on the liquid crystal display panel 85a in accordance with the operation of the determination key 85c and the return key 85d. In addition, setting parameters corresponding to the same operation are generated, and position information corresponding to the setting parameters can be output from the infrared transmission / reception unit. In this embodiment, the room numbers “1-7 and corridor”, cleaning selection “Yes”, “No”, “EXIT (exit)”, “ENT (entrance)”, “SP1 (special position) as special designations can be set. 1) "SP2 (special position 2)" SP3 (special position 3) "SP4 (special position 4)". In the following embodiments, the special positions 1 to 4 are locations of fire monitoring objects that can cause fire, and are set in advance. The flowchart required for these settings is not special and can be generated by those skilled in the art with ordinary knowledge.

次に、上記構成からなる自走式掃除機の動作について説明する。
(1)走行制御及び清掃動作について:
図8及び図9は上記CPU11が実行する制御プログラムに対応したフローチャートを示しており、図10は同制御プログラムに従って本自走式掃除機が走行する走行順路を示す図である。
Next, the operation of the self-propelled cleaner having the above configuration will be described.
(1) About travel control and cleaning operation:
8 and 9 are flowcharts corresponding to the control program executed by the CPU 11, and FIG. 10 is a diagram showing a traveling route on which the self-propelled cleaner travels according to the control program.

電源オンにより、CPU11は図8の走行制御を開始する。ステップS110ではAF用パッシブセンサ31の検知結果を入力し、前方エリアを監視する。前方エリアの監視に使用するのはAF用パッシブセンサ31FR,31FM,31FLの検知結果であり、平坦な床面であれば、その撮像イメージから得られるのは図5に示す斜め下方の床面までの距離L1である。それぞれのAF用パッシブセンサ31FR,31FM,31FLの検知結果に基づき、本体BD幅に一致する前方の床面が平坦であるか否かが判断できる。ただし、この時点では、各AF用パッシブセンサ31FR,31FM,31FLが対面している床位置と本体の直前位置までの間の情報は何も得られていないので死角となる。   When the power is turned on, the CPU 11 starts the traveling control shown in FIG. In step S110, the detection result of the AF passive sensor 31 is input, and the front area is monitored. The detection results of the AF passive sensors 31FR, 31FM, and 31FL are used for monitoring the front area. If the floor surface is flat, the captured image can be obtained up to the diagonally lower floor surface shown in FIG. Distance L1. Based on the detection results of the respective AF passive sensors 31FR, 31FM, and 31FL, it can be determined whether or not the front floor surface corresponding to the main body BD width is flat. However, at this time, no information is obtained between the floor position where each AF passive sensor 31FR, 31FM, 31FL is facing and the position immediately before the main body, so that it becomes a blind spot.

ステップS120ではモータドライバ41R,41Lを介して駆動輪モータ42R,42Lに対してそれぞれ回転方向を異にしつつ同回転量の駆動を指示する。これにより本体BDはその場で回転を始める。同じ場所での360度の回転(スピンターン)に要する駆動モータ42R,42Lの回転量は予め分かっており、CPU11は同回転量をモータドライバ41R,41Lに指示している。
スピンターン中、CPU11はAF用パッシブセンサ31R,31Lの検知結果を入力し、本体BDの直前位置の状況を判断する。上述した死角はこの間の検知結果により、ほぼなくなり、段差、障害物が何も無い場合、周囲の平坦な床面の存在を検知できる。
In step S120, the driving wheel motors 42R and 42L are instructed to drive the same amount of rotation through the motor drivers 41R and 41L while changing the rotation directions. Thereby, the main body BD starts rotating on the spot. The rotation amounts of the drive motors 42R and 42L required for 360-degree rotation (spin turn) at the same place are known in advance, and the CPU 11 instructs the motor drivers 41R and 41L to perform the rotation amounts.
During the spin turn, the CPU 11 inputs the detection results of the AF passive sensors 31R and 31L, and determines the status of the position immediately before the main body BD. The blind spot described above is almost eliminated by the detection result during this period, and when there is no step or obstacle, the presence of the surrounding flat floor surface can be detected.

ステップS130ではCPU11はモータドライバ41R,41Lを介して駆動輪モータ42R,42Lに対してそれぞれ同回転量の駆動を指示する。これにより本体BDは直進を開始する。直進中、CPU11はAF用パッシブセンサ31FR,31FM,31FLの検知結果を入力し、正面に障害物がいないか判断しながら前進する。そして、同検知結果から正面に障害物たる壁面が検知できたら、その壁面の所定距離だけ手前で停止する。   In step S130, the CPU 11 instructs the drive wheel motors 42R and 42L to drive the same rotation amount via the motor drivers 41R and 41L. As a result, the main body BD starts going straight. While traveling straight, the CPU 11 inputs detection results of the AF passive sensors 31FR, 31FM, 31FL, and moves forward while judging whether there is an obstacle in front. And if the wall surface which is an obstruction in the front is detected from the detection result, it will stop in front of the predetermined distance of the wall surface.

ステップS140では右に90度回転する。ステップS130で壁面の所定距離だけ手前で停止したが、この所定距離は本体BDが回転動作するときに同壁面に衝突せず、また、直前および左右の状況を判断するためのAF用パッシブセンサ31R,31Lが検知する本体幅の外側にあたる範囲の距離である。すなわち、ステップS130にてAF用パッシブセンサ31FR,31FM,31FLの検知結果に基づいて停止し、ステップS140にて90度回転するときには、少なくともAF用パッシブセンサ31Lが壁面の位置を検知できる程度の距離となるようにしている。また、90度回転するときには、上記AF用パッシブセンサ31R,31Lの検知結果に基づいて直前位置の状況を判断しておく。図10はこのようにしてたどり着いた平面図で見たときの部屋の左下角を清掃開始位置として清掃走行を開始する状況を示している。   In step S140, it is rotated 90 degrees to the right. In step S130, the actuator stops at a predetermined distance on the wall surface, but this predetermined distance does not collide with the wall surface when the main body BD rotates, and the AF passive sensor 31R for determining the immediately preceding and left and right situations. , 31L is a distance in a range corresponding to the outside of the body width detected. That is, the distance is such that at least the AF passive sensor 31L can detect the position of the wall surface when stopping based on the detection results of the AF passive sensors 31FR, 31FM, 31FL in step S130 and rotating 90 degrees in step S140. It is trying to become. Further, when rotating 90 degrees, the state of the immediately preceding position is determined based on the detection results of the AF passive sensors 31R and 31L. FIG. 10 shows a situation in which the cleaning travel is started with the lower left corner of the room when viewed in the plan view thus reached as the cleaning start position.

清掃走行開始位置へたどり着く方法はこれ以外にも各種の方法がある。壁面に当接する状況において右に90度回転するだけでは、最初の壁面の途中から始めることになることもあるため、図10に示すように左下角の最適位置にたどり着くのであれば、壁面に当接して左90度回転し、正面の壁面に当接するまで前進し、当接した時点で180度回転することも望ましい走行制御である。   There are various other methods for reaching the cleaning travel start position. If you rotate 90 degrees to the right while in contact with the wall surface, you may start from the middle of the first wall surface, so if you reach the optimal position in the lower left corner as shown in FIG. It is also desirable travel control to rotate 90 degrees to the left, move forward until it contacts the front wall surface, and rotate 180 degrees when contacted.

ステップS150では、清掃走行を実施する。同清掃走行のより詳細なフローを図9に示している。前進走行するにあたり、ステップS210〜S240にて各種のセンサの検知結果を入力している。ステップS210では前方監視センサデータ入力しており、具体的にはAF用パッシブセンサ31FR,31FM,31FL,31CLの検知結果を入力し、走行範囲の前方に障害物あるいは壁面が存在しないか否かの判断に供することになる。なお、前方監視という場合には、広い意味での天井の監視も含めている。   In step S150, cleaning travel is performed. A more detailed flow of the cleaning traveling is shown in FIG. When traveling forward, detection results of various sensors are input in steps S210 to S240. In step S210, forward monitoring sensor data is input. Specifically, detection results of AF passive sensors 31FR, 31FM, 31FL, and 31CL are input, and whether or not an obstacle or a wall surface exists in front of the traveling range. It will be used for judgment. In addition, in the case of forward monitoring, monitoring of the ceiling in a broad sense is included.

ステップS220では段差センサデータ入力をしており、具体的にはAF用パッシブセンサ31R,31Lの検知結果を入力し、走行範囲の直前位置に段差がないか否かの判断に供することになる。また、壁面や障害物に沿って平行に移動するときには壁面や障害物までの距離を計測し、平行に移動しているか否かの判断に供することになる。   In step S220, step sensor data is input. Specifically, the detection results of the AF passive sensors 31R and 31L are input and used to determine whether or not there is a step immediately before the travel range. In addition, when moving in parallel along the wall surface or obstacle, the distance to the wall surface or obstacle is measured and used to determine whether the object is moving in parallel.

ステップS230では地磁気センサデータ入力をしており、具体的には地磁気センサ43の検知結果を入力し、直進走行中に走行方向が変化していないか否かを判断するのに利用する。例えば、清掃走行開始時の地磁気の角度を記憶しておき、走行中に検出される角度が記憶されている角度と異なった場合には、左右の駆動輪モータ42R,42Lの回転量をわずかに異ならせて進行方向を修正し、元の角度へ戻す。例えば、地磁気の角度に基づいて角度が増加する方向へ変化(359度から0度への変化は例外点となる))したら左方向へ軌道を修正する必要があり、右の駆動輪モータ42Rの回転量を左の駆動輪モータ42Lの回転量よりも僅かに増やすようにそれぞれのモータドライバ41R,41Lへ駆動を制御する指示を出力する。   In step S230, geomagnetic sensor data is input. Specifically, the detection result of the geomagnetic sensor 43 is input and used to determine whether or not the traveling direction has changed during straight traveling. For example, the geomagnetic angle at the start of cleaning traveling is stored, and if the angle detected during traveling is different from the stored angle, the rotational amounts of the left and right drive wheel motors 42R, 42L are slightly increased. Correct the direction of travel by making it different, and return to the original angle. For example, if the angle changes in a direction in which the angle increases based on the angle of geomagnetism (change from 359 degrees to 0 degrees is an exception), the trajectory needs to be corrected in the left direction, and the right drive wheel motor 42R Instructions for controlling the drive are output to the respective motor drivers 41R and 41L so that the rotation amount is slightly increased from the rotation amount of the left drive wheel motor 42L.

ステップS240では、加速度センサデータ入力をしており、具体的には加速度センサ44の検知結果を入力し、走行状態の確認に供することになる。例えば、直進走行開始時に概ね一定の方向への加速度を検知できれば正常な走行と判断できるが、回転する加速度を検知すれば片方の駆動輪モータが駆動されていないような異常を判断できる。また、正常な範囲の加速度値を超えたら段差などから落下したり、横転したような異常を判断できる。そして、前進中に後方にあたる方向への大きな加速度を検知したら前方の障害物に当接した異常を判断できる。このように、加速度値を入力して目標加速度を維持するとか、その積分値に基づいて速度を得るというような走行に対する直接的な制御をすることはないが、異常検出の目的として加速度値を有効に利用している。   In step S240, acceleration sensor data is input. Specifically, the detection result of the acceleration sensor 44 is input and used for checking the running state. For example, normal acceleration can be determined if acceleration in a substantially constant direction can be detected at the start of straight traveling, but abnormality such that one of the drive wheel motors is not driven can be determined by detecting rotating acceleration. In addition, when the acceleration value exceeds the normal range, it is possible to determine an abnormality such as a fall from a step or a rollover. And if the big acceleration to the direction which hits back is detected during advance, the abnormality which contact | abutted the front obstacle can be judged. In this way, there is no direct control over traveling such as inputting the acceleration value to maintain the target acceleration or obtaining the speed based on the integral value, but the acceleration value is used for the purpose of detecting an abnormality. We use effectively.

ステップS250では、ステップS210とステップS220で入力したAF用パッシブセンサ31FR,31FM,31CL,31FL,31R,31Lの検知結果に基づいて障害物の判定を行う。障害物の判定は、正面、天井、直前のそれぞれの部位毎に行う。正面は障害物あるいは壁面の意味として判定し、直前は段差の判定とともに走行範囲外の左右の状況、例えば壁面の有無などを判定する。天井は鴨居などによって天井までの距離が下がってきているときに正面に障害物がないとしても、そこからは廊下であって室外に出てしまうことを判定するのに利用される。   In step S250, the obstacle is determined based on the detection results of the AF passive sensors 31FR, 31FM, 31CL, 31FL, 31R, and 31L input in steps S210 and S220. Obstacles are determined for each of the front, ceiling, and immediately preceding parts. The front is determined as the meaning of an obstacle or a wall, and immediately before the step is determined, the right and left conditions outside the traveling range, for example, the presence or absence of a wall are determined. Even if there is no obstacle in the front when the distance to the ceiling is decreasing due to a duck or the like, the ceiling is used to determine that it is a corridor and goes out of the room.

ステップS260では、各センサからの検知結果を総合的に判断し、回避の必要があるか否かを判断する。回避の必要がない限りステップS270の清掃処理を実行する。清掃処理は、サイドブラシとメインブラシを回転させつつ、ゴミを吸引する処理であり、具体的にはモータドライバ53R,53L,54,56に各モータ51R,51L,52,55を駆動させる指示を出力する。むろん、走行中は常に同指示を出しているのであり、後述するように清掃走行の終端条件が成立したときに停止させることになる。   In step S260, the detection result from each sensor is comprehensively determined to determine whether or not it is necessary to avoid it. Unless there is a need for avoidance, the cleaning process in step S270 is executed. The cleaning process is a process of sucking dust while rotating the side brush and the main brush. Specifically, the motor drivers 53R, 53L, 54, and 56 are instructed to drive the motors 51R, 51L, 52, and 55. Output. Of course, the same instruction is always issued during traveling, and the vehicle is stopped when the termination condition for cleaning traveling is satisfied, as will be described later.

一方、回避が必要と判断されると、ステップS280にて右に90度ターンを実施する。このターンは同じ位置での90度ターンであり、モータドライバ41R,41Lを介して駆動輪モータ42R,42Lに対してそれぞれ回転方向を異にしつつ90度ターンに必要なだけの回転量の駆動を指示する。回転方向は右の駆動輪に対して後退の方向であり、左の駆動輪に対して前進の方向となる。回転中は段差センサであるAF用パッシブセンサ31R,31Lの検知結果を入力し、障害物の状況を判断する。例えば、正面に障害を検知し、右90度ターンを実施したとき、AF用パッシブセンサ31Rが前方右方の直前位置に壁面を検知しなければ単に正面の壁面に当接したといえるが、回転後も前方右方の直前位置に壁面を検知しているのであれば、角部に入り込んでいるといったことが判断できる。また、右90度回転時にAF用パッシブセンサ31R,31Lのいずれもが前方直前に障害を検知しなければ、壁面に当接したのではなく、小さな障害物などであったと判断できる。   On the other hand, if it is determined that avoidance is necessary, a 90 degree turn to the right is performed in step S280. This turn is a 90-degree turn at the same position, and drives the rotation amount necessary for the 90-degree turn while changing the rotation direction with respect to the drive wheel motors 42R and 42L via the motor drivers 41R and 41L. Instruct. The rotation direction is the backward direction with respect to the right drive wheel, and the forward direction with respect to the left drive wheel. During the rotation, the detection results of the AF passive sensors 31R and 31L, which are step sensors, are input to determine the state of the obstacle. For example, when an obstacle is detected on the front and a 90-degree turn to the right is performed, if the AF passive sensor 31R does not detect the wall surface immediately before the front right, it can be said that it is simply in contact with the front wall surface. After that, if the wall surface is detected at a position immediately before the right front side, it can be determined that the wall has entered the corner. Further, if neither of the AF passive sensors 31R, 31L detects an obstacle immediately before the rotation when rotating 90 degrees to the right, it can be determined that the obstacle is not a contact with the wall surface but a small obstacle.

ステップS290では障害物を走査しながらの進路変更のため前進する。壁面に当接し、右90度回転後、前進していく。壁面の手前で停止したのであれば、前進の走行量は概ね本体BDの幅分である。その分の前進後、ステップS300では再度右90度ターンを実施する。
以上の移動の間、正面の障害物、前方左右の障害物の有無は常に走査して状況を確認しており、部屋の中の障害物の有無の情報として記憶していく。
In step S290, the vehicle advances to change the course while scanning the obstacle. It abuts against the wall and rotates forward 90 degrees to the right. If stopped before the wall surface, the forward travel amount is approximately the width of the main body BD. After advance by that amount, in step S300, the right 90 degree turn is performed again.
During the above movement, the presence or absence of front obstacles and front and right obstacles is always scanned to check the situation and stored as information on the presence or absence of obstacles in the room.

ところで、上述した説明では、右90度ターンを2度実行したが、次に前方に壁面を検知した時点で右90度ターンを実行すると元に戻ってしまうので、二度の90度ターンは、右を繰り返したら、次は左を繰り返し、その次は右というように交互に行っていく。従って、奇数回目の障害物回避では右ターン、偶数回目の障害物回避では左ターンとなる。   By the way, in the above description, the right 90 degree turn is executed twice. However, when the right 90 degree turn is executed next when the wall surface is detected forward, the turn returns to the original state. If you repeat the right, the next is the left, the next is the right, and so on. Therefore, a right turn is used for the odd-numbered obstacle avoidance and a left turn is used for the even-numbered obstacle avoidance.

以上のように障害物を回避しながら、部屋の中をつづら折り状に走査して清掃走行を継続していく。そして、部屋の終端にきたか否かをステップS310にて判断する。清掃走行の終端は、二度目のターン後に、壁面に沿って前進して清掃走行を実施し、その後で前方に障害物を検知した場合と、既に走行した部位に入り込んだ場合である。すなわち、前者はつづら折り状に走行していった最後の端から端への走行後に生じる終了条件であり、後者は後述するように未清掃エリアを発見して再度清掃走行を開始したときの終了条件になる。   As described above, the cleaning traveling is continued by scanning the room in a zigzag manner while avoiding the obstacles. Then, in step S310, it is determined whether or not the end of the room has been reached. The end of the cleaning travel is when the second turn is advanced along the wall surface to perform the cleaning travel, after which an obstacle is detected forward and when the vehicle has already traveled. That is, the former is an end condition that occurs after the last end-to-end travel that traveled in a zigzag manner, and the latter is an end condition that occurs when an uncleaned area is found and cleaning travel is started again as described later. become.

この終端条件が成立していなければ、ステップS210へ戻って以上の処理を繰り返す。終端条件が成立していれば、本清掃走行のサブルーチン処理を終了し、図8に示す処理へ復帰する。
復帰後、ステップS160では、これまでの走行経路と走行経路の周囲の状況から未清掃エリアが残っていないか判断する。未清掃エリアが見つかれば、ステップS170で未清掃エリアの開始点へと移動し、ステップS150に戻って清掃走行を再開する。
未清掃エリアが複数箇所に散在していたとしても、上述したような清掃走行の終端条件が成立するごとに、未清掃エリアの検出を繰り返していくことにより、最終的には未清掃エリアがなくなる。
If this termination condition is not satisfied, the process returns to step S210 and the above processing is repeated. If the termination condition is satisfied, the main cleaning traveling subroutine process is terminated, and the process returns to the process shown in FIG.
After returning, in step S160, it is determined whether or not an uncleaned area remains from the previous travel route and the situation around the travel route. If an uncleaned area is found, it moves to the starting point of an uncleaned area at step S170, returns to step S150, and restarts cleaning travel.
Even if the uncleaned areas are scattered in a plurality of places, the uncleaned areas are finally eliminated by repeating the detection of the uncleaned areas every time the termination condition of the cleaning traveling as described above is satisfied. .

(2)マッピングについて:
未清掃エリアの有無の判断は、各種の手法を利用可能であるが、本実施例においては、図13及び図14に示すマッピングの手法で実現する。
図13は、マッピングのフローチャートを示しており、図14は、マッピングの手法を説明する図である。この例では、上述したロータリーエンコーダの検知結果に基づいて室内での走行経路と、走行中に検出した壁面の有無を記憶領域に確保してあるマップ上に書き込んでいっており、周囲の壁面が途絶えることなく連続し、かつ、室内の存在していた障害物の周囲も連続し、かつ、室内で障害物を除く範囲を全て走行したか否かで判断する。
(2) About mapping:
Various methods can be used to determine the presence or absence of an uncleaned area. In this embodiment, the determination is realized by the mapping method shown in FIGS. 13 and 14.
FIG. 13 shows a flowchart of mapping, and FIG. 14 is a diagram for explaining a mapping method. In this example, based on the detection result of the rotary encoder described above, the indoor travel route and the presence or absence of wall surfaces detected during travel are written on a map secured in the storage area, and the surrounding wall surfaces are Judgment is made based on whether or not the vehicle travels continuously in a room without obstacles, and the surroundings of obstacles that existed in the room are also continuous, and the entire range excluding the obstacles is traveled indoors.

マッピングのデータベースは、x軸とy軸でアドレス指定可能な二次元のデータベースであり、(1,1)を室内の角部であるスタート地点とし、(n,0)(0,m)については仮の壁面を表している。本体BDの走行に伴って、本体BDの大きさ30cm×30cmを単位エリアとして未走行エリア、掃除完了エリア、壁、障害物の区分をして室内をマッピングしていく。   The mapping database is a two-dimensional database that can be addressed on the x-axis and y-axis, with (1, 1) as the starting point that is the corner of the room, and (n, 0) (0, m) It represents a temporary wall surface. As the body BD travels, the room is mapped by dividing the non-running area, the cleaning completion area, the walls, and the obstacles by using the size 30 cm × 30 cm of the body BD as a unit area.

ステップS400では、スタートポイントのフラグを書き込む。図14に示すように、スタートポイント(1,1)は部屋の角部である。360度スピンターンし、後方と左方に壁面が存在することを確認し、それぞれの単位エリア(1,0)、(0,1)に対して壁のフラグを書き込み(1)、壁と壁の交点(0,0)に対してさらに壁のフラグを書き込む(2)。ステップS402では本体BDの前方に障害があるか否かを判断し、前方に障害がなければステップS404にて単位エリアだけ前進する。この前進は実際には上述した清掃を伴う前進であり、具体的には清掃に伴う移動中にロータリーエンコーダの出力から単位エリア分だけ移動したときに同期して本マッピング処理が並行して行われることになる。   In step S400, a start point flag is written. As shown in FIG. 14, the start point (1, 1) is the corner of the room. Make a 360 degree spin turn, confirm that there are walls on the back and left, and write wall flags for each unit area (1, 0), (0, 1) (1). Further, a wall flag is written to the intersection (0, 0) of (2). In step S402, it is determined whether or not there is a failure in front of the main body BD. If there is no failure in front, the unit advances in unit area in step S404. This advancement is actually the advancement with the cleaning described above. Specifically, this mapping process is performed in parallel when moving by the unit area from the output of the rotary encoder during the movement accompanying the cleaning. It will be.

一方、前方に障害があると判断されたときは、ステップS406にてターン方向に障害があるか判断する。障害の回避は、90度ターンと前進と90度ターンで行うことにしている。ターン方向は、上述したように左と右を2度つつ繰り返して順次変更するようにしている。次の回避のためのターンが右方向であるとすると、前方に障害があるとき、右方向に進んでターンできるか否かを判断することになる。最初の頃は右方向は未清掃エリアであって、ターン方向に障害がないものと判断し、ステップS408にて通常回避運動を行う。   On the other hand, if it is determined that there is an obstacle ahead, it is determined in step S406 whether there is an obstacle in the turn direction. Obstacles are avoided by turning 90 degrees, moving forward, and turning 90 degrees. As described above, the turn direction is sequentially changed by repeating the left and right twice. Assuming that the next turn for avoidance is in the right direction, when there is an obstacle ahead, it is determined whether or not the turn can proceed in the right direction. At the beginning, it is determined that the right direction is an uncleaned area and there is no obstacle in the turn direction, and a normal avoidance exercise is performed in step S408.

これらの移動後、ステップS410では走行した経路の単位エリアに走行部位フラグを書き込む。走行したということは掃除をしたということなので、清掃完了エリアを表すフラグを書き込む。ステップS412では周囲の壁面の状況を周壁フラグとして各単位エリア毎に書き込む。単位エリア(1,1)から、単位エリア(1,2)へ移動したとき、AF用パッシブセンサ31R,31Lの検知結果に基づき、(0,1)、(2,1)の単位エリアについて壁か否かの判断が可能であり、単位エリア(0,1)については壁を表すフラグを書き込み、単位エリア(2,1)については壁がない未走行かつ未清掃を表すフラグを書き込める。   After these movements, a travel part flag is written in the unit area of the traveled route in step S410. Since traveling means that cleaning has been performed, a flag indicating a cleaning completion area is written. In step S412, the status of the surrounding wall surface is written for each unit area as a peripheral wall flag. When moving from the unit area (1,1) to the unit area (1,2), based on the detection results of the AF passive sensors 31R, 31L, the walls of the unit areas (0,1), (2,1) The unit area (0, 1) can be written with a flag indicating a wall, and the unit area (2, 1) can be written with a flag indicating no running and no cleaning.

一方、単位エリア(1,20)では前方に障害を検出され、二度の90度ターンと前進とで単位エリア(2,20)へ移動しつつ進行方向は180度反転した。このときは、単位エリア(0,20)、(2,20)、(1,21)、(2,21)のそれぞれについてフラグを書き込む(4)ことができる。また、単位エリア(0,21)については壁と壁の交点であるととの判断に基づき、壁を表すフラグを書き込む(5)。なお、走行済みかつ清掃済みの領域も障害として扱う。   On the other hand, in the unit area (1, 20), a failure was detected forward, and the traveling direction was reversed 180 degrees while moving to the unit area (2, 20) by two 90 degree turns and forward movement. At this time, flags can be written (4) for each of the unit areas (0, 20), (2, 20), (1, 21), and (2, 21). For the unit area (0, 21), a flag representing the wall is written based on the determination that the intersection is between the walls (5). In addition, the run and cleaned area is also treated as an obstacle.

前進をするとき、単位エリア(3,10)と単位エリア(3,11)では右方向に障害物を検知し、その時点では障害物のフラグを書き込む(6)。なお、単位エリア(3,1)〜(3,9)の移動時、進行方向右側には未走行かつ未清掃のエリアを検知しており、これらを表すフラグを書き込んでいる。同様に、後で単位エリア(8,9)〜(8,1)を移動する時、進行方向右側には未走行かつ未清掃のエリアを検知し、これらを表すフラグを書き込むことになる。   When moving forward, in the unit area (3, 10) and the unit area (3, 11), an obstacle is detected in the right direction, and an obstacle flag is written at that time (6). When the unit areas (3, 1) to (3, 9) are moved, an untraveled and uncleaned area is detected on the right side in the traveling direction, and a flag representing these is written. Similarly, when the unit areas (8, 9) to (8, 1) are moved later, a non-running and uncleaned area is detected on the right side in the traveling direction, and a flag representing these is written.

また、単位エリア(4,12)では前方に障害物を検知して回避運動を行うが、このときは単位エリア(4,11)に障害物のフラグを書き込んであるので、移動に伴って単位エリア(4,11)には障害物のフラグを書き込む。   Further, in the unit area (4, 12), an obstacle is detected ahead and an avoidance exercise is performed. At this time, the obstacle flag is written in the unit area (4, 11). An obstacle flag is written in the area (4, 11).

ステップS414では走行した単位エリアにおいて上述したマーカー85から位置情報の通信を行ったか否かを判断し、マーカーとの通信を行ったときにはステップS416にてマーカーから得た情報に基づくフラグを書き込む。例えば、ユーザーが避難口を指定するためにマーカー85の操作キー85b〜85dで操作して特定の単位エリアに置いてあったとすると、本体BDが同単位エリアを通過するときに赤外線通信ユニット83にて同位置情報を取得するので、当該単位エリアには避難口を表すフラグを書き込む。   In step S414, it is determined whether or not position information has been communicated from the marker 85 described above in the traveled unit area. When communication with the marker is performed, a flag based on the information obtained from the marker is written in step S416. For example, if the user operates the operation keys 85b to 85d of the marker 85 to place an evacuation exit and puts it in a specific unit area, when the main body BD passes the same unit area, the infrared communication unit 83 Since the same position information is acquired, a flag indicating an evacuation exit is written in the unit area.

前進や回避運動を繰り返し、単位エリア(10,20)では進行方向左方に障害を発見する。この場合は、単位エリア(10,21)が連続する壁と判断されているので、単位エリア(11,20)について壁を表すフラグを書き込み(4)、次いで交点(11,21)についても壁を表すフラグを書き込む(5)。   Repeating forward and avoidance movements, the unit area (10, 20) finds an obstacle to the left in the direction of travel. In this case, since the unit area (10, 21) is determined to be a continuous wall, a flag representing the wall is written for the unit area (11, 20) (4), and then the intersection (11, 21) is also a wall. Is written (5).

前進や回避運動を繰り返す結果、単位エリア(10,1)では前方に障害を発見し、かつ、ターン方向にも障害があると判断される。従って、この場合はステップS418にて終端か否かを判断する。なお、単位エリア(10,1)については、前方の障害と進行方向左方に壁を発見する(7)(8)。   As a result of repeating the forward movement and the avoidance movement, it is determined that the unit area (10, 1) finds an obstacle ahead and also has an obstacle in the turn direction. Therefore, in this case, it is determined in step S418 whether or not the end is reached. As for the unit area (10, 1), the front obstacle and the wall on the left side in the traveling direction are found (7) (8).

終端か否かは、未走行かつ未清掃を表すフラグが書き込まれている単位エリアがあるか否かが第一の判断項目となる。未走行かつ未清掃を表すフラグが書き込まれている単位エリアが発見されなくなった場合には、スタートポイントで書き込んだ壁のフラグが連続して一周しているか判断する。一周していれば、室内をX方向とY方向にスキャンしてフラグが書き込まれていない領域を探す。なお、障害物と判断した領域についても壁と同様に一連続した領域として判断して障害物の検出の完了となる。   Whether or not it is the end is a first determination item whether or not there is a unit area in which a flag indicating unrunning and uncleaning is written. When a unit area in which a flag indicating unrun and unclean is written is no longer found, it is determined whether or not the wall flag written at the start point makes one round. If the circuit has made a round, the room is scanned in the X and Y directions to find an area where no flag is written. Note that the area determined to be an obstacle is also determined as a continuous area in the same manner as the wall, and the detection of the obstacle is completed.

終端でない場合は、ステップS420にて未走行エリアを検出し、ステップS422にて未走行エリアのスタートポイントへ移動し、上述した処理を繰り返す。そして、最終的に終端と判断されれば、マッピング処理を完了する。マッピングの完了時には室内の壁と走行エリアが一目瞭然となっており、これを各部屋の地図情報として利用する。   If it is not the end, a non-running area is detected in step S420, and it moves to the start point of the non-running area in step S422, and the above-described processing is repeated. Then, if it is finally determined that it is the end, the mapping process is completed. When the mapping is completed, the walls and the running area in the room are obvious and are used as map information for each room.

全部屋と廊下について以上のマッピング処理を完了し、廊下などについては各部屋への入口をマーカー85にて指定しておく。図15は各部屋と廊下のそれぞれで形成した地図情報を連結する手法を示している。全部屋と廊下について、各部屋の部屋番号(1〜3)と出入口(E)と、廊下からの各部屋への入口(1〜3)などを指定しておくことにより、各部屋毎に得られた地図情報は平面的に連結することができる。   The above mapping process is completed for all rooms and corridors, and the entrance to each room is designated by a marker 85 for the corridors and the like. FIG. 15 shows a method of connecting the map information formed in each room and corridor. All rooms and corridors can be obtained for each room by specifying the room number (1-3) and entrance (E) of each room and the entrance (1-3) to each room from the corridor. The obtained map information can be connected in a plane.

(3)火災監視処理について:
図16は火災監視時刻と火災監視対象の設定画面を示している。
操作用スイッチ15aと液晶表示パネル15bを操作し、火災監視をする時刻とともに、各監視時にどの火災監視対象の所在地へ赴くかを指定する。巡回する時刻は5回まで設定でき、火災監視対象の所在地についてはマーカー85の特別位置SP1〜SP4により、4個の所在地まで設定できるようになっている。時刻の前に付している○と×は、それぞれの時刻の巡回を行うか否かを表している。図16に示す例では、時刻7時00分に1個目の火災監視対象と2個目の火災監視対象の所在地へ赴き、時刻12時00分に1個目の火災監視対象の所在地へ赴き、時刻19時00分に2個目の火災監視対象の所在地へ赴く設定を表している。なお、巡回時刻の設定に伴い、時計機能を備えていることはいうまでもない。
時刻の設定、及び巡回火災監視対象の指定のためのプログラムは当業者が通常の能力で実現しうるフローチャートに従って処理される。
(3) About fire monitoring processing:
FIG. 16 shows a fire monitoring time and fire monitoring target setting screen.
The operation switch 15a and the liquid crystal display panel 15b are operated, and the fire monitoring target location is designated at the time of each monitoring as well as the time of fire monitoring. The traveling time can be set up to five times, and the locations to be monitored by the fire can be set up to four locations by the special positions SP1 to SP4 of the marker 85. O and X attached to the front of the time indicate whether or not the time is circulated. In the example shown in FIG. 16, the first fire monitoring target and the second fire monitoring target are visited at the time 7:00, and the first fire monitoring target is visited at the time 12:00. , Represents a setting to go to the second fire monitoring target location at 19:00. Needless to say, a clock function is provided along with the setting of the tour time.
A program for setting the time and designating the target of the cyclic fire monitoring is processed in accordance with a flowchart that can be realized by a person skilled in the art with ordinary capabilities.

図17は火災監視処理の流れを示している。 操作パネルユニット15からの指示により、本処理の実施が指示されると、ステップS440では現在時刻とタイマーのセット時刻とを対比してタイマーセット時刻か否かを判断し、タイマーセット時刻であれば、以下の処理を実行する。
ステップS442では現在位置を保存する。ここで保存しておくことにより、最後の火災監視対象の所在地へ赴いた後で、現在地に戻ることができる。
FIG. 17 shows the flow of the fire monitoring process. When execution of this processing is instructed by an instruction from the operation panel unit 15, in step S440, it is determined whether or not it is a timer set time by comparing the current time with the timer set time. The following processing is executed.
In step S442, the current position is stored. By saving it here, you can return to your current location after visiting the last fire monitoring location.

ステップS444では巡回する火災監視対象の所在地を取得し、配列変数へ保存する。現在時刻が7:00であるとすると、図16に示すように巡回する火災監視対象は1個目と2個目である。従って、2個の火災監視対象の所在位置を取得し、配列変数へ保存する。配列変数へ保存することにより、変数nにより、順次巡回していくことが可能となる。このため、変数nに「1」をセットする。
ステップS446では、現在位置から配列変数に保存されているn番目の火災監視対象の所在位置への走行経路を求める。
In step S444, the location of the fire monitoring target to go around is acquired and stored in an array variable. Assuming that the current time is 7:00, the first and second fire monitoring targets to circulate are shown in FIG. Therefore, the locations of the two fire monitoring targets are acquired and stored in array variables. By storing the data in the array variable, it is possible to sequentially cycle through the variable n. Therefore, “1” is set to the variable n.
In step S446, a travel route from the current position to the location of the nth fire monitoring target stored in the array variable is obtained.

上述したように、地図情報が完備しているときは、現在位置からn番目の火災監視対象の所在位置への走行経路を探索することが可能となる。走行経路を得るのは公知の迷路の解答手法を採用可能である。例えば、右手法などによって進行方向に沿って常に右手を壁面に触れながら進行していくと、いずれ入口からゴールへとたどり着ける。その後、冗長な経路を順次消していく。例えば、180度ターンして戻ったところを順次消していく。また、室内であるので、コの字形のターンをしている部位を探し、障害がない限りターン部位を手前側にしていって経路を詰めていく。むろん、このように自動的に走行経路を求めるのではなく、ユーザーに対して走行経路を指示するインターフェイスを提供しても良い。   As described above, when the map information is complete, it is possible to search for a travel route from the current position to the nth fire monitoring target location. A known maze answering method can be used to obtain the travel route. For example, if you proceed while touching the wall with your right hand always along the direction of travel using the right method, you will eventually reach the goal from the entrance. Thereafter, the redundant paths are sequentially deleted. For example, turn back 180 degrees and erase the points that are returned. Also, since it is indoors, the part where the U-shaped turn is made is searched, and unless there is a failure, the turn part is set to the near side and the route is narrowed down. Of course, instead of automatically obtaining the travel route in this way, an interface for instructing the travel route to the user may be provided.

このようにして現在位置から火災監視対象の所在位置への走行経路が求められた後、ステップS448にて同走行経路に沿って移動する。移動の完了後、ステップS500では駆動および操舵を停止した状態で火災検出処理を実行する。図18は、火災検出処理の流れを示している。同図において、ステップS505ではAF用パッシブセンサ31CLにおけるモニターセル31b3を利用して明るさを取得する。なお、明るさを測定する前にモニターセル31b3に蓄積した電荷は予め排出する。ステップS510では、AF用パッシブセンサ31CLにおけるCCDラインセンサ31b1により正面前方の撮像を行う。撮像する前にCCDラインセンサ31b1に蓄積した電荷は予め排出する。そして、ステップS515においてはCCDラインセンサ31b1の各撮像画素に蓄積された電荷から各撮像画素に対応する色を特定する。すなわち、明るさ−色−電荷テーブルT2を参照することにより、各撮像画素に蓄積された電荷に基づいて色を特定する。このとき、もう一方のCCDラインセンサ31b2においても撮像を行い、測炬を行うようにしても良い。   In this way, after the travel route from the current position to the location to be monitored by fire is obtained, the vehicle travels along the travel route in step S448. After the movement is completed, in step S500, the fire detection process is executed with the driving and steering stopped. FIG. 18 shows the flow of the fire detection process. In step S505, the brightness is acquired using the monitor cell 31b3 in the AF passive sensor 31CL. The charge accumulated in the monitor cell 31b3 before measuring the brightness is discharged in advance. In step S510, imaging in front of the front is performed by the CCD line sensor 31b1 in the AF passive sensor 31CL. The charges accumulated in the CCD line sensor 31b1 before imaging are discharged in advance. In step S515, the color corresponding to each imaging pixel is specified from the charge accumulated in each imaging pixel of the CCD line sensor 31b1. That is, by referring to the brightness-color-charge table T2, the color is specified based on the charge accumulated in each imaging pixel. At this time, the other CCD line sensor 31b2 may also perform imaging and measure.

ステップS520では、CCDラインセンサ31b1の全撮像画素のなかから、ステップS515において炎色を示すと判断された撮像画素を、炎を受像した撮像画素として検出する。なお、ここでいう炎色は予め定義されており、例えば赤色やオレンジ色等とすることができる。むろん、燃焼物によって炎の色は異なるため、他の色を炎色として定義することも可能である。なお、明るさ−色−電荷テーブルT2を参照することにより、炎色に対応する電荷の値域も図4に示すように明るさに応じて変動する。すなわち、炎以外の周辺の外部光源からモニターセル31b3に入射される光の光量に応じて炎色に対応する電荷の値域も変動する。   In step S520, from among all the imaging pixels of the CCD line sensor 31b1, the imaging pixel determined to show the flame color in step S515 is detected as the imaging pixel that has received the flame. In addition, the flame color here is defined in advance, and can be, for example, red or orange. Of course, since the color of the flame differs depending on the combustion product, it is possible to define other colors as flame colors. By referring to the brightness-color-charge table T2, the charge range corresponding to the flame color also varies according to the brightness as shown in FIG. That is, the charge range corresponding to the flame color also varies according to the amount of light incident on the monitor cell 31b3 from a peripheral external light source other than the flame.

例えば、平均的に明るい環境においては、同じ炎の色でも炎以外の外部光源から入射する光量が多いために蓄積される電荷も多くなる傾向となるが、それに応じて炎色に対応する電荷の値域も多めにシフトされるため、適正に炎色を判定することができる。逆に、平均的に暗い環境においては、同じ炎の色でも炎以外の外部光源から入射する光量が少ないために蓄積される電荷も少なくなる傾向となるが、それに応じて炎色に対応する電荷の値域も少なめにシフトされるため、適正に炎色を判定することができる。すなわち、炎以外の外部の光源の光量に依存することなく、正確に炎色を判断することが可能となっている。   For example, in an average bright environment, even if the flame color is the same, there is a tendency for the accumulated charge to increase due to the large amount of light incident from an external light source other than the flame. Since the value range is shifted too much, the flame color can be determined appropriately. Conversely, in an average dark environment, even if the color of the flame is the same, there is a tendency for the accumulated charge to decrease due to the small amount of light incident from an external light source other than the flame, but the charge corresponding to the flame color accordingly. Since the value range of is shifted slightly, the flame color can be properly determined. That is, it is possible to accurately determine the flame color without depending on the light amount of an external light source other than the flame.

また、炎が明るければ、炎から放射された光線が屋内で反射してモニターセル31b3に入射する反射光の光量も多くなる。すなわち、モニターセル31b3にて測定される光量によって、炎自体の明るさも、おおよそ予測することが可能であると言える。従って、炎自体が明るい場合には、同じ炎の色でも暗い場合よりも電荷が蓄積されやすいが、モニターセル31b3にて測定された明るさに応じて炎色に対応する電荷の値域も多めにシフトされるため、適正に炎色を判定することができる。例えば、図4において、明るさ50%における緑色光に対応する電荷の量の値域と、明るさ100%におけるオレンジ色光に対応する電荷の量の値域とが同等となっており、CCDラインセンサ31b1に蓄積された電荷のみでいずれの色の光を受像しているか判断することができない。しかし、予めモニターセル31bにて明るさが分かっているため、該当する明るさにおける色の値域を適用することができる。なお、本実施形態においては、一定時間に蓄積される電荷の量に基づいて色および明るさを判定しているが、一定の電荷が蓄積されるまでの所要時間によって色および明るさを判定するようにしても良い。   Also, if the flame is bright, the amount of reflected light incident on the monitor cell 31b3 is increased when the light emitted from the flame is reflected indoors. That is, it can be said that the brightness of the flame itself can be roughly predicted by the amount of light measured by the monitor cell 31b3. Therefore, when the flame itself is bright, charges are more likely to be accumulated in the same flame color than when it is dark, but the charge value range corresponding to the flame color is larger depending on the brightness measured by the monitor cell 31b3. Since it is shifted, the flame color can be properly determined. For example, in FIG. 4, the value range of the amount of charge corresponding to green light at a brightness of 50% is equal to the value range of the amount of charge corresponding to orange light at a brightness of 100%, and the CCD line sensor 31b1. It is impossible to determine which color of light is received by only the electric charge accumulated in. However, since the brightness is known in advance in the monitor cell 31b, the color value range at the corresponding brightness can be applied. In the present embodiment, the color and brightness are determined based on the amount of charge accumulated in a certain time, but the color and brightness are determined based on the time required until the certain charge is accumulated. You may do it.

ステップS520にて炎色を示す撮像画素が存在すると判定されると、ステップS525で30秒待機する。すなわち、この間にCCDラインセンサ31b1の視野が変動しないように、駆動および操舵を停止させる。そして、ステップS530では、ステップS510〜S525にわたって一定に保持された視野を再度CCDラインセンサ31b1によって撮像する。   If it is determined in step S520 that there is an imaging pixel that indicates flame color, the process waits for 30 seconds in step S525. That is, driving and steering are stopped so that the visual field of the CCD line sensor 31b1 does not fluctuate during this time. In step S530, the visual field held constant over steps S510 to S525 is imaged again by the CCD line sensor 31b1.

ステップS535において、ステップS515において炎色を示すと判定された画素領域に増減がないかどうかを判定する。図19は、CCDラインセンサ31b1による撮像イメージを模式的に示している。同図上段はステップS510における撮像イメージを示し、同図下段はステップ530における撮像イメージを示している。また、炎と赤色の置物が撮像対象として撮像されているものとする。CCDラインセンサ31b1において示すセルは各撮像画素を示しており、斜線で示すセルは炎色(赤色からオレンジ色)に対応する電荷が蓄積された撮像画素を示している。   In step S535, it is determined whether or not there is any increase or decrease in the pixel area determined to show the flame color in step S515. FIG. 19 schematically shows an image captured by the CCD line sensor 31b1. The upper part of the figure shows the captured image in step S510, and the lower part of the figure shows the captured image in step 530. Further, it is assumed that a flame and a red figurine are imaged as imaging targets. The cells shown in the CCD line sensor 31b1 indicate the respective imaging pixels, and the cells indicated by diagonal lines indicate the imaging pixels in which charges corresponding to the flame color (red to orange) are accumulated.

上段においてCCDラインセンサ31b1における炎と赤色の置物に対応するアドレスの撮像画素が炎色を示している。下段においては炎が拡大しており、炎を受像した撮像画素の画素領域Bも拡大している。一方、赤色の置物を示す撮像画素の画素領域Aは変動していない。ステップS535では、画素領域BのようにステップS510とステップS530の間に変動(増加・減少)する画素領域を検出する。そして、炎を示す画素領域が変動したと判断するとステップS540にて火災が発生したと判断する。一方、画素領域AのようにステップS510とステップS530との間で変動がないもののみである場合には、ステップS545にて火災の発生がないと判断する。   In the upper stage, the image pickup pixel of the address corresponding to the flame and red figurine in the CCD line sensor 31b1 shows the flame color. In the lower stage, the flame is enlarged, and the pixel region B of the imaging pixel that has received the flame is also enlarged. On the other hand, the pixel area A of the imaging pixel indicating the red figurine is not changed. In step S535, a pixel area that fluctuates (increases or decreases) between step S510 and step S530, such as the pixel area B, is detected. If it is determined that the pixel area indicating the flame has changed, it is determined in step S540 that a fire has occurred. On the other hand, if there is only a pixel region A that does not vary between step S510 and step S530, it is determined in step S545 that there is no fire.

すなわち、炎は常に形状を変えることから、炎色を示す画素領域が変動するかどうかによって炎の存在を判定することができる。従って、偶然、炎色を示す物が視野内に存在する場合であっても、火災のみを検出することができる。一方、ステップS520にて炎色を示す撮像画素が検出されない場合には、火災が発生している可能性がないため、ステップS545にて火災の発生がないと判断する。なお、より正確に火災を検出するために、ステップS525,S530を複数回繰り返すことにより、多くの撮像結果から炎の変動を確認するようにしても良い。むろん、撮像のインターバルも30秒に限られるものでもない。   That is, since the flame always changes its shape, the presence of the flame can be determined based on whether the pixel area indicating the flame color changes. Therefore, even if an object that shows flame color is present in the field of view, only a fire can be detected. On the other hand, if no imaging pixel indicating a flame color is detected in step S520, there is no possibility that a fire has occurred, so it is determined in step S545 that there is no fire. In order to detect a fire more accurately, steps S525 and S530 may be repeated a plurality of times to check the fluctuation of the flame from many imaging results. Of course, the imaging interval is not limited to 30 seconds.

ステップS456では、以上説明した火災検出処理の結果を認識し、火災の発生があった場合には、ステップS453にて警報を発する。この警報は、オプションユニット80に備えられた火災警報装置84により行われる。火災警報装置84が警報を発するにあたっては音声やブザー音等を発することにより、使用者に火災発生を通知する。また、警報の開始とともに自走式掃除機は駆動輪モータ42R,42Lの駆動を開始し、各部屋を巡回する。このようにすることにより、どの部屋に使用者がいても確実に火災発生を通知することができる。   In step S456, the result of the fire detection process described above is recognized, and if a fire has occurred, an alarm is issued in step S453. This alarm is performed by a fire alarm device 84 provided in the option unit 80. When the fire alarm device 84 issues an alarm, the user is notified of the occurrence of a fire by generating a sound, a buzzer sound, or the like. In addition, the self-propelled cleaner starts driving the drive wheel motors 42R and 42L with the start of the alarm and goes around each room. In this way, it is possible to reliably notify the occurrence of a fire regardless of which room the user is in.

一方、火災が検出されなかった場合には、ステップS454にて変数nをインクリメントし、ステップS455にて同変数の値から巡回が終わりか否かを判断する。すなわち、ステップS444にて取得した火災監視対象の所在地の数よりも多くなっていれば火災監視は終わりであり、ステップS456ではステップS442にて保存しておいた最初の現在位置へ戻る。一方、終わりでなければ、ステップS446に戻り、この時点での現在位置から次の火災監視対象の所在位置への走行経路を求めることになる。   On the other hand, if no fire is detected, the variable n is incremented in step S454, and it is determined in step S455 whether or not the circulation is completed from the value of the variable. That is, if the number of fire monitoring target locations acquired in step S444 is greater, the fire monitoring ends, and in step S456, the process returns to the first current position stored in step S442. On the other hand, if it is not the end, the process returns to step S446, and a travel route from the current position at this point to the next position to be monitored for fire is obtained.

以上においては火災監視処理を独立した処理として行うものとしているが、通常の清掃動作中に火災を監視するようにしても良い。すなわち、ステップS520にて炎色を示す撮像画素を検出する際に必要なデータは、モニターセル31b3からの明るさデータとCCDラインセンサ31b1からの電荷のデータであり、通常の走行時にも取得することが可能なデータである。特に、障害物を回避するためにCCDラインセンサ31b1は断続的に撮像を実行している。従って、通常の動作の際に付随的に火災を監視することも可能である。通常動作時に炎色が検出された場合には、検出された同時に駆動および操舵をさせ、視野を変動させることなく再度撮像を行うようにすればよい。   In the above description, the fire monitoring process is performed as an independent process, but the fire may be monitored during a normal cleaning operation. In other words, the data necessary for detecting the imaging pixel indicating the flame color in step S520 is the brightness data from the monitor cell 31b3 and the charge data from the CCD line sensor 31b1, which are also acquired during normal travel. It is possible data. In particular, the CCD line sensor 31b1 intermittently performs imaging to avoid obstacles. Therefore, it is possible to monitor fire incidentally during normal operation. If a flame color is detected during normal operation, driving and steering may be performed at the same time, and imaging may be performed again without changing the field of view.

また、モニターセル31b3の代わりに照度計を備えることにより、明るさを取得するようにしても良い。さらに、モニターセル31b3による明るさ測定を、より正確に行うため、モニターセル31b3が明るさを測定するために撮像する範囲を所定の位置に規定するようにしても良い。すなわち、モニターセル31b3が明るさを検出するにあたっては、撮像された範囲の色がノイズとなるため、ある一定の色を有する位置を撮像することにより、正確に明るさを測定することができる。例えば、モニターセル31b3が明るさを検出する場合には、毎回、白色の壁に正面が対向するように自走式掃除機を駆動・停止させることにより、色によるノイズの影響を受けることなく明るさを測定することができる。むろん、その場合は白色の壁を撮像して得られた明るさデータに基づいて明るさ−色−電荷テーブルT2が作成されていることが前提となる。   Moreover, you may make it acquire brightness by providing an illuminometer instead of the monitor cell 31b3. Further, in order to more accurately measure the brightness by the monitor cell 31b3, a range in which the monitor cell 31b3 captures an image for measuring the brightness may be defined at a predetermined position. That is, when the monitor cell 31b3 detects the brightness, the color in the captured range becomes noise, so that the brightness can be accurately measured by imaging a position having a certain color. For example, when the monitor cell 31b3 detects brightness, the self-propelled cleaner is driven and stopped so that the front faces the white wall each time, so that the brightness is not affected by noise due to color. Can be measured. Of course, in that case, it is assumed that the brightness-color-charge table T2 is created based on the brightness data obtained by imaging the white wall.

さらに、モニターセル31b3による明るさ測定においては、あくまでも照明や日光等による外部に依存する明るさが測定される。しかしながら、炎は、自らが発光しているのであり、外部の明るさに依存度することなく特定の光量で特定波長の光線を発しているものと考えることができる。従って、明るさ測定を行うことが好ましいが、必ずしも明るさ測定を行わなくても本発明を実現することは可能である。また、炎は可視光以外の光線も放射するため、炎の色に拘泥されることなく、蓄積された電荷のみに基づいて炎を検出するようにしても良い。この場合、炎から放射される光線のエネルギーに応じて蓄積される電荷の値域は、予め炎を撮像した実験に基づいて用意されることが望ましい。   Further, in the brightness measurement by the monitor cell 31b3, the brightness depending on the outside due to illumination, sunlight or the like is only measured. However, it can be considered that the flame itself emits light and emits a light beam having a specific wavelength with a specific light amount without depending on external brightness. Therefore, although it is preferable to perform brightness measurement, the present invention can be realized without necessarily performing brightness measurement. In addition, since the flame also emits light rays other than visible light, the flame may be detected based only on the accumulated charge without being bound by the color of the flame. In this case, it is desirable that the range of the charge accumulated according to the energy of the light emitted from the flame is prepared based on an experiment in which the flame is imaged in advance.

この場合、ステップS515にて、炎を撮像したときに蓄積される電荷の取り得る値域を規定したテーブルを参照することにより、炎の有無を検出することができる。すなわち、本発明において必ずしも写像の色が特定されている必要はなく、少なくとも写像が炎に対応した電荷を生成させたかどうかが判定できれば良い。ただし、この場合であっても光路における外部光の影響は避けられないため、明るさごとに異なる値域が規定されたテーブルを用意しておくことが望ましい。さらに、火災監視対象によって予め実験を行う炎を異なる物としても良い。例えば、火災監視対象がキッチンである場合に、ガスを燃焼させた炎を撮像した結果に基づいたテーブルを参照するようにしても良い。   In this case, in step S515, it is possible to detect the presence or absence of a flame by referring to a table that defines a range in which charges accumulated when a flame is imaged can be taken. That is, in the present invention, it is not always necessary to specify the color of the mapping, and it is sufficient that at least whether the mapping generates a charge corresponding to the flame can be determined. However, even in this case, the influence of external light on the optical path is unavoidable, so it is desirable to prepare a table in which different value ranges are defined for each brightness. Furthermore, it is good also considering the flame which performs an experiment beforehand by a fire monitoring object as a different thing. For example, when the fire monitoring target is a kitchen, a table based on a result of imaging a flame in which gas is burned may be referred to.

以上説明したように、本発明によれば自走式掃除機に備えられる測距用のAF用パッシブセンサ31CLを利用して炎の検出を行うことができる。従って、火災検出用のカメラ等を新たに搭載する必要がなくて済む。また、AF用パッシブセンサ31CLにより少なくとも2回以上(ステップS510,S530)撮像を行い、炎に対応する撮像画素領域の増減を判断基準としているため、炎のみを確実に検出することができる。従って、炎に似た色の障害物を炎として検出してしまうこともない。   As described above, according to the present invention, flame detection can be performed using the AF passive sensor 31CL for distance measurement provided in the self-propelled cleaner. Therefore, there is no need to newly install a fire detection camera or the like. In addition, since the AF passive sensor 31CL performs imaging at least twice (steps S510 and S530) and uses the increase / decrease in the imaging pixel area corresponding to the flame as a criterion, it is possible to reliably detect only the flame. Therefore, an obstacle having a color similar to a flame is not detected as a flame.

本発明にかかる自走式掃除機の概略構成を示すブロック図である。It is a block diagram which shows schematic structure of the self-propelled cleaner concerning this invention. 同自走式掃除機のより詳細なブロック図である。It is a more detailed block diagram of the self-propelled cleaner. AF用パッシブセンサのブロック図である。It is a block diagram of a passive sensor for AF. 明るさと色と電荷の関係を示すグラフである。It is a graph which shows the relationship between brightness, a color, and an electric charge. AF用パッシブセンサを床面に対して斜め下方に配向した場合における床面の状況と測距距離の変化の状況を示す説明図である。It is explanatory drawing which shows the condition of the floor surface condition, and the change of ranging distance when the passive sensor for AF is oriented obliquely downward with respect to the floor surface. 直前位置用のAF用パッシブセンサを床面に対して斜め下方に配向した場合における撮像範囲の測距距離を示す説明図である。It is explanatory drawing which shows the ranging distance of the imaging range in case the passive sensor for AF for immediately before positions is orientated diagonally downward with respect to the floor surface. それぞれのAF用パッシブセンサの配置位置と測距部位を示す図である。It is a figure which shows the arrangement position and ranging part of each passive sensor for AF. 走行制御のフローチャートである。It is a flowchart of traveling control. 清掃走行のフローチャートである。It is a flowchart of cleaning travel. 室内の走行経路を示す図である。It is a figure which shows the indoor traveling route. オプションユニットの構成を示す図である。It is a figure which shows the structure of an option unit. マーカーの外観を示すである。It is an appearance of a marker. マッピング処理のフローチャートである。It is a flowchart of a mapping process. マッピングを説明する図である。It is a figure explaining mapping. マッピング後に各部屋の地図情報を連結する手法を説明する図である。It is a figure explaining the method of connecting the map information of each room after mapping. 火災監視時刻と火災監視対象の設定画面を示す図である。It is a figure which shows the setting screen of fire monitoring time and a fire monitoring object. 火災監視処理のフローチャートである。It is a flowchart of a fire monitoring process. 火災検出処理のフローチャートである。It is a flowchart of a fire detection process. 火災検出処理の様子を示す模式図である。It is a schematic diagram which shows the mode of a fire detection process.

符号の説明Explanation of symbols

10…制御ユニット
20…人体感知ユニット
30…障害物監視ユニット
40…走行系ユニット
50…クリーナ系ユニット
60…カメラ系ユニット
70…無線LANユニット
80…オプションユニット
DESCRIPTION OF SYMBOLS 10 ... Control unit 20 ... Human body detection unit 30 ... Obstacle monitoring unit 40 ... Traveling system unit 50 ... Cleaner system unit 60 ... Camera system unit 70 ... Wireless LAN unit 80 ... Option unit

Claims (7)

掃除機構を備えた本体と、障害物との距離を検出する測距機構と、同測距機構により測定された距離に基づいて操舵と駆動を実現する駆動機構とを備える自走式掃除機において、
上記測距機構は、
それぞれ複数の撮像画素によって構成され、異なる位置に備えられた2個以上のCCDラインセンサにおける撮像ずれから上記障害物との距離を測定する測距手段と、
上記CCDラインセンサの各撮像画素に蓄積される電荷の蓄積度合いを取得し、同取得した蓄積度合いが炎に対応する値域となる撮像画素を、炎を受像した撮像画素として検出する炎検出手段と、
明るさを取得する明るさ検出手段と、
同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる値域変動手段と、
上記炎検出手段により炎を受像した撮像画素が検出されたとき、上記駆動機構による操舵および駆動を停止させるとともに、上記CCDラインセンサにより再度撮像し、その撮像結果から炎を受像した撮像画素領域の変動を検出する火災検出手段と、
上記火災検出手段が炎を受像した撮像画素領域の変動を認識したとき、上記駆動機構に操舵および駆動を行わせつつ、警報を発する警報手段とを具備することを特徴とする自走式掃除機。
In a self-propelled cleaner comprising a main body having a cleaning mechanism, a distance measuring mechanism for detecting a distance from an obstacle, and a drive mechanism for realizing steering and driving based on the distance measured by the distance measuring mechanism. ,
The distance measuring mechanism is
Ranging means for measuring the distance to the obstacle from imaging deviations in two or more CCD line sensors each constituted by a plurality of imaging pixels and provided at different positions;
Flame detection means for acquiring an accumulation degree of charge accumulated in each imaging pixel of the CCD line sensor and detecting an imaging pixel in which the obtained accumulation degree is in a value range corresponding to a flame as an imaging pixel receiving a flame; ,
Brightness detection means for acquiring brightness;
Value range changing means for changing the value range corresponding to the flame according to the brightness acquired by the brightness detection means;
When the imaging pixel that has received the flame is detected by the flame detection means, the steering and driving by the drive mechanism are stopped, and the CCD line sensor captures the image again, and the imaging pixel area that has received the flame from the imaging result Fire detection means for detecting fluctuations;
A self-propelled cleaner, comprising: an alarm unit that issues an alarm while causing the drive mechanism to perform steering and driving when the fire detection unit recognizes a change in an imaging pixel region that has received a flame. .
掃除機構を備えた本体と、障害物との距離を検出する測距機構と、同測距機構により測定された距離に基づいて操舵と駆動を実現する駆動機構とを備える自走式掃除機において、
上記測距機構は、
それぞれ複数の撮像画素によって構成され、異なる位置に備えられた2個以上のラインセンサにおける撮像ずれから上記障害物との距離を測定する測距手段と、
上記ラインセンサによる撮像結果から炎を受像した撮像画素を検出する炎検出手段と、
上記炎検出手段により炎を受像した撮像画素が検出されたとき、上記ラインセンサにより再度撮像し、その撮像結果から炎を受像した撮像画素領域の変動を検出する火災検出手段と、
上記火災検出手段が炎を受像した撮像画素領域の変動を認識したとき、警報を発する警報手段とを具備することを特徴とする自走式掃除機。
In a self-propelled cleaner comprising a main body having a cleaning mechanism, a distance measuring mechanism for detecting a distance from an obstacle, and a drive mechanism for realizing steering and driving based on the distance measured by the distance measuring mechanism. ,
The distance measuring mechanism is
Ranging means for measuring the distance from the obstacle from imaging deviations in two or more line sensors each composed of a plurality of imaging pixels and provided at different positions;
Flame detection means for detecting an imaging pixel that has received a flame from the imaging result of the line sensor;
When an image pickup pixel that has received a flame is detected by the flame detection unit, a fire detection unit that takes an image again by the line sensor and detects a change in an image pickup pixel region that has received the flame from the image pickup result;
A self-propelled cleaner, comprising: an alarm unit that issues an alarm when the fire detection unit recognizes a change in an imaging pixel region that has received a flame.
上記炎検出手段は、
上記ラインセンサに蓄積される電荷の蓄積度合いを取得し、同取得した蓄積度合いが炎に対応する値域となる撮像画素を、炎を受像した撮像画素として検出することを特徴とする請求項2に記載の自走式掃除機。
The flame detection means is
3. The image sensor according to claim 2, wherein an accumulation degree of the electric charge accumulated in the line sensor is acquired, and an imaging pixel in which the obtained accumulation degree is in a value range corresponding to the flame is detected as an imaging pixel receiving the flame. The self-propelled vacuum cleaner described.
明るさを取得する明るさ検出手段と、
同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる値域変動手段とを具備することを特徴とする請求項3に記載の自走式掃除機。
Brightness detection means for acquiring brightness;
4. The self-propelled cleaner according to claim 3, further comprising a value range changing means for changing the value range corresponding to the flame according to the brightness acquired by the brightness detecting means.
上記駆動機構は、上記炎検出手段が炎を検出した後、上記火災検出手段が再度の撮像を完了させるまで操舵および駆動を停止させることを特徴とする請求項2から請求項4のいずれかに記載の自走式掃除機。   5. The drive mechanism according to claim 2, wherein the drive mechanism stops steering and drive until the fire detection unit completes another imaging after the flame detection unit detects the flame. The self-propelled vacuum cleaner described. 上記ラインセンサは、CCDセンサであることを特徴とする請求項2から請求項5のいずれかに記載の自走式掃除機。   The self-propelled cleaner according to any one of claims 2 to 5, wherein the line sensor is a CCD sensor. 上記警報手段は、上記駆動機構に上記自走式掃除機の操舵および駆動を行わせつつ、警報を発することを特徴とする請求項2から請求項6のいずれかに記載の自走式掃除機。   The self-propelled cleaner according to any one of claims 2 to 6, wherein the alarm means issues an alarm while causing the drive mechanism to steer and drive the self-propelled cleaner. .
JP2004188370A 2004-06-25 2004-06-25 Self-propelled cleaner Withdrawn JP2006011845A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2004188370A JP2006011845A (en) 2004-06-25 2004-06-25 Self-propelled cleaner

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2004188370A JP2006011845A (en) 2004-06-25 2004-06-25 Self-propelled cleaner

Publications (1)

Publication Number Publication Date
JP2006011845A true JP2006011845A (en) 2006-01-12

Family

ID=35779043

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2004188370A Withdrawn JP2006011845A (en) 2004-06-25 2004-06-25 Self-propelled cleaner

Country Status (1)

Country Link
JP (1) JP2006011845A (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2081003A1 (en) * 2008-01-21 2009-07-22 Sidacon Systemtechnik GmbH Detector for electromagnetic radiation emitted by flames, in particular for use in machine tools
JP2014085975A (en) * 2012-10-26 2014-05-12 Hochiki Corp Disaster prevention alarm system
CN105931418A (en) * 2016-07-11 2016-09-07 安徽升隆电气有限公司 Explosion-proofing infrared UV flame detector
JP2018532175A (en) * 2015-08-07 2018-11-01 フォルヴェルク・ウント・ツェーオー、インターホールディング・ゲーエムベーハーVorwerk & Compagnie Interholding Gesellshaft Mit Beschrankter Haftung Surface treatment equipment and base station

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2081003A1 (en) * 2008-01-21 2009-07-22 Sidacon Systemtechnik GmbH Detector for electromagnetic radiation emitted by flames, in particular for use in machine tools
JP2014085975A (en) * 2012-10-26 2014-05-12 Hochiki Corp Disaster prevention alarm system
JP2018532175A (en) * 2015-08-07 2018-11-01 フォルヴェルク・ウント・ツェーオー、インターホールディング・ゲーエムベーハーVorwerk & Compagnie Interholding Gesellshaft Mit Beschrankter Haftung Surface treatment equipment and base station
CN105931418A (en) * 2016-07-11 2016-09-07 安徽升隆电气有限公司 Explosion-proofing infrared UV flame detector

Similar Documents

Publication Publication Date Title
US20050234611A1 (en) Self-propelled cleaner
US20050273226A1 (en) Self-propelled cleaner
US20050237388A1 (en) Self-propelled cleaner with surveillance camera
JP2005296510A (en) Self-traveling vacuum cleaner with monitor camera
JP3832593B2 (en) Self-propelled vacuum cleaner
US20050212680A1 (en) Self-propelled cleaner
JP6752118B2 (en) Autonomous vehicle
US9456725B2 (en) Robot cleaner and control method thereof
JP7058067B2 (en) Autonomous vehicle
KR101771869B1 (en) Traveling body device
WO2018087952A1 (en) Electric vacuum cleaner
WO2017141536A1 (en) Autonomous travelling body
US20060047364A1 (en) Self-propelled cleaner
US20050166355A1 (en) Autonomous mobile robot cleaner
US20050171644A1 (en) Autonomous mobile robot cleaner
JP2005296511A (en) Self-propelled vacuum cleaner
US20050216122A1 (en) Self-propelled cleaner
JP2004148088A (en) Robot cleaner, system and control method therefor
JP2005230032A (en) Autonomous running robot cleaner
JP2006007368A (en) Self-propelled vacuum cleaner
JP2019103618A (en) Vacuum cleaner
JP2005216022A (en) Autonomous run robot cleaner
JP2006095005A (en) Self-propelled vacuum cleaner
JP2007148591A (en) Self-propelled cleaner
JP3721939B2 (en) Mobile work robot

Legal Events

Date Code Title Description
RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20051221

A761 Written withdrawal of application

Free format text: JAPANESE INTERMEDIATE CODE: A761

Effective date: 20060915