JP7615618B2 - 自律走行経路計画方法 - Google Patents

Description

本発明は、自律走行経路計画方法に関し、特に、自律走行体の走行経路を計画する方法に関する。

従来、走行開始位置から走行終了位置までの経路計画に従って自律的に走行する自律走行体が知られている。
一例として、自律走行式床洗浄機は、ユーザの操作により教示された走行経路及び清掃条件を再現することにより、教示された走行経路を自律的に走行しつつ、教示された清掃条件に従った清掃を自律的に実行する。

また、別の経路計画方法では、環境地図の塗り潰し走行対象領域を所定の大きさのグリッド座標に投影し、グリッドを通過する順番を決めることで、走行スケジュールを作成している（例えば、特許文献１を参照）。

また、環境領域の内側に作業対象領域を設け、その外周に収穫機の方向転換を行う外周領域を設ける走行経路計画装置が知られている（例えば、特許文献２を参照）。

国際公開第２０１８／０４３１８０号公報 特開２０１８－０９９１１３号公報

一般に自律走行体の機体は、長さと幅のサイズが異なっており、例えば平面視で矩形である。したがって、塗り潰し経路計画がグリッドベースである場合に、教示走行時の機体の向きと塗り潰し走行時の機体の向きとが異なる場所において（例えば、機体がＵターンする場所において）、塗り潰し走行時に、走行領域の外周境界から外側に機体が逸脱することがある。
また、自律走行体の機体が逸脱しない範囲で塗り潰し計画を行うと（例えば単に塗り潰しの対象領域を縮めると）、外周付近に塗り残しが出てしまう。

本発明の目的は、グリッドベースによる自律走行経路計画において、走行領域の外周境界から外側に自律走行体が逸脱しないようにすることにある。

以下に、課題を解決するための手段として複数の態様を説明する。これら態様は、必要に応じて任意に組み合せることができる。

本発明の一見地に係る自律走行経路計画方法は、自律走行体が自律走行する経路を計画する方法であって、下記のステップを備えている。
◎環境地図において塗り潰し走行を行う走行領域を取得するステップ。
◎自律走行体の車体サイズと回転半径と回転移動距離及びグリッドのサイズに基づいて、自律走行体が方向転換を行う際に走行領域から自律走行体の車体が逸脱する逸脱幅を算出するステップ。
◎少なくとも逸脱幅の一部に相当する一又は複数の内周周回経路を作成するステップ。
◎最内周の内周周回経路に対応する位置を境界とするグリッド領域を作成するステップ。
◎グリッド領域内を塗り潰すように塗り潰し走行経路を作成するステップ。
なお、回転移動距離とは、車体が旋回したときの車輪中点の移動軌跡である。
この方法では、少なくとも逸脱幅の一部に相当する一又は複数の内周周回経路が作成され、さらにグリッド領域内に塗り潰し走行経路が作成される。その結果、グリッドベースによる自律走行経路において、走行領域の外周境界から逸脱しないように自律走行体が走行できる走行経路が計画される。
なお、内周周回経路は、複数の場合に互いに独立していてもよいし、一部同士が重複していてもよい。

内周周回経路を作成するステップでは、逸脱幅を全て覆うために必要な最大本数を算出してもよい。
この方法では、逸脱幅は内周周回経路によって全体にわたって確実に覆われる。つまり、逸脱幅の大きさは場所によって変わる可能性があるが、逸脱幅を覆うために必要な最大本数の内周周回経路を作成することで、塗り残しが生じなくなる。

走行領域を取得するステップは、自律走行体によって走行領域の境界を教示して外周教示経路を作成することで走行領域を取得してもよい。

この方法は、下記のステップをさらに備えていてもよい。
◎外周教示経路に基づいて作成される外周周回経路、塗り潰し走行経路、及び内周周回経路を連続的に繋いで自律走行経路として決定するステップ。
この方法では、外周周回経路を含んだ自律走行経路が計画される。

この方法は、下記のステップをさらに備えていてもよい。
◎塗り潰し走行経路の開始位置を外周周回経路上に設定するステップ
◎塗り潰し走行経路の終了位置を外周周回経路より内側の開始位置付近に設定するステップ。
これにより、塗り潰し走行経路の終了位置が明確になる。さらに、終了位置が開始位置付近に設定されるので、連続走行をスムーズに行うことができる。
さらに、開始位置から内側にずらした位置を終了位置にすることで、外周周回経路上の終了位置（＝開始位置）に戻る経路を計画するときに、教示範囲から経路が逸脱することが防止される。

この方法は、下記のステップをさらに備えていてもよい。
◎環境変動検出用のテスト走行経路を作成するステップ。
◎自律走行体にテスト走行経路を走行させるステップ。
従来、塗り潰し走行において環境変動が発生した場合、途中で自己位置を見失い、計画された走行経路に自律走行体が追従できないことを防止するために走行を停止させていた。この場合、停止地点の周辺を含む以降の塗り残し箇所について、走行範囲の再度教示や経路作成が必要となる。
この方法では、自律走行体にテスト走行経路を走行させることで、塗り潰し走行の事前に環境変動を検出できる。したがって、従来とは異なり、実際の自律走行時に環境変動による影響を受けにくい。

この方法は、下記のステップをさらに備えていてもよい。
◎自律走行体がテスト走行経路を走行中に検出した環境変動を通知するステップ。
この方法では、ユーザが環境変動に直ちに気付くことができる。
この方法は、下記のステップをさらに備えていてもよい。
◎自律走行体がテスト走行経路を走行中に環境変動を検出した後に、テスト走行を中止するステップ。
この方法では、ユーザが走行範囲の再教示を直ちに開始できる。

この方法は、下記のステップをさらに備えていてもよい。
◎テスト走行を中止した後に、自律走行体をテスト走行経路上の地点に戻すステップ。
この方法では、ユーザが走行範囲の再教示を直ちに開始できる。
この方法は、下記のステップをさらに備えていてもよい。
◎テスト走行を中止した後に、自律走行体を走行領域内の地点に移動するステップ。
この方法では、例えば、テスト走行スタート位置と塗り潰しスタート位置が異なる場合に、自律走行体を塗り潰しスタート位置に移動させることができる。

本発明に係る自律走行経路計画方法では、グリッドベースによる自律走行経路計画において、走行領域の外周境界から外側に自律走行体が逸脱しないようにできる。

第１実施形態の自律走行装置の一例の全体構成を示す図。 走行経路教示部の構成の一例を示す図。 設定部の構成を示す図。 制御部の全体構成を示す図。 走行制御部の詳細構成を示す図。 制御統括部の詳細構成を示す図。 走行領域内経路作成部の詳細構成を示す図。 自律走行装置の基本的な動作を示すフローチャート。 手動操作教示モードの動作を示すフローチャート。 走行環境の一例を示す図。 グローバルマップにグリッドレイヤーを投影しさらに走行領域を重ねた状態を示す図。 走行領域を矩形領域に分割した状態の一例を示す図。 走行領域内経路の一例を示す図。 自律走行モードの実行時の自律走行装置の動作を示すフローチャート。 矩形領域内経路作成制御動作を示すフローチャート。 外周周回経路、第１グリッド領域、第２グリッド領域、内周周回経路、塗り潰し経路の関係を示す模式的平面図。 外周周回経路、第１グリッド領域、第２グリッド領域、内周周回経路、塗り潰し経路の関係を示す模式的平面図。 外周周回経路、第１グリッド領域、第２グリッド領域、内周周回経路、塗り潰し経路の関係を示す模式的平面図。 第１実施形態において走行経路が表された環境地図。 従来例において走行経路が表された環境地図。 第３実施形態のテスト走行経路作成及びテスト走行制御動作を示すフローチャート。 テスト走行経路の模式的平面図。 第１変形例のテスト走行経路の模式的平面図。 第２変形例のテスト走行経路の模式的平面図。 第３変形例のテスト走行経路の模式的平面図。 第４変形例のテスト走行経路の模式的平面図。 第５変形例のテスト走行経路の模式的平面図。 第６変形例のテスト走行経路の模式的平面図。 第７変形例のテスト走行経路の模式的平面図。

１．第１実施形態
（１）自律走行装置の全体構成
図１を用いて、第１実施形態に係る自律走行装置１００（自律走行体の一例）の全体構成を説明する。図１は、自律走行装置の一例の全体構成を示す図である。自律走行装置１００は、設定された清掃条件と走行経路とを自律的に再現する清掃機である。
自律走行装置１００は、走行部１を備える。走行部１は、自律走行装置１００を走行させる装置である。走行部１は、自律走行装置１００の本体を構成する本体Ｂを有する。走行部１は、本体Ｂの底部の左右端にそれぞれ、走行モータ１１と、走行モータ１１の出力回転軸に取り付けられ、走行モータ１１の回転に従って回転する主輪１３と、を有する。

自律走行装置１００は、清掃部３を備える。清掃部３は、本体Ｂの底部に設けられ、指定された清掃条件に従って床面Ｆを清掃する装置である。本実施形態の清掃部３は、洗浄液吐出口３１と、スキージ３３と、洗浄用部材３５と、を有する。
洗浄液吐出口３１は、洗浄液供給タンク３１１から洗浄液供給ポンプ３１３により供給された洗浄液（例えば、水）を、本体Ｂの前方側の床面Ｆに吐出する。スキージ３３は、本体Ｂの底面後方に設けられ、床面Ｆ上に残留する洗浄液を収集する。洗浄用部材３５は、本体Ｂの底面の前方側に設けられ、洗浄用部材回転モータ３５１の回転にて洗浄液が存在する床面Ｆ上にて回転することにより、床面Ｆを洗浄する。
上記の清掃部３を備えることにより、自律走行装置１００は、洗浄液を用いて床面Ｆを洗浄用部材３５にて磨く清掃作業を実行できる。
他の実施形態において、スキージ３３には吸引口３３ａが設けられていてもよい。吸引口３３ａは、吸引モータ３３１により回収部材３３３を負圧状態にすることにより、スキージ３３により収集された洗浄液やゴミなどを吸引して、回収部材３３３へと搬送できる。

