JPWO2020039656A1 - 自走装置、自走装置の走行制御方法及び走行制御プログラム - Google Patents

自走装置、自走装置の走行制御方法及び走行制御プログラム Download PDF

Info

Publication number
JPWO2020039656A1
JPWO2020039656A1 JP2019549503A JP2019549503A JPWO2020039656A1 JP WO2020039656 A1 JPWO2020039656 A1 JP WO2020039656A1 JP 2019549503 A JP2019549503 A JP 2019549503A JP 2019549503 A JP2019549503 A JP 2019549503A JP WO2020039656 A1 JPWO2020039656 A1 JP WO2020039656A1
Authority
JP
Japan
Prior art keywords
self
propelled device
information
position information
unit
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.)
Pending
Application number
JP2019549503A
Other languages
English (en)
Inventor
真唯子 盛
真唯子 盛
圭 近藤
圭 近藤
真章 田上
真章 田上
学士 尾崎
学士 尾崎
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
NSK Ltd
Original Assignee
NSK Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by NSK Ltd filed Critical NSK Ltd
Publication of JPWO2020039656A1 publication Critical patent/JPWO2020039656A1/ja
Pending legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G05D1/243—Means capturing signals occurring naturally from the environment, e.g. ambient optical, acoustic, gravitational or magnetic signals
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G05D1/245—Arrangements for determining position or orientation using dead reckoning
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G05D1/246—Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM]
    • G05D1/2462—Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM] using feature-based mapping
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2105/00—Specific applications of the controlled vehicles
    • G05D2105/20—Specific applications of the controlled vehicles for transportation
    • G05D2105/28—Specific applications of the controlled vehicles for transportation of freight
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2107/00—Specific environments of the controlled vehicles
    • G05D2107/60—Open buildings, e.g. offices, hospitals, shopping areas or universities
    • G05D2107/65—Hospitals
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2109/00—Types of controlled vehicles
    • G05D2109/10—Land vehicles
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
    • G05D2111/10—Optical signals
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
    • G05D2111/50—Internal signals, i.e. from sensors located in the vehicle, e.g. from compasses or angular sensors
    • G05D2111/54—Internal signals, i.e. from sensors located in the vehicle, e.g. from compasses or angular sensors for measuring the travel distances, e.g. by counting the revolutions of wheels
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
    • G05D2111/60—Combination of two or more signals
    • G05D2111/67—Sensor fusion

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Traffic Control Systems (AREA)

Abstract

自己位置の推定を継続して目的地に到達可能な自走装置、自走装置の走行制御方法及び走行制御プログラムを提供する。自走装置１００は、自走装置１００の周囲の情報に基づき、自走装置１００の位置を推定し、当該推定した自走装置の位置の情報を第１位置情報として生成して更新する第１位置推定部１０２１と、車輪１０３ａの回転量に基づき、自走装置１００の位置を推定し、当該推定した自走装置の位置の情報を第２位置情報として生成して更新する第２位置推定部１０２２と、第１位置情報又は第２位置情報に基づき、自走装置の自律移動制御を行う制御部１０１と、を備える。制御部１０１は、第１位置情報が異常値である場合に、第２位置情報に基づき自律移動制御を行う。

Description

