JPH0582603B2 - - Google Patents

Description

【発明の詳細な説明】

〔産業上の利用分野〕 本発明は、自律走行して掃除を行なう自動掃除
機などに用いて好適な自走ロボツトの走行制御方
法に関する。 〔従来の技術〕 室内を自動掃除機によつて掃除する方法とし
て、自動掃除機を、通常は直進走行させ、前方に
壁や障害物があつて直進走行不能となつた場合に
は、Ｕターンさせ、直進とＵターンとを繰り返し
て室内全体を同一ピツチで往復走行させるのが一
般である。そして、自動掃除機が壁ぎわや障害物
のきわに達してＵターンができなくなると、掃除
が終了したと判定する。 しかしながら、自動掃除機がＵターンするため
にはそれだけの空間が必要であるから、自動掃除
機が壁や障害物に近づいてＵターンができず、掃
除が終つたと判定しても、壁ぎわあるいは障害物
のきわには、掃除されない部分がかなり残る場合
がある。すなわち、自動掃除機を同一ピツチで往
復走行させて掃除を行なうと、壁ぎわや障害物の
きわまで充分には掃除ができないことになる。 かかる問題を解消する方法として、たとえば特
開昭55−97608号公報に開示されるように、自動
掃除機の走行方向に対して左右に移動可能な塵芥
の吸引口ブラシを設け、横方向へ１ピツチ移動す
るためのＵターンができないときは、吸引口ブラ
シのみ横方向に必要な距離だけ移動させる方法が
知られている。この方法によると、自動掃除機が
壁や障害物の近くに達してＵターンができなくな
ると、吸引口ブラシのみを壁ぎわや障害物のきわ
まで移動させ、自動掃除機を逆走行させることに
よつて室内の隅々まで掃除できる。 〔発明が解決しようとする問題点〕 ところで、かかる従来技術によると、吸引口ブ
ラシの位置および駆動タイミングを考慮した直進
行、Ｕターンの走行制御と吸引口ブラシの駆動制
御とが必要となり、制御が複雑になるとともに、
制御に時間がかかるという問題があつた。また、
吸引口ブラシの駆動装置が必要となるために、掃
除機を搭載した自走ロボツト本体が大型化、重量
化し、機動性が損なわれて掃除時間が長くなつて
しまうし、この大型化、重量化と吸引口ブラシの
駆動を必要とすることから、消費電力が増大化す
るという問題があつた。 本発明の目的は、かかる従来技術の問題点を解
消し、壁ぎわや障害物のきわの作業残りを失く
し、迅速かつ簡単な自走ロボツトの走行制御方法
を提供するにある。 〔問題点を解決するための手段〕 自走ロボツトが直進走行とＵターンとの交互の
動作による一定ピツチの往復動作ができなくなつ
たときに、該自走ロボツトの自己位置から該自走
ロボツトの直進走行方向に直垂な方向での壁ある
いは障害物までの距離に応じたピツチで、該自走
ロボツトをＵターンあるいは後退させる。 〔作用〕 自走ロボツト自体を壁あるいは障害物に充分近
接して走行させる。 〔実施例〕 以下、本発明の対象となる自走ロボツトを掃除
機を搭載した自走ロボツト（以下、自走掃除ロボ
ツトという）とし、本発明の実施例を説明する
が、まず、自走掃除ロボツトの構成について説明
する。 第２図はこの自走掃除ロボツトの一具体例を示
す斜視図であつて、１は左車輪、２は左車輪駆動
モータ、３は左車輪エンコーダ、４は歯車ケー
ス、５は右車輪、６は右車輪駆動モータ、７は右
車輪エンコーダ、８は歯車ケース、９は超音波送
受信器、１０は回転円板、１１は回転軸、１２は
パラボラアンテナ、１３は超音波レーダ回転モー
タ、１４は超音波レーダエンコーダ、１５は歯車
ケース、１６はジヤイロ、１７は掃除機、１８は
ごみ吸口、１９は測定回路部、２０は走行制御
部、２１は操作部、２２は制御用電源、２３は駆
動用電源、２４はロボツト本体フレーム、２５は
キヤスタ、２６はロボツトボデイである。 同図において、ロボツト本体フレーム２４に
は、左右に左車輪１、右車輪５が、また、前部中
央にキヤスタ２５が設けられている。左車輪１
は、歯車ケース４に収納された歯車を介し、左車
輪駆動モータ２と左車輪用エンコーダ３とに連結
され、同様にして、右車輪５も、歯車ケース８に
収納された歯車を介し、右車輪駆動モータ６と右
車輪用エンコーダ７とに連結されている。これに
より、左車輪１と右車輪５とは別々のモータによ
つて駆動され、夫々の車輪の回転数が別々のエン
コーダで測定される。 また、ロボツト本体フレーム２４には、超音波
レーダが搭載されている。これは、歯車ケース１
５に収納された歯車を介して超音波レーダ回転モ
ータ１３と回転軸１１とが連結され、この回転軸
１１に、パラボラアンテナ１２が一体となり、か
つ超音波送受信器９が搭載された回転円板１０と
からなり、超音波レーダ回転モータ１３によつて
回転円板１０（したがつて、パラボラアンテナ１
２）を回転軸１１を中心に回転させながら、超音
波送受信器９で破線で示す指向性の鋭い超音波の
送受信を行なう。また、回転軸１１は歯車ケース
１５に収納された歯車を介して超音波レーダエン
コーダ１４に連結されており、この超音波レーダ
エンコーダ１４によつて回転軸１１の回転角、し
たがつて、超音波の発射方向が検出される。な
お、歯車ケース１５は回転軸１１を支えるフレー
ムともなつている。 超音波送受信器９から発射された超音波は壁や
障害物などに当たると反射され、反射超音波のう
ちのパラボラアンテナ１２に帰つてきたものが超
音波送受信器９で受信されるが、超音波が発射さ
れてから受信されるまでの時間と超音波レーダエ
ンコーダ１４によつて検出される超音波の発射方
向とから、壁や障害物の位置が測定される。 さらに、ロボツト本体フレーム２４には、自走
掃除ロボツトの進行方向の角度変化を計測するた
めのジヤイロ１６、掃除機１７、測定回路部１
９、走行制御部２０、操作部２１、走行制御部２
０のための制御用電源２２、駆動用電源２３など
も搭載されており、超音波レーダの超音波送受信
器９、回転円板１０、パラボラアンテナ１２や操
作部２１以外がロボツトボデイ２６で覆われてい
る。掃除機１７には、ロボツト本体フレーム２４
の幅にほぼ等しい幅のごみ吸口１８が設けられ、
自走掃除ロボツトの走行とともに、床面（図示せ
ず）でのロボツト本体フレーム２４の幅にほぼし
い幅にわたつて塵芥を吸収する。測定回路部１９
は超音波レーダのデータ検出回路、ジヤイロ１６
のデータ測定回路および左車輪エンコーダ３、右
車輪エンコーダ７のデータ測定回路からなり、測
定回路１９からのデータを用いて走行制御部２０
は自走掃除ロボツトの自己位置、壁や障害物の位
置を計算し、計算結果にもとづいて自走掃除ロボ
ツトの走行を制御するものである。これら測定回
路部１９および走行制御部２０の電源として制御
用電源２２が用いられる。左車輪駆動モータ２、
右車輪駆動モータ６、超音波レーダ回転モータ１
３および掃除機１７のモータなどの電源として
は、駆動用電源２３が用いられる。操作部２１で
は、走行方法の切換え、自動走行と手動走行との
切換えなどの操作を行なうことができる。 第３図は、第２図における走行制御系の全体を
示すシステムブロツク図であつて、２７ａは
CPU（中央処理部）、２７ｂはメモリ、２８は超
音波レーダ検出回路、２９はレーダエンコーダ測
定回路、３０はジヤイロ測定回路、３１は車輪エ
ンコーダ測定回路であり、第２図に対応する部分
には同一符号をつけている。 第３図において、測定回路部１９は超音波送受
信器９の出力信号を検出する超音波レーダ検出回
路２８と、超音波レーダエンコーダ１４からのデ
ータを測定するレーダエンコーダ測定回路２９
と、ジヤイロ１６からのデータを測定するジヤイ
ロ測定回路３０と、左車輪エンコーダ３および右
車輪エンコーダ７のデータを測定する車輪エンコ
ーダ測定回路３１とからなる。 一方、走行制御部２０はCPU２７ａとメモリ
２７ｂとからなる。CPU２７ａは、測定回路部
１９の超音波レーダ検出回路２８、レーダエンコ
ーダ測定回路２９、ジヤイロ測定回路３０および
車輪エンコーダ測定回路３１の出力データを周期
的に取り込んで自走掃除ロボツトの自己位置、壁
や障害物の位置などを計算し、この結果をメモリ
２７ｂに格納するとともに、この結果に応じて左
車輪駆動モータ２、右車輪駆動モータ６、超音波
レーダ回転モータ１３および掃除機１７のモータ
の制御信号を形成する。 自走掃除ロボツトは以上の構成をなすものであ
る。 次に、かかる自走掃除ロボツトを対象とした本
発明の実施例を図面によつて説明する。 第１図は本発明による自走ロボツトの制御方法
の一実施例を示すフローチヤートである。 この実施例は、後に説明する第９図に示すよう
に、基本的には直進とＵターンとを繰り返えし、
自走掃除ロボツトを走行経路３２に沿つて移動さ
せるものである。 第１図において、自走掃除ロボツトの動作開始
時には、CPU２７ａはメモリ２７ｂ（第３図）の
内容をクリアし、掃除機１７（第２図）のモータ
を起動させて掃除を開始させ、ステツプ１に進
む。 ステツプ１では、自走掃除ロボツトがＵターン
中であることを表わすフラグ（以下、Ｕターン中
フラグという）をリセツトする。 ステツプ２では、室内での自走掃除ロボツトの
自己位置が検出される。ここで、自走掃除ロボツ
トの自己位置の測定方法について説明する。 この自己位置は、左車輪エンコーダ３、右車輪
エンコーダ７およびジヤイロ１６の出力信号をも
とに測定される。すなわち、左車輪エンコーダ３
からは左車輪１（第２図）の回転速度を表わすデ
ータ（パルス数）が出力され、車輪エンコーダ測
定回路３１でこのデータから左車輪１の回転数が
測定されて、その結果、左車輪１の走行距離ΔL₁
が測定される。同様にして、右車輪エンコーダ７
からは右車輪５（第２図）の回転速度を表わすデ
ータが出力され、車輪エンコーダ測定回路３１で
右車輪５の走行距離ΔL₂が測定される。また、ジ
ヤイロ１６からは自走掃除ロボツトの回転角度を
表わす角度データが出力され、このデータからジ
ヤイロ測定回路３０で、一定時間間隔Δtおきに、
自走掃除ロボツトの進行方向の角度変化量Δθが
測定される。この一定時間間隔おきに、これらデ
ータΔL₁，ΔL₂，ΔθがCPUに取り込まれ、これ
らデータを計算処理して自走掃除ロボツトの自己
位置データが得られる。 ここで、自己位置データを得るための計算方法
について、第４図を用いて説明する。同図に示す
ように、自己位置データはＸ−Ｙ座標系の座標と
して得られる。このＸ−Ｙ座標は自走掃除ロボツ
トが作業を行なうために部屋の床面に置かれたと
きに決まり、その置かれた位置を原点Ｏとし、そ
のときの直進走行すべき方向をＹ軸、これに垂直
な方向をＸ軸とする。 同図において、いま、現時点t_aでの自走掃除ロ
ボツトの自己位置を座標（X_a、y_a）の点ａとし、
この点ａからＹ軸に対して角度θ_aの方向に移動し
たところ、これより上記一定時間Δt後には、自
走掃除ロボツトの左車輪１の走行距離がΔL₁、右
車輪５の走行距離がΔL₂、進行方向の角度変化量
がΔθであつたとすると、この一定時間Δtにおけ
る自走掃除ロボツトの走行距離ΔLは、 ΔL＝１／２（ΔL₁＋ΔL₂） …(1) で表わされ、時点t_b（＝t_a＋Δt）における自走掃
除ロボツトの進行方向θ_bは、 θ_b＝θ_a＋Δθ …(2) となる。時点t_bにおける自走掃除ロボツトの自己
位置を点ｂとすると、この点ｂの座標（x_b、y_b）
は次のように表わされる。 x_b＝x_a−ΔL・sin（θ_a＋Δθ／２） …(3) y_b＝y_a＋ΔL・cos（θ_a＋Δθ／２） …(4) ここで、式(3)の右辺のΔLの前の符号をマイナ
スとし、式(4)の右辺のΔLの前の符号をプラスと
したのは、Ｙ軸に対する角度は時計方向をマイナ
ス、反時計方向をプラスとしたためである。自走
掃除ロボツトが原点Ｏにあるときの位置座標は
（０、０）であつて進行方向は0゜であり、一定時
間Δt毎に式(1)〜(4)の計算を行なつて順次の自己
位置とそこでの進行方向が得られる。 ステツプ３では、壁や障害物の位置が検出され
る。ここで、壁や障害物の位置の測定方法につい
て、同じく第４図を用いて説明する。 この測定は第２図で示した超音波レーダのデー
タを用いて行なわれる。いま、第４図において、
自走掃除ロボツトが点ａにあるものとすると、パ
ラボラアンテナ１２（第２図）が壁や障害物Ｓの
超音波発射方向に垂直な面（以下、単に垂直面と
いう）に向いたとき、超音波送受信器９（第２
図）で反射された超音波はこの垂直面で反射され
てこの超音波送受信器９で受信される。そこで、
超音波が超音波送受信器９から発射されてから壁
や障害物Ｓの垂直面で反射されてこの超音波送受
信器９で受信されるまでの往復時間をΔTとし、
超音波の速度をＶとすると、点ａから壁もしくは
障害物Ｓまでの距離L_sは、 L_s＝１／２Ｖ・ΔT …(5) で表わされる。 また、超音波レーダエンコーダ１４では、パラ
ボラアンテナ１２からの超音波の発射および受波
方向θ_sが測定される。この方向は自走掃除ロボツ
トの進行方向からみたものであり、時計方向をマ
イナス、反時計方向をプラスとしている。 以上のデータL_s，θ_sと点ａの座標（x_a、x_b）お
よび点ａでの自走掃除ロボツトの進行方向θ_aか
ら、壁もしくは障害物Ｓの位置（正確には、超音
波の反射面の位置）の座標（x_s，y_s）は次のよう
に表わされる。 x_s＝x_a−L_s・sin（θ_a＋θ_s） …(6) y_s＝y_a＋L_s・cos（θ_a＋θ_s） …(7) 以上のようにして、設定されたＸ−Ｙ座標系に
おける自走掃除ロボツトの自己位置座標と壁もし
くは障害物の位置座標が求まる。 ステツプ４では、ステツプ２、３で以上のよう
にして得られた自走掃除ロボツトと壁もしくは障
害物の位置座標をメモリ２７ｂ（第３図）に格納
し、壁や障害物の位置関係を表わす情景地図を作
成し、そこに、自走掃除ロボツトの走行経路を画
く。 ステツプ５では、Ｕターン中フラグがセツトさ
れているか否かを判定し、セツトされていなけれ
ば、次のステツプ６に進む。 ステツプ６では、自走掃除ロボツトの進行方向
に直進走行を阻げる壁もしくは障害物があるか否
かを判定する。先にも説明したよに、この実施例
においても、自走掃除ロボツトを直進走行とＵタ
ーンとを繰り返しながら走行させるのであるが、
CPU２７ａ（第３図）は、自走掃除ロボツトとそ
の進行方向での壁もしくは障害物との間隔を計算
して常時監視しており、この間隔が自走掃除ロボ
ツトのＵターン可能な最初のものとなつたとき、
ステツプ６で前方に壁もしくは障害物有りと判定
する。 ステツプ７では、ステツプ６で前方に壁もしく
は障害物がないと判定されたとき、自走掃除ロボ
ツトを直進走行させる。この直進走行は、左車輪
駆動モータ２と右車輪駆動モータ６（第２図）と
を同時に回転させ、左車輪１と右車輪５（第２
図）とを駆動することによつて行なわれる。 ステツプ７からはステツプ２に戻るが、ステツ
プ６で前方に壁もしくは障害物有りと判定されな
い限り、ステツプ２、３、４、５、６、７の一連
の動作が繰り返えされ、自走掃除ロボツトを直進
走行させる。この直進走行中自走掃除ロボツトと
壁もしくは障害物の位置が検出され、夫々の位置
座標が順次メモリ２７ｂ（第３図）に格納される。
これによつてメモリ２７ｂでは、情景地図が次第
に詳しくなり、そこに自走掃除ロボツトの走行経
路が画かれる。 ここで、第５図により、障害物がない室内にお
いて、ステツプ６で前方に壁ありと判定するまで
の自走掃除ロボツトの動作を説明する。 まず、自走掃除ロボツトは走行開始する前の原
点Ｏにあるときに、超音波レーダによつて壁の位
置を検出する。ここで、説明を簡単にするため
に、壁３３，３４，３５，３６はＸ軸，Ｙ軸のい
ずれかに平行であるとする。自走掃除ロボツトが
原点Ｏにあるときに超音波レーダによつて検出さ
れるのは、壁のＸ軸、Ｙ軸上の部分（点３３ａ，
３４ａ，３５ａ，３６ａ）と壁の角の部分（点３
３ｂ，３４ｂ，３５ｂ，３６ｂ）である。自走掃
除ロボツトは原点Ｏから常にＹ軸の正方向に直進
走行開始するものであり、この場合、上記のよう
にして、自走掃除ロボツトの進行方向の壁の位置
は点３４ａとして予じめ検出されているから、
CPU２７ａによつて壁の点３４ａと自走掃除ロ
ボツトとの間の距離を監視している。 自走掃除ロボツトのCPU２７ａは、かかる直
進走行の間も自己位置座標と壁の位置座標とを計
算してメモリ２７ｂに格納しており、壁３３，３
４，３５，３６が順次検出されてメモリ２７ｂで
背景地図が次第に出来上つており、その情景地図
内で自走掃除ロボツトの走行経路３２が画かれて
いる。 直進走行中、ステツプ６で前方に壁もしくは障
害物有りと判定すると、ステツプ８に進む。 ステツプ８では、自走掃除ロボツトを停止させ
る。 ステツプ９では、Ｕターン中フラグをセツトす
る。 ステツプ10では、Ｕターン方向の切換えを行な
う。 先にも説明したように、自走掃除ロボツトは直
進走行とＵターンとを繰り返し行なわせるが、第
５図では、軌跡３２で示すように、最初のＵター
ンの方向は右方向であるが、次のＵターンは左方
向に行なわれる。つまり、Ｕターンする毎にその
方向は右、左と交互に変わり、これによつて自走
掃除ロボツトはＹ軸方向に往復走行をしつつＸ軸
方向に進むことになる。ステツプ10では、このよ
うにＵターンの方向を設定する。通常、最初のＵ
ターンの方向は右方向に設定されるが、この方向
のＵターンが不可能な場合には、Ｕターンの方向
を左方向とし、以下、右、左、右……と交互に方
向を切換える。 第１図に戻つて、ステツプ11〜20では、第５図
で示すＸ軸方向での自走掃除ロボツトと壁３３と
の間隔ｌがいかなる範囲に入るかを判定する。か
かる範囲は、ｌ＞l₁（ステツプ11）、l₁≧ｌ＞l₂（ス
テツプ12）、l₂≧ｌ＞l₃（ステツプ13）、l₃≧ｌ＞l₄
（ステツプ14）、l₄≧ｌ＞l₅（ステツプ15）、l₅≧ｌ
＞l₆（ステツプ16）、l₆≧ｌ＞l₇（ステツプ17）、l₇≧
ｌ＞l₈（ステツプ18）、l₈≧ｌ＞l₉（ステツプ19）、l₉
≧ｌ＞l₁₀（ステツプ20）がある。 第５図において、間隔ｌが充分大きいときに
は、自走掃除ロボツトがＵターンする前とＵター
ンした後との直進走行経路のピツチはＡであると
すると、このピツチＡで自走掃除ロボツトのＵタ
ーンが可能な自走掃除ロボツトと壁３３との間隔
ｌの最小値がステツプ11におけるl₁である。 かかるＵターンの方法を第６図で説明する。同
図において、１′はＵターン前の左車輪、１″はＵ
ターン後の左車輪、２は右車輪、３３は壁、２
６′はＵターン前のロボツトボデイ、２６″はＵタ
ーン後のロボツトボデイ、３７′，３７″は夫々ロ
ボツトボデイ２６′，２６″の左前先端部、３８′，
３８″は夫々ロボツトボデイ２６′，２６″の左後
先端部である。 同図において、自走掃除ロボツトは右方向にＵ
ターンするものとする。この場合のＵターンは、
右車輪５を停止させて左車輪１′を前進方向に駆
動し、ロボツトボデイ２６′を右車輪５を中心に
180゜旋回させる。かかるＵターンを行なうことに
より、ロボツトボデイ２６′，２６″の直進方向の
中心線の間隔がピツチＡであり、これは左車輪
１′と右車輪５との間隔Ｗに等しい。掃除機１７
のごみ吸口１８（第２図）の幅はロボツトボデイ
２６′，２６″の幅にほぼ等しいから、Ｕターン前
後の掃除範囲は図示する量Ｅだけオーバラツプす
る。 かかるＵターンは、ロボツトボデイ２６′の先
端から車輪軸までの距離、右車輪５からロボツト
ボデイ２６′の左前先端部３７′までの距離および
右車輪５からロボツトボデイ２６′の左後先端部
３８′までの距離で決まる領域a₁，b₁，c₁，d₁内
に壁や障害物がないときに可能である。第６図に
よると、このようにＵターンするために必要なロ
ボツトボデイ２６′の中心線Ｒ−Ｒから右方向の
空間の最小幅l₁は、左車輪１′と右車輪５との間
隔をＷ、右車輪５とロボツトボデイ２６′の左前
先端部３７′との間隔をｄとすると、 l₁＝１／２Ｗ＋ｄ …(8) となる。したがつて、自走掃除ロボツトと壁３３
との間隔（厳密には、ロボツトボデイ２６′の中
心線Ｒ−Ｒと壁３３との間隔）ｌが式(8)で表わさ
れる間隔l₁よりも大きいとき、Ｕターン時に自走
掃除ロボツトが壁３３に当たることはとない。 ステツプ11は、ｌ＞l₁の判定とともに、第６図
の範囲a₁，b₁，c₁，d₁において、壁や障害物が存
在するか否かの判定も行なう。 自走掃除ロボツトと壁３３との間隔ｌがl₁以下
になると、上記のようなＵターンができなくな
り、壁３３のきわに掃除残りが生ずる。 ステツプ12、13、14、15から始まる一連の動作
はＵターン前後のピツチを小さくしてこの掃除残
りを少なくするものである。この場合のＵターン
方法を第７図によつて説明する。同図において、
５′はＵターン前の右車輪、５″はＵターン後の右
車輪、２６はＵターン途中のロボツトボデイ、
３７はロボツトボデイ２６の左前先端部であ
り、第６図に対応する部分には同一符号をつけて
いる。 第７図において、まず、左車輪１′を停止させ
て右車輪５′を後進方向に駆動し、ロボツトボデ
イ２６′を左車輪１′を中心にして右方向に旋回さ
せる。この動作は右車輪５′を右後方に引くもの
である。ロボツトボデイ２６′の中心線Ｒ−Ｒに
垂直な方向での右車輪５′の移動量Ｄを車輪引き
幅という。第６図に示したＵターンの場合には、
右車輪５は停止しているから、車輪引き幅Ｄは零
である。 次に、右車輪が引かれたロボツトボデイ２６
に対し、第６図の場合と同様に、右車輪５″を停
止させて左車輪１′を前進方向に駆動する。これ
により、ロボツトボデイ２６は右車輪５″を中
心に右方向に旋回する。ロボツトボデイ２６″の
中心線R′−R′がロボツトボデイ２６′の中心線Ｒ
−Ｒに平行となつたとき、すなわち自走掃除ロボ
ツトが180゜旋回したとき、左車輪１′の駆動を停
止させてＵターンを終了する。この場合でのＵタ
ーン前後の自走掃除ロボツトの間隔、すなわちピ
ツチＢは、左車輪１′と右車輪５′との間隔をＷと
すると、 Ｂ＝Ｗ−Ｄ …(9) となる。したがつて、第６図の場合よりも狭いピ
ツチでＵターンされることになる。このために、
Ｕターン前後の掃除範囲のオーバラツプ量は第６
図の場合の量Ｅよりも大きくなることはいうまで
もない。 この場合には、左車輪１′と左後先端部３８′と
の間の距離、右車輪５′と左前先端部３７′、左後
先端部３８′との間の距離、ロボツトボデイ２
６′の長さ、ロボツトボデイ２６′に対する右車輪
５′、左車輪１′の位置、車輪引き幅Ｄなどによつ
て決まる範囲a₂，b₂，c₂，d₂内に壁や障害物がな
いときにＵターンが可能となる。 また、第７図から明らかなように、右車輪５′
と左前先端部３７′との距離をｄとすると、ロボ
ツトボデイ２６の中心線Ｒ−Ｒから右方向の空間
幅ｌと車輪引き幅Ｄとの関係が、 ｌ＞ｄ＋（Ｗ−Ｄ）−Ｗ／２＝ｄ＋（Ｗ／２−Ｄ）…
(10) （但し、Ｗは左車輪１′と右車輪５′との間隔）
であるとき、第７図で示すＵターンを行なつても
自走掃除ロボツトは壁３３に当たることはない。 そこで、自走掃除ロボツトと壁３３との間隔ｌ
が式(8)で表わされる値l₁以下となつたとき、式(10)
を満すようにこの間隔ｌに応じて車輪引き幅Ｄを
設定し、第７図に示したようにＵターンを行なう
ことにより、ピツチを小さくしてＵターンがで
き、壁３３のきわまで掃除出来る。 この実施例では、第１図のステツプ12〜15に示
すように、値l₁以下で自走掃除ロボツトと壁３３
との間隔ｌがとる範囲を４つに区分し（すなわ
ち、l₁≧ｌ＞l₂、l₂≧ｌ＞l₃、l₃≧ｌ＞l₄、l₄≧ｌ＞
l₅）、各区分毎に、夫々l₂，l₃，l₄，l₅，に対して式
(10)を満足する車輪引き幅D₂，D₃，D₄，D₅を設定
している。 そこで、いま、自走掃除ロボツトと壁３３との
間隔ｌがl₁≧ｌ＞l₂の範囲にあるとすると、これ
であることがステツプ12で判定され、ステツプ22
で車輪引き幅Ｄが値D₂と設定される。この間隔
ｌが値l₁以下の他の範囲にあつてステツプ13〜15
のいずれかでこれであることが判定されると、こ
れに応じた車輪引き幅D₃〜D₅のいずれかがステ
ツプ23、24あるいは25で設定される。式(10)から車
輪引き幅Ｄが大きくなるに従い間隔ｌが小さくな
り自走掃除ロボツトが壁３３により近接した状態
でＵターンが可能であるがＤ＝Ｗのときには、走
径経路をもどることになるから、ステツプ15での
l₅をｄ−Ｗ／２よりも若干大きく、かつステツプ
25のD₅をＷよりも若干小さく設定する。なお、
ｌ＞l₁の場合には、ステツプ11でこれが判定さ
れ、ステツプ21で車輪引き幅Ｄが値０のD₁と設
定される。 もちろん、ステツプ12〜15でも、ステツプ11と
同様に、第７図における範囲a₂，b₂，c₂，d₂内に
壁もしくは障害物があるか否かの判定も行なう。 なお、左方向にＵターンする場合も同様であ
る。 ところで、以上のようなＵターンを行なう場
合、ロボツトボデイ２６′，２６″を旋回されるこ
とから、Ｕターン終了後には、第７図に示すよう
に、ロボツトボデイ２６″と壁３３との間に幅Ｎ
の隙間が生じ、この部分が掃除残りとなる。この
幅Ｎは、ステツプ11〜15のいずれのＵターンを行
なうようにしても、 Ｎ≧ｄ−Ｗ＋ｗ／２ …(11) となる。但し、ｄ，Ｗは第６図で示される幅であ
り、また、ｗはロボツトボデイ２６の幅である。 ステツプ15〜20から始まる一連の動作は、この
幅Ｎの隙間の掃除残しをも失くすようにするもの
である。これは、ロボツトボデイ２６を後進走行
させながら壁３３のきわに寄せるものである。以
下、この動作を後退旋回と呼ぶことにする。 以下、第８図によつて後退旋回動作を詳細に説
明する。ここでは、進行方向に対して右側にある
壁３３に自走掃除ロボツトをよせるものとする。 まず、ロボツトボデイ２６′に対し、右車輪
５′を停止させて左車輪１′を後進駆動する。これ
により、ロボツトボデイ２６′は右車輪５′を中心
にして左方向に旋回する。このとき、左車輪１′
は右後方に引かれたことになる。次に、旋回した
ロボツトボデイ２６″の左車輪１″を停止させて右
車輪５′を後進駆動させる。これにより、ロボツ
トボデイ２６″は左車輪１″を中心にして右方向に
旋回する。この旋回はロボツトボデイ２６″の中
心軸が旋回前の中心軸Ｒ−Ｒと平行になつたとき
に停止する。 かかる一連の旋回により、右車輪５′は左車輪
１′と平行な方向に同量だけ引かれている。かか
る旋回後の左車輪１′、右車輪５′の進行方向（中
心軸Ｒ−Ｒ）に垂直な方向の移動量Ｃを両車輪引
き幅という。 ロボツトボデイ２６′の長さ、ロボツトボデイ
２６′に対する左車輪１′、右車輪５′の位置関係
などで決まる後進旋回に必要な空間範囲a₃，b₃，
c₃，d₃内に壁や障害物がないときに、後進旋回が
可能となる。また、左車輪１′とロボツトボデイ
２６′の右後先端部３９′との間隔をd′とし、両車
輪１′，５′の間隔をＷとすると、ロボツトボデイ
２６′の中心軸Ｒ−Ｒから壁３３までの間隔ｌと
両車輪引き幅Ｃとの関係が、 ｌ＞d′＋（Ｃ−Ｗ／２） …(12) であるとき、自走掃除ロボツトは壁３３に当たら
ない。そこで、ロボツトボデイ２６′と壁３３と
の間隔がステツプ15での値l₅よりも小さいとき、
式(12)を満たすように間隔ｌに応じて両車輪引き幅
Ｃを設定し、第８図に示すように後進旋回を行な
つた後、ロボツトボデイ２６を矢印方向に後進
走行させることにより、壁３３のきわの掃除残し
をなくすことができる。 この実施例では、第１図のステツプ16〜20に示
すように、値l₅以下のロボツト本体２６と壁３３
との間隔ｌがとる範囲をl₅≧ｌ＞l₆、l₆≧ｌ＞l₇、
l₇≧ｌ＞l₈、l₈≧ｌ＞l₉、l₉≧ｌ＞l₁₀の５つに区分
し、各区分毎に、l₆，l₇，l₈，l₉，l₁₀に対応して式
(12)を満足する両車輪引き幅C₆，C₇，C₈，C₉，C₁₀
を設定している。 そこで、いま、ロボツトボデイ２６′と壁３３
との間隔ｌがl₅≧ｌ＞l₆であるとすると（ステツ
プ11〜15では「no」と判定している）、これであ
ることがステツプ16で判定され、ステツプ26で両
車輪引き幅Ｃが値C₆と設定される。ステツプ17
〜20のいずれかで「yes」と判定された場合にも、
それに応じてステツプ27〜30のいずれかで両車輪
引き幅Ｃが値C₇，C₈，C₉またはC₁₀に設定され
る。もちろんこのとき、ステツプ16〜20では、第
８図で示した後退旋回に必要な空間範囲a₃，b₃，
c₃，d₃内に壁もしくは障害物があるか否かの判定
も行なう。 ここで、第６図〜第８図でのロボツトボデイ２
６′に対し、長さを80cm、幅を50cm、各車輪１′，
５′の直径を10cm、車輪１′，５′の間隔を30cm、
ロボツトボデイ２６′の前先端から車輪軸までの
距離を50cm、ロボツトボデイ２６′の後先端から
車輪軸までの距離を30cmとしたときの第１図の間
隔l₁〜l₁₀の値と車輪引き幅D₁〜D₅、C₆〜C₁₀の値
の一具体例を次表に示す。