自律走行装置１００は、制御部５を有する。制御部５は、ＣＰＵ、記憶装置（ＲＡＭ、ＲＯＭ、ハードディスクドライブ、ＳＳＤなど）、各種インターフェースなどを備えたコンピュータシステムである。制御部５は、自律走行装置１００に関する各種制御を行う（後述）。
自律走行装置１００は、走行経路教示部７を備える。走行経路教示部７は、操作者による走行部１の移動操作を受け付ける装置である。走行経路教示部７は、取付部材８を介して、本体Ｂの上部後側に取り付けられている。これにより、操作者は、走行経路教示部７を操作して走行部１を移動操作できる（後述）。

他の実施形態として、走行経路教示部７は、本体Ｂに取り付けられていなくともよい。この場合、走行経路教示部７は、例えば、ジョイスティックなどのコントローラである。これにより、操作者は、自律走行装置１００を遠隔操作できる。

自律走行装置１００は、設定部９を備える。設定部９は、自律走行装置１００に関する各種設定を行うための操作盤であり、本体Ｂの上方後側の表面に取り付けられている。また、設定部９は、走行経路教示部７の近傍に設けられている。これにより、操作者は、走行経路教示部７を操作して走行部１を操作しつつ、設定部９を操作できる。
他の実施形態として、設定部９は、本体Ｂに取り付けられていなくてもよい。この場合、設定部９は、例えば、ポータブル端末などの無線通信可能なコンソールとできる。これにより、操作者は、自律走行装置１００を遠隔にて設定できる。

（２）走行経路教示部の構成
図２を用いて、走行経路教示部７の構成の一例を説明する。図２は、走行経路教示部の構成の一例を示す図である。
走行経路教示部７は、ハンドル７１ａ、７１ｂを有する。ハンドル７１ａ、７１ｂは、それぞれ、筐体７３の左右側面に取り付けられている。ハンドル７１ａ、７１ｂは、操作者が自律走行装置１００を操作するときに使用される。

例えば、ハンドル７１ａ、７１ｂを把持する操作者は、ハンドル７１ａ、７１ｂを介して、自律走行装置１００を操作者の方へ引張る力、又は、自律走行装置１００を押し出す力のいずれかを加えることができる。ハンドル７１ａ、７１ｂのそれぞれにかける力を調節することにより、操作者は、自律走行装置１００の走行方向を調整できる。例えば、自律走行装置１００の前方方向から見て右側のハンドル７１ａに対して、自律走行装置１００を引張る力を加えれば、自律走行装置１００は左へと方向転換する。

ハンドル７１ａ、７１ｂは、筐体７３に回動可能に取り付けられている。また、ハンドル７１ａ、７１ｂは、走行制御指令算出部７５を介して制御部５に接続されている。走行制御指令算出部７５は、ハンドル７１ａ、７１ｂの回動を電気信号に変換し、制御部５に出力する。これにより、操作者は、ハンドル７１ａ、７１ｂの回動操作によって、自律走行装置１００（走行部１）を操作できる。
例えば、ハンドル７１ａ、７１ｂの回動方向を調整することにより、操作者は、自律走行装置１００の前進と後進とを切り替え可能となっていてもよい。また、ハンドル７１ａ、７１ｂの回動量を調節することにより、自律走行装置１００の走行速度を調整可能となっていてもよい。さらに、ハンドル７１ａの回動量と、ハンドル７１ｂの回動量とを異ならせて、自律走行装置１００の進行方向を変更してもよい。

（３）設定部の構成
図３を用いて、設定部９の構成を説明する。図３は、設定部の構成を示す図である。
設定部９は、切替部９１を有する。切替部９１は、自律走行装置１００の動作モードを選択し、制御部５に出力する。自律走行装置１００の動作モードとしては、自律走行モードと手動操作モードとがある。自律走行モードは、自律走行装置１００が、自律的に走行し床面Ｆを洗浄する動作モードである。手動操作モードは、自律走行装置１００が操作者により手動操作可能な状態にある動作モードである。
切替部９１は、例えば、図３に示すような切り替えスイッチにて構成できる。

設定部９は、手動操作記憶スイッチ９２を有する。手動操作記憶スイッチ９２は、操作者による自律走行装置１００の手動操作の記憶を開始又は終了するためのスイッチである。具体的には、切替部９１により動作モードが手動操作モードに設定された後に手動操作記憶スイッチ９２が押されると、操作者の手動操作により実行された清掃条件及び走行経路を、自律走行装置１００に教示する手動操作教示モードが、手動操作モードのサブ動作モードとして開始する。一方、手動操作教示モードを実行中に手動操作記憶スイッチ９２が切り替わると、手動操作教示モードが停止される。
手動操作記憶スイッチ９２としては、例えば、図３に示すような押ボタンスイッチとすることができる。この場合、手動操作記憶スイッチ９２の切り替えは、当該押ボタンスイッチを押すことにより切り替わる。

設定部９は、設定操作部９３を有する。設定操作部９３は、例えば押圧スイッチなどにより構成され、自律走行装置１００に関する各種設定の入力を受け付けて、設定変換部９４を介して、制御部５に出力する。
設定変換部９４は、設定操作部９３にて受け付けた入力を、制御部５が解読可能な信号に変換する信号変換回路、又は、コンピュータシステムである。

設定部９はディスプレイ９５を有する。ディスプレイ９５は、現在設定されている自律走行装置１００に関する各種設定情報を表示する。ディスプレイ９５は、例えば、液晶ディスプレイ、有機ＥＬディスプレイなどのディスプレイである。
他の実施形態において、ディスプレイ９５は、現在の動作モード（自律走行モード／手動操作モード／手動操作教示モード）、運転時間、自律走行装置１００を駆動するバッテリー残量などをさらに表示してもよい。
さらなる他の実施形態において、ディスプレイ９５は、設定操作部９３により自律走行装置１００の各種設定を行う際に、各種設定手順を表示してもよい。これにより、自律走行装置１００に関する情報を視覚的にユーザに提供し、ユーザは表示された情報に基づいて、設定部９を操作できる。

他の実施形態において、ディスプレイ９５にはタッチパネルが設けられていてもよい。この場合、上記の切替部９１、手動操作記憶スイッチ９２、及び／又は設定操作部９３は、当該タッチパネルにより実現されてもよい。
設定部９は、清掃条件教示部９６を有してもよい。清掃条件教示部９６は、操作者による清掃条件の入力を受け付けて、清掃制御指令算出部９７へ出力する。清掃制御指令算出部９７は、清掃条件教示部９６にて受け付けた清掃条件を、制御部５が解読可能な信号に変換して制御部５に出力する信号変換回路、又は、コンピュータシステムである。

（４）制御部の構成
（４－１）制御部の全体構成
図４を用いて、制御部５の全体構成を説明する。図４は、制御部の全体構成を示す図である。以下に説明する制御部５の各機能ブロックの全部又は一部は、制御部５を構成するコンピュータシステムにて実行可能なプログラムにより実現されてもよい。この場合、当該プログラムは、メモリ部及び／又は記憶装置に記憶されていてもよい。制御部５の各機能ブロックの全部又は一部は、ＳｏＣ（Ｓｙｓｔｅｍ ｏｎ Ｃｈｉｐ）などのカスタムＩＣとして実現されていてもよい。
制御部５は、１つのコンピュータシステムにより構成されていてもよいし、複数のコンピュータシステムにより構成されていてもよい。複数のコンピュータシステムにより制御部５を構成する場合、例えば、制御部５の複数の機能ブロックにて実現される機能を複数のコンピュータシステムに任意の割合で振り分けて実行させることができる。

制御部５は、清掃制御部５１を有する。清掃制御部５１は、洗浄用部材回転モータ３５１と、洗浄液供給ポンプ３１３と、吸引モータ３３１に対して、回転速度や出力などを制御する電力を供給する。
設定部９が清掃条件教示部９６を有する実施例では、清掃制御部５１は、清掃制御指令算出部９７を介して清掃条件教示部９６から教示清掃条件を入力し、当該教示清掃条件に基づいて、洗浄用部材回転モータ３５１と、洗浄液供給ポンプ３１３と、吸引モータ３３１と、を制御してもよい。
他の実施形態において、清掃制御部５１は、自律走行モードの実行時に、制御統括部５５から、自律走行モードにおける清掃条件の設定値を示す再現清掃条件を入力し、当該再現清掃条件に基づいて、清掃部３を制御してもよい。

制御部５は、走行制御部５３を有する。走行制御部５３は、走行経路教示部７から入力したハンドル７１ａ、７１ｂの回動量及び回動方向に基づく走行制御指令、又は、制御統括部５５から入力した走行制御指令に基づき、走行モータ１１を制御する。
また、走行制御部５３は、走行モータ１１の出力回転軸に取り付けられたエンコーダ１１１から出力されるパルス信号に基づいて、走行モータ１１の回転速度を算出する。
制御部５は、制御統括部５５を有する。制御統括部５５は、自律走行装置１００による走行を統括する。具体的には、制御統括部５５は、前方検出器５５５１ａ、後方検出器５５５１ｂ、及び／又はエンコーダ１１１にて取得された情報に基づいて、自律走行装置１００が床面Ｆのどの位置を移動しているかを示す位置情報を算出する。
制御統括部５５は、手動操作教示モードの実行時における上記の位置情報を用いて、走行スケジュール５００を作成する。他の実施形態において、制御統括部５５は、自律走行モードにおける清掃条件を算出し、走行スケジュール５００と関連付けてもよい。