本発明は、自走装置、自走装置の走行制御方法及び走行制御プログラムに関する。
設定された目的地へ向かって自律で移動する自律移動ロボット等の自律移動機器が知られている。自立移動ロボット等の自律移動機器に設けられる自走装置には、事前にフィールド上における地図情報がインプットされ、地図上に設定されたノード間を接続して与えられた目的地までの経路が生成される。例えば、予め目的地を画像認識するための認識用マーカを付け、認識用マーカを画像認識できない範囲では教示された経路に追従して移動し、認識用マーカを画像認識すると認識用マーカに向かって自律移動する制御方法が開示されている（例えば、特許文献１）。
また、例えば、レーダにより得られた画像から特徴点を取得し、当該特徴点にマップ上で対応するランドマークの位置情報と画像上で得られた特徴点までの距離情報を用いて、自己位置を推定する誘導装置が開示されている（例えば、特許文献２）。
特開２０１５−１２１９２８号公報 特開２０１４−１７４０７０号公報
自律移動機器の稼働範囲として、例えば、病院等の屋内施設や屋外を想定した場合、目的地までの経路上に認識用マーカ等の固有のマーカを付けられない場合がある。また、自律移動機器の経路上の環境（例えば、可視光カメラを画像センサとして用いた場合、画像の輝度が極端に明るい又は暗い環境や、画像内の輝度差が大きい環境等）によっては、自己位置の推定精度が低下する場合がある。
本発明は、上記の課題に鑑みてなされたものであって、自己位置の推定を継続して目的地に到達可能な自走装置、自走装置の走行制御方法及び走行制御プログラムを提供すること、を目的としている。
上記の目的を達成するため、本発明の一態様に係る自走装置は、所定のエリア内を自律移動する自走装置であって、前記自走装置の周囲の情報を取得する周囲情報取得部と、前記自走装置を移動させる走行部と、前記走行部に設けられた車輪の回転量を検出する回転センサと、前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新する第１位置推定部と、前記回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新する第２位置推定部と、前記第１位置情報又は前記第２位置情報に基づき、前記自走装置の自律移動制御を行う制御部と、を備え、前記制御部は、前記第１位置情報が異常値である場合に、前記第２位置情報に基づき前記自律移動制御を行う。
上記構成によれば、自走装置は、第１位置推定部が推定する第１位置情報が異常値である場合でも、第２位置推定部によって更新される第２位置情報に基づき自律移動制御を継続することができ、目標地点に到達することができる。
上記の目的を達成するため、本発明の一態様に係る自走装置は、所定のエリア内を自律移動する自走装置であって、前記自走装置の周囲の情報を取得する周囲情報取得部と、前記自走装置を移動させる走行部と、前記走行部に設けられた車輪の回転量を検出する回転センサと、前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新する第１位置推定部と、前記回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新する第２位置推定部と、前記第１位置情報又は前記第２位置情報に基づき、前記自走装置の自律移動制御を行う制御部と、を備え、前記制御部は、前記第２位置情報が異常値である場合に、前記第１位置情報に基づき前記自律移動制御を行う。
上記構成によれば、自走装置は、第２位置推定部が推定する第２位置情報が異常値である場合でも、第１位置推定部によって更新される第１位置情報に基づき自律移動制御を継続することができ、目標地点に到達することができる。
自走装置の望ましい態様として、前記自走装置の周囲の情報を解析した周囲情報データを前記第１位置推定部に出力する周囲情報解析部と、少なくとも前記エリア内における複数の位置ごとの周囲環境の特徴が位置情報パターンとして記憶された記憶部と、を備え、前記第１位置推定部は、前記周囲情報データと前記位置情報パターンとを照合し、前記自走装置の位置を推定することが好ましい。
これにより、エリア内に特定のランドマークを設けることなく、自走装置の位置を推定することができる。
自走装置の望ましい態様として、周囲情報解析部は、前記自走装置の移動方向に対し所定の仰角方向を含む範囲を前記周囲情報データの取得範囲とすることが好ましい。
これにより、自走装置の移動方向における移動体（例えば、人体）によって周囲情報データの精度が低下することを抑制することができる。
自走装置の望ましい態様として、前記第１位置推定部は、前記第１位置情報を逐次更新して前記記憶部に記憶し、前記第２位置推定部は、前記第１位置情報が異常値である場合に、前記記憶部に前記第１位置情報として記憶されている位置を初期位置として前記自走装置の位置を推定することが好ましい。
これにより、第２位置推定部によって推定される自走装置の位置の誤差を小さくすることができる。
自走装置の望ましい態様として、前記自走装置の経路を生成する経路生成部を備え、
前記制御部は、前記経路に沿って前記自走装置の軌道を生成し、当該軌道を前記自走装置が自律移動するようにリアルタイム演算処理を行うことが好ましい。
これにより、自走装置は、生成された経路に沿って自律走行することができる。
自走装置の望ましい態様として、前記経路生成部は、前記エリア内における前記自走装置の位置から目標地点までの前記経路を生成することが好ましい。
これにより、自走装置は、エリア内に配置された位置から目標地点までの経路に沿って自律走行することができる。
自走装置の望ましい態様として、前記経路生成部は、外部機器から前記目標地点の位置情報である目標地点情報を受信したとき、前記第１位置推定部によって推定される前記自走装置の位置を初期位置として、当該初期位置から前記目標地点までの前記経路を生成することが好ましい。
これにより、自走装置は、外部機器から指定された目標地点に向けて自律走行することができる。
自走装置の望ましい態様として、前記経路生成部は、前記経路から前記自走装置が逸脱した場合に、前記第１位置推定部によって推定される前記自走装置の位置を現在位置として、当該現在位置から前記目標地点までの経路を再生成することが好ましい。
これにより、自走装置は、当初設定した経路を逸脱した場合でも、目標地点に到達することができる。
上記の目的を達成するため、本発明の一態様に係る自走装置の走行制御方法は、所定のエリア内を自律移動する自走装置の走行制御方法であって、前記エリア内における前記自走装置の位置から目標地点までの経路を生成するステップと、前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新するステップと、前記自走装置を移動させる走行部に設けられた車輪の回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新するステップと、前記第１位置情報が正常値である場合に、前記第１位置情報に基づき前記自走装置の自律移動制御を行い、前記第１位置情報が異常値である場合に、前記第２位置情報に基づき前記自律移動制御を行うステップと、を有する。
これにより、自走装置は、第１位置推定部が推定する第１位置情報が異常値である場合でも、第２位置推定部によって更新される第２位置情報に基づき自律移動制御を継続することができ、目標地点に到達することができる。
上記の目的を達成するため、本発明の一態様に係る自走装置の走行制御プログラムは、所定のエリア内を自律移動する自走装置の走行制御プログラムであって、前記エリア内における前記自走装置の位置から目標地点までの経路を生成する処理と、前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新する処理と、前記自走装置を移動させる走行部に設けられた車輪の回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新する処理と、前記第１位置情報が正常値である場合に、前記第１位置情報に基づき前記自走装置の自律移動制御を行い、前記第１位置情報が異常値である場合に、前記第２位置情報に基づき前記自律移動制御を行う処理と、をコンピュータに実行させる。
これにより、自走装置は、第１位置推定部が推定する第１位置情報が異常値である場合でも、第２位置推定部によって更新される第２位置情報に基づき自律移動制御を継続することができ、目標地点に到達することができる。
本発明によれば、自己位置の推定を継続して目的地に到達可能な自走装置、自走装置の走行制御方法及び走行制御プログラムを提供することができる。
図１は、実施形態１に係る自走装置の一例を示す図である。 図２は、実施形態１に係る自走装置の周囲情報解析部における周囲情報データの取得範囲の一例を示す概念図である。 図３は、実施形態１に係る自走装置が走行するエリアのマップ形状図の一例を示す概念図である。 図４は、実施形態１に係る自走装置の走行制御処理の一例を示すフローチャートである。 図５は、実施形態１に係る自走装置が走行するエリア内における経路の一例を示す概念図である。 図６は、実施形態１に係る自走装置が走行する経路において、第１位置推定部が第１位置情報を生成しない区間が存在する例を示す概念図である。 図７は、実施形態２に係る自走装置の走行制御処理の一例を示すフローチャートである。 図８は、実施形態３に係る自走装置の走行制御処理の一例を示すフローチャートである。 図９は、実施形態３に係る自走装置を待機状態に移行して自走装置が走行する経路から逸脱させた例を示す概念図である。 図１０は、実施形態４に係る自走装置の走行制御処理の一例を示すフローチャートである。
以下、発明を実施するための形態（以下、実施形態という）につき図面を参照しつつ詳細に説明する。なお、下記の実施形態により本発明が限定されるものではない。また、下記実施形態における構成要素には、当業者が容易に想定できるもの、実質的に同一のもの、いわゆる均等の範囲のものが含まれる。さらに、下記実施形態で開示した構成要素は適宜組み合わせることが可能である。
（実施形態１）
図１は、実施形態１に係る自走装置の一例を示す図である。自走装置１００としては、例えば病院等の公共施設の建造物において被案内者に館内の施設を案内する案内用ロボットや、医師等の操作者が指定した物品を倉庫等から操作者のもとに運搬する、あるいは、工場の生産ライン等において部品の搬送を行う搬送用ロボット等の自立移動ロボットが例示される。
本実施形態に係る自走装置１００は、目標地点へ向かって自律で移動する移動体であり、図１に示すように、操作部１１、表示部１２、送受信部１３、周囲情報取得部１４、周囲情報解析部１５、制御部１０１、位置推定部１０２、走行部１０３、経路生成部１０４、記憶部１０５、及び入出力部１０６を備えている。
本実施形態において、操作部１１、表示部１２、送受信部１３、周囲情報取得部１４、周囲情報解析部１５、制御部１０１、位置推定部１０２、経路生成部１０４、記憶部１０５、及び入出力部１０６は、例えば、本実施形態に係る走行制御プログラムを実行するコンピュータの構成要素によって実現する機能ブロックである。また、操作部１１、表示部１２、送受信部１３、周囲情報取得部１４、周囲情報解析部１５、制御部１０１、位置推定部１０２、経路生成部１０４、記憶部１０５、及び入出力部１０６は、例えば、後述する走行制御処理において各機能を実現するための個別の回路であっても良い。
操作部１１は、操作者が自走装置１００の制御に必要な情報を入力するための構成部である。操作部１１としては、例えば操作者がタッチすることによって情報を入力することが可能なタッチパネル（図示せず）が例示される。
表示部１２は、操作者が操作部１１を操作した結果や、自走装置１００における各種情報を表示する。表示部１２としては、例えば液晶パネル等の表示装置が例示される。また、表示部１２は、上述したタッチパネル（図示せず）を備えた構成とし、操作部１１を兼ねていても良い。
送受信部１３は、外部機器から送信された各種情報を受信する機能を有している。また、送受信部１３は、自走装置１００における各種情報を、外部機器に送信する機能を有している。送受信部１３は、例えば、後述する走行制御処理における目的地の位置情報を外部機器から受信する。また、送受信部１３は、例えば、走行中の経路情報や、経路上における現在位置を外部機器に送信する。送受信部１３は、自走装置に搭載されるバッテリの残容量を外部装置に送信可能な態様であっても良い。また、送受信部１３は、後述する走行制御処理において、例えば、自己位置の推定が不可能となった場合や、通路の凹凸により自律走行が不可能となった場合に、目的地の到達不可能となったことを示す異常発生情報を外部機器に送信可能な態様であっても良い。送受信部１３としては、例えば赤外線や電波で情報の送受信を行う無線通信装置が例示される。
周囲情報取得部１４は、自走装置１００の周囲の情報を取得する。周囲情報取得部１４は、例えば、２次元の画像を取得する可視光カメラでも良いし、３次元の距離画像を取得するレーザーレンジセンサ等の測域センサでも良い。
周囲情報解析部１５は、周囲情報取得部１４が取得した自走装置１００の周囲の情報を解析し、解析した周囲情報データを位置推定部１０２に出力する。周囲情報解析部１５は、例えば、周囲情報取得部１４が取得した周囲情報データから、周囲環境の特徴を抽出し、抽出した周囲環境の特徴を周囲情報データとして生成する。ここで、周囲環境の特徴としては、例えば、壁面に設けられた窓部の外枠や、外枠の辺と辺との交点、壁面と天井面との境界線、２面の壁面と天井面との交点等が考えられる。
図２は、実施形態１に係る自走装置の周囲情報解析部における周囲情報データの取得範囲の一例を示す概念図である。図２では、周囲情報取得部１４として可視光カメラを例示している。図２に示す例において、周囲情報解析部１５における周囲情報データの取得範囲は、例えば、図２に斜線で示すように、周囲情報取得部１４が設けられた位置における鉛直方向を中心軸とし、移動方向（水平方向）に対し所定の仰角方向（例えば４５°）を含む略円錐形状の範囲とすることができる。これにより、自走装置１００の移動方向（水平方向）における移動体（例えば、人体）によって周囲情報データの精度が低下することを抑制することができる。なお、周囲情報解析部１５によって生成される周囲情報データにより本開示が限定されるものではない。また、図２に示す周囲情報解析部１５における周囲情報データの取得範囲は一例であって、移動方向（水平方向）に対する仰角方向は、例えば、可視光カメラ（周囲情報取得部１４）の視野角や、可視光カメラを設置する位置等によって最適値が異なる。また、周囲情報解析部１５における周囲情報データの取得範囲の中心軸は、鉛直方向に限るものではなく、例えば、自走装置１００の移動方向（水平方向）であっても良い。周囲情報解析部１５における周囲情報データの取得範囲は、周囲の情報として有意な特徴を抽出できる範囲に設定することが望ましい。
走行部１０３は、自走装置１００を移動させるための移動機構である。走行部１０３は、自走装置１００を移動させる車輪１０３ａや車輪１０３ａを駆動する駆動装置（不図示）を備えている。走行部１０３は、車輪１０３ａの回転量を検出する回転センサ１０３ｂを備えている。回転センサ１０３ｂとしては、例えば、車輪１０３ａの回転角を検出する回転角センサが例示される。また、走行部１０３は、回転センサ１０３ｂとして、ジャイロセンサ（不図示）を備えた構成であっても良い。また、走行部１０３は、回転センサ１０３ｂとして、加速度センサ（不図示）を備えた構成であっても良い。走行部１０３は、制御部１０１から与えられる車輪回転指令値にしたがって車輪１０３ａを回転駆動し、自走装置１００を移動させる。
制御部１０１は、実施形態１に係る自走装置１００の自律移動制御を実現するための制御手段である。制御部１０１は、後述する経路生成部１０４によって生成された経路に沿って自走装置１００が走行する軌道を生成し、当該軌道を自走装置１００が自律移動するようにリアルタイム演算処理を行う。制御部１０１は、例えば、本実施形態に係る走行制御プログラムを実行することで、自走装置１００の自律移動制御を実現するＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）である。
制御部１０１は、位置推定部１０２、経路生成部１０４、記憶部１０５、及び入出力部１０６を介して入力された情報に基づき、自走装置１００の自律移動制御を行う。また、制御部１０１は、入出力部１０６を介して入力された情報を記憶部１０５に記憶させる機能を有している。また、制御部１０１は、入出力部１０６を介して情報を出力する機能を有している。
位置推定部１０２は、第１位置推定部１０２１及び第２位置推定部１０２２を含む。第１位置推定部１０２１は、周囲情報解析部１５からの周囲情報データ、及び、記憶部１０５に記憶された情報に基づき、自走装置１００の位置を推定する。第１位置推定部１０２１は、推定した自走装置１００の位置の情報を第１位置情報として生成し、生成した第１位置情報によって前回生成した第１位置情報を更新（上書き）して、制御部１０１及び記憶部１０５に逐次出力する。第２位置推定部１０２２は、走行部１０３の車輪１０３ａに設けられた回転センサ１０３ｂからの回転量情報、及び、記憶部１０５に記憶された情報に基づき、自走装置１００の位置を推定する。第２位置推定部１０２２は、推定した自走装置１００の位置の情報を第２位置情報として生成し、生成した第２位置情報によって前回生成した第２位置情報を更新（上書き）して、制御部１０１及び記憶部１０５に逐次出力する。
本実施形態において、第１位置推定部１０２１及び第２位置推定部１０２２は、それぞれ、互いに第１位置情報又は第２位置情報が正常値であるか否かを判定可能であるものとする。また、本実施形態において、制御部１０１は、第１位置推定部１０２１から出力される第１位置情報、及び、第２位置推定部１０２２から出力される第２位置情報が正常値であるか否かを判定可能であるものとする。なお、第１位置情報又は第２位置情報が正常値であるか否かの判定手法により本開示が限定されるものではない。
第１位置情報及び第２位置情報は、記憶部１０５に記憶される、自走装置１００が走行するエリアの地図情報であるマップ形状図上における自走装置１００の座標及び姿勢（向き）を含む。マップ形状図については後述する。位置推定部１０２は、例えばＣＰＵによって実行される走行制御プログラムによって実現することができる。
本実施形態において、第１位置推定部１０２１は、周囲情報解析部１５からの周囲情報データと、記憶部１０５に予め登録されている位置情報パターンとを照合し、自走装置１００の位置を推定する。これにより、エリア２００内に特定のランドマークを設けることなく、自走装置１００の位置を推定することができる。
具体的に、第１位置推定部１０２１は、例えば、周囲情報データに含まれる周囲環境の特徴と、１箇所又は複数箇所の位置情報パターンにおける周囲環境の特徴とを比較して自走装置１００の位置を推定し、第１位置情報を生成する。なお、第１位置推定部１０２１は、自走装置１００が走行する軌道の環境（例えば、可視光カメラを周囲情報取得部１４として用いた場合、画像の輝度が極端に明るい又は暗い環境や、画像内の輝度差が大きい環境等）によっては、自己位置の推定精度が低下し、第１位置情報が異常値となる場合がある。
また、第２位置推定部１０２２は、例えば、車輪１０３ａが段差等によって空転し、第２位置情報が異常値となる場合がある。
なお、第２位置推定部１０２２は、走行部１０３に設けられたジャイロセンサ（不図示）からの角速度を併用して、自走装置１００の位置を推定する態様であっても良い。また、第２位置推定部１０２２は、走行部１０３に設けられた加速度センサ（不図示）からの角加速度を併用して、自走装置１００の位置を推定する態様であっても良い。このように、回転センサ１０３ｂとして、回転角センサ、ジャイロセンサ、加速度センサ等の複数のセンサを併用することで、第２位置情報が正常値であるか否かの判定が容易となる。
具体的に、例えば、回転角センサによって推定される位置を第２位置情報とする態様では、第２位置情報がジャイロセンサや加速度センサによる予測位置に対して所定の閾値以上乖離している場合に、第２位置情報が異常値であると判定する態様としても良い。
経路生成部１０４は、自走装置１００が自律走行するエリア内における自走装置１００の経路を生成する構成部である。経路生成部１０４は、生成した経路の情報を経路情報として記憶部１０５に出力する。この経路生成部１０４において経路情報を生成する際に用いる経路探索アルゴリズムとしては、エースター（Ａ＊、又はＡ−ｓｔａｒ）アルゴリズムが例示されるが、この経路探索アルゴリズムによって本実施形態が限定されるものではない。経路情報は、マップ形状図上における諸条件に応じて設定される。マップ形状図上における経路は、例えば、目標地点までの最短経路であっても良いし、マップ形状図上における諸条件に応じた経路であっても良い。経路生成部１０４は、例えばＣＰＵによって実行される走行制御プログラムによって実現することができる。
入出力部１０６は、操作部１１及び送受信部１３から入力された情報を制御部１０１及び経路生成部１０４に出力すると共に、制御部１０１から入力された情報を、表示部１２及び送受信部１３に出力する機能を有している。
記憶部１０５は、第１位置推定部１０２１から出力される第１位置情報、及び、第２位置推定部１０２２から出力される第２位置情報を逐次上書きして記憶する。また、記憶部１０５は、経路生成部１０４から出力される経路情報を記憶する。本実施形態において、マップ形状図は、予め記憶部１０５に記憶されているものとする。
また、記憶部１０５は、上述したマップ形状図、第１位置情報、第２位置情報、経路情報に加え、マップ形状図上における諸条件等、自走装置１００の制御に必要な各種情報が記憶される。マップ形状図上における諸条件としては、例えば、自走装置１００が走行するエリアにおける通行禁止のエリアの位置情報や通行条件（右側通行又は左側通行）等が含まれる。
また、記憶部１０５は、位置推定部１０２の第１位置推定部１０２１が第１位置情報を生成する際の情報として、マップ形状図上における複数の位置ごとの位置情報パターンを含む。本実施形態では、自走装置１００が走行するエリアにおいて、周囲情報取得部１４による複数の視点における位置情報パターンが予め記憶部１０５に記憶されているものとする。
マップ形状図、マップ形状図上における諸条件、及び複数の位置情報パターンは、操作部１１を操作者が操作することにより、入出力部１０６を介して制御部１０１が記憶部１０５に記憶する態様であっても良いし、送受信部１３を介して外部機器から入力され、入出力部１０６を介して制御部１０１が記憶部１０５に記憶する態様であっても良い。
また、記憶部１０５には、本実施形態に係る走行制御プログラムが格納されている。この記憶部１０５は、例えば、ハードディスクドライブやフラッシュメモリ等の記憶媒体である。この記憶部１０５を格納する記憶媒体は、例えば、自走装置１００に内蔵されていても良いし、また、例えば、光ディスクやＵＳＢ（Ｕｎｉｖｅｒｓａｌ Ｓｅｒｉａｌ Ｂｕｓ）メモリのような可搬型の記憶媒体であっても良い。この記憶部１０５の態様により本実施形態が限定されるものではない。
図３は、実施形態１に係る自走装置が走行するエリアのマップ形状図の一例を示す概念図である。図３に示すように、自走装置１００が走行するエリア２００は、例えば、四方が外壁面２１０で囲われた建造物の１フロアであり、Ｘ方向及びＹ方向にグリッド分割されている。以下の説明において、自走装置１００の位置は、エリア２００内において、グリッド分割されたＸ方向及びＹ方向の位置で定義され、自走装置１００の姿勢（向き）は、Ｘ方向を基準とする角度θによって定義される。
図３において、自走装置１００が走行するエリア２００は、壁面２２０によって、複数の空間２３０（例えば、部屋）と、各空間２３０を接続する通路２４０（例えば、廊下）に仕切られている。図３に示す例では、斜線で示す通路２４０ａが自走装置１００の通行禁止エリアとして設定されている。また、本実施形態では、通路２４０を自走装置１００が通行する際の通行条件として、通路２４０の右側を通行することが規定されているものとする。
また、図３に示す例では、外壁面の一部に開口２５０（例えば、窓）が設けられ、矢示方向から直射日光が入射し、開口２５０の周辺の通路２４０、壁面２２０、及び天井（図示せず）が直射日光によって照らされているものとする。
図３に示す例において、自走装置１００は、空間２３０ａの地点Ａに配置されている。空間２３０ｂにいる操作者は、空間２３０ａの地点Ａに配置されている自走装置１００に対し、空間２３０ｂの地点Ｂを目標地点とするコマンドを送信する。コマンドを送信する外部機器としては、例えば、スマートフォンやタブレット等の携帯端末が例示される。なお、自走装置１００が走行するエリア２００内における操作者は複数であっても良く、複数の操作者がそれぞれ所持する外部機器からのコマンドを受信可能な待機状態でスタンバイしている態様であっても良い。
また、図３では、複数の位置ａ，ｂ，ｃ，・・・，ｚ，ａａ，ｂｂ，ｃｃ，ｄｄごとの周囲環境の特徴が位置情報パターンとして記憶部１０５に記憶されている例を示している。図３に示す例では、各空間２３０、及び通路２４０の複数箇所における位置情報パターンが記憶されている。位置情報パターンが記憶される位置は、図３に示す例に限定されない。例えば、図３に示す例では、各空間２３０に１箇所の位置情報パターンが記憶される例を示したが、広い空間２３０では複数箇所の位置情報パターンが記憶される態様であっても良い。
本実施形態では、記憶部１０５に格納された走行制御プログラムが実行されることによって、実施形態１に係る自走装置１００の自律移動制御が実現する。以下、図３に示した空間２３０ａの地点Ａから空間２３０ｂの地点Ｂまで、自走装置１００が自律走行する例について説明する。
図４は、実施形態１に係る自走装置の走行制御処理の一例を示すフローチャートである。
送受信部１３が外部機器から空間２３０ｂの地点Ｂを目標地点とするコマンドを受信し、マップ形状図上における自走装置１００の目標地点の位置情報である目標地点情報が入力されると（ステップＳ１０１）、自走装置１００は、待機状態から復帰する（ステップＳ１０２）。ここで、「待機状態から復帰」とは、外部機器からのコマンドを受信するために必要な最小限の電力が供給されている状態から、自走装置１００が自律走行するために必要な電力が自走装置１００の各部に供給されている状態に移行し、自走装置１００における走行制御を開始することを示す。図３に示す例では、空間２３０ｂの地点Ｂの位置が自走装置１００の目標地点の位置（ｘ（ｂ），ｙ（ｂ），θ（ｂ））が目標地点情報として入力される。
待機状態から復帰すると（ステップＳ１０２）、第１位置推定部１０２１は、自走装置１００の初期位置を推定する。図３に示す例では、自走装置１００が空間２３０ａの地点Ａに配置されている場合の初期位置（ｘ（ａ），ｙ（ａ），θ（ａ））を推定する。第１位置推定部１０２１は、推定した自走装置１００の初期位置（ｘ（ａ），ｙ（ａ），θ（ａ））を初期位置情報として制御部１０１及び記憶部１０５に出力する。なお、自走装置１００の初期位置情報は、前回の走行制御における位置情報を用いても良い。また、操作部１１を操作者が操作して、自走装置１００の初期位置情報を入力することにより、入出力部１０６を介して制御部１０１が記憶部１０５に記憶する態様であっても良いし、送受信部１３を介して外部機器から自走装置１００の初期位置情報が入力され、入出力部１０６を介して制御部１０１が記憶部１０５に記憶する態様であっても良い。
経路生成部１０４は、目標地点情報が入力されると、自走装置１００の初期位置（ここでは、空間２３０ａの地点Ａ（ｘ（ａ），ｙ（ａ）））から目標地点（ここでは、空間２３０ｂの地点Ｂ（ｘ（ｂ），ｙ（ｂ）））までのマップ形状図上における経路を生成し（ステップＳ１０３）、生成した経路の情報を経路情報として記憶部１０５に出力する。
図５は、実施形態１に係る自走装置が走行するエリア内における経路の一例を示す概念図である。図５において、自走装置１００の経路を破線で示している。図５に示す例では、自走装置１００が配置されている空間２３０ａの地点Ａを自走装置１００の初期位置とし、操作者がいる空間２３０ｂの地点Ｂを自走装置１００の目標地点として、通行禁止エリアである通路２４０ａを迂回し、通路２４０を右側通行しつつ、地点Ｂまでが最短となる経路が生成された例を示している。
位置推定部１０２の第１位置推定部１０２１及び第２位置推定部１０２２は、それぞれ、自走装置１００の位置を推定し（ステップＳ１０４）、第１位置情報及び第２位置情報を更新して、制御部１０１及び記憶部１０５に逐次出力する。
制御部１０１は、第１位置情報が正常値であるか否かを判定する（ステップＳ１０５）。
上述したように、開口２５０の周辺の通路２４０、壁面２２０、及び天井（図示せず）が開口２５０から入射する直射日光によって照らされている。このような場合、開口２５０付近では、周囲情報取得部１４が取得した周囲の情報から、周囲情報解析部１５が有意な周囲環境の特徴を抽出できない場合がある。このような場合、第１位置推定部１０２１による自己位置の推定精度が低下し、第１位置情報が異常値となる場合がある。
第１位置情報が正常値である場合（ステップＳ１０５；Ｙｅｓ）、制御部１０１は、第１位置推定部１０２１によって更新された第１位置情報に基づき、図５に示した経路に沿って軌道を生成し、当該軌道を自走装置１００が走行するように自律移動制御を行う（ステップＳ１０６）。
図６は、実施形態１に係る自走装置が走行する経路において、第１位置推定部が第１位置情報を生成しない区間が存在する例を示す概念図である。図６では、自走装置１００が走行する経路上の地点Ｃから地点Ｄまでの区間において、第１位置推定部が第１位置情報を更新しない例を示している。
図６に示す地点Ｃにおいて、第１位置情報が異常値となると（ステップＳ１０５；Ｎｏ）、制御部１０１は、第２位置推定部１０２２によって更新された第２位置情報に基づき、図５に示した経路に沿った軌道を自走装置１００が走行するように自律移動制御を行う。
図６に示す地点Ｄにおいて、第１位置情報が正常値となると、制御部１０１は、第１位置推定部１０２１によって更新された第１位置情報に基づき、上述した自律移動制御を行う（ステップＳ１０７）。
制御部１０１は、自走装置１００が目標地点（空間２３０ｂの地点Ｂ）に到着したか否かを判定する（ステップＳ１０８）。自走装置１００が目標地点に到着していなければ（ステップＳ１０８；Ｎｏ）、ステップＳ１０４の処理に戻り、ステップＳ１０５からステップＳ１０８までの処理を繰り返し実施する。
自走装置１００が目標地点に到着すると（ステップＳ１０８；Ｙｅｓ）、制御部１０１は、自走装置１００における自律移動制御を終了して待機状態に移行し（ステップＳ１０９）、走行制御処理を終了する。
このように、本実施形態では、第１位置推定部１０２１が第１位置情報を生成できない場合に、第２位置推定部１０２２によって生成される第２位置情報に基づき自律移動制御を継続することで、目標地点（空間２３０ｂの地点Ｂ）に到達することができる。
以上説明したように、実施形態１に係る自走装置１００は、周囲情報取得部１４によって取得される自走装置１００の周囲の情報に基づき、自走装置１００の位置を推定し、当該推定した自走装置１００の位置の情報を第１位置情報として生成して更新する第１位置推定部１０２１と、車輪１０３ａの回転量に基づき、自走装置１００の位置を推定し、当該推定した自走装置１００の位置の情報を第２位置情報として生成して更新する第２位置推定部１０２２と、第１位置情報又は前記第２位置情報に基づき、自走装置１００の自律移動制御を行う制御部１０１と、を備える。制御部１０１は、前記第１位置情報が異常値である場合に、第２位置情報に基づき自律移動制御を行う。
また、実施形態に係る自走装置１００の走行制御方法は、エリア２００内における自走装置１００の位置から目標地点までの経路を生成するステップと、自走装置１００の周囲の情報に基づき、自走装置１００の位置を推定し、当該推定した自走装置１００の位置の情報を第１位置情報として生成して更新するステップと、車輪１０３ａの回転量に基づき、自走装置１００の位置を推定し、当該推定した自走装置１００の位置の情報を第２位置情報として生成して更新するステップと、第１位置情報が更新されている場合に、第１位置情報に基づき自走装置１００の自律移動制御を行い、第１位置情報が異常値である場合に、第２位置情報に基づき自律移動制御を行うステップと、を有する。
また、実施形態に係る自走装置１００の走行制御プログラムは、エリア２００内における自走装置１００の位置から目標地点までの経路を生成する処理と、自走装置１００の周囲の情報に基づき、自走装置１００の位置を推定し、当該推定した自走装置１００の位置の情報を第１位置情報として生成して更新する処理と、車輪１０３ａの回転量に基づき、自走装置１００の位置を推定し、当該推定した自走装置１００の位置の情報を第２位置情報として生成して更新する処理と、第１位置情報が正常値である場合に、第１位置情報に基づき自走装置１００の自律移動制御を行い、第１位置情報が異常値である場合に、第２位置情報に基づき自律移動制御を行う処理と、をコンピュータに実行させる。
これにより、自走装置１００は、第１位置推定部１０２１が推定する第１位置情報が異常値である場合でも、第２位置推定部１０２２によって更新される第２位置情報に基づき自律移動制御を継続することができ、目標地点に到達することができる。
（実施形態２）
図７は、実施形態２に係る自走装置の走行制御処理の一例を示すフローチャートである。なお、上述した実施形態１で説明した処理と同じ処理には同一の符号を付して重複する説明は省略する。また、実施形態２に係る自走装置の構成は、上述した実施形態１と同様であるので、ここでは説明を省略する。
実施形態１では、ステップＳ１０３の経路生成後に、位置推定部１０２の第１位置推定部１０２１及び第２位置推定部１０２２がそれぞれ自走装置１００の位置を推定し（ステップＳ１０４）、第１位置情報及び第２位置情報を制御部１０１及び記憶部１０５に出力する例を説明したが、実施形態２では、図７に示すように、経路生成後（ステップＳ１０３）に、第１位置推定部１０２１が自走装置１００の位置を推定して（ステップＳ１０４ａ）、第１位置情報を制御部１０１及び記憶部１０５に逐次出力する。第１位置情報が異常値となると（ステップＳ１０５；Ｎｏ）、第２位置推定部１０２２は、記憶部１０５に第１位置情報として記憶された位置を初期位置として、自走装置１００の位置を推定し（ステップＳ１０４ｂ）、第２位置情報を生成して制御部１０１及び記憶部１０５に出力する。これにより、第１位置情報が異常値となった場合でも、第２位置推定部１０２２によって更新される第２位置情報に基づき、自律移動制御を継続することができる。
また、第２位置推定部１０２２によって生成される第２位置情報は、車輪１０３ａの滑り等による誤差を含む可能性がある。本実施形態において、第２位置推定部１０２２は、第１位置情報が異常値となった場合に（ステップＳ１０５；Ｎｏ）、記憶部１０５に第１位置情報として記憶された位置を初期位置として、自走装置１００の位置を推定する。これにより、第２位置推定部１０２２によって推定される自走装置１００の位置の誤差を小さくすることができる。
（実施形態３）
図８は、実施形態３に係る自走装置の走行制御処理の一例を示すフローチャートである。図９は、実施形態３に係る自走装置を待機状態に移行して自走装置が走行する経路から逸脱させた例を示す概念図である。なお、上述した実施形態１で説明した処理と同じ処理には同一の符号を付して重複する説明は省略する。また、実施形態３に係る自走装置の構成は、上述した実施形態１と同様であるので、ここでは説明を省略する。
図９では、自走装置１００が走行する経路上の地点Ｅにおいて、操作者が操作部１１を操作して自走装置１００を強制的に待機状態に移行させ、空間２３０ｃの地点Ｆに手動で移動した例を示している。
本実施形態では、ステップＳ１０６又はステップＳ１０７において自走装置１００が自律移動制御によって経路上を自走しているとき、制御部１０１は、操作者によって待機状態に移行されたか否かを判定する（ステップＳ１１０）。
待機状態に移行されていなければ（ステップＳ１１０；Ｎｏ）、ステップＳ１０８の処理に移行する。
待機状態に移行後（ステップＳ１１０；Ｙｅｓ）、空間２３０ｃの地点Ｆにおいて待機状態から復帰すると（ステップＳ１１１）、第１位置推定部１０２１は、自走装置１００の現在位置を推定する。図９に示す例では、自走装置１００が空間２３０ｃの地点Ｆに配置されている場合の現在位置（ｘ（ｆ），ｙ（ｆ），θ（ｆ））を推定する。第１位置推定部１０２１は、推定した自走装置１００の現在位置（ｘ（ｆ），ｙ（ｆ），θ（ｆ））を現在位置情報として制御部１０１及び記憶部１０５に出力する。なお、ステップＳ１１１における待機状態からの復帰は、操作者が操作部１１を操作して自走装置１００を待機状態から復帰させる態様であっても良いし、ステップＳ１１０において待機状態に移行されてから所定時間後に待機状態から復帰する態様であっても良い。
経路生成部１０４は、自走装置１００の現在位置（空間２３０ｃの地点Ｆ（ｘ（ｆ），ｙ（ｆ）））から目標地点（空間２３０ｂの地点Ｂ（ｘ（ｂ），ｙ（ｂ）））までのマップ形状図上における経路を再生成し（ステップＳ１１２）、再生成した経路の情報を経路情報として記憶部１０５に出力して、ステップＳ１０５の処理に戻る。
このように、本実施形態では、ステップＳ１０６又はステップＳ１０７において自走装置１００が自律移動制御によって経路上を自走しているとき、操作者によって待機状態に移行され、ステップＳ１０３において経路生成部１０４が生成した経路を逸脱させた場合でも、待機状態から復帰した時点で、経路生成部１０４が目標地点までの経路を再設定することで、目標地点に到達することができる。
（実施形態４）
図１０は、実施形態４に係る自走装置の走行制御処理の一例を示すフローチャートである。なお、実施形態４に係る自走装置の構成、自走装置が走行するエリアのマップ形状図、及び自走装置が走行するエリア内における経路は、上述した実施形態１と同様であるので、ここでは説明を省略する。
送受信部１３が外部機器から空間２３０ｂの地点Ｂを目標地点とするコマンドを受信し、マップ形状図上における自走装置１００の目標地点の位置情報である目標地点情報が入力されると（ステップＳ２０１）、自走装置１００は、待機状態から復帰する（ステップＳ２０２）。
本実施形態では、自走装置１００の初期位置情報は、待機状態から復帰後（ステップＳ２０２）、第１位置推定部１０２１が自走装置１００の初期位置を推定し、推定した自走装置１００の初期位置を初期位置情報として制御部１０１及び記憶部１０５に出力する態様であっても良いし、前回の走行制御における位置情報を用いても良い。また、操作部１１を操作者が操作して、自走装置１００の初期位置情報を入力することにより、入出力部１０６を介して制御部１０１が記憶部１０５に記憶する態様であっても良いし、送受信部１３を介して外部機器から自走装置１００の初期位置情報が入力され、入出力部１０６を介して制御部１０１が記憶部１０５に記憶する態様であっても良い。
経路生成部１０４は、目標地点情報が入力されると、自走装置１００の初期位置から目標地点までのマップ形状図上における経路を生成し（ステップＳ２０３）、生成した経路の情報を経路情報として記憶部１０５に出力する。
位置推定部１０２の第１位置推定部１０２１及び第２位置推定部１０２２は、それぞれ、自走装置１００の位置を推定し（ステップＳ２０４）、第１位置情報及び第２位置情報を更新して、制御部１０１及び記憶部１０５に逐次出力する。
制御部１０１は、第２位置情報が正常であるか否かを判定する（ステップＳ２０５）。
上述したように、自走装置１００の経路上において、例えば、通路２４０と各空間２３０との間に段差がある場合、車輪１０３ａが段差によって空転し、第２位置情報が異常値となる場合がある。
第２位置情報が正常値である場合（ステップＳ２０５；Ｙｅｓ）、制御部１０１は、第２位置推定部１０２２によって更新された第２位置情報に基づいて軌道を生成し、当該軌道を自走装置１００が走行するように自律移動制御を行う（ステップＳ２０６）。
第２位置情報が異常値となると（ステップＳ２０５；Ｎｏ）、制御部１０１は、第１位置推定部１０２１によって更新された第１位置情報に基づき、自走装置１００が走行するように自律移動制御を行う。
第２位置情報が正常値となると、制御部１０１は、第２位置推定部１０２２によって更新された第２位置情報に基づき、上述した自律移動制御を行う（ステップＳ２０７）。
制御部１０１は、自走装置１００が目標地点に到着したか否かを判定する（ステップＳ２０８）。自走装置１００が目標地点に到着していなければ（ステップＳ２０８；Ｎｏ）、ステップＳ２０４の処理に戻り、ステップＳ２０５からステップＳ２０８までの処理を繰り返し実施する。
自走装置１００が目標地点に到着すると（ステップＳ２０８；Ｙｅｓ）、制御部１０１は、自走装置１００における自律移動制御を終了して待機状態に移行し（ステップＳ２０９）、走行制御処理を終了する。
このように、本実施形態では、第２位置推定部１０２２が推定する第２位置情報が異常値である場合に、第１位置推定部１０２１によって更新される第１位置情報に基づき自律移動制御を継続することで、目標地点に到達することができる。
１１ 操作部
１２ 表示部
１３ 送受信部
１４ 周囲情報取得部
１５ 周囲情報解析部
１００ 自走装置
１０１ 制御部
１０２ 位置推定部
１０３ 走行部
１０３ａ 車輪
１０３ｂ 回転センサ
１０４ 経路生成部
１０５ 記憶部
１０６ 入出力部
２００ エリア
２１０ 外壁面
２２０ 壁面
２３０，２３０ａ，２３０ｂ，２３０ｃ 空間（部屋）
２４０，２４０ａ 通路（廊下）
２５０ 開口（窓）
１０２１ 第１位置推定部
１０２２ 第２位置推定部
設定された目的地へ向かって自律で移動する自律移動ロボット等の自律移動機器が知られている。自律移動ロボット等の自律移動機器に設けられる自走装置には、事前にフィールド上における地図情報がインプットされ、地図上に設定されたノード間を接続して与えられた目的地までの経路が生成される。例えば、予め目的地を画像認識するための認識用マーカを付け、認識用マーカを画像認識できない範囲では教示された経路に追従して移動し、認識用マーカを画像認識すると認識用マーカに向かって自律移動する制御方法が開示されている（例えば、特許文献１）。
上記の目的を達成するため、本発明の一態様に係る自走装置は、所定のエリア内を自律移動する自走装置であって、前記自走装置の周囲の情報を取得する周囲情報取得部と、前記自走装置を移動させる走行部と、前記走行部に設けられた車輪の回転量を検出する回転センサと、前記自走装置の制御に必要な情報を記憶する記憶部と、前記自走装置の経路を生成する経路生成部と、前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定できた前記自走装置の位置の情報を第１位置情報として生成して、当該第１位置情報で前記記憶部に記憶された第１位置情報を上書きする第１位置推定部と、前記第１位置情報が生成されない場合に、前記回転量に基づき、前記記憶部に記憶された第１位置情報を初期位置として、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成する第２位置推定部と、前記第２位置情報に基づき、前記経路に沿って前記自走装置の軌道を生成し、当該軌道を前記自走装置が自律移動するようにリアルタイム演算処理を行い、前記自走装置の自律移動制御を行う制御部と、を備える。
（実施形態１）
図１は、実施形態１に係る自走装置の一例を示す図である。自走装置１００としては、例えば病院等の公共施設の建造物において被案内者に館内の施設を案内する案内用ロボットや、医師等の操作者が指定した物品を倉庫等から操作者のもとに運搬する、あるいは、工場の生産ライン等において部品の搬送を行う搬送用ロボット等の自律移動ロボットが例示される。
図６に示す地点Ｃにおいて、第１位置情報が異常値となると（ステップＳ１０５；Ｎｏ）、制御部１０１は、第２位置推定部１０２２によって更新された第２位置情報に基づき、図５に示した経路に沿った軌道を自走装置１００が走行するように自律移動制御を行う（ステップＳ１０７）。
図６に示す地点Ｄにおいて、第１位置情報が正常値となると（ステップＳ１０５；Ｙｅｓ）、制御部１０１は、第１位置推定部１０２１によって更新された第１位置情報に基づき、上述した自律移動制御を行う（ステップＳ１０６）。
制御部１０１は、自走装置１００が目標地点（空間２３０ｂの地点Ｂ）に到着したか否かを判定する（ステップＳ１０８）。自走装置１００が目標地点に到着していなければ（ステップＳ１０８；Ｎｏ）、ステップＳ１０４の処理に戻り、ステップＳ１０４からステップＳ１０８までの処理を繰り返し実施する。
また、第２位置推定部１０２２によって生成される第２位置情報は、車輪１０３ａの滑り等による誤差を含む可能性がある。本実施形態において、第２位置推定部１０２２は、第１位置推定部１０２１が第１位置情報を生成できない（第１位置情報が異常値となった）場合に（ステップＳ１０５；Ｎｏ）、記憶部１０５に第１位置情報として記憶された位置を初期位置として、自走装置１００の位置を推定する。これにより、第２位置推定部１０２２によって推定される自走装置１００の位置の誤差を小さくすることができる。
経路生成部１０４は、自走装置１００の現在位置（空間２３０ｃの地点Ｆ（ｘ（ｆ），ｙ（ｆ）））から目標地点（空間２３０ｂの地点Ｂ（ｘ（ｂ），ｙ（ｂ）））までのマップ形状図上における経路を再生成し（ステップＳ１１２）、再生成した経路の情報を経路情報として記憶部１０５に出力して、ステップＳ１０４の処理に戻る。
第２位置情報が異常値となると（ステップＳ２０５；Ｎｏ）、制御部１０１は、第１位置推定部１０２１によって更新された第１位置情報に基づき、自走装置１００が走行するように自律移動制御を行う（ステップＳ２０７）。
第２位置情報が正常値となると（ステップＳ２０５；Ｙｅｓ）、制御部１０１は、第２位置推定部１０２２によって更新された第２位置情報に基づき、上述した自律移動制御を行う（ステップＳ２０６）。
制御部１０１は、自走装置１００が目標地点に到着したか否かを判定する（ステップＳ２０８）。自走装置１００が目標地点に到着していなければ（ステップＳ２０８；Ｎｏ）、ステップＳ２０４の処理に戻り、ステップＳ２０４からステップＳ２０８までの処理を繰り返し実施する。