〔発明の効果〕

以上説明したように、本発明によれば、自走ロ
ボツトを壁ぎわや障害物のきわまで簡単かつ正確
に接近させることができ、該自走ロボツトに載置
される掃除機などの作業機器を制御することな
く、壁ぎわや障害物のきわまでの作業が可能とな
るものであつて、作業機器の機構部や駆動部の簡
略化が図かれて該自走ロボツトの小型、軽量化や
消費電力の削減が達成できるし、作業機器の位置
や駆動タイミングを考慮することなしに自走ロボ
ツトの制御が可能となるものであるから、自走ロ
ボツトの走行方法の判断や決定を迅速に行なうこ
とができるし、さらに、該自走ロボツトの小型、
軽量化にともない、部屋の壁や障害物に対応した
該自走ロボツトの動作変化を迅速に行なえ、作業
時間を大幅に短縮できる。

【図面の簡単な説明】

第１図は本発明による自走ロボツトの走行制御
方法の一実施例を示すフローチヤート、第２図は
自走ロボツトの一具体例を示す構成図、第３図は
第２図に示した自走ロボツトにおける走行制御系
の全体を示すシステムブロツク図、第４図は自走
ロボツトの自己位置座標および壁や障害物の位置
座標を得る方法を示す説明図、第５図は第３図に
おけるメモリで画かれる情景地図と自走ロボツト
の走行経路とを示す説明図、第６図および第７図
は夫々自走ロボツトのＵターン方法を示す説明
図、第８図は自走ロボツトの後退旋回方法を示す
説明図、第９図は自走ロボツトの走行方法の一例
を示す説明図である。 １，１′，１″…左車輪、３…左車輪用エンコー
ダ、５，５′，５″…右車輪、７…右車輪用エンコ
ーダ、９…超音波送受信器、１２…パラボラアン
テナ、１３…超音波レーダ回転モータ、１４…超
音波レーダエンコーダ、１６…ジヤイロ、１７…
掃除機、２０…走行制御部、２６，２６″，２６
…ロボツトボデイ。