一方、自律走行モードの実行時においては、制御統括部５５は、走行スケジュール５００に記憶されたデータに基づいて再現走行制御指令を算出し、走行制御部５３に出力する。これにより、自律走行モードの実行時においては、走行制御部５３は、再現走行制御指令に基づいて走行モータ１１を制御することで、自律走行装置１００を自律的に移動させることができる。
走行スケジュール５００に清掃条件が関連付けられている実施形態では、制御統括部５５は、自律走行モードの実行時において、走行スケジュール５００に記憶された清掃条件に基づいて、清掃制御部５１を制御してもよい。これにより、自律走行装置１００は、走行スケジュール５００に従って自律的に走行中に、当該清掃条件に従って自律的に清掃作業を実行できる。

制御部５は、記憶部５７を有する。記憶部５７は、制御部５を構成するコンピュータシステムの記憶装置の記憶領域の一部又は全部であり、自律走行装置１００に関する各種情報を記憶する。具体的には、記憶部５７は、制御統括部５５において作成された走行スケジュール５００、及び、設定操作部９３や設定変換部９４から入力された自律走行装置１００に関する各種設定を記憶する。
走行制御部５３、及び制御統括部５５は、記憶部５７に記憶された自律走行装置１００に関する各種設定、及び／又は、走行スケジュール５００を必要に応じて読み出して、これらに基づいて各種の調整及び制御を実行できる。

（４－２）走行制御部の構成
図５を用いて、走行制御部５３の構成を詳細に説明する。図５は、走行制御部の詳細構成を示す図である。
走行制御部５３は、走行切替部５３１を有する。走行切替部５３１は、３つの端子ｄ、ｅ、及びｆを有している。端子ｄは走行経路教示部７に接続され、端子ｅはモータ制御部５３３に接続され、端子ｆは制御統括部５５に接続されている。

走行切替部５３１は、切替部９１により選択されている動作モードに基づいて、端子ｅと端子ｄとを接続するか、あるいは、端子ｅと端子ｆとを接続するかのいずれかを選択する。
具体的には、切替部９１において手動操作モードが選択されていれば、走行切替部５３１は、端子ｅと端子ｄとを接続することで、走行経路教示部７をモータ制御部５３３に接続する。これにより、走行切替部５３１は、手動操作モード又は手動操作教示モードの実行時には、走行経路教示部７のハンドル７１ａ、７１ｂの回動量及び／又は回転方向を示す信号を、モータ制御部５３３に送信できる。
一方、切替部９１において自律走行モードが選択されていれば、走行切替部５３１は、端子ｅと端子ｆとを接続することで、制御統括部５５をモータ制御部５３３に接続する。これにより、走行切替部５３１は、自律走行モードの実行時には、制御統括部５５から出力される再現走行制御指令を、モータ制御部５３３に送信できる。

モータ制御部５３３は、入力されたハンドル７１ａ、７１ｂの回動量／回動方向、又は、再現走行制御指令に基づいて、走行モータ１１の目標回転速度を算出し、当該目標回転速度にて走行モータ１１を回転させるための駆動電力を、走行モータ１１に出力する。
モータ制御部５３３は、エンコーダ１１１からのパルス信号に基づいて実際の走行モータ１１の回転速度を算出しフィードバックして、走行モータ１１に出力すべき駆動電力を算出する。従って、モータ制御部５３３は、例えば、ＰＩ（Ｐｒｏｐｏｒｔｉｏｎａｌ Ｉｎｔｅｇｒａｌ）制御理論や、ＰＩＤ（Ｐｒｏｐｏｒｔｉｏｎａｌ Ｉｎｔｅｇｒａｌ Ｄｉｆｆｅｒｅｎｔｉａｌ）制御理論などを用いて走行モータ１１を制御する。
本実施形態においては、本体Ｂの底部の左右端のそれぞれに、走行モータ１１及び主輪１３が設けられている。このような場合、モータ制御部５３３は、左右２つの走行モータ１１のそれぞれの回転速度及び回転方向を独立に制御して、自律走行装置１００の進行方向を決定する。
他の実施形態において、制御部５が複数のコンピュータシステムにて構成される場合、モータ制御部５３３は、当該複数のコンピュータシステムのうちの１つであってもよい。すなわち、モータ制御部５３３の機能のみを１つのコンピュータシステムにて実現してもよい。この場合、モータ制御部５３３は、例えば、ＰＩ制御理論又はＰＩＤ制御理論を用いたモータ制御装置である。

（４－３）制御統括部の構成
図６を用いて、制御統括部５５の構成を詳細に説明する。図６は、制御統括部の詳細構成を示す図である。
制御統括部５５は、走行領域取得部５５１を有する。走行領域取得部５５１は、手動操作教示モードの実行時に、所定時間毎（例えば、制御部５における制御周期毎）に、ＳＬＡＭ部５５５（後述）から、ＳＬＡＭ部５５５にて推定された位置情報（後述）を入力する。
走行領域取得部５５１は、走行環境において自律走行装置１００が走行する領域を表す走行領域ＴＡを、取得した複数の位置情報の点列として取得する。走行領域取得部５５１は、取得した複数の位置情報の点列を、走行領域ＴＡの外周境界を表す点列として、走行領域内経路作成部５５３に出力する。
他の実施形態において、走行領域取得部５５１は、予め作成したグローバルマップＧＭ（走行環境を表す地図情報）をディスプレイ９５に表示させてもよい。このとき、走行領域取得部５５１は、操作者に対して、ディスプレイ９５に表示されたグローバルマップＧＭ上に、走行領域ＴＡを表す閉じられた領域を描画するように指示をしてもよい。

制御統括部５５は、走行領域内経路作成部５５３（経路計画装置の一例）を有する。走行領域内経路作成部５５３は、走行領域取得部５５１から取得した走行領域ＴＡ内に、自律走行装置１００が当該走行領域ＴＡをまんべんなく（「塗り潰す」ように）走行する走行スケジュール５００を作成し、記憶部５７に記憶する。
図７に示すように、走行領域内経路作成部５５３は、グリッド作成部５５３１、走行順番決定部５５３２、逸脱幅算出部５５３３、逸脱判定部５５３４、及び走行経路計画部５５３５を有している。

グリッド作成部５５３１は、グローバルマップＧＭにおいて塗り潰し走行を行う対象領域を所定サイズのグリッドで区画する。具体的には、グリッド作成部５５３１は、グローバルマップＧＭとは別の座標軸であるグリッドレイヤーＧＬにグローバルマップＧＭを投影し、グリッドレイヤーＧＬ上で対象領域を所定サイズのグリッドＧＲで区画する。このようにグリッドレイヤーＧＬとグローバルマップＧＭを別々に管理できるので、作業効率が良い。なお、グリッドレイヤーＧＬ上の対象領域は、グローバルマップＧＭ内に一又は複数設定される。

走行順番決定部５５３２は、走行対象であるグリッドＧＲに走行順を決定する。なお、走行順とは、自律走行装置１００が通過するグリッドＧＲの順番である。

走行経路計画部５５３５は、選択した走行対象であるグリッドを通る走行経路を計画する（後述）。
制御統括部５５は、ＳＬＡＭ部５５５を有する。ＳＬＡＭ部５５５は、本体Ｂの前方に設けられた前方検出器５５５１ａ（図１）にて取得した自律走行装置１００の前方に存在する障害物に関する情報と、本体Ｂの後方に設けられた後方検出器５５５１ｂ（図１）にて取得した自律走行装置１００の後方に存在する障害物に関する情報と、エンコーダ１１１にて取得した走行モータ１１の回転量に基づいて、自律走行装置１００の所定の座標上の位置に関する情報（位置情報）を推定する。

前方検出器５５５１ａ及び後方検出器５５５１ｂは、例えば、その検出範囲が１８０°以上のレーザーレンジファインダ（Ｌａｓｅｒ Ｒａｎｇｅ Ｆｉｎｄｅｒ、ＬＲＦ）である。レーザーレンジファインダを前方検出器５５５１ａ及び後方検出器５５５１ｂとして用いた場合、走行部１と障害物との距離と、当該障害物が存在する方向とが、障害物に関する情報として取得される。
前方検出器５５５１ａ及び後方検出器５５５１ｂにて取得される情報は、所定の平面上における障害物の存在位置を表す二次元的な情報であってもよいし、さらに高さ方向における障害物の存在位置を表す情報を含めて三次元的な情報であってもよい。

制御統括部５５は、走行再現部５５７を有する。走行再現部５５７は、自律走行モードを実行する時に、走行スケジュール５００に記憶された情報と、ＳＬＡＭ部５５５から取得した推定された位置情報とに基づいて、自律走行装置１００が走行スケジュール５００に示された走行経路を自律的に走行するための制御指令（再現走行制御指令）を算出する。走行再現部５５７は、算出した再現走行制御指令を走行制御部５３に出力する。
他の実施形態において、走行再現部５５７は、走行スケジュール５００に関連付けられた清掃条件を、清掃制御部５１に出力してもよい。

（４－４）ＳＬＡＭ部の構成
図６を用いて、ＳＬＡＭ部５５５の構成の詳細を説明する。本実施形態に係るＳＬＡＭ部５５５は、ＳＬＡＭ（Ｓｉｍｕｌｔａｎｅｏｕｓ Ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ Ｍａｐｐｉｎｇ）法にて、走行部１（自律走行装置１００）の位置（位置情報）推定と地図情報の作成とを実行する。
ＳＬＡＭ部５５５は、地図作成部５５５３を有する。地図作成部５５５３は、前方検出器５５５１ａにて取得された前方の障害物（例えば、壁など）に関する情報、後方検出器５５５１ｂにて取得された後方の障害物に関する情報と、を用いて地図情報を作成する。地図情報は、位置推定部５５５５において位置情報を推定する際に用いられる。地図情報としては、ローカルマップとグローバルマップＧＭ（環境地図の一例）とが存在する。