Claims (11)

  1. 所定のエリア内を自律移動する自走装置であって、
    前記自走装置の周囲の情報を取得する周囲情報取得部と、
    前記自走装置を移動させる走行部と、
    前記走行部に設けられた車輪の回転量を検出する回転センサと、
    前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新する第１位置推定部と、
    前記回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新する第２位置推定部と、
    前記第１位置情報又は前記第２位置情報に基づき、前記自走装置の自律移動制御を行う制御部と、
    を備え、
    前記制御部は、
    前記第１位置情報が異常値である場合に、前記第２位置情報に基づき前記自律移動制御を行う
    自走装置。
  2. 所定のエリア内を自律移動する自走装置であって、
    前記自走装置の周囲の情報を取得する周囲情報取得部と、
    前記自走装置を移動させる走行部と、
    前記走行部に設けられた車輪の回転量を検出する回転センサと、
    前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新する第１位置推定部と、
    前記回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新する第２位置推定部と、
    前記第１位置情報又は前記第２位置情報に基づき、前記自走装置の自律移動制御を行う制御部と、
    を備え、
    前記制御部は、
    前記第２位置情報が異常値である場合に、前記第１位置情報に基づき前記自律移動制御を行う
    自走装置。
  3. 前記自走装置の周囲の情報を解析した周囲情報データを前記第１位置推定部に出力する周囲情報解析部と、
    少なくとも前記エリア内における複数の位置ごとの周囲環境の特徴が位置情報パターンとして記憶された記憶部と、
    を備え、
    前記第１位置推定部は、前記周囲情報データと前記位置情報パターンとを照合し、前記自走装置の位置を推定する
    請求項１又は２に記載の自走装置。
  4. 周囲情報解析部は、前記自走装置の移動方向に対し所定の仰角方向を含む範囲を前記周囲情報データの取得範囲とする
    請求項３に記載の自走装置。
  5. 前記第１位置推定部は、前記第１位置情報を逐次更新して前記記憶部に記憶し、
    前記第２位置推定部は、前記第１位置情報が異常値である場合に、前記記憶部に前記第１位置情報として記憶された位置を初期位置として、前記自走装置の位置を推定する
    請求項３又は４に記載の自走装置。
  6. 前記自走装置の経路を生成する経路生成部を備え、
    前記制御部は、前記経路に沿って前記自走装置の軌道を生成し、当該軌道を前記自走装置が自律移動するようにリアルタイム演算処理を行う
    請求項１から５の何れか一項に記載の自走装置。
  7. 前記経路生成部は、前記エリア内における前記自走装置の位置から目標地点までの前記経路を生成する
    請求項６に記載の自走装置。
  8. 前記経路生成部は、外部機器から前記目標地点の位置情報である目標地点情報を受信したとき、前記第１位置推定部によって推定される前記自走装置の位置を初期位置として、当該初期位置から前記目標地点までの前記経路を生成する
    請求項７に記載の自走装置。
  9. 前記経路生成部は、前記経路から前記自走装置が逸脱した場合に、前記第１位置推定部によって推定される前記自走装置の位置を現在位置として、当該現在位置から前記目標地点までの経路を再生成する
    請求項７又は８に記載の自走装置。
  10. 所定のエリア内を自律移動する自走装置の走行制御方法であって、
    前記エリア内における前記自走装置の位置から目標地点までの経路を生成するステップと、
    前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新するステップと、
    前記自走装置を移動させる走行部に設けられた車輪の回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新するステップと、
    前記第１位置情報が正常値である場合に、前記第１位置情報に基づき前記自走装置の自律移動制御を行い、前記第１位置情報が異常値である場合に、前記第２位置情報に基づき前記自律移動制御を行うステップと、
    を有する自走装置の走行制御方法。
  11. 所定のエリア内を自律移動する自走装置の走行制御プログラムであって、
    前記エリア内における前記自走装置の位置から目標地点までの経路を生成する処理と、
    前記自走装置の周囲の情報に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第１位置情報として生成して更新する処理と、
    前記自走装置を移動させる走行部に設けられた車輪の回転量に基づき、前記自走装置の位置を推定し、当該推定した前記自走装置の位置の情報を第２位置情報として生成して更新する処理と、
    前記第１位置情報が正常値である場合に、前記第１位置情報に基づき前記自走装置の自律移動制御を行い、前記第１位置情報が異常値である場合に、前記第２位置情報に基づき前記自律移動制御を行う処理と、
    をコンピュータに実行させるための自走装置の走行制御プログラム。