Claims (1)

1. 【特許請求の範囲】 １ 互いに独立に回転駆動される左車輪と右車輪
   とが取り付けられた本体フレームの端部に所定領
   域を作業する作業装置が取り付けられ、かつ、該
   本体フレームに走行方向、走行距離及び物体に対
   する距離、方向を測定する測定手段が載置された
   自走ロボツトを、該測定手段の測定結果に基づい
   て、走行制御し、該自走ロボツトが直進走行とＵ
   ターンとを繰り返しながら該所定領域内をジグザ
   グ走行するにした自走ロボツトの走行制御方法に
   おいて、 該作業装置の作業幅が該左車輪と該右車輪との
   間隔以上であつて、 該Ｕターンとしては、 該左車輪と右車輪の一方を停止状態とし、他方
   を前進駆動することにより、該左車輪と該右車輪
   との間隔に等しいピツチで該本体フレームの向き
   を逆転させる第１のＵターンと、 該左車輪と該右車輪の一方を停止状態として他
   方を所定距離だけ後進駆動し、後進駆動した方の
   車輪を停止状態として停止状態とした車輪を前進
   駆動することにより、該左車輪と該右車輪との間
   隔よりも小さいピツチで該本体フレームの向きを
   逆転させる第２のＵターンとが選択可能であり、 該自走ロボツトの直進方向に垂直な方向での該
   所定領域の境界と該自走ロボツトとの間の距離が
   該第１のＵターンが可能な距離であるときには、
   該第１のＵターンを行なわせ、 該自走ロボツトの直進方向に垂直な方向での該
   所定領域の境界と該自走ロボツトとの間の距離が
   該第１のＵターンが不可能な距離であるときに
   は、該距離に応じた該左車輪と該右車輪の一方の
   前記後進駆動の距離で該第２のＵターンを行なわ
   せ、 該自走ロボツトの直進方向に垂直な方向での該
   所定領域の境界と該自走ロボツトとの間の距離が
   該第２のＵターンも不可能な距離であるときに
   は、該自走ロボツトを該所定領域の境界側に寄せ
   ながら、該自走ロボツトを後進させることを特徴
   とする自走ロボツトの走行制御方法。