ローカルマップは、走行部１の周囲に存在する障害物（の存在位置）に関する地図情報である。ローカルマップは、前方検出器５５５１ａにて取得された前方の障害物に関する情報と、後方検出器５５５１ｂにて取得された後方の障害物に関する情報とを、必要に応じて座標変換することにより作成される。
グローバルマップＧＭは、走行部１が走行する環境（走行環境）に存在する障害物（の存在位置）に関する地図情報である。本実施形態において、グローバルマップＧＭは、操作者の操作によって走行する手動操作教示モードの実行時に走行領域ＴＡを表す位置情報の点列を取得したときに取得したローカルマップに基づいて生成される。つまり、グローバルマップＧＭは、自律走行装置１００が教示走行を行うことで作成され、塗り潰し走行を行う対象領域は教示走行時の走行軌跡で画定される。

具体的には、地図作成部５５５３は、走行領域ＴＡを表す位置情報の点列とともに取得したローカルマップを、当該位置情報に対応する位置に配置することでグローバルマップＧＭを作成する。
走行領域ＴＡを表す位置情報の点列を取得する際に、手動操作教示モードの初期に取得した位置情報と、手動操作教示モードの終盤に取得した位置情報との間には、誤差が生じる場合がある。具体的には、例えば、閉じられた領域である走行領域ＴＡを位置情報の点列として取得する際に、手動操作教示モードの開始時の走行部１の位置と終了時の走行部１の位置とが同一であるに関わらず、推定された位置情報が一致しないことがある（いわゆる、環状経路問題）。

上記の推定された位置情報の不一致を解消するため、地図作成部５５５３は、ローカルマップを対応する位置に配置して作成したグローバルマップＧＭを修正する。具体的には、例えば、以下のようにしてグローバルマップを修正する。
最初に、地図作成部５５５３は、手動操作教示モードの開始時と終了時に、前方検出器５５５１ａにて取得された障害物に関する情報、及び／又は、後方検出器５５５１ｂにて取得された障害物に関する情報を取得する。

次に、地図作成部５５５３は、手動操作教示モードの開始時に得られた障害物に関する情報と終了時に得られた障害物に関する情報との差分などに基づいて、手動操作教示モードの開始時と終了時における走行部１の実際の位置のずれを算出する。
その後、地図作成部５５５３は、算出した実際の位置のずれに基づいて、例えばＧｒａｐｈＳＬＡＭなどのアルゴリズムを用いて、ローカルマップの配置位置を修正し、修正した新たな配置位置にローカルマップを配置して、新たなグローバルマップＧＭを作成する。

このとき、地図作成部５５５３は、手動操作教示モードを実行することにより取得した走行領域ＴＡを表す点列の位置情報（座標値）も、Ｇｒａｐｈ ＳＬＡＭなどのアルゴリズムを用いて同時に修正し、修正した新たな位置情報の点列を走行領域ＴＡを表す点列としてもよい。
上記のようにしてグローバルマップＧＭを修正することにより、走行環境をより適切に表したグローバルマップＧＭを作成できる。また、グローバルマップＧＭの修正時に、走行領域ＴＡを表す位置情報を修正することにより、閉じられた領域である走行領域ＴＡをより適切に表した位置情報の点列を取得できる。
他の実施形態において、グローバルマップＧＭは、専用のソフトウェア又はＣＡＤなどを用いて作成されて記憶部５７に記憶されてもよい。この場合、当該ソフトウェアなどで作成したグローバルマップは、走行部１の制御部５が解釈できるようなデータに変換される。

ＳＬＡＭ部５５５は、位置推定部５５５５を有する。位置推定部５５５５は、地図作成部５５５３が生成したグローバルマップと、ローカルマップと、走行モータ１１の回転量と、に基づいて、所定の座標上の走行部１の存在位置及び当該位置における走行部１の姿勢に関する位置情報を推定する。
具体的には、以下のようにして位置情報が推定される。ここでは、走行部１がある所定の時刻（時刻ｔｋとする）における（推定）位置から移動して、次の時刻（時刻ｔｋ＋１とする）にて走行部１が到達する位置を推定する場合を例として考える。
最初に、位置推定部５５５５は、時刻ｔｋから時刻ｔｋ＋１までの間にエンコーダ１１１から出力されたパルス数から、時刻ｔｋから時刻ｔｋ＋１までの間の主輪１３の回転量を算出し、当該回転量に基づいて、主輪１３の回転による走行部１の移動距離と姿勢変化とを推定する（デッドレコニング）。

次に、位置推定部５５５５は、時刻ｔｋにおける事後確率（走行部１の位置と、時刻ｔｋにおいて当該位置に走行部１が存在する確率と、の関係を表した確率分布に対応する）を、主輪１３の回転による走行部１の移動距離分及び姿勢変化分だけ移動させて、時刻ｔｋ＋１における事前確率を算出する。
他の実施形態において、位置推定部５５５５は、主輪１３の回転による移動距離分及び姿勢変化分だけ移動後の事後確率の確率分布の幅（標準偏差）を拡大して、時刻ｔｋ＋１における事前確率としてもよい。これにより、主輪１３と床面Ｆとの滑りを考慮した事前確率を算出できる。

その後、位置推定部５５５５は、時刻ｔｋ＋１におけるローカルマップとグローバルマップとを地図作成部５５５３から取得し、時刻ｔｋ＋１におけるローカルマップとグローバルマップＧＭとをマップマッチングし、時刻ｔｋ＋１における走行部１の位置情報を推定する。
具体的には、例えば、グローバルマップＧＭ上において、主輪１３の回転量に基づいて算出された推定位置の近傍のいくつかの位置に、時刻ｔｋ＋１におけるローカルマップを配置し、当該ローカルマップをその中心回りに取りうる姿勢変化に対応する角度だけ回転させて、マップマッチングを行う。
位置推定部５５５５は、当該マップマッチングの結果に基づいて、尤度（ローカルマップ情報を配置した位置と、当該位置におけるグローバルマップＧＭとローカルマップ情報との一致度と、の関係を表すものに対応）を算出する。

その後、位置推定部５５５５は、尤度と時刻ｔｋ＋１における事前確率とを乗算することにより、時刻ｔｋ＋１における事後確率を算出する。位置推定部５５５５は、時刻ｔｋ＋１における事後確率が最大値となる位置及び姿勢、すなわち、走行部１が存在する可能性が最も高いと推定される位置、及び、当該位置において走行部１がとりうる最も可能性が高い姿勢を、時刻ｔｋ＋１における走行部１の存在位置（推定位置）及び当該存在位置における姿勢（推定姿勢）と推定する。
時刻ｔｋ＋１における事後確率は、次の位置推定において事前確率として使用される。
上記のように、位置推定部５５５５が、主輪１３の回転量に基づいた移動距離と、前方検出器５５５１ａ及び後方検出器５５５１ｂとを用いて得られた地図情報と、を用いて位置推定を実行することにより、主輪１３の回転量に基づいた移動距離に含まれる誤差（主に、主輪１３と床面Ｆとの間の滑りに起因）と、地図情報に含まれる誤差（主に、前方検出器５５５１ａ及び後方検出器５５５１ｂにて取得した情報に含まれるノイズ成分に起因）とを相補的に減少させて、精度のよい位置推定を実行できる。

ＳＬＡＭ部５５５は、経過時間決定部５５５７を有する。経過時間決定部５５５７は、自律走行モードの実行開始からの経過時間を決定する。具体的には、経過時間決定部５５５７は、自律走行モードの実行開始からの経過時間を、位置推定部５５５５にて推定された位置情報に基づき決定する。
より具体的には、例えば、走行スケジュール５００に記憶されている位置情報のうち、位置推定部５５５５にて推定された走行部１の位置情報に最も近い位置情報に関連付けられている時間を、自律走行モードの実行開始からの経過時間とする。

（５）自律走行装置の動作
（５－１）基本動作
図８を用いて、自律走行装置１００の基本的な動作を説明する。図８は、自律走行装置の基本的な動作を示すフローチャートである。
ステップＳ１では、自律走行装置１００が動作を開始すると、制御部５は、切替部９１の状態を確認する。切替部９１が「自動」を選択している場合（「自律走行モード」の場合）、プロセスはステップＳ２に移行して自律走行モードが実行される。具体的には、記憶部５７に記憶された走行スケジュール５００に従って、自律走行装置１００は自律的に清掃作業を実行する。

一方、切替部９１が「手動」を選択している場合（「手動操作モード」の場合）、制御部５は、実行すべき動作モードが手動操作モードと判断する。
ステップＳ３では、手動操作モードを実行中に手動操作記憶スイッチ９２が押されたことを検知したか否かが判断される。検知した場合、プロセスはステップＳ４に移行し動作モードを手動操作教示モードに移行させられる。その結果、手動操作記憶スイッチ９２が押されたタイミング以降の操作者による走行部１の操作が記憶される。

また、手動操作教示モードにおいては、制御統括部５５は、操作者による走行部１の操作にて決定した走行領域ＴＡ内を自律走行装置１００に走行させるための走行スケジュール５００を作成する。
一方、手動操作記憶スイッチ９２が押されたことが検知されない場合には、プロセスはステップＳ５に移行して操作者の操作を記憶しない手動操作モードの実行を維持する。

上記のステップＳ４において手動操作教示モードを実行中に、制御部５は、手動操作記憶スイッチ９２が押されたか否かをモニターする。手動操作教示モードの実行中に手動操作記憶スイッチ９２が押された場合には、そのタイミングで動作モードが手動操作モードに切り替わり、当該タイミング以降の清掃作業が走行スケジュール５００に記憶されなくなる。すなわち、手動操作教示モードの実行時に手動操作記憶スイッチ９２を押すことにより、操作者は、清掃作業の途中の任意のタイミングにてその記憶（教示）を停止できる。
上記のように、本実施形態に係る自律走行装置１００は、切替部９１における動作モードの選択、及び、手動操作記憶スイッチ９２が押されたか否かに応じて、自律走行モード、手動操作モード、及び手動操作教示モードを実行できる。