JP2019549503A 2018-08-23 2019-04-26 自走装置、自走装置の走行制御方法及び走行制御プログラム Pending JPWO2020039656A1 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2018156681 2018-08-23
JP2018156681 2018-08-23
PCT/JP2019/017876 WO2020039656A1 (ja) 2018-08-23 2019-04-26 自走装置、自走装置の走行制御方法及び走行制御プログラム

Publications (1)

Publication Number Publication Date
JPWO2020039656A1 true JPWO2020039656A1 (ja) 2020-08-27

Family

ID=69592537

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019549503A Pending JPWO2020039656A1 (ja) 2018-08-23 2019-04-26 自走装置、自走装置の走行制御方法及び走行制御プログラム

Country Status (6)

Country Link
US (1) US11531344B2 (ja)
EP (1) EP3842886A4 (ja)
JP (1) JPWO2020039656A1 (ja)
CN (1) CN111480131B (ja)
TW (1) TWI808210B (ja)
WO (1) WO2020039656A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI818355B (zh) * 2021-11-16 2023-10-11 萬潤科技股份有限公司 異常事件通報方法及執行該異常事件通報方法的自走式裝置及通報系統

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01207804A (ja) * 1988-02-16 1989-08-21 Sanyo Electric Co Ltd 自走式作業車
JP2012128781A (ja) * 2010-12-17 2012-07-05 Toyota Motor Corp 移動体
WO2019026761A1 (ja) * 2017-08-03 2019-02-07 日本電産シンポ株式会社 移動体およびコンピュータプログラム

