自走式掃除機
【課題】タイルカーペットがひかれた部屋や１部分にだけ絨毯が敷かれている部屋でも効率良く清掃できる自走式掃除機を提供することを目的とする。
【解決手段】掃除機の本体１を移動させる駆動輪２と、清掃を行う清掃手段と、前記駆動輪２の駆動手段３を制御して本体の走行制御を行う走行制御手段８と、本体の方向を計測する方向計測手段１１と、本体に取り付けられ被掃除面を撮像するイメージセンサ１２と、このイメージセンサが撮像した画像を一時的に保持する画像保持部９と、この画像保持部の画像の変位を逐次検出する変位検知部１０とを具備し、前記方向計測手段１１の出力と前記変位検知部１０の出力により前記走行制御手段８が本体方向と直進進行方向が同一になるように走行を制御するようにした。
【解決手段】掃除機の本体１を移動させる駆動輪２と、清掃を行う清掃手段と、前記駆動輪２の駆動手段３を制御して本体の走行制御を行う走行制御手段８と、本体の方向を計測する方向計測手段１１と、本体に取り付けられ被掃除面を撮像するイメージセンサ１２と、このイメージセンサが撮像した画像を一時的に保持する画像保持部９と、この画像保持部の画像の変位を逐次検出する変位検知部１０とを具備し、前記方向計測手段１１の出力と前記変位検知部１０の出力により前記走行制御手段８が本体方向と直進進行方向が同一になるように走行を制御するようにした。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、自動的に床面などの被掃除面を清掃するようにした自走式掃除機に関するものである。
【背景技術】
【０００２】
近年、作業機器に走行駆動装置、センサ類、および走行制御手段などを付加して、自動的に作業を行う各種の移動作業ロボットが開発されている。
【０００３】
例えば、自走式掃除機は、清掃機能として本体底部に吸い込みノズルやブラシなどを備え、移動機能として走行および操舵手段と、走行時の障害物を検知する障害物検知手段と、位置を認識する位置認識手段とを備え、この障害物検知手段によって清掃場所の周囲の壁等に沿って移動しつつ、位置認識手段によって清掃区域を認識し、その清掃区域内を移動して清掃区域全体を清掃するものである（例えば、特許文献１参照）。
【０００４】
自走式掃除機に関連する絨毯目による影響について図６を参照しながら説明する。作業区域の床面が毛足の長いカットパイルカーペットなどのように、絨毯目の強い絨毯で、しかも絨毯目が直進方向と直角方向にある場合には、走行中に本体が徐々に絨毯目方向に流されるという現象が起こる。
【０００５】
（ａ）は絨毯のない平坦なベアフロア上で直進した場合の本体４１の移動軌跡を示す。このときは絨毯がないので、当然絨毯目の影響はなく、本体４１に移動軌跡は走行開始時の本体の方向と一致した直線ａになる。
【０００６】
しかしながら、（ｂ）に示すように床面を絨毯目が左から右の方向にある絨毯に変えて同条件で直進させると、本体は目標ラインＬ１に乗るように直進制御を行うが、実際の移動軌跡は、目標ラインＬ１の方向から右へ角度θだけ傾いた直線ｂになる。この横ずれの度合いを示す角度偏差θは絨毯によってほぼ固有であり数度程度である。
【０００７】
この絨毯固有の横ずれの度合いを示す角度偏差θは、本体に対して回転自由な支持軸と車輪からなる操舵手段の角度をもとに検出するものである。
【０００８】
ここで絨毯上を直進走行する場合の絨毯目の影響について図７を用いて説明する。
【０００９】
図７において、（ａ）は走行床面が絨毯のないベアフロアの場合の本体４１の移動軌跡を示す。
【００１０】
既に述べたように、このとき絨毯がないので当然絨毯目の影響はなく、本体４１は直進制御を行い、その移動軌跡は走行開始時の本体４１の方向と一致した直線ａになる。
【００１１】
しかしながら、（ｂ）に示すように、床面を絨毯目が左から右の方向にある絨毯に変えて同条件で直進走行させると、本体４１を目標ラインＬ１に乗るように直進制御しているにもかかわらず、実際の移動軌跡は目標ラインＬ１の方向から右へ角度θだけ傾いた直線ｂになる。
【００１２】
本体４１が絨毯上を直進走行する場合に、その直進距離に比例して本体４１が絨毯目の方向に横すべりする度合いを表す角度偏差θは、絨毯によってほぼ固有であり、数度程度であることがを確認しており、例えば（ｃ）に示すように角度偏差θを最初の走行時にあ
らかじめ測定した絨毯上で直進手段の目標ラインを走行開始時の方向から左に角度θ傾いた直線Ｌ２として（ｂ）と同条件で直進走行させると、そのときの移動軌跡は走行開始時の本体４１の方向と一致した直線ｃになる。
【００１３】
同様に（ｄ）に示すように、走行開始方向を（ｃ）と反対方向に直進走行させる場合には、直進手段の目標ラインを走行開始時の方向から右に角度θ傾いたＬ３として直進走行させれば、移動軌跡は走行開始時の本体４１の方向と一致した直線ｄになる。
【００１４】
このように、絨毯上を直進走行する場合は、絨毯目の方向とその目の強さに応じて直進する方向すなわち本体の方向を流される方向とは逆の方向に少し向かせることにより本体４１の移動軌跡を補正していた。
【特許文献１】特開平８−２２８９８０号公報
【発明の開示】
【発明が解決しようとする課題】
【００１５】
しかしながら、前記従来の構成では、機械的に操舵手段の車輪の角度を検出しようとするものであるため支持軸のガタや埃等による支持軸の固着が計測精度を悪くする原因となっていた。
【００１６】
さらに、従来の自走式掃除機の移動軌跡について図８を用いて説明すると、本体４１で清掃する床面が絨毯目が左から右にあるとする。
【００１７】
本体４１を開始点Ｓにおいてスタートすると、直進走行を開始し、図７の（ｂ）で示した場合と同様に、本体４１は走行開始時の方向に直進制御を行うが、実際の移動軌跡は絨毯目の影響で右にずれた方向に流される。
【００１８】
既に説明した様に、ずれ角度θは、本体に対して回転自由な支持軸と車輪からなる操舵手段の角度をもとに検出される。
【００１９】
前方の壁Ｗ１に近づくと、作業方向Ａの方向、すなわち本体４１の右方向へ所定の作業幅だけシフトし正確に１８０°反転する。
【００２０】
このとき、地点Ｐ１で反転開始するまでの操舵手段の車輪の角度を検出し平均値θを絨毯目によるずれ角度として記憶する。
【００２１】
地点Ｐ１での反転後、前回の往路で得たずれ角度θをもとに本体４１の方向を右へ角度θだけ傾けて直進を開始する。壁Ｗ２に近づいた地点Ｐ２でも作業方向Ａの方向すなわち本体４１の左方向へ所定の作業幅だけシフトし正確に１８０°反転する。
【００２２】
その後、今度は本体４１の方向を左へ角度θだけ傾けて直進を開始する。
【００２３】
以上の動作を繰り返し、点Ｆにきて壁Ｗ１を本体４１の前方で検知すると、このときは作業方向Ａ、すなわち本体４１の左方向には壁Ｗ３があるので清掃終了と判断し作業を終了する。
【００２４】
しかし、清掃を始めた直後の最初の直進は絨毯目の影響度合いが判らないため、補正ができず直進距離が大きいほど、すなわち図８の部屋が縦方向に長いほど未清掃の領域が左上の部分にできてしまっていた。
【００２５】
また、絨毯が１枚ものの絨毯ではなく、タイルカーペットで１枚ずつ目の方向を変えて
敷き詰めてある部屋や、部屋の１部分にだけ絨毯がある場合は、前述した従来の補正のやりかたは役に立たないものであった。
【００２６】
そこで本発明は、絨毯目による横ずれの角度偏差を機械的ではなく非接触な光学手段により検出し、かつ、補正値を最初の直線走行の時にだけ作成するのではなく、走行中に逐次、直線性を検知して走行制御にフィードバックすることで、タイルカーペットがひかれた部屋や１部分にだけ絨毯が敷かれている部屋でも効率良く清掃できる自走式掃除機を提供することを目的としている。
【課題を解決するための手段】
【００２７】
前記従来の課題を解決するために、本発明の自走式掃除機は、掃除機の本体を移動させる駆動輪と、前記駆動輪を駆動する駆動手段と、清掃を行う清掃手段と、前記駆動手段を制御して本体の走行制御を行う走行制御手段と、本体の方向を計測する方向計測手段と、本体に取り付けられ被掃除面を撮像するイメージセンサと、このイメージセンサが撮像した画像を一時的に保持する画像保持部と、この画像保持部の画像の変位を逐次検出する変位検知部とを具備し、前記方向計測手段の出力と前記変位検知部の出力により前記走行制御手段が本体方向と直進進行方向が同一になるように走行を制御するようにした。
【００２８】
これにより、機械的に操舵手段の車輪の角度を検出する場合にあった支持軸のガタや埃などによる支持軸の固着の課題がなくなり、精度良く絨毯目による横ずれの角度偏差を検出でき直進性の良い走行ができ、また、タイルカーペットがひかれた部屋や１部分にだけ絨毯が敷かれている部屋でも効率良く清掃できる自走式掃除機が提供される。
【発明の効果】
【００２９】
本発明の自走式掃除機は、光学的に非接触で絨毯目による横方向への流され度合いを検出するため、機械的に操舵手段の車輪の角度を検出する場合にあった支持軸のガタや埃等による支持軸の固着の課題がなくなり、精度良く絨毯目による横ずれの角度偏差を検出でき、さらに、走行中に逐次、直線性を検知して走行制御にフィードバックすることで、タイルカーペットがひかれた部屋や１部分にだけ絨毯が敷かれている部屋でも効率良く清掃できる。
【発明を実施するための最良の形態】
【００３０】
第１の発明は、掃除機の本体を移動させる駆動輪と、前記駆動輪を駆動する駆動手段と、清掃を行う清掃手段と、前記駆動手段を制御して本体の走行制御を行う走行制御手段と、本体の方向を計測する方向計測手段と、本体に取り付けられ被掃除面を撮像するイメージセンサと、このイメージセンサが撮像した画像を一時的に保持する画像保持部と、この画像保持部の画像の変位を逐次検出する変位検知部とを具備し、前記方向計測手段の出力と前記変位検知部の出力により前記走行制御手段が本体方向と直進進行方向が同一になるように走行を制御するようにしたものである。
【００３１】
したがって、絨毯目の有無や強さおよび目の方向がところどころで変わる部屋でも直進性よく走行し効率よく清掃できる。
【００３２】
第２の発明は、特に、前記第１の発明において、変位検知部の出力により横方向の画像の変位が最小になるように走行制御手段が走行を制御するようにしたもので、さらに効率良く走行できる。
【００３３】
第３の発明は、特に、前記第１または第２の発明において、本体から外部の物体までの距離を測定する測距手段と、測距センサの出力に基づいて障害物を検知する障害物検知手段と、この障害物検知手段の出力により本体の直進走行をＵターンさせる旋回手段とを有
し、旋回手段動作中は変位検知部の出力を無視するようにしたもので、Ｕターン時の変位検知誤りを回避でき、効率良く走行できる。
【００３４】
第４の発明は、特に、前記第３の発明において、旋回手段動作後安定して直進するまでは変位検知部の出力を無視するようにしたものであり、Ｕターン後の変位検知誤差を抑えることができ、効率良く走行できる。
【００３５】
第５の発明は、特に、前記第１〜４のいずれか一つ発明において、本体に光源を取り付け走行方向側の被掃除面を照射するようにして、さらに効率良く走行できるようにしたものである。
【００３６】
第６の発明は、特に、前記第１〜４のいずれか一つ発明において、本体後部に光源を取り付けて被掃除面の後方を照射するとともに、イメージセンサを本体の後部に取り付けて被掃除面の後方を撮像するようにしたことで、直進性よく走行させ効率よく清掃できる。
【００３７】
第７の発明は、特に、前記第５または６の発明において、被掃除面に写るレーザ光の輝点を基準に被掃除面画像の変位を検知するようにしたことで、明確なマーカを付加でき画像処理精度を高められ、さらに効率良く走行できる。
【００３８】
第８の発明は、特に、前記第１の発明において、走行制御手段は被掃除面画像の変位から走行速度を計測するようにしたことで、さらに効率良く走行できる。
【００３９】
以下、本発明の実施の形態について、図面を参照しながら説明する。なお、本実施の形態によって本発明が限定されるものではない。
【００４０】
（実施の形態１）
図１，２において、１は自走式掃除機の本体であり、高さ約２０ｃｍ、長さ約３０ｃｍ、幅約２５ｃｍの大きさのものである。
【００４１】
２は前記本体１を移動させる駆動輪、３は駆動手段であり、直流モータからなる。４は清掃手段で、床ノズル５ａ、ファンモータ５ｂ、ダストボックス６などからなる。
【００４２】
７は制御回路基板であり、マイクロコンピュータなどの電子回路とともに、走行制御手段８、画像保持手段９、変位検知手段１０なども搭載されている。
【００４３】
１１は方向計測手段であり、角速度を検知するジャイロセンサを用いている。１２はイメージセンサであり、斜め下方向に向けられ走行時の前方床面を撮像するようにしている。
【００４４】
このイメージセンサ１２の出力は画像保持手段９に接続されている。
【００４５】
１３は操作部で、本体１の運転を開始したり、停止したり、あるいは清掃モードを設定入力できる。
【００４６】
１４は電源スイッチ、１５はバンパーで、走行中に壁や家具に接触すると図示していないが本体１の内部にあるスイッチが入る構造になっており、接触を検知するものである。
【００４７】
１６は電池、１７ａ，１７ｂは右横方向にある家具や壁などとの距離を測る赤外線式の測距センサであり、横方向に２個付けることで壁に本体１が平行になるような制御をしやすいようにしている。１７ｃ，１７ｄは同じく赤外線式の測距センサであるが、前部に取
り付けられており、前進時に前方の障害物との衝突を避けられるよう前方向にある家具や壁などの障害物との距離を測るものである。
【００４８】
１７ｅ，１７ｆは左横方向にある家具や壁などとの距離を測る赤外線式の測距センサである。
【００４９】
方向計測手段１１、測距センサ１７ａ〜１７ｆ、方向計測手段１１、および画像保持手段９、この画像保持手段９の画像の変位を逐次検出する変位検知手段１０は走行制御手段８にその出力を入力している。
【００５０】
走行制御手段８は、これらのデータを判断して駆動輪２のモータ２Ｌ、２Ｒに制御信号を出力する。
【００５１】
本実施の形態では、このモータ２Ｌ，２Ｒの回転速度を制御することにより、左右の駆動輪２の回転速度を独立に制御し、本体１の駆動および操舵を行っている。
【００５２】
次にイメージセンサ１２で床面を撮像することによる動作を図３を用いて説明する。
【００５３】
図３において（ａ）および（ｂ）は絨毯上を走行したときのイメージセンサ１２で撮像した画像を保持する画像保持手段９の時刻Ｔ１と時刻Ｔ２のときの画像である。
【００５４】
１８はイメージセンサ１２が撮像した画像フレームである。イメージセンサ１２は約３０万画素のＣＣＤであり横６４０画素×縦４８０画素で構成され毎秒２４コマの画像を撮像できるものである。
【００５５】
ここで、模様Ａ〜模様Ｅは床面の木目、絨毯の毛の傾きのばらつき、絨毯の柄、ゴミなどイメージセンサ１２で撮像した時に濃淡模様として写るものである。
【００５６】
図３の（ｃ）は変位検知手段１０が検知した時刻Ｔ１から時刻Ｔ２のときの画像の変位ベクトルである。１９は変位検知手段１０の画像フレームである。
【００５７】
変位検知手段１０は２枚の画像の相関をとることにより床面の模様Ａ〜模様Ｅの変位が左斜め下方向にθずれていることを検知できる。
【００５８】
すなわち、時刻Ｔ２の画像を１画素分ずつ右または左や上にずらし、時刻Ｔ１の画像と重ね合わせて画面全体の明るさを計算していき、画面全体の明るさが一番明るい時の縦・横のずらし量から変位が検知できる。
【００５９】
例えば、時刻Ｔ２の画像を上に３０画素、右に１８画素ずらしたときの時刻Ｔ１の画像との重ね合わせ画像が一番明度が高ければ、横にずれた分は１８画素分となる。
【００６０】
次に、モータ２Ｌ，２Ｒの回転速度を制御して、横にずれた１８画素分左に戻るよう方向計測手段１１の出力をもとに本体方向を左に振れば元の直進コースに戻れる。
【００６１】
図では説明のために大きくずれているが、実際は２４分の１秒毎に画像を取り込み、逐次変位を算出し本体１の方向を方向計測手段１１の出力を見ながら制御している。
【００６２】
このように制御のフィードバック周期が短いため、本体１の振れは小さく、実走行では最初に定めた方向に本体１はまっすぐ向かい、絨毯目に流されること無く直進しているように見える。
【００６３】
図４は本実施の形態の走行制御手段８における制御のフローチャートである。
【００６４】
ステップ１では掃除機本体１が床に置かれ電源スイッチが入れられ、スタートボタンが押された後の処理である。
【００６５】
スタートボタンが押されたときの本体１の方向を直進の進行方向であるとして動作するため、最初に床に置かれている状態での方向計測手段１１の出力を記憶する。
【００６６】
ステップ２はイメージセンサ１２が撮像可能であるかを確認し、最新の画像が得られるまで待つ。
【００６７】
最新の画像が得られるとステップ３に移り、画像保持手段９に保存する。ステップ４では再度イメージセンサ１２が撮像可能であるかを確認し、最新の画像が得られるまで待つ。最新の画像が得られるとステップ５に移る。ステップ５ではステップ４で得られた最新の画像と画像保持手段９に保存されているひとつ前との画像の相関をとり、最新画像がひとつ前の画像から横方向にどれだけずれているかを検出する。
【００６８】
ステップ６ではステップ５で検出した横方向のずれ量をもとに本体１の方向の補正角度を算出する。ステップ７ではステップ６で算出した補正角度どおりに本体が方向を変えるようにモータ２Ｌ，２Ｒの回転速度を制御する。
【００６９】
ステップ８はステップ４で得られた最新の画像を画像保持手段９に保存する。ステップ９で前方に壁があればこの直進走行を終了する。
【００７０】
図５は直進走行を説明するもので、（ａ）はスタート時の位置である。絨毯目は右方向に向いている。
【００７１】
スタートすると絨毯目により本体１は（ｂ）に示すように本来の直線コースＬ１からやや右にそれる。ここで変位検出手段１０が横ずれを検知し、（ｃ）に示すように本体１の方向をやや左に向ける。その結果（ｄ）のＬ１に乗った位置に戻る。
【００７２】
その後（ｅ）のように本体１の方向も元のＬ１と同じ方向になる。（ｆ）はまた絨毯目に流され、以降（ｇ）〜（ｉ）は（ｃ）〜（ｅ）と同じ動作となる。復路も同様の動作をし、順番に右にシフトしていき部屋全体の掃除を完了する。
【００７３】
図では説明のために本体１が大きく振れているが、実際は逐次変位を算出し本体１の方向を細かく方向計測手段１１の出力を見ながら制御しているため、本体１の振れは小さく、実走行では最初に定めた方向に本体１はまっすぐ向かい、絨毯目に流されること無く直進しているように見える。
【００７４】
このように本実施の形態によれば、イメージセンサ１２で撮像した床面画像の横ずれ変位から逐次本体１の向きを修正するよう走行制御手段が制御し、その結果、方向計測手段の出力と変位検知部の出力により本体方向と直進進行方向が同一になるように走行制御され絨毯目の有無や強さおよび目の方向がところどころで変わる部屋でも直進性よく走行し効率よく清掃できる。
【００７５】
また、走行制御手段において変位検知部の出力により横方向の画像の変位が最小になるように走行制御するように方向の補正値を修正していけばさらに効率良く走行できる。
【００７６】
また、本体から外部の物体までの距離を測定する測距手段と、測距センサの出力に基づいて障害物を検知する障害物検知手段と、障害物検知手段の出力により本体の直進走行をＵターンしたときに、旋回中は変位検知部の出力を無視することでＵターン時の変位検知誤りを回避でき、効率良く走行できる。
【００７７】
また、Ｕターン後安定して直進するまでは変位検知部の出力を無視するようにすれば、Ｕターン後の変位検知誤差を抑えることができ、効率良く走行できる。
【００７８】
また、本体前部に光源を取り付け前方床面を照射すると床面の濃淡が明確になり画像処理精度が高まりさらに効率良く走行できる。
【００７９】
また、本体後部に光源を取り付け後方床面を照射しイメージセンサを本体の後部に取り付け後方床面を撮像するようにしても直進性良く走行し効率よく清掃できる。
【００８０】
また、レーザ光源を取り付け床面に写るレーザ光の輝点を基準に床面画像の変位を検知することで明確なマーカを付加でき画像処理精度を高められ、さらに効率良く走行できる。
【００８１】
また、床面画像の変位から走行制御手段にて走行速度を計測することでさらに効率良く走行できる。
【産業上の利用可能性】
【００８２】
以上のように、本発明にかかる自走式掃除機は、直進の目標方向に変位検知手段の出力に基づき修正を施すため精度良く絨毯目による横ずれを瞬時に検出して進行方向をすこし補正することで横ずれを回避でき、しかも機械的な構成物に頼らず非接触で床面の模様の流れを検知しているため、従来方式にあった支持軸へのほこり付着や支持軸のガタによる検知誤差などが起こり得ないものである。
【図面の簡単な説明】
【００８３】
【図１】本発明の実施の形態１を示す自走式掃除機の透視斜視図
【図２】同自走式掃除機の制御ブロック図
【図３】同自走式掃除機のイメージセンサの説明図
【図４】同自走式掃除機の制御方法を示すフローチャート
【図５】同自走式掃除機の動作説明図
【図６】従来の自走式掃除機の絨毯目の影響説明図
【図７】従来の自走式掃除機の絨毯目補正の動作説明図
【図８】従来の自走式掃除機の部屋内走行の動作説明図
【符号の説明】
【００８４】
１ 本体
２ 駆動輪
３ 駆動手段
４ 清掃手段
８ 走行制御手段
９ 画像保持手段
１０ 変位検知手段
１１ 方向計測手段
１２ イメージセンサ
１７ａ、１７ｂ、１７ｃ、１７ｄ 測距手段
【技術分野】
【０００１】
本発明は、自動的に床面などの被掃除面を清掃するようにした自走式掃除機に関するものである。
【背景技術】
【０００２】
近年、作業機器に走行駆動装置、センサ類、および走行制御手段などを付加して、自動的に作業を行う各種の移動作業ロボットが開発されている。
【０００３】
例えば、自走式掃除機は、清掃機能として本体底部に吸い込みノズルやブラシなどを備え、移動機能として走行および操舵手段と、走行時の障害物を検知する障害物検知手段と、位置を認識する位置認識手段とを備え、この障害物検知手段によって清掃場所の周囲の壁等に沿って移動しつつ、位置認識手段によって清掃区域を認識し、その清掃区域内を移動して清掃区域全体を清掃するものである（例えば、特許文献１参照）。
【０００４】
自走式掃除機に関連する絨毯目による影響について図６を参照しながら説明する。作業区域の床面が毛足の長いカットパイルカーペットなどのように、絨毯目の強い絨毯で、しかも絨毯目が直進方向と直角方向にある場合には、走行中に本体が徐々に絨毯目方向に流されるという現象が起こる。
【０００５】
（ａ）は絨毯のない平坦なベアフロア上で直進した場合の本体４１の移動軌跡を示す。このときは絨毯がないので、当然絨毯目の影響はなく、本体４１に移動軌跡は走行開始時の本体の方向と一致した直線ａになる。
【０００６】
しかしながら、（ｂ）に示すように床面を絨毯目が左から右の方向にある絨毯に変えて同条件で直進させると、本体は目標ラインＬ１に乗るように直進制御を行うが、実際の移動軌跡は、目標ラインＬ１の方向から右へ角度θだけ傾いた直線ｂになる。この横ずれの度合いを示す角度偏差θは絨毯によってほぼ固有であり数度程度である。
【０００７】
この絨毯固有の横ずれの度合いを示す角度偏差θは、本体に対して回転自由な支持軸と車輪からなる操舵手段の角度をもとに検出するものである。
【０００８】
ここで絨毯上を直進走行する場合の絨毯目の影響について図７を用いて説明する。
【０００９】
図７において、（ａ）は走行床面が絨毯のないベアフロアの場合の本体４１の移動軌跡を示す。
【００１０】
既に述べたように、このとき絨毯がないので当然絨毯目の影響はなく、本体４１は直進制御を行い、その移動軌跡は走行開始時の本体４１の方向と一致した直線ａになる。
【００１１】
しかしながら、（ｂ）に示すように、床面を絨毯目が左から右の方向にある絨毯に変えて同条件で直進走行させると、本体４１を目標ラインＬ１に乗るように直進制御しているにもかかわらず、実際の移動軌跡は目標ラインＬ１の方向から右へ角度θだけ傾いた直線ｂになる。
【００１２】
本体４１が絨毯上を直進走行する場合に、その直進距離に比例して本体４１が絨毯目の方向に横すべりする度合いを表す角度偏差θは、絨毯によってほぼ固有であり、数度程度であることがを確認しており、例えば（ｃ）に示すように角度偏差θを最初の走行時にあ
らかじめ測定した絨毯上で直進手段の目標ラインを走行開始時の方向から左に角度θ傾いた直線Ｌ２として（ｂ）と同条件で直進走行させると、そのときの移動軌跡は走行開始時の本体４１の方向と一致した直線ｃになる。
【００１３】
同様に（ｄ）に示すように、走行開始方向を（ｃ）と反対方向に直進走行させる場合には、直進手段の目標ラインを走行開始時の方向から右に角度θ傾いたＬ３として直進走行させれば、移動軌跡は走行開始時の本体４１の方向と一致した直線ｄになる。
【００１４】
このように、絨毯上を直進走行する場合は、絨毯目の方向とその目の強さに応じて直進する方向すなわち本体の方向を流される方向とは逆の方向に少し向かせることにより本体４１の移動軌跡を補正していた。
【特許文献１】特開平８−２２８９８０号公報
【発明の開示】
【発明が解決しようとする課題】
【００１５】
しかしながら、前記従来の構成では、機械的に操舵手段の車輪の角度を検出しようとするものであるため支持軸のガタや埃等による支持軸の固着が計測精度を悪くする原因となっていた。
【００１６】
さらに、従来の自走式掃除機の移動軌跡について図８を用いて説明すると、本体４１で清掃する床面が絨毯目が左から右にあるとする。
【００１７】
本体４１を開始点Ｓにおいてスタートすると、直進走行を開始し、図７の（ｂ）で示した場合と同様に、本体４１は走行開始時の方向に直進制御を行うが、実際の移動軌跡は絨毯目の影響で右にずれた方向に流される。
【００１８】
既に説明した様に、ずれ角度θは、本体に対して回転自由な支持軸と車輪からなる操舵手段の角度をもとに検出される。
【００１９】
前方の壁Ｗ１に近づくと、作業方向Ａの方向、すなわち本体４１の右方向へ所定の作業幅だけシフトし正確に１８０°反転する。
【００２０】
このとき、地点Ｐ１で反転開始するまでの操舵手段の車輪の角度を検出し平均値θを絨毯目によるずれ角度として記憶する。
【００２１】
地点Ｐ１での反転後、前回の往路で得たずれ角度θをもとに本体４１の方向を右へ角度θだけ傾けて直進を開始する。壁Ｗ２に近づいた地点Ｐ２でも作業方向Ａの方向すなわち本体４１の左方向へ所定の作業幅だけシフトし正確に１８０°反転する。
【００２２】
その後、今度は本体４１の方向を左へ角度θだけ傾けて直進を開始する。
【００２３】
以上の動作を繰り返し、点Ｆにきて壁Ｗ１を本体４１の前方で検知すると、このときは作業方向Ａ、すなわち本体４１の左方向には壁Ｗ３があるので清掃終了と判断し作業を終了する。
【００２４】
しかし、清掃を始めた直後の最初の直進は絨毯目の影響度合いが判らないため、補正ができず直進距離が大きいほど、すなわち図８の部屋が縦方向に長いほど未清掃の領域が左上の部分にできてしまっていた。
【００２５】
また、絨毯が１枚ものの絨毯ではなく、タイルカーペットで１枚ずつ目の方向を変えて
敷き詰めてある部屋や、部屋の１部分にだけ絨毯がある場合は、前述した従来の補正のやりかたは役に立たないものであった。
【００２６】
そこで本発明は、絨毯目による横ずれの角度偏差を機械的ではなく非接触な光学手段により検出し、かつ、補正値を最初の直線走行の時にだけ作成するのではなく、走行中に逐次、直線性を検知して走行制御にフィードバックすることで、タイルカーペットがひかれた部屋や１部分にだけ絨毯が敷かれている部屋でも効率良く清掃できる自走式掃除機を提供することを目的としている。
【課題を解決するための手段】
【００２７】
前記従来の課題を解決するために、本発明の自走式掃除機は、掃除機の本体を移動させる駆動輪と、前記駆動輪を駆動する駆動手段と、清掃を行う清掃手段と、前記駆動手段を制御して本体の走行制御を行う走行制御手段と、本体の方向を計測する方向計測手段と、本体に取り付けられ被掃除面を撮像するイメージセンサと、このイメージセンサが撮像した画像を一時的に保持する画像保持部と、この画像保持部の画像の変位を逐次検出する変位検知部とを具備し、前記方向計測手段の出力と前記変位検知部の出力により前記走行制御手段が本体方向と直進進行方向が同一になるように走行を制御するようにした。
【００２８】
これにより、機械的に操舵手段の車輪の角度を検出する場合にあった支持軸のガタや埃などによる支持軸の固着の課題がなくなり、精度良く絨毯目による横ずれの角度偏差を検出でき直進性の良い走行ができ、また、タイルカーペットがひかれた部屋や１部分にだけ絨毯が敷かれている部屋でも効率良く清掃できる自走式掃除機が提供される。
【発明の効果】
【００２９】
本発明の自走式掃除機は、光学的に非接触で絨毯目による横方向への流され度合いを検出するため、機械的に操舵手段の車輪の角度を検出する場合にあった支持軸のガタや埃等による支持軸の固着の課題がなくなり、精度良く絨毯目による横ずれの角度偏差を検出でき、さらに、走行中に逐次、直線性を検知して走行制御にフィードバックすることで、タイルカーペットがひかれた部屋や１部分にだけ絨毯が敷かれている部屋でも効率良く清掃できる。
【発明を実施するための最良の形態】
【００３０】
第１の発明は、掃除機の本体を移動させる駆動輪と、前記駆動輪を駆動する駆動手段と、清掃を行う清掃手段と、前記駆動手段を制御して本体の走行制御を行う走行制御手段と、本体の方向を計測する方向計測手段と、本体に取り付けられ被掃除面を撮像するイメージセンサと、このイメージセンサが撮像した画像を一時的に保持する画像保持部と、この画像保持部の画像の変位を逐次検出する変位検知部とを具備し、前記方向計測手段の出力と前記変位検知部の出力により前記走行制御手段が本体方向と直進進行方向が同一になるように走行を制御するようにしたものである。
【００３１】
したがって、絨毯目の有無や強さおよび目の方向がところどころで変わる部屋でも直進性よく走行し効率よく清掃できる。
【００３２】
第２の発明は、特に、前記第１の発明において、変位検知部の出力により横方向の画像の変位が最小になるように走行制御手段が走行を制御するようにしたもので、さらに効率良く走行できる。
【００３３】
第３の発明は、特に、前記第１または第２の発明において、本体から外部の物体までの距離を測定する測距手段と、測距センサの出力に基づいて障害物を検知する障害物検知手段と、この障害物検知手段の出力により本体の直進走行をＵターンさせる旋回手段とを有
し、旋回手段動作中は変位検知部の出力を無視するようにしたもので、Ｕターン時の変位検知誤りを回避でき、効率良く走行できる。
【００３４】
第４の発明は、特に、前記第３の発明において、旋回手段動作後安定して直進するまでは変位検知部の出力を無視するようにしたものであり、Ｕターン後の変位検知誤差を抑えることができ、効率良く走行できる。
【００３５】
第５の発明は、特に、前記第１〜４のいずれか一つ発明において、本体に光源を取り付け走行方向側の被掃除面を照射するようにして、さらに効率良く走行できるようにしたものである。
【００３６】
第６の発明は、特に、前記第１〜４のいずれか一つ発明において、本体後部に光源を取り付けて被掃除面の後方を照射するとともに、イメージセンサを本体の後部に取り付けて被掃除面の後方を撮像するようにしたことで、直進性よく走行させ効率よく清掃できる。
【００３７】
第７の発明は、特に、前記第５または６の発明において、被掃除面に写るレーザ光の輝点を基準に被掃除面画像の変位を検知するようにしたことで、明確なマーカを付加でき画像処理精度を高められ、さらに効率良く走行できる。
【００３８】
第８の発明は、特に、前記第１の発明において、走行制御手段は被掃除面画像の変位から走行速度を計測するようにしたことで、さらに効率良く走行できる。
【００３９】
以下、本発明の実施の形態について、図面を参照しながら説明する。なお、本実施の形態によって本発明が限定されるものではない。
【００４０】
（実施の形態１）
図１，２において、１は自走式掃除機の本体であり、高さ約２０ｃｍ、長さ約３０ｃｍ、幅約２５ｃｍの大きさのものである。
【００４１】
２は前記本体１を移動させる駆動輪、３は駆動手段であり、直流モータからなる。４は清掃手段で、床ノズル５ａ、ファンモータ５ｂ、ダストボックス６などからなる。
【００４２】
７は制御回路基板であり、マイクロコンピュータなどの電子回路とともに、走行制御手段８、画像保持手段９、変位検知手段１０なども搭載されている。
【００４３】
１１は方向計測手段であり、角速度を検知するジャイロセンサを用いている。１２はイメージセンサであり、斜め下方向に向けられ走行時の前方床面を撮像するようにしている。
【００４４】
このイメージセンサ１２の出力は画像保持手段９に接続されている。
【００４５】
１３は操作部で、本体１の運転を開始したり、停止したり、あるいは清掃モードを設定入力できる。
【００４６】
１４は電源スイッチ、１５はバンパーで、走行中に壁や家具に接触すると図示していないが本体１の内部にあるスイッチが入る構造になっており、接触を検知するものである。
【００４７】
１６は電池、１７ａ，１７ｂは右横方向にある家具や壁などとの距離を測る赤外線式の測距センサであり、横方向に２個付けることで壁に本体１が平行になるような制御をしやすいようにしている。１７ｃ，１７ｄは同じく赤外線式の測距センサであるが、前部に取
り付けられており、前進時に前方の障害物との衝突を避けられるよう前方向にある家具や壁などの障害物との距離を測るものである。
【００４８】
１７ｅ，１７ｆは左横方向にある家具や壁などとの距離を測る赤外線式の測距センサである。
【００４９】
方向計測手段１１、測距センサ１７ａ〜１７ｆ、方向計測手段１１、および画像保持手段９、この画像保持手段９の画像の変位を逐次検出する変位検知手段１０は走行制御手段８にその出力を入力している。
【００５０】
走行制御手段８は、これらのデータを判断して駆動輪２のモータ２Ｌ、２Ｒに制御信号を出力する。
【００５１】
本実施の形態では、このモータ２Ｌ，２Ｒの回転速度を制御することにより、左右の駆動輪２の回転速度を独立に制御し、本体１の駆動および操舵を行っている。
【００５２】
次にイメージセンサ１２で床面を撮像することによる動作を図３を用いて説明する。
【００５３】
図３において（ａ）および（ｂ）は絨毯上を走行したときのイメージセンサ１２で撮像した画像を保持する画像保持手段９の時刻Ｔ１と時刻Ｔ２のときの画像である。
【００５４】
１８はイメージセンサ１２が撮像した画像フレームである。イメージセンサ１２は約３０万画素のＣＣＤであり横６４０画素×縦４８０画素で構成され毎秒２４コマの画像を撮像できるものである。
【００５５】
ここで、模様Ａ〜模様Ｅは床面の木目、絨毯の毛の傾きのばらつき、絨毯の柄、ゴミなどイメージセンサ１２で撮像した時に濃淡模様として写るものである。
【００５６】
図３の（ｃ）は変位検知手段１０が検知した時刻Ｔ１から時刻Ｔ２のときの画像の変位ベクトルである。１９は変位検知手段１０の画像フレームである。
【００５７】
変位検知手段１０は２枚の画像の相関をとることにより床面の模様Ａ〜模様Ｅの変位が左斜め下方向にθずれていることを検知できる。
【００５８】
すなわち、時刻Ｔ２の画像を１画素分ずつ右または左や上にずらし、時刻Ｔ１の画像と重ね合わせて画面全体の明るさを計算していき、画面全体の明るさが一番明るい時の縦・横のずらし量から変位が検知できる。
【００５９】
例えば、時刻Ｔ２の画像を上に３０画素、右に１８画素ずらしたときの時刻Ｔ１の画像との重ね合わせ画像が一番明度が高ければ、横にずれた分は１８画素分となる。
【００６０】
次に、モータ２Ｌ，２Ｒの回転速度を制御して、横にずれた１８画素分左に戻るよう方向計測手段１１の出力をもとに本体方向を左に振れば元の直進コースに戻れる。
【００６１】
図では説明のために大きくずれているが、実際は２４分の１秒毎に画像を取り込み、逐次変位を算出し本体１の方向を方向計測手段１１の出力を見ながら制御している。
【００６２】
このように制御のフィードバック周期が短いため、本体１の振れは小さく、実走行では最初に定めた方向に本体１はまっすぐ向かい、絨毯目に流されること無く直進しているように見える。
【００６３】
図４は本実施の形態の走行制御手段８における制御のフローチャートである。
【００６４】
ステップ１では掃除機本体１が床に置かれ電源スイッチが入れられ、スタートボタンが押された後の処理である。
【００６５】
スタートボタンが押されたときの本体１の方向を直進の進行方向であるとして動作するため、最初に床に置かれている状態での方向計測手段１１の出力を記憶する。
【００６６】
ステップ２はイメージセンサ１２が撮像可能であるかを確認し、最新の画像が得られるまで待つ。
【００６７】
最新の画像が得られるとステップ３に移り、画像保持手段９に保存する。ステップ４では再度イメージセンサ１２が撮像可能であるかを確認し、最新の画像が得られるまで待つ。最新の画像が得られるとステップ５に移る。ステップ５ではステップ４で得られた最新の画像と画像保持手段９に保存されているひとつ前との画像の相関をとり、最新画像がひとつ前の画像から横方向にどれだけずれているかを検出する。
【００６８】
ステップ６ではステップ５で検出した横方向のずれ量をもとに本体１の方向の補正角度を算出する。ステップ７ではステップ６で算出した補正角度どおりに本体が方向を変えるようにモータ２Ｌ，２Ｒの回転速度を制御する。
【００６９】
ステップ８はステップ４で得られた最新の画像を画像保持手段９に保存する。ステップ９で前方に壁があればこの直進走行を終了する。
【００７０】
図５は直進走行を説明するもので、（ａ）はスタート時の位置である。絨毯目は右方向に向いている。
【００７１】
スタートすると絨毯目により本体１は（ｂ）に示すように本来の直線コースＬ１からやや右にそれる。ここで変位検出手段１０が横ずれを検知し、（ｃ）に示すように本体１の方向をやや左に向ける。その結果（ｄ）のＬ１に乗った位置に戻る。
【００７２】
その後（ｅ）のように本体１の方向も元のＬ１と同じ方向になる。（ｆ）はまた絨毯目に流され、以降（ｇ）〜（ｉ）は（ｃ）〜（ｅ）と同じ動作となる。復路も同様の動作をし、順番に右にシフトしていき部屋全体の掃除を完了する。
【００７３】
図では説明のために本体１が大きく振れているが、実際は逐次変位を算出し本体１の方向を細かく方向計測手段１１の出力を見ながら制御しているため、本体１の振れは小さく、実走行では最初に定めた方向に本体１はまっすぐ向かい、絨毯目に流されること無く直進しているように見える。
【００７４】
このように本実施の形態によれば、イメージセンサ１２で撮像した床面画像の横ずれ変位から逐次本体１の向きを修正するよう走行制御手段が制御し、その結果、方向計測手段の出力と変位検知部の出力により本体方向と直進進行方向が同一になるように走行制御され絨毯目の有無や強さおよび目の方向がところどころで変わる部屋でも直進性よく走行し効率よく清掃できる。
【００７５】
また、走行制御手段において変位検知部の出力により横方向の画像の変位が最小になるように走行制御するように方向の補正値を修正していけばさらに効率良く走行できる。
【００７６】
また、本体から外部の物体までの距離を測定する測距手段と、測距センサの出力に基づいて障害物を検知する障害物検知手段と、障害物検知手段の出力により本体の直進走行をＵターンしたときに、旋回中は変位検知部の出力を無視することでＵターン時の変位検知誤りを回避でき、効率良く走行できる。
【００７７】
また、Ｕターン後安定して直進するまでは変位検知部の出力を無視するようにすれば、Ｕターン後の変位検知誤差を抑えることができ、効率良く走行できる。
【００７８】
また、本体前部に光源を取り付け前方床面を照射すると床面の濃淡が明確になり画像処理精度が高まりさらに効率良く走行できる。
【００７９】
また、本体後部に光源を取り付け後方床面を照射しイメージセンサを本体の後部に取り付け後方床面を撮像するようにしても直進性良く走行し効率よく清掃できる。
【００８０】
また、レーザ光源を取り付け床面に写るレーザ光の輝点を基準に床面画像の変位を検知することで明確なマーカを付加でき画像処理精度を高められ、さらに効率良く走行できる。
【００８１】
また、床面画像の変位から走行制御手段にて走行速度を計測することでさらに効率良く走行できる。
【産業上の利用可能性】
【００８２】
以上のように、本発明にかかる自走式掃除機は、直進の目標方向に変位検知手段の出力に基づき修正を施すため精度良く絨毯目による横ずれを瞬時に検出して進行方向をすこし補正することで横ずれを回避でき、しかも機械的な構成物に頼らず非接触で床面の模様の流れを検知しているため、従来方式にあった支持軸へのほこり付着や支持軸のガタによる検知誤差などが起こり得ないものである。
【図面の簡単な説明】
【００８３】
【図１】本発明の実施の形態１を示す自走式掃除機の透視斜視図
【図２】同自走式掃除機の制御ブロック図
【図３】同自走式掃除機のイメージセンサの説明図
【図４】同自走式掃除機の制御方法を示すフローチャート
【図５】同自走式掃除機の動作説明図
【図６】従来の自走式掃除機の絨毯目の影響説明図
【図７】従来の自走式掃除機の絨毯目補正の動作説明図
【図８】従来の自走式掃除機の部屋内走行の動作説明図
【符号の説明】
【００８４】
１ 本体
２ 駆動輪
３ 駆動手段
４ 清掃手段
８ 走行制御手段
９ 画像保持手段
１０ 変位検知手段
１１ 方向計測手段
１２ イメージセンサ
１７ａ、１７ｂ、１７ｃ、１７ｄ 測距手段
【特許請求の範囲】
【請求項１】
掃除機の本体を移動させる駆動輪と、前記駆動輪を駆動する駆動手段と、清掃を行う清掃手段と、前記駆動手段を制御して本体の走行制御を行う走行制御手段と、本体の方向を計測する方向計測手段と、本体に取り付けられ被掃除面を撮像するイメージセンサと、このイメージセンサが撮像した画像を一時的に保持する画像保持部と、この画像保持部の画像の変位を逐次検出する変位検知部とを具備し、前記方向計測手段の出力と前記変位検知部の出力により前記走行制御手段が本体方向と直進進行方向が同一になるように走行を制御するようにした自走式掃除機。
【請求項２】
変位検知部の出力により横方向の画像の変位が最小になるように走行制御手段が走行を制御する請求項１記載の自走式掃除機。
【請求項３】
本体から外部の物体までの距離を測定する測距手段と、測距センサの出力に基づいて障害物を検知する障害物検知手段と、この障害物検知手段の出力により本体の直進走行をＵターンさせる旋回手段とを有し、旋回手段動作中は変位検知部の出力を無視するようにした請求項１または２記載の自走式掃除機。
【請求項４】
旋回手段動作後安定して直進するまでは変位検知部の出力を無視するようにした請求項３記載の自走式掃除機。
【請求項５】
本体に光源を取り付け走行方向側の被掃除面を照射するようにした請求項１〜４いずれか１項記載の自走式掃除機。
【請求項６】
本体後部に光源を取り付けて被掃除面の後方を照射するとともに、イメージセンサを本体の後部に取り付けて被掃除面の後方を撮像するようにした請求項１〜４いずれか１項記載の自走式掃除機。
【請求項７】
被掃除面に写るレーザ光の輝点を基準に被掃除面画像の変位を検知するようにした請求項５または６記載の自走式掃除機。
【請求項８】
走行制御手段は被掃除面画像の変位から走行速度を計測するようにした請求項１記載の自走式掃除機。
【請求項１】
掃除機の本体を移動させる駆動輪と、前記駆動輪を駆動する駆動手段と、清掃を行う清掃手段と、前記駆動手段を制御して本体の走行制御を行う走行制御手段と、本体の方向を計測する方向計測手段と、本体に取り付けられ被掃除面を撮像するイメージセンサと、このイメージセンサが撮像した画像を一時的に保持する画像保持部と、この画像保持部の画像の変位を逐次検出する変位検知部とを具備し、前記方向計測手段の出力と前記変位検知部の出力により前記走行制御手段が本体方向と直進進行方向が同一になるように走行を制御するようにした自走式掃除機。
【請求項２】
変位検知部の出力により横方向の画像の変位が最小になるように走行制御手段が走行を制御する請求項１記載の自走式掃除機。
【請求項３】
本体から外部の物体までの距離を測定する測距手段と、測距センサの出力に基づいて障害物を検知する障害物検知手段と、この障害物検知手段の出力により本体の直進走行をＵターンさせる旋回手段とを有し、旋回手段動作中は変位検知部の出力を無視するようにした請求項１または２記載の自走式掃除機。
【請求項４】
旋回手段動作後安定して直進するまでは変位検知部の出力を無視するようにした請求項３記載の自走式掃除機。
【請求項５】
本体に光源を取り付け走行方向側の被掃除面を照射するようにした請求項１〜４いずれか１項記載の自走式掃除機。
【請求項６】
本体後部に光源を取り付けて被掃除面の後方を照射するとともに、イメージセンサを本体の後部に取り付けて被掃除面の後方を撮像するようにした請求項１〜４いずれか１項記載の自走式掃除機。
【請求項７】
被掃除面に写るレーザ光の輝点を基準に被掃除面画像の変位を検知するようにした請求項５または６記載の自走式掃除機。
【請求項８】
走行制御手段は被掃除面画像の変位から走行速度を計測するようにした請求項１記載の自走式掃除機。
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図１】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図１】
【公開番号】特開２０１０−１７２４４１（Ｐ２０１０−１７２４４１Ａ）
【公開日】平成２２年８月１２日（２０１０．８．１２）
【国際特許分類】
【出願番号】特願２００９−１７５６６（Ｐ２００９−１７５６６）
【出願日】平成２１年１月２９日（２００９．１．２９）
【出願人】（０００００５８２１）パナソニック株式会社 (73,050)
【Ｆターム（参考）】
【公開日】平成２２年８月１２日（２０１０．８．１２）
【国際特許分類】
【出願日】平成２１年１月２９日（２００９．１．２９）
【出願人】（０００００５８２１）パナソニック株式会社 (73,050)
【Ｆターム（参考）】
[ Back to top ]