（５－２）手動操作教示モードの動作（概略説明）
図９～図１３を用いて上記のステップＳ４において実行される手動操作教示モードの動作を説明する。図９は、手動操作教示モードの動作を示すフローチャートである。図１０は、走行環境の一例である。図１１は、グローバルマップにグリッドレイヤーを投影しさらに走行領域を重ねた状態を示す図である。図１２は、グローバルマップ上に走行領域を画定する様子の一例を示す図である。図１３は、走行領域内経路の一例を示す図である。
以下の説明では、図１０に示すような走行環境において設定された走行領域ＴＡ内をまんべんなく「塗り潰す」走行領域内経路を計画し、走行スケジュール５００として作成する。

ステップＳ１１では、手動操作教示モードにおいて走行スケジュール５００を作成するにあたり、制御統括部５５は、走行環境を表すグローバルマップＧＭを作成する。
最初に、手動操作記憶スイッチ９２が押された後に自律走行装置１００の手動操作を開始するか、又は、手動操作中に手動操作記憶スイッチ９２が押されて、手動操作教示モードが開始されると、操作者は、走行経路教示部７を用いて自律走行装置１００を操作する。操作者は、走行領域ＴＡとしたい領域の外周境界に沿って、自律走行装置１００を走行させる。

操作者による操作により自律走行装置１００が走行中、地図作成部５５５３が、所定の時間毎に、ローカルマップを取得する。図１０に示すように、自律走行装置１００が走行を開始した開始点ＳＴから、走行領域ＴＡの外周境界とする閉じられた経路を走行し、再度開始点ＳＴ又はその近傍まで戻ってきた後、地図作成部５５５３は、取得したローカルマップを対応する位置に配置してグローバルマップＧＭを作成する。その後、地図作成部５５５３は、必要に応じて、Ｇｒａｐｈ ＳＬＡＭアルゴリズムなどを用いて、当該グローバルマップＧＭを修正する。

一方、グローバルマップＧＭに対応するグリッドレイヤーＧＬが用意されている。グリッドレイヤーＧＬは、グリッド作成部５５３１によって適宜作成される。グリッドレイヤーＧＬは、多数のグリッドＧＲの集合体である。グリッドＧＲは、走行環境においては、所定の面積を有する小領域に対応する。グリッドサイズは、例えば、５０×５０ｃｍである。このようにグローバルマップＧＭとは別の座標軸であるグリッドレイヤーＧＬを用いているので、両者を別々に管理することができ、そのため作業効率が良い。

また、制御部５を構成するコンピュータシステムにおいては、当該グリッドＧＲを、例えばグリッドに関するパラメータ（例えば、グリッドＧＲを識別するパラメータ、グリッドＧＲの位置情報、グリッドＧＲの有効無効、グリッドＧＲに付与されたスコア、など）を含む「構造体」として定義できる。

ステップＳ１２では、グローバルマップＧＭを作成後、走行環境において自律走行装置１００が走行する領域を表す走行領域ＴＡが、グローバルマップＧＭ上に画定される。具体的には、以下のようにして、走行領域ＴＡがグローバルマップＧＭ上に画定される。

最初に、上記のステップＳ１１を実行中、すなわち、自律走行装置１００を走行領域ＴＡの外周境界に沿って走行させる間に、走行領域取得部５５１が、所定の時間毎に、位置推定部５５５５にて推定された位置情報を走行領域ＴＡの外周境界を表す点として取得する。

これにより、走行領域取得部５５１は、自律走行装置１００が開始点ＳＴ（図１０）から点線にて示す経路に沿って走行し、開始点ＳＴ又はその近傍まで戻ってくるまでの間に取得した複数の位置情報を、走行領域ＴＡの外周境界を表す点列として取得できる。走行領域取得部５５１は、走行領域ＴＡの外周境界を表す位置情報の点列を、走行領域内経路作成部５５３に出力する。

次に、図１１に示すように、走行領域内経路作成部５５３は、グローバルマップＧＭ（実際には、グリッドレイヤーＧＬ）上に、走行領域ＴＡの外周境界を表す点列を配置する。走行領域ＴＡの外周境界を表す位置情報が、グリッドレイヤーＧＬのいずれのグリッドに配置されるかは、例えば、位置情報（グローバルマップ）を定義した座標系において、グリッドＧＲがどの座標値に存在するかにより決定できる。

その後、走行領域内経路作成部５５３は、図１２に示すように、走行領域ＴＡ内のグリッドＧＲ（図１２では白色のグリッド）と、走行領域ＴＡの点列がグリッド上にあるグリッド（図１２では白色のグリッド）が有効グリッドであると決定し、それ以外のグリッドＧＲについては無効グリッド（図１２では灰色のグリッド）であると決定する。
このようにして、走行領域内経路作成部５５３は、走行領域ＴＡには含まれないグリッドＧＲを新たに無効グリッドとすることにより、走行領域ＴＡを多数の有効グリッド（図１２においては、白色のグリッドＧＲ）にて構成される領域として、グローバルマップＧＭ上に画定できる。

ステップＳ１３では、グローバルマップＧＭ上に走行領域ＴＡを画定後、走行領域内経路作成部５５３は、走行領域ＴＡを矩形の領域（矩形領域ＲＡ）に分割する。走行領域ＴＡを矩形領域ＲＡに分割するにあたり、走行領域内経路作成部５５３は、走行領域ＴＡのどの部分に矩形領域ＲＡが存在するかを探索する。
ステップＳ１４では、走行領域ＴＡを矩形領域ＲＡ１～ＲＡ３に分割後、走行領域内経路作成部５５３は、各矩形領域ＲＡ１～ＲＡ３に対して、当該各矩形領域ＲＡ１～ＲＡ３内おける矩形領域内経路（後述）の始点グリッドを決定する。他の矩形領域ＲＡ２、ＲＡ３の始点グリッドは、後述するステップＳ１７において決定される。
ステップＳ１５では、走行領域内経路作成部５５３は、当該始点グリッドから開始し、対象の各矩形領域ＲＡ１～ＲＡ３に含まれる全ての有効グリッドを通過する走行経路である矩形領域内経路を作成する。

ステップＳ１６では、走行領域内経路作成部５５３は、矩形領域内経路を未だ作成していない矩形領域ＲＡ１～ＲＡ３が存在するか否かを判定する。
矩形領域内経路を作成していない矩形領域ＲＡ１～ＲＡ３が存在していない場合には、手動操作教示モードを終了する。
その一方、矩形領域内経路を作成していない矩形領域ＲＡ１～ＲＡ３が存在する場合、ステップＳ１７では、次にどの矩形領域ＲＡ２、ＲＡ３内を自律走行装置１００に走行させるかを決定する。
ステップＳ１８では、走行領域内経路作成部５５３は、矩形領域ＲＡ１の終点グリッドと、当該次に走行すべきと決定した矩形領域ＲＡ３の始点グリッドとを接続する走行経路（接続走行経路）を作成する。

その後、矩形領域内経路が全ての矩形領域ＲＡ１～ＲＡ３において作成されるまで、上記のステップＳ１５～Ｓ１８が繰り返し実行される。その結果、図１２などにて示した走行領域ＴＡに対して、最終的に図１３の太矢印にて示すような、設定された走行領域ＴＡ内を自律走行装置１００がまんべんなく走行する走行領域内経路が作成される。

走行領域内経路を作成後、走行領域内経路作成部５５３は、作成した走行領域内経路を、自律走行装置１００が通過する通過点（例えば、サブゴール）の集合に変換する（後述）。その後、走行領域内経路作成部５５３は、走行領域内経路を変換して生成した各通過点に対して当該通過点を通過する時間を関連付け、さらに、必要に応じて、各通過点における清掃条件を対応する通過点に関連付けることで、走行スケジュール５００を作成する。

手動操作教示モードにおいて、上記のステップＳ１１～Ｓ１８を実行することにより、走行環境を表すグローバルマップＧＭ上において走行領域ＴＡを指定するとの容易な方法により、自律走行装置１００が走行領域ＴＡをまんべんなく走行できる走行経路、すなわち、走行領域内経路を精度よく作成できる。

（５－３）自律走行モードの動作
図１４を用いて、図８のステップＳ２において実行される、手動操作教示モードにおいて作成された走行領域内経路を再現する自律走行モードの実行時における自律走行装置１００の動作を説明する。図１４は、自律走行モードの実行時の自律走行装置の動作を示すフローチャートである。

切替部９１において「自動」が選択されて自律走行モードを実行すると、自律走行装置１００は、走行スケジュール５００に従って自律的に走行する自律走行モードを開始する。自律走行モードは、具体的には、以下のようにして実行される。

以下の説明においては、自律走行モードの実行開始からの経過時間ｔｍ－１までの走行が実行済みであるとする。ここで、ｍは、ｍ番目の走行のための制御を示す。
ステップＳ２１では、ＳＬＡＭ部５５５が、前方検出器５５５１ａ及び後方検出器５５５１ｂから、前方の障害物に関する情報及び後方の障害物に関する情報を取得する。

ステップＳ２２では、位置推定部５５５５が、エンコーダ１１１にて測定された走行モータ１１の回転量、グローバルマップＧＭ、及び上記のステップＳ２１において取得された情報に基づいて得られたローカルマップに基づいて、走行部１のｘ－ｙ座標上の位置を推定する。例えば、自律走行装置１００の位置が、ｘ－ｙ座標上において、（ｘｍ’，ｙｍ’、θｍ’）と推定されたとする。

ステップＳ２３では、走行部１の位置を推定後、経過時間決定部５５５７が、自律走行モードの実行開始からの経過時間ｔｍを決定する。
ステップＳ２４では、走行再現部５５７が、経過時間ｔｍにおける再現走行制御指令を、以下のように算出する。