Family Cites Families (35)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07120202B2 (ja) * 1987-03-14 1995-12-20 株式会社豊田自動織機製作所 無人車の運行制御装置
JP3878008B2 (ja) * 2001-12-07 2007-02-07 株式会社日立製作所 車両用走行制御装置及び地図情報データ記録媒体
JP2005148960A (ja) * 2003-11-12 2005-06-09 Matsushita Electric Works Ltd 自律移動体の周辺機器連携システム
JP4600357B2 (ja) * 2006-06-21 2010-12-15 トヨタ自動車株式会社 測位装置
KR100785784B1 (ko) 2006-07-27 2007-12-13 한국전자통신연구원 인공표식과 오도메트리를 결합한 실시간 위치산출 시스템및 방법
JP5203585B2 (ja) * 2006-08-21 2013-06-05 三菱電機株式会社 駆動制御装置及びその制御方法
JP4379493B2 (ja) * 2007-06-07 2009-12-09 ソニー株式会社 撮像装置、情報処理装置、および情報処理方法、並びにコンピュータ・プログラム
JP5500449B2 (ja) * 2010-09-21 2014-05-21 株式会社安川電機 移動体
US20140297066A1 (en) * 2011-11-04 2014-10-02 Panasonic Corporation Remote control system
TW201334747A (zh) * 2012-02-16 2013-09-01 Micro Star Int Co Ltd 掃地機器人的控制方法
KR20140074538A (ko) * 2012-12-10 2014-06-18 현대모비스 주식회사 Ｍｄｐｓ에서의 홀 센서 위치보정을 통한 회전 상태 추정 방법
JP6089812B2 (ja) 2013-03-12 2017-03-08 三菱電機株式会社 誘導装置
ITMI20131252A1 (it) * 2013-07-25 2015-01-26 Fabrizio Bernini Apparecchiatura di lavorazione di un¿area limitata
JP2015092795A (ja) * 2013-11-08 2015-05-14 株式会社ミツバ ブラシレスモータ制御装置及びブラシレスモータ制御方法
JP2015121928A (ja) 2013-12-24 2015-07-02 トヨタ自動車株式会社 自律移動ロボットの制御方法
WO2015107853A1 (ja) * 2014-01-14 2015-07-23 旭化成株式会社 進行方向情報出力装置、マップマッチング装置、進行方向情報出力方法、およびプログラム
JP2015225065A (ja) * 2014-05-30 2015-12-14 トヨタ自動車株式会社 距離センサの動作確認方法及び自律走行体
JP6481347B2 (ja) * 2014-11-28 2019-03-13 村田機械株式会社 移動量推定装置、自律移動体、及び移動量の推定方法
EP3109589B1 (en) * 2015-06-23 2019-01-30 Volvo Car Corporation A unit and method for improving positioning accuracy
KR102431996B1 (ko) * 2015-10-12 2022-08-16 삼성전자주식회사 로봇 청소기 및 그 제어 방법
JP6288060B2 (ja) * 2015-12-10 2018-03-07 カシオ計算機株式会社 自律移動装置、自律移動方法及びプログラム
CN106406338B (zh) * 2016-04-14 2023-08-18 中山大学 一种基于激光测距仪的全向移动机器人的自主导航装置及其方法
JP2017194527A (ja) * 2016-04-19 2017-10-26 トヨタ自動車株式会社 環境地図のデータ構造、環境地図の作成システム及び作成方法、並びに、環境地図の更新システム及び更新方法
JP6421782B2 (ja) * 2016-04-22 2018-11-14 トヨタ自動車株式会社 周辺情報収集システム
RU2722356C1 (ru) * 2016-07-26 2020-05-29 Ниссан Мотор Ко., Лтд. Способ оценки собственного положения и устройство оценки собственного положения
CN106681320A (zh) * 2016-12-15 2017-05-17 浙江大学 一种基于激光数据的移动机器人导航控制方法
WO2018137047A1 (en) * 2017-01-30 2018-08-02 Clearpath Robotics, Inc. Apparatus, systems, and methods for operating and maintaining electrically-powered material-transport vehicles
CN107297744A (zh) * 2017-06-16 2017-10-27 江苏科技大学 一种多功能家用移动设备及其路径规划方法
US10627828B2 (en) * 2017-06-30 2020-04-21 Casio Computer Co., Ltd. Autonomous movement device, autonomous movement method and program recording medium
US11427218B2 (en) * 2017-08-04 2022-08-30 Sony Corporation Control apparatus, control method, program, and moving body
JP7052260B2 (ja) * 2017-09-01 2022-04-12 富士フイルムビジネスイノベーション株式会社 カメラ付き移動体、カメラ付き移動体制御システム、及びプログラム
CN107526360B (zh) * 2017-09-26 2020-08-21 河南科技学院 一种未知环境下排爆机器人多阶自主导航探测系统及方法
JP7353747B2 (ja) * 2018-01-12 2023-10-02 キヤノン株式会社 情報処理装置、システム、方法、およびプログラム
US11714411B2 (en) * 2018-03-19 2023-08-01 Honda Motor Co., Ltd. Autonomous traveling work machine
JP2019168942A (ja) * 2018-03-23 2019-10-03 日本電産シンポ株式会社 移動体、管理装置および移動体システム

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01207804A (ja) * 1988-02-16 1989-08-21 Sanyo Electric Co Ltd 自走式作業車
JP2012128781A (ja) * 2010-12-17 2012-07-05 Toyota Motor Corp 移動体
WO2019026761A1 (ja) * 2017-08-03 2019-02-07 日本電産シンポ株式会社 移動体およびコンピュータプログラム

