JP2006011845A - Self-propelled cleaner - Google Patents
Self-propelled cleaner Download PDFInfo
- 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
Links
Images
Landscapes
- Electric Suction Cleaners (AREA)
- Fire-Detection Mechanisms (AREA)
- Alarm Systems (AREA)
Abstract
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参照。)。 かかる構成によれば、炎の位置変化の空間周波数特性に着目することにより、カラー画像データに含まれる炎の成分の検出を正確に行うことが可能であった。従って、カラー画像データにイルミネーション等の画像成分が含まれる場合であっても、火災の有無を正確に判定することができた。
しかしながら、上述した火災報知器は固定して設置されるため、視野が一定となる。従って、広範囲にわたって火災の監視を行うためには、複数のカラーカメラを設置しなければならない。この場合、カラーカメラの設置台数が増加し、設置コストが増加するという課題があたった。また、障害物等により死角が生じ、視野内であっても実質的に火災の監視を行うことができない部分が存在するという課題があった。 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
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
上記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
炎検出手段は、上記ラインセンサによる撮像結果から炎を受像した撮像画素を検出する。火災検出手段は、上記炎検出手段により炎を受像した撮像画素が検出されたとき、、上記ラインセンサにより再度撮像し、その撮像結果から炎を受像した撮像画素領域の変動を検出する。炎を受像した撮像画素領域の変動があった場合には、警報手段が警報を発する。 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
In the invention of
さらに、請求項4にかかる発明は、明るさを取得する明るさ検出手段と、同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる値域変動手段とを具備する構成としてある。
上記のように構成した請求項4の発明において、明るさ検出手段は、明るさを取得する。そして、値域変動手段は、同明るさ検出手段によって取得された明るさに応じて炎に対応する上記値域を変動させる。このようにすることにより、明るさに応じた上記閾値を設定することができる。
Further, the invention according to
In the invention of
また、請求項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
また、請求項6にかかる発明は、上記ラインセンサは、CCDセンサである構成としてある。
上記のように構成した請求項6の発明において、上記ラインセンサとしてCCDセンサを適用することも可能である。
According to a sixth aspect of the present invention, the line sensor is a CCD sensor.
In the invention of
また、請求項7にかかる発明は、上記警報手段は、上記駆動機構に上記自走式掃除機の操舵および駆動を行わせつつ、警報を発する構成としてある。
上記のように構成した請求項7の発明において、警報を発する際に、上記駆動機構により操舵および駆動を行うことにより、離れた位置にいる使用者にも近づいて警報を発することができる。
The invention according to
In the invention of
以上説明したように請求項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
Furthermore, according to the
さらに、請求項5にかかる発明によれば、同一視野にて炎の変動を比較することができる。
さらに、請求項6にかかる発明によれば、感度の良い撮像を行うことができる。
また、請求項7にかかる発明によれば、確実に火災の発生を知らせることができる。
Furthermore, according to the
Furthermore, according to the sixth aspect of the invention, it is possible to perform imaging with high sensitivity.
Moreover, according to the
図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
図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
また、バス14には操作パネルユニット15が備えられ、同操作パネルユニット15には、各種の操作用スイッチ15aと、液晶表示パネル15bと、表示用LED15cが備えられている。液晶表示パネルは多階調表示が可能なモノクロ液晶パネルを使用しているが、カラー液晶パネルなどを使用することも可能である。
The
本自走式掃除機はバッテリー17を有しており、CPU11はバッテリー監視回路16を介してバッテリー17の残量をモニター可能となっている。なお、同バッテリー17は誘導コイル18aを介して非接触で供給される電力を用いて充電する充電回路18を備えている。バッテリー監視回路16は主にバッテリー17の電圧を監視して残量を検知する。
This self-propelled cleaner has a battery 17, and the
人体感知ユニット20として、四つの人体センサ21(21fr,21rr,21fl,21rl)が前方左右斜め方向と後方左右斜め方向に対面させて備えられている。各人体センサ21は赤外線の受光センサを備えるとともに受光した赤外線の光量の変化に基づいて人体の有無を検知するものであり、変化する赤外線照射物体を検知したとき出力用のステータスを変化させるため、CPU11は上記バス14を介して同人体センサ21の検知を取得することが可能となっている。すなわち、CPU11は所定時間毎に各人体センサ21fr,21rr,21fl,21rlのステータスを取得しにいき、取得したステータスが変化していれば、同人体センサ21fr,21rr,21fl,21rlの対向方向に人体の存在を検知することが可能となる。
As the human
ここでは赤外線の光量変化に基づくセンサによって人体センサを構成しているが、人体センサはこれに限られるものではない。例えば、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
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
一方の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
様々な明るさにおいて、各色の被写体を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
なお、上述のとおり各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
図5は正面と前方左右直前の障害をAF用パッシブセンサ31で検知する際の原理を示している。これらのAF用パッシブセンサ31は周囲の床面に対して斜めに向けて配置されている。対向方向に障害物が無い場合、AF用パッシブセンサ31による測距距離はほぼ全撮像範囲においてL1となる。しかし、図面で一点鎖線で示すように段差がある場合、その測距距離はL2となる。測距距離が伸びたら下がる段差があると判断できる。また、二点鎖線で示すように上がる段差があれば測距距離はL3となる。障害物があるときも上がる段差と同様に測距距離は同障害物までの距離として計測され、床面よりも短くなる。
FIG. 5 shows the principle when the AF
本実施形態においては、AF用パッシブセンサ31を前方の床面に斜めに配向した場合、その撮像範囲は約10cmとなった。本自走式クリーナの幅が30cmであったので、三つのAF用パッシブセンサ31FR,31FM,31FLについては撮像範囲が重ならないように僅かに角度を変えて配置している。これにより、三つのAF用パッシブセンサ31FR,31FM,31FLにより前方方向の30cmの範囲での障害物と段差を検知できるようになっている。むろん、検知幅はセンサの仕様や取付位置などに応じて変化し、実際に必要となる幅に応じた数のセンサを利用すればよい。
In the present embodiment, when the AF
一方、前方左右直前の障害を検知するAF用パッシブセンサ31R,31Lについては撮像範囲を垂直方向を基準として床面に対して斜めに配置している。また、AF用パッシブセンサ31Rを本体左方に取り付けつつ本体中央を横切って右方直前位置から本体幅を超えた右方の範囲を撮像するように対向させてあり、AF用パッシブセンサ31Lを本体右方に取り付けつつ本体中央を横切って左方直前位置から本体幅を超えた左方の範囲を撮像するように対向させてある。
On the other hand, the AF
クロスさせないで左右の直前位置を撮影するようにすると、センサは急角度で床面に対面させなければならず、このようにすると撮像範囲が極めて狭くなってしまうので、複数のセンサが必要となる。このため、敢えてクロスさせる配置とし、撮像範囲を広げて少ない数のセンサで必要範囲をカバーできるようにしている。また、撮像範囲を垂直方向を基準として斜めに配置するのは、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
走行系ユニット40は、モータドライバ41R,41Lと、駆動輪モータ42R,42Lと、この駆動輪モータ42R,42Lにて駆動される図示しないギアユニットと駆動輪を備えている。駆動輪は本体BDの左右に一輪ずつ配置されており、この他に駆動源を持たない自由転動輪が本体の前方側中央下面に取り付けられている。駆動輪モータ42R,42Lは回転方向と回転角度をモータドライバ41R,41Lによって詳細に駆動可能であり、各モータドライバ41R,41LはCPU11からの制御指示に応じて対応する駆動信号を出力する。また、駆動輪モータ42R,42Lと一体的に取り付けられているロータリーエンコーダの出力から現実の駆動輪の回転方向と回転角度が正確に検知できるようになっている。なお、ロータリーエンコーダは駆動輪と直結させず、駆動輪の近傍に自由回転可能な従動輪を取り付け、同従動輪の回転量をフィードバックさせることによって駆動輪にスリップが生じているような場合でも現実の回転量を検知できるようにしても良い。走行系ユニット40には、この他に地磁気センサ43が備えられており、地磁気に照らし合わせて走行方向を判断できるようになっている。また、加速度センサ44はXYZ三軸方向における加速度を検知し、検知結果を出力する。
The
ギアユニットや駆動輪は各種のものを採用可能であり、円形のゴム製タイヤを駆動させるようにしたり、無端ベルトを駆動させるようにして実現しても良い。 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
カメラ系ユニット60は、それぞれ視野角の異なる二つのCMOSカメラ61,62を備えており、本体BDの正面方向であってそれぞれことなる仰角にセットされている。また、各カメラ61,62への撮像を指示するとともに撮像イメージを出力するためのカメラ通信I/O63も備えられている。さらに、カメラ61,62の撮像方向に対面させて15コの白色LEDからなるカメラ用照明LED64と、同LEDに照明用駆動電力を供給するためのLEDドライバ65を備えている。
The
無線LANユニット70は、無線LANモジュール71を有しており、CPU11は所定のプロトコルに従って外部LANと無線によって接続可能となっている。無線LANモジュール71は、図示しないアクセスポイントの存在を前提として、同アクセスポイントはルータなどを介して外部の広域ネットワーク(例えばインターネット)に接続可能な環境となっていることとする。従って、インターネットを介した通常のメールの送受信やWEBサイトの閲覧といったことが可能である。なお、無線LANモジュール71は、規格化されたカードスロットと、同スロットに接続される規格化された無線LANカードなどから構成されている。むろん、カードスロットは他の規格化されたカードを接続することも可能である。
The
オプションユニット80は、図11に示すように、通信ユニットなどからなる。本実施形態においては、赤外線通信ユニット83と火災警報装置84とを備えている。赤外線通信ユニット83は後述するマーカーから送信される位置情報をコーディングした赤外線信号を受信可能であり、上記位置情報をデコードしてCPU11に送出可能となっている。火災警報装置84は使用者に対して火災の発生を警報により知らせることができるものであり、スピーカを備えている。音声やブザー音等を発することにより、使用者に火災発生を通知することができる。応答判断装置86は使用者が火災発生の有無を確認した後に操作されるスイッチを備えており、このスイッチが操作されることにより火災警報装置84は警報を停止させる。
The
図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
次に、上記構成からなる自走式掃除機の動作について説明する。
(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
電源オンにより、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
ステップS120ではモータドライバ41R,41Lを介して駆動輪モータ42R,42Lに対してそれぞれ回転方向を異にしつつ同回転量の駆動を指示する。これにより本体BDはその場で回転を始める。同じ場所での360度の回転(スピンターン)に要する駆動モータ42R,42Lの回転量は予め分かっており、CPU11は同回転量をモータドライバ41R,41Lに指示している。
スピンターン中、CPU11はAF用パッシブセンサ31R,31Lの検知結果を入力し、本体BDの直前位置の状況を判断する。上述した死角はこの間の検知結果により、ほぼなくなり、段差、障害物が何も無い場合、周囲の平坦な床面の存在を検知できる。
In step S120, the
During the spin turn, the
ステップS130ではCPU11はモータドライバ41R,41Lを介して駆動輪モータ42R,42Lに対してそれぞれ同回転量の駆動を指示する。これにより本体BDは直進を開始する。直進中、CPU11はAF用パッシブセンサ31FR,31FM,31FLの検知結果を入力し、正面に障害物がいないか判断しながら前進する。そして、同検知結果から正面に障害物たる壁面が検知できたら、その壁面の所定距離だけ手前で停止する。
In step S130, the
ステップ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
清掃走行開始位置へたどり着く方法はこれ以外にも各種の方法がある。壁面に当接する状況において右に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
ステップS230では地磁気センサデータ入力をしており、具体的には地磁気センサ43の検知結果を入力し、直進走行中に走行方向が変化していないか否かを判断するのに利用する。例えば、清掃走行開始時の地磁気の角度を記憶しておき、走行中に検出される角度が記憶されている角度と異なった場合には、左右の駆動輪モータ42R,42Lの回転量をわずかに異ならせて進行方向を修正し、元の角度へ戻す。例えば、地磁気の角度に基づいて角度が増加する方向へ変化(359度から0度への変化は例外点となる))したら左方向へ軌道を修正する必要があり、右の駆動輪モータ42Rの回転量を左の駆動輪モータ42Lの回転量よりも僅かに増やすようにそれぞれのモータドライバ41R,41Lへ駆動を制御する指示を出力する。
In step S230, geomagnetic sensor data is input. Specifically, the detection result of the
ステップS240では、加速度センサデータ入力をしており、具体的には加速度センサ44の検知結果を入力し、走行状態の確認に供することになる。例えば、直進走行開始時に概ね一定の方向への加速度を検知できれば正常な走行と判断できるが、回転する加速度を検知すれば片方の駆動輪モータが駆動されていないような異常を判断できる。また、正常な範囲の加速度値を超えたら段差などから落下したり、横転したような異常を判断できる。そして、前進中に後方にあたる方向への大きな加速度を検知したら前方の障害物に当接した異常を判断できる。このように、加速度値を入力して目標加速度を維持するとか、その積分値に基づいて速度を得るというような走行に対する直接的な制御をすることはないが、異常検出の目的として加速度値を有効に利用している。
In step S240, acceleration sensor data is input. Specifically, the detection result of the
ステップ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
一方、回避が必要と判断されると、ステップ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
ステップ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
ステップ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
一方、単位エリア(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
前進や回避運動を繰り返し、単位エリア(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
(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
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
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
一方、火災が検出されなかった場合には、ステップ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.
10…制御ユニット
20…人体感知ユニット
30…障害物監視ユニット
40…走行系ユニット
50…クリーナ系ユニット
60…カメラ系ユニット
70…無線LANユニット
80…オプションユニット
DESCRIPTION OF
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.
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)
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 |
-
2004
- 2004-06-25 JP JP2004188370A patent/JP2006011845A/en not_active Withdrawn
Cited By (4)
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 |