今、経過時間ｔｍが、走行スケジュール５００に記憶された時間ＴＬ（に最も近い）であると決定されたとする。この場合、走行再現部５５７は、次の時間ＴＬ＋１に関連付けられた位置情報（ｘＬ＋１，ｙＬ＋１，θＬ＋１）を、走行スケジュール５００から読み出し、経過時間ｔｍにおける再現走行制御指令を、推定された位置情報と目標とする位置情報との差分（ｘＬ＋１－ｘｍ’，ｙＬ＋１－ｙｍ’，θＬ＋１－θｍ’）に基づいて算出する。

ステップＳ２５では、再現走行制御指令を算出後、走行再現部５５７は、再現走行制御指令を走行制御部５３に出力する。これにより、走行制御部５３は、受信した再現走行制御指令に基づいて走行モータ１１を制御することで、走行部１を走行スケジュール５００に従って自律的に移動させる。

他の実施形態において、走行スケジュール５００に清掃条件が関連付けられている場合には、上記のステップＳ２４～Ｓ２５において、走行再現部５５７は、再現清掃条件を算出し、当該再現清掃条件に基づいて清掃制御部５１を制御してもよい。
具体的には、走行再現部５５７は、時間ＴＬに関連付けられた清掃条件（ＳＬ，ＷＬ，ＰＬ）を走行スケジュール５００から読み出し、当該清掃条件（ＳＬ，ＷＬ，ＰＬ）を経過時間ｔｍにおける再現清掃条件として決定する。その後、走行再現部５５７は、再現清掃条件を清掃制御部５１に出力する。これにより、再現清掃条件に従って、清掃部３を制御できる。

ステップＳ２６では、走行部１を再現走行制御指令に基づいて制御後、走行再現部５５７は、走行スケジュール５００に記憶された走行動作を全て実行したか否かを確認する。
走行スケジュール５００に記憶された走行動作が全て終了したか否かは、例えば、走行スケジュール５００の末尾にある識別子（例えば、「エンド・オブ・ファイル」を示す識別子など）を検出することにより確認できる。

走行スケジュール５００に記憶された走行動作が全て実行されていないと判定される限り（ステップＳ２６において「Ｎｏ」である限り）、上記のステップＳ２１～Ｓ２５が繰り返し実行される。
一方、走行スケジュール５００に記憶された全ての走行動作が実行されたと判定されたとき、すなわち、自律走行装置１００が走行領域内経路を全て走行したと判定されたとき（ステップＳ２６において「Ｙｅｓ」の場合）に、自律走行モードの実行を終了する。
これにより、自律走行装置１００は、走行スケジュール５００に記憶された走行動作を忠実に再現して、設定された走行領域内を自律的にまんべんなく走行できる。
他の実施形態において、走行スケジュール５００に記憶された走行動作を全て実行した場合のみでなく、例えば、自律走行装置１００にて異常が発生した場合、ユーザにより自律走行モードの実行停止が指令された場合などにおいても、自律走行モードの実行が停止されてもよい。

（６）矩形領域内経路作成の制御動作
図９～図１３を用いて説明した手動操作教示モードの変形例として、図１５～図１８を用いて、矩形領域内経路作成の制御動作を説明する。なお、以下の説明は、図９のステップＳ１５に概ね対応している。
図１５は、矩形領域内経路作成制御動作を示すフローチャートである。図１６～図１８は、外周教示経路、第１グリッド領域、第２グリッド領域、内周周回経路、塗り潰し経路の関係を示す模式的平面図である。

グローバルマップＧＭは、自律走行装置１００によって外周教示走行を行うことで取得されている。例えば、図１６では、自律走行装置１００による外周周回経路２１が示されており、外周周回経路２１の図下側が走行領域ＴＡになっている。なお、外周周回経路２１は、外周教示のスタート位置から外周を一周する経路である。これは、グリッド経路ではなく、外周教示経路（教示走行時の実際の走行軌跡）を基にした自由経路計画によって計画される経路である。なお、本実施例では、外周周回経路２１は、外周教示経路をそのまま利用している。
変形例では、外周教示経路から外周周回経路が作成される。例えば、ＧＵＩ上で走行領域を指定し（つまり、外周教示経路を作成し）、次に、教示された外周を基に外周周回経路が作成される。これにより、自律走行装置１００が滑らかに走行できる。

矩形領域内経路作成の制御動作は、自律走行装置１００が自律走行する経路を計画する自律走行経路計画方法であって、下記のステップを備えている。
ステップＳ３１では、走行領域ＴＡに対応して第１グリッド領域ＧＡ１が作成される。このときに前述のグリッドレイヤーＧＬが用いられる。具体的には、走行領域内経路作成部５５３のグリッド作成部５５３１（グリッド作成部の一例）が、例えば、外周教示経路を含む第１矩形を求め、次に第１矩形よりマージン分大きな第２矩形を求め、次に第２矩形とグリッド中心が一致する位置に最初のグリッドＧＲを配置し、最後に複数のグリッドＧＲを第２矩形を含む位置まで敷き詰める。これにより、第１グリッド領域ＧＡ１が生成される。例えば、図１７では、第１グリッド領域ＧＡ１が示されている。ここで、第１グリッド領域ＧＡ１は、最外側のグリッドＧＲが外周周回経路２１をカバーしている。
なお、第１グリッド領域ＧＡ１は、走行領域ＴＡとは独立して形成されている。実際は、第１グリッド領域ＧＡ１は走行領域ＴＡをはみ出して形成される。
また、第１グリッド領域ＧＡ１は、グリッドレイヤーＧＬのグリッドの一部を無効として、残りを有効とすることで形成されてもよい。

ステップＳ３２では、自律走行装置１００の車体サイズと回転半径と回転移動距離及びグリッドのサイズに基づいて、自律走行装置１００が方向転換を行う際に外周周回経路２１から自律走行装置１００の本体Ｂが逸脱する逸脱幅ＤＷを算出する。具体的には、逸脱幅算出部５５３３が上記計算を行う。例えば、図１７では、自律走行装置１００が方向転換によって外周周回経路２１からはみ出す逸脱幅ＤＷ（最大逸脱領域境界ＢＬまでの距離）が示されている。逸脱幅ＤＷは、位置によって異なり、本実施形態においては最小逸脱量Ｄ１～最大逸脱量Ｄ２（最小逸脱量Ｄ１＋グリッド長ＧＲＬ）の範囲である。

ステップＳ３３では、逸脱があったか否かが判断される。具体的には、逸脱判定部５５３４が上記判断を行う。逸脱があればプロセスはステップＳ３４に移行し、逸脱がなければプロセスはステップＳ３４をスキップしてステップＳ３５に移行する。
ステップＳ３４では、内周周回経路２３が作成される。具体的には、走行経路計画部５５３５（内周周回経路作成部の一例）が内周周回経路２３を作成する。内周周回経路２３は、外周周回経路２１からグリッド幅ずつ内側に位置する経路（外周周回経路２１を縮小した経路）であり、互いに平行になっている。内周周回経路２３は、外周周回経路２１を基にした自由経路計画によって作成される。例えば、図１８では、２本の内周周回経路２３が平行に延びている。ただし、２本の内周周回経路２３同士の距離はグリッド幅ずつでなくてもよいし、途中で変化してもよいし、部分的に一致してもよい。なお、内周周回経路２３は、外周教示経路を元にした自由経路計画によって作成されてもよい。また、内周周回経路２３は、外周周回経路２１を縮めつつ滑らかになるように加工されてもよい。
なお、このステップでは、塗り残しが生じないようにするために必要な内周周回経路２３の最大本数が算出されるつまり、逸脱幅ＤＷの大きさは場所によって変わる可能性があるが、逸脱幅ＤＷを覆うために必要な最大本数の内周周回経路２３を作成することで、塗り残しが生じない走行経路を計画することができる。

ステップＳ３５では、第２グリッド領域ＧＡ２（グリッド領域の一例）が作成される。第２グリッド領域ＧＡ２は、塗り潰し走行経路を計画する対象エリアである。第２グリッド領域ＧＡ２は、最も内側の内周周回経路２３と第１グリッド領域ＧＡ１とを用いて作成される。具体的には、第１グリッド領域ＧＡ１のグリッドＧＲのうち最も内側の内周周回経路２３が入っているもの及びそれらより内側のものを第２グリッド領域ＧＡ２のグリッドＧＲと判定される。つまり、第１グリッド領域ＧＡ１の一部を無効として、残りを有効として残すことで第２グリッド領域ＧＡ２とする。
なお、変形例として、第１グリッド領域ＧＡ１のグリッドＧＲのうち最も内側の内周周回経路２３より中心Ｃが内側に入っているもの及びそれらより内側ものを第２グリッド領域ＧＡ２のグリッドＧＲと判定してもよい。

ステップＳ３６では、第２グリッド領域ＧＡ２内を塗り潰すように塗り潰し走行経路２５が作成される。具体的には、走行経路計画部５５３５（塗り潰し走行経路作成部の一例）が塗り潰し走行経路２５を作成する。最初に、グリッドレイヤーＧＬの各グリッドＧＲの走行順番が決定され、次にグリッドＧＲの中心Ｃを通るグリッド経路として作成される。
例えば、図１８では、塗り潰し走行経路２５の一部が示されている。この場合、自律走行装置１００が第２グリッド領域ＧＡ２において方向転換をすれば、自律走行装置１００は図に示すように第２グリッド領域ＧＡ２を逸脱するが、逸脱部分は最外周の内周周回経路２３の内側に位置している。
なお、ステップＳ３６において、塗り潰し走行経路２５は、第２グリッド領域ＧＡ２に加えて逸脱幅ＤＷも塗り潰すように形成されてもよい。この場合、グリッドが外周教示経路の境界に跨って配置される条件において、境界のグリッド配置、すなわち実際の第２グリッド領域ＧＡ２の境界形状が直線になるため、効率の高い直線の塗り潰し走行経路が計画されやすくなる。