Also Published As

Publication number Publication date
CN111480131A (zh) 2020-07-31
US11531344B2 (en) 2022-12-20
US20210255628A1 (en) 2021-08-19
TWI808210B (zh) 2023-07-11
EP3842886A4 (en) 2022-05-11
CN111480131B (zh) 2024-01-12
EP3842886A1 (en) 2021-06-30
WO2020039656A1 (ja) 2020-02-27
TW202009623A (zh) 2020-03-01

Similar Documents

Publication Publication Date Title
CN111837083B (zh) 信息处理装置、信息处理方法和存储介质
EP3525992B1 (en) Mobile robot and robotic system comprising a server and the robot
US10845821B2 (en) Route planning for a mobile robot using configuration-based preferences
US20090312871A1 (en) System and method for calculating location using a combination of odometry and landmarks
KR20170087384A (ko) 청소로봇을 원격으로 제어하기 위한 원격 제어 장치, 제어 시스템 및 제어 방법
US20180055325A1 (en) Robot cleaner
US11175664B1 (en) Navigation directly from perception data without pre-mapping
JP5298741B2 (ja) 自律移動装置
KR20210058998A (ko) 웨이포인트 매칭을 이용한 자율적 맵 주행
Nieuwenhuisen et al. Layered mission and path planning for MAV navigation with partial environment knowledge
US11537140B2 (en) Mobile body, location estimation device, and computer program
Koval et al. Experimental evaluation of autonomous map-based spot navigation in confined environments
Bodhale et al. Path planning for a mobile robot in a dynamic environment
JP2008021023A (ja) 移動ロボット装置および移動ロボット制御方法
CN114564027A (zh) 足式机器人的路径规划方法、电子设备及可读存储介质
JP6540917B1 (ja) 自走装置、自走装置の走行制御方法及び走行制御プログラム
JP2009176031A (ja) 自律移動体，自律移動体制御システムおよび自律移動体の自己位置推定方法
JPWO2020039656A1 (ja) 自走装置、自走装置の走行制御方法及び走行制御プログラム
EP3478143B1 (en) Robot cleaner
KR102408327B1 (ko) 자율주행 판매를 위한 제스처 인식을 지원하는 ai 기반 자율주행 로봇 시스템
Copot et al. Collision-free path planning in indoor environment using a quadrotor
Schueftan et al. Indoor mapping using SLAM for applications in Flexible Manufacturing Systems
Oh et al. Chance-constrained target tracking for mobile robots
KR101408383B1 (ko) 무궤도 무인 운반차량
JP7501643B2 (ja) 移動体制御システム、制御装置、及び、移動体制御方法

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190910

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190910

A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20190910

A975 Report on accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A971005

Effective date: 20191004

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20191224

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200220

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200310

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20200923