ステップＳ３７では、外周教示走行を行った外周周回経路２１、内周周回経路２３、及び塗り潰し走行経路２５を連続的に繋ぐ。具体的には、走行経路計画部５５３５が上記決定を行う。この結果、自律走行経路が完成する。
上記において、塗り潰し走行経路２５の開始位置は、外周周回経路２１上に設定される。これにより、塗り潰し走行経路２５の終了位置が明確になり、自律走行装置１００の回収が容易になる。また、塗潰しの終了位置がユーザにとって明示的になるので、例えば次に実現したい教示の開始位置が決まることで、自律走行装置１００がスムーズに連続走行できる。
さらに具体的には、その場合、塗り潰し走行経路２５の終了位置は、外周周回経路２１より内側の開始位置付近（数十ｃｍ程度）に設定される。開始位置から内側にずらした位置を終了位置にすることで、外周周回経路２１上の終了位置（＝開始位置）に戻る塗り潰し走行経路２５を計画するときに教示範囲から逸脱することが防止される。それに比べて、開始位置＝終了位置とすると、外周周回経路２１上の終了位置（＝開始位置）に移動で戻る経路を計画する場合、自律走行装置１００の走行部１の形状により、上記の逸脱が生じることが想定される。

以上に述べたように、逸脱幅ＤＷを走行する内周周回経路２３が作成され、次に第２グリッド領域ＧＡ２が作成され、さらに第２グリッド領域ＧＡ２内に塗り潰し走行経路２５が作成される。その結果、グリッドベースよる自律走行経路において、走行領域ＴＡの外周境界ＢＯから逸脱しないように自律走行装置１００が走行できる自律走行経路が計画される。
なお、内周周回経路２３は、単数又は複数でよいし、複数の場合に互いに独立していてもよいし、一部同士が重複していてもよい。複数の内周周回経路２３は互いに平行でもよいし、一部又は全部が非平行でもよい。また、内周周回経路２３の本数はあらかじめ定まった固定値でもよい。

図１９及び図２０を用いて、実際のグローバルマップ（環境地図）に形成された走行経路を説明する。図１９は、第１実施形態において走行経路が表された環境地図である。図２０は、従来例において走行経路が表された環境地図である。
図１９には、本実施形態において、外周境界ＢＯ、外周周回経路２１、２本の内周周回経路２３、塗り潰し走行経路２５が示されている。
図２０には、従来技術において、外周周回経路２１、及び塗り潰し走行経路２５が示されている。図２０において二点鎖線で示す領域Ａが塗り潰し走行経路２５の方向転換によって自律走行装置１００が走行する領域であり、外周周回経路２１の外側に逸脱している。

２．第２実施形態
第１実施形態では内周走行経路作成及び第２グリッド領域作成の前に第１グリッド領域が作成されていたが、第１グリッド領域の作成（第１実施形態の段落００８９の第２段落、図１５のステップＳ３１、図１７）は省略されてもよい。つまり、第１実施形態における第１グリッドは作成されなくても、下記のステップが実行されて第２グリッド領域ＧＡ２（グリッド領域の一例、第１実施形態の第２グリッド領域ＧＡ２に対応）が形成されればよい。

以下、第１実施時形態の図１５のフローチャートからステップＳ３１を削除した制御動作を説明する。
ステップＳ３２では、自律走行装置１００の車体サイズと回転半径と回転移動距離及びグリッドのサイズに基づいて、自律走行装置１００が方向転換を行う際に外周周回経路２１から自律走行装置１００の本体Ｂが逸脱する逸脱幅ＤＷを算出する。具体的には、逸脱幅算出部５５３３が上記計算を行う。
ステップＳ３３では、逸脱があったか否かが判断される。具体的には、逸脱判定部５５３４が上記判断を行う。逸脱があればプロセスはステップＳ３４に移行し、逸脱がなければプロセスはステップＳ３４をスキップしてステップＳ３５に移行する。

ステップＳ３４では、少なくとも逸脱幅の一部に相当する一又は複数の内周周回経路２３が作成される。具体的には、走行経路計画部５５３５（内周周回経路作成部の一例）が内周周回経路２３を作成する。内周周回経路２３は、外周周回経路２１からグリッド幅ずつ内側に位置する経路（外周周回経路２１を縮小した経路）であり、互いに平行になっている。内周周回経路２３は、外周周回経路２１を基にした自由経路計画によって作成される。

ステップＳ３５では、第２グリッド領域ＧＡ２が作成される。第２グリッド領域ＧＡ２は、塗り潰し走行経路を計画する対象エリアである。具体的には、走行領域内経路作成部５５３のグリッド作成部５５３１（グリッド作成部の一例）が、例えば、グリッドレイヤーＧＬのグリッドの一部を無効として、残りを有効とすることで第２グリッド領域ＧＡ２を作成する。
さらに具体的には、第２グリッド領域ＧＡ２は、最も内側の内周周回経路を用いて作成される。つまり、最も外側のグリッドＧＲ内に最も内側の内周周回経路２３が入るように、第２グリッド領域ＧＡ２が形成される。なお、変形例として、最も外側のグリッドＧＲの中心Ｃよりも内側に最も内側の内周周回経路２３が入るように、第２グリッド領域ＧＡ２が形成されてもよい。
ステップＳ３６及びステップＳ３７の説明は、第１実施形態と同じであるので、省略される。

３．第３実施形態
従来、塗り潰し走行において環境変動が発生した場合、途中で自律走行装置が自己位置を見失い、計画された走行経路に自律走行装置が追従できないことを防止するために走行を停止させていた。なお、環境変動とは、教示時に環境地図に記録された障害物と、自律走行時にセンサで検出された障害物の位置移動（追加、削除を含む）である。
この場合、停止地点の周辺を含む以降の塗り残し箇所について走行範囲の再度教示や経路作成が必要となる。上記技術の問題点として、停止地点以降が塗り残し（例えば、未清掃エリア）になり、自律走行装置にその範囲を塗り潰し走行させたい場合には、再教示が必要になり、環境変動を検出するまでにかかった塗り潰し走行時間（清掃時間）が無駄になる。そこで、なるべく早い時点で環境変動を検出して、ユーザに通知することが望ましい。

上記問題を解決するために、本実施形態では、塗り潰し走行の前に環境変動検出用のテスト走行を行うことで、塗り潰し走行の事前に環境変動を検出し、ユーザに通知することを可能にする。したがって、従来とは異なり、環境変動を検出する前に行った自律走行時間を無駄にすることがない。なお、本実施形態は第１実施形態の自律移動経路作成の後だけでなく、前にでも実行可能である。自律移動経路作成の前でも、走行領域が取得された後であればテスト走行経路の計画が可能だからである。
以下、図２１を用いて、環境変動検出制御動作をさらに詳細に説明する。図２１は、第３実施形態のテスト走行経路作成及びテスト走行制御動作を示すフローチャートである。

（１）テスト走行経路作成
環境変動検出動作は、自律走行経路を計画した後に、例えば、ユーザが明示的にテスト走行を選択できる指定方法（ＵＩなど）で開始される。なお、外周直接教示方式の場合、教示の開始時から終了時の間の任意の時刻と塗り潰し走行の開始時刻との間が所定時間より長い場合に自動的にテスト走行を行うようにしてもよい。
ステップＳ４１では、環境変動検出用のテスト走行経路４１が作成される。具体的には、走行領域内経路作成部５５３がテスト走行経路４１を作成する。
テスト走行経路４１は、図２２に示すように、全体エリア４３において、外周周回経路４５と一致している。この場合、後述するテスト走行時間が短くなる。図２２は、テスト走行経路の模式的平面図である。

（２）テスト走行
テスト走行では、下記のステップが実行される。
ステップＳ４２では、自律走行装置１００にテスト走行経路を開始させる。具体的には、走行制御部５３が上記動作を実行する。
ステップＳ４３では、自律走行装置１００がゴールＧに到達したか否かが判断される。具体的には、制御統括部５５がセンサからの検出情報（例えば、前方検出器５５５１ａにて取得した自律走行装置１００の前方に存在する障害物に関する情報と、後方検出器５５５１ｂにて取得した自律走行装置１００の後方に存在する障害物に関する情報）に基づいて状況判断を行う。ゴールＧに到達していなければプロセスはステップＳ４４に移行し、ゴールＧに到達していればプロセスはステップＳ４８に移行する。

ステップＳ４４では、テスト走行中に環境変動があるか否かが判断される。具体的には、制御統括部５５が、センサからの検出情報に基づいて、環境変動判定部として上記判断を行う。環境変動があればプロセスはステップＳ４５に移行し、環境変動がなければプロセスはステップＳ４３に戻る。このように、自律走行装置１００がゴールＧに到達するまでは、常に環境変動の有無が調べられる。

ステップＳ４５では、テスト走行中に検出した環境変動がユーザに通知される。具体的には、通知部（図示せず）が通知を行う。環境変動を検出した場合の通知手段としては，画面表示，音，光，メールなどがある。これにより、ユーザが環境変動に直ちに気付くことができる。
ステップＳ４６では、テスト走行が中止される。具体的には、走行制御部５３が上記動作を実行する。

ステップＳ４７では、自律走行装置１００はスタート地点Ｓに戻される。具体的には、走行制御部５３が上記動作を実行する。これにより、ユーザが再教示をすぐに開始できる。
なお、スタート地点Ｓに戻るルートは、今まで通ってきた経路を逆転してスタート地点Ｓ（付近）に戻るルートでもよいし、最短経路でスタート地点Ｓに戻るルートでもよい。前者は、環境変動していない経路なので、安全にスタート地点Ｓに戻れる。後者は、戻る時間が短くなる。
なお、自律走行装置１００が戻されるのは、テスト走行のスタート地点に限られず、テスト走行経路上のいずれかの地点でもよい。
その後、プロセスはステップＳ４８に移行する。
ステップＳ４８では、テスト走行が終了する。その後、塗り潰し走行が実施される。

なお、変形例としては、スタート地点Ｓに戻すステップ（ステップＳ４７）の代わりに、その場で停止するステップ又はテスト走行を継続するステップを実行してもよい。
別の変形例としては、環境変動があった場合は、塗り潰し走行を開始しなくてもよい。
さらに別の変形例としては、テスト走行時にも清掃を行ってもよい。

なお、塗り潰しエリアが分割された場合は、各エリアでテスト走行を行ってもよい。この場合、最初に変動を検知したときに、環境変動を通知、テスト走行を中止、自律走行装置１００をテスト走行のスタート地点に戻す等のいずれか又は全てを行ってもよいし、それらを行わずに最終エリアまでテスト走行を実行してもよい。
また、環境変動が検出されなかったエリアは塗り潰し清掃を行ってもよい。
なお、環境変動が検知された場合には、テスト走行を完了させた後、テスト走行を中止した後、あるいは、テスト走行のスタート位置に戻した後で、あるいは、それらの動作の代りに、自律走行装置１００を塗り潰し自律走行の開始位置や終了位置などの走行領域内の地点に移動させてもよい。
また、ユーザが明示的にテスト走行を選択する形態ではなく、塗り潰し自律走行の実施前にテスト走行を自動的に行う形態の場合、環境変動が検出されなかった場合は自動的に塗り潰し走行を開始することが望ましいが、ユーザが念のため塗り潰し走行の開始を判断する形態でもよい。

（３）テスト走行経路の変形例
第１の変形例では、図２３に示すように、エリアが２つに分割されている場合に、テスト走行経路４１Ａは、全体エリア４３の外周を一回りする外周周回経路４５Ａと一致している。
第２の変形例では、図２４に示すように、エリアが２つに分割されている場合に、テスト走行経路４１Ｂは、第１エリア４３Ａ及び第２エリア４３Ｂにおいて、外周周回経路４５Ａの一部と一致しておりかつ少なくとも各エリアの外周経路の一部になっている。

第３の変形例では、テスト走行経路４１Ｃは、図２５に示すように、外周周回経路４５Ａを内側にシフトした単数又は複数の内周周回経路である。この場合、内部の状況をより正確に認識できる。なお、図２５では、エリアが２つに分割されている場合に、各内周周回経路は全体エリアの内周を一回りするように形成されている。
また、エリアが分割されていない場合に、テスト走行経路は、外周周回経路を内側にシフトした単数又は複数の内周周回経路であってもよい。

第４の変形例では、テスト走行経路４１Ｄは、図２６に示すように、外周周回経路を内側にシフトした単数又は複数の周回経路である。この場合、内部の状況をより正確に認識できる。なお、図２６では、エリアが２つに分割されている場合に、テスト走行経路４１Ｄは、第１エリア４３Ａ及び第２エリア４３Ｂにおいて、外周周回経路４５Ａの一部と相似している。
第５の変形例では、テスト走行経路４１Ｅは、図２７に示すように、全体エリア４３内の中心部を走行する経路である。具体的には、テスト走行経路４１Ｅは、全体エリア４３の長手方向に沿って直線状に延びている。この場合、内部の状況をより正確に認識できる。

第６の変形例では、図２８に示すように、エリアが２つに分割されている場合に、テスト走行経路４１Ｆは第１エリア４３Ａ及び第２エリア４３Ｂ間で連続して形成されている。
第７の変形例では、図２９に示すように、エリアが２つに分割されている場合に、テスト走行経路４１Ｇは第１エリア４３Ａ及び第２エリア４３Ｂ内に別々に形成されている。

４．他の実施形態
以上、本発明の複数の実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。特に、本明細書に書かれた複数の実施形態及び変形例は必要に応じて任意に組み合せ可能である。
自律走行装置は、自律的に清掃作業を実行する清掃機以外の走行装置であってもよい。例えば、自律走行装置は、宣伝用ロボッ卜であってもよい。

自律走行装置は、自律的に走行するための走行部（とそれを制御する制御部）のみにて構成されていてもよい。この場合は、例えば、当該自律走行装置と、所望の機能を発揮するためのロボッ卜システムと、を組み合わせて、所望の機能を有するロボッ卜（装置）を構成できる。

第１実施形態ではグリッドレイヤーはグローバルマップとは別のレイヤーであったが、両者を一体として管理してもよい。
本実施形態は、自律走行体の機体が「真円であって超信地旋回するもの」以外には適用できる。

本発明は、自律走行体の走行経路を計画する自律走行経路計画方法に広く適用できる。

１ ：走行部
３ ：清掃部
５ ：制御部
７ ：走行経路教示部
８ ：取付部材
９ ：設定部
１１ ：走行モータ
１３ ：主輪
１５ ：補助輪
２１ ：外周周回経路
２３ ：内周周回経路
２５ ：塗り潰し走行経路
３１ ：洗浄液吐出口
３３ ：スキージ
３３ａ ：吸引口
３５ ：洗浄用部材
４１ ：テスト走行経路
５１ ：清掃制御部
５３ ：走行制御部
５５ ：制御統括部
５７ ：記憶部
７１ａ ：ハンドル
７１ｂ ：ハンドル
７３ ：筐体
７５ ：走行制御指令算出部
９１ ：切替部
９２ ：手動操作記憶スイッチ
９３ ：設定操作部
９４ ：設定変換部
９５ ：ディスプレイ
９６ ：清掃条件教示部
９７ ：清掃制御指令算出部
１００ ：自律走行装置
１１１ ：エンコーダ
３１１ ：洗浄液供給タンク
３１３ ：洗浄液供給ポンプ
３３１ ：吸引モータ
３３３ ：回収部材
３５１ ：洗浄用部材回転モータ
５００ ：走行スケジュール
５３１ ：走行切替部
５３３ ：モータ制御部
５５１ ：走行領域取得部
５５３ ：走行領域内経路作成部
５５５ ：ＳＬＡＭ部
５５７ ：走行再現部
５５３１ ：グリッド作成部
５５３２ ：走行順番決定部
５５３５ ：走行経路計画部
５５５１ａ ：前方検出器
５５５１ｂ ：後方検出器
５５５３ ：地図作成部
５５５５ ：位置推定部
５５５７ ：経過時間決定部
Ｂ ：本体
Ｃ ：中心
ＤＷ ：逸脱幅
Ｆ ：床面
ＧＲ ：グリッド
ＧＡ１ ：第１グリッド領域
ＧＡ２ ：第２グリッド領域
ＧＬ ：グリッドレイヤー
ＧＭ ：グローバルマップ
ＲＡ ：矩形領域
ＲＡ１ ：矩形領域
ＲＡ２ ：矩形領域
ＲＡ３ ：矩形領域
ＳＴ ：開始点
ＴＡ ：走行領域

Claims (8)

1. 自律走行体が自律走行する経路を計画する自律走行経路計画方法であって、
   前記自律走行体によって、環境地図において塗り潰し走行を行う走行領域の境界を教示して外周教示経路を作成することで、前記走行領域を取得するステップと、
   前記走行領域に対応する領域を、それぞれが前記自律走行体を包含できないサイズの複数のグリッドで敷き詰めた第１グリッド領域を作成するステップと、
   前記自律走行体の車体サイズと回転半径と回転移動距離及び前記グリッドのサイズに基づいて、前記自律走行体が方向転換を行う際に前記走行領域から前記自律走行体の車体が逸脱する逸脱幅を算出するステップと、
   前記外周教示経路に基づいて作成される外周周回経路を縮小して、前記逸脱幅を覆うために必要な最大本数の内周周回経路を作成するステップと、
   前記第１グリッド領域に含まれる複数のグリッドのうち、最内周の内周周回経路が入っているグリッドと、最内周の内周周回経路が入っているグリッドよりも内側のグリッドと、を有効とし、前記第１グリッド領域の他のグリッドを無効とすることで、最内周の内周周回経路に対応する位置を境界とする第２グリッド領域を作成するステップと、
   前記第２グリッド領域内を塗りつぶすように塗り潰し走行経路を作成するステップと、
   前記塗り潰し走行経路の開始位置を前記外周周回経路上に設定するステップと、
   前記塗り潰し走行経路の終了位置を前記外周周回経路より内側の前記開始位置付近に設定するステップと、
   を備えた自律走行経路計画方法。
2. 前記内周周回経路を作成するステップでは、前記最大本数を算出する、請求項１に記載の自律走行経路計画方法。
3. 前記外周周回経路、前記塗り潰し走行経路、及び前記内周周回経路を連続的に繋いで自律走行経路として決定するステップをさらに備える、請求項１又は２に記載の自律走行経路計画方法。
4. 環境変動検出用のテスト走行経路を作成するステップと、
   前記自律走行体に前記テスト走行経路を走行させるステップと、をさらに備えている、請求項１～３のいずれかに記載の自律走行経路計画方法。
5. 前記自律走行体が前記テスト走行経路を走行中に検出した環境変動を通知するステップをさらに備えている、請求項４に記載の自律走行経路計画方法。
6. 前記自律走行体が前記テスト走行経路を走行中に環境変動を検出した後に、テスト走行を中止するステップをさらに備えている、請求項４又は５に記載の自律走行経路計画方法。
7. 前記テスト走行を中止した後に、前記自律走行体を前記テスト走行経路上の地点に戻すステップをさらに備えている、請求項６に記載の自律走行経路計画方法。
8. 前記テスト走行を中止した後に、前記自律走行体を前記走行領域内の地点に移動するステップをさらに備えている、請求項６に記載の自律走行経路計画方法。
   

Images