JP7020290B2 - 自律移動体 - Google Patents

Description

本発明は、自律移動体に関する。

特許文献１に記載されているように、追尾対象を自動で追尾する自律移動体は、移動体と、追尾対象までの離間距離を測定するためのセンサと、制御装置と、を備える。制御装置は、センサによって測定される離間距離が適正範囲か否かを判定する。制御装置は、離間距離が適正範囲より長ければ追尾対象に近付き、離間距離が適正範囲より短ければ追尾対象から離れるように移動体を制御する。これにより、移動体は追尾対象を追尾するように自律移動することになる。

特開平６－３４３３３４号公報

ところで、追尾対象との離間距離に応じて移動体を後退させる場合、追尾対象と移動体との離間距離が過度に長くなるおそれがある。すると、制御装置において、追尾対象を追尾する応答性が悪くなるおそれがある。また、追尾する応答性が悪化した場合、制御装置が追尾対象を認識できなくなり、追尾対象の追尾を行えなくなる場合がある。

本発明の目的は、制御装置が追尾対象の認識を行いやすい自律移動体を提供することにある。

上記課題を解決する自律移動体は、移動体と、前記移動体から追尾対象までの離間距離を測定するセンサと、前記追尾対象を追尾するように前記移動体の制御を行う制御装置と、を備え、前記制御装置は、前記離間距離が第１所定距離よりも長くなると前記追尾対象に近付くように前記移動体を移動させる前進モードと、前記離間距離が第２所定距離よりも短くなると前記追尾対象から離れるように前記移動体を移動させる後退モードと、を切り替え可能であり、前記前進モードから前記後退モードへの切り替えは、前記第１所定距離から第１距離を減じた後退開始距離よりも前記離間距離が短くなったときに行われ、前記後退モードから前記前進モードへの切り替えは、前記第２所定距離に第２距離を加えた前進開始距離よりも前記離間距離が長くなったときに行われ、前記第２距離は、前記第１距離よりも短い距離である。

これによれば、前進モードでは、離間距離が第１所定距離よりも長くなると移動体を移動させる制御が行われる一方で、離間距離が第１所定距離と後退開始距離との間であれば、移動体を移動させる制御が行われない。同様に、後退モードでは、離間距離が第２所定距離と前進開始距離との間であれば、移動体を移動させる制御が行われない。したがって、前進モードでの第１所定距離と後退開始距離との間、及び、後退モードでの第２所定距離と前進開始距離との間は、移動体を移動させる制御が行われない不感帯となる。第２距離が第１距離よりも短いため、後退モードの不感帯は、前進モードの不感帯よりも短くなる。前進モードの不感帯は、前進モードから後退モードへの切り替えをするために必要となる距離であり、後退モードの不感帯は、後退モードから前進モードへの切り替えをするために必要となる距離である。後退モードの不感帯を前進モードの不感帯よりも短くすることで、後退モードから前進モードへの切り替えに必要となる距離を短くすることができる。即ち、前進モードから後退モードへの切り替えに比べて、後退モードから前進モードへの切り替えが行われやすい。したがって、第２距離を第１距離と同一の距離にした場合に比べて、移動体と追尾対象との離間距離が長くなりにくく、制御装置が追尾対象の認識を行いやすい。

上記自律移動体について、前記制御装置は、前記前進モードでは、前記離間距離が前記第１所定距離よりも長いほど移動速度が速くなるように前記移動体を制御し、前記後退モードでは、前記離間距離が前記第２所定距離よりも短いほど移動速度が速くなるように前記移動体を制御し、前記移動体の移動速度を前記離間距離に応じて速くするに際して、前記離間距離と前記第１所定距離の差と、前記離間距離と前記第２所定距離との差とが同一の場合、前記後退モードでの移動速度に比べて、前記前進モードでの移動速度のほうが速くなるように前記移動体を制御してもよい。

これによれば、前進モードでは、後退モードの場合に比べて、移動体の移動速度が速くなりやすい。前進モードでは、後退モードの場合に比べて、車両が停止するのに必要となる移動距離が長くなるといえる。不感帯は、車両を停止させるのに必要となる移動距離によって意図せずモードが切り替わることを抑制するために設定されている。後退モードで移動体の移動速度が速くなることを抑制することで、第２距離を短くしても、不感帯の範囲内で車両が停止しやすい。

上記自律移動体について、前記前進モードでの前記移動体の加速度は、前記後退モードでの前記移動体の加速度に比べて大きくしてもよい。
これによれば、後退モードでは、前進モードに比べて移動速度が速くなりにくく、車両が停止するのに必要となる移動距離が短くなる。したがって、第２距離を短くしても、不感帯の範囲内で車両が停止しやすい。

本発明によれば、制御装置が追尾対象の認識を行いやすい。

自律移動体、及び、追尾対象である人を示す概略図。 自律移動体、及び、駆動機構を示すブロック図。 後退モード時の自律移動体を示す概略図。 離間距離と速度指令値との関係を示す図。 離間距離と速度指令値との関係を示す図。

以下、自律移動体の一実施形態について説明する。
図１に示すように、自律移動体１０は、車両２０と、車両２０に搭載されたセンサ３１と、車両２０に搭載された制御装置３２と、を備える。車両２０は、車体２１と、複数の車輪２２と、車両２０を走行させるための駆動機構２３と、を備える。車両２０は、制御装置３２に制御されることで、登録された追尾対象Ｔを追尾するように自律移動する移動体である。車両２０は、例えば、荷を搬送する搬送台車である。

本実施形態の車輪２２は、オムニホイール、メカナムホイール、オムニボールなどの全方向移動車輪である。車輪２２は、３つ以上設けられている。車輪２２の回転数、及び、回転方向が制御されることで、車両２０は、車体２１の向きを維持した状態での全方向への移動、車体２１の向きを変更しながらの移動、移動しない状態での車体２１の向きの変更が可能である。なお、上記した「全方向」とは、車両２０が走行する路面上や床面上での移動方向を示す。

図２に示すように、駆動機構２３は、車輪２２を回転させるためのモータ２４と、モータ２４を駆動させるモータドライバ２５と、走行制御装置２６と、速度センサ２９と、を備える。なお、図示は省略するが、モータ２４、及び、モータドライバ２５は、車輪２２の数と同数設けられる。

走行制御装置２６は、ＣＰＵ２７と、種々の制御を行うためのプログラムなどが記憶された記憶部２８と、を備える。走行制御装置２６には、制御装置３２からの指令が入力される。走行制御装置２６は、車両２０の速度を指示する指令である速度指令値や、車両２０の進行方向を指示する指令である進行方向指令に基づき指令回転数を演算する。

速度センサ２９は、モータ２４に搭載された回転数センサである。速度センサ２９は、モータ２４の回転数を検出して、検出結果をモータドライバ２５に出力する。モータドライバ２５は、モータ２４の回転数と指令回転数とが一致するようにフィードバック制御を行う。これにより、車両２０は、速度指令値に応じた速度で、進行方向指令に応じた進行方向へ移動することになる。

次に、センサ３１、及び、制御装置３２について詳細に説明する。
センサ３１としては、制御装置３２に追尾対象Ｔを認識させることができ、かつ、車両２０から追尾対象Ｔまでの離間距離Ｌを測定できるものが用いられる。なお、本実施形態において、車両２０から追尾対象Ｔまでの離間距離Ｌとは、車体２１の中心から追尾対象Ｔまでの距離である。

センサ３１としては、LIDAR：Laser Imaging Detection and Rangingが用いられる。LIDARは、レーザーを周辺に照射し、レーザーが当たった部分から反射された反射光を受信することで周辺環境を認識可能な距離計である。LIDARとしては、水平方向の照射角度を変更しながらレーザーを照射する二次元距離計、及び、水平方向に加えて鉛直方向の照射角度を変更しながらレーザーを照射する三次元距離計のいずれを用いてもよい。レーザーが当たった部分を測定点とすると、LIDARは測定点までの距離を照射角度に対応付けて測定する。即ち、LIDARは、車両２０と測定点との相対座標を測定できる。制御装置３２は、測定点の集合である点群から車両２０の周辺に存在する物体の寸法などの情報を認識することができる。

制御装置３２は、ＣＰＵ３３と、ＲＡＭ及びＲＯＭ等からなる記憶部３４と、を備える。記憶部３４には、車両２０を制御するための種々のプログラムが記憶されている。制御装置３２は、各種処理のうち少なくとも一部の処理を実行する専用のハードウェア、例えば、特定用途向け集積回路：ＡＳＩＣを備えていてもよい。制御装置３２は、コンピュータプログラムに従って動作する１つ以上のプロセッサ、ＡＳＩＣ等の１つ以上の専用のハードウェア回路、あるいは、それらの組み合わせを含む回路として構成し得る。プロセッサは、ＣＰＵ、並びに、ＲＡＭ及びＲＯＭ等のメモリを含む。メモリは、処理をＣＰＵに実行させるように構成されたプログラムコードまたは指令を格納している。メモリ、即ち、コンピュータ可読媒体は、汎用または専用のコンピュータでアクセスできるあらゆるものを含む。

制御装置３２は、センサ３１の検出結果から追尾対象Ｔを認識する。制御装置３２には、追尾対象Ｔに関する情報が登録されており、この情報に適合する物体を追尾対象Ｔとして認識する。本実施形態の追尾対象Ｔは、人である。人を追尾対象Ｔとする場合、追尾対象Ｔに関する情報とは、例えば、足の幅である。追尾対象Ｔの登録は、人がセンサ３１の正面に直立した状態で、車両２０に設けられた操作部や外部機器を操作して、制御装置３２を登録モードにすることで行われる。

制御装置３２は、離間距離Ｌに応じて走行制御装置２６に各種指令を出力する。これにより、車輪２２の回転数や、車輪２２の回転方向が制御され、車両２０は追尾対象Ｔを追尾することになる。制御装置３２は、駆動機構２３を制御することで、車両２０を自律移動させているといえる。

制御装置３２は、走行用のモードとして、前進モードと、後退モードと、を備える。制御装置３２は、前進モードと後退モードとを切り替え可能であり、各モードに応じた制御を行う。

図１に示すように、前進モードとは、離間距離Ｌが第１所定距離よりも長くなると追尾対象Ｔに近づくように車両２０を移動させるモードである。
図３に示すように、後退モードとは、離間距離Ｌが第２所定距離よりも短くなると追尾対象Ｔから離れるように車両２０を移動させるモードである。なお、本実施形態では、第１所定距離と第２所定距離とは同一の距離である。以下、両者を所定距離と総称して説明を行う。

所定距離は、追尾対象Ｔや、車体２１の大きさ、車両２０の種類などに基づき予め定められた距離である。所定距離は、例えば、追尾対象Ｔである人の足と車体２１との接触を抑止することができ、かつ、センサ３１による追尾対象Ｔの認識が阻害されない距離に設定される。更に、所定距離は、追尾対象Ｔである人が車体２１に向けて腕を伸ばしたときに車体２１に触れることが可能と想定される距離に設定される。腕の長さとしては、例えば、成人の腕の平均長よりも短い長さを用いる。上記した要素を加味した上で、所定距離は、例えば、０．６ｍ～０．９ｍの間で設定される。

図４は、制御装置３２から出力される速度指令値と、離間距離Ｌとの関係を示している。図４において、横軸は離間距離Ｌであり、縦軸は速度指令値である。太線Ｍ１は前進モードにおける速度指令値と離間距離Ｌとの関係を示し、一点鎖線の太線Ｍ２は、後退モードにおける速度指令値と離間距離Ｌとの関係を示す。横軸の中心は、所定距離ｄ０であり、縦軸の中心は速度指令値０である。速度指令値０とは、速度指令値が出力されていない状態である。横軸は、右に位置するほど離間距離Ｌが長く、左に位置するほど離間距離Ｌが短い。縦軸は、中心よりも上が前進の場合の速度指令値であり、中心よりも下が後退の場合の速度指令値である。縦軸は、中心を境として、前進と後退が分かれているが、中心から上下へのずれ量が同一であれば、速度指令値の絶対値は同一である。

図４示すように、前進モードでは、離間距離Ｌが長いほど出力される速度指令値は大きな値になる。また、前進モードでは、予め定められた前進速度抑制距離ｄ１１で速度指令値が上限値となる。前進速度抑制距離ｄ１１までは、離間距離Ｌが長くなるのに比例して速度指令値は大きくなり、前進速度抑制距離ｄ１１よりも離間距離Ｌが長くなると速度指令値は上限値で一定となる。前進モードでは、離間距離Ｌが所定距離ｄ０から後退開始距離ｄ１２までの範囲内の場合、制御装置３２は速度指令値を出力しない。後退開始距離ｄ１２とは、所定距離ｄ０から第１距離Ｌ１を減じた距離である。モードが前進モードの場合、所定距離ｄ０から後退開始距離ｄ１２の範囲は速度指令値が出力されない第１不感帯Ａ１といえる。第１不感帯Ａ１は、車両２０を移動させる制御が行われない範囲となる。

モードが前進モードで、離間距離Ｌが後退開始距離ｄ１２よりも短くなると、制御装置３２は、モードを前進モードから後退モードに遷移させる。後退モードでは、離間距離Ｌが短いほど出力される速度指令値は大きな値になる。また、後退モードでは、予め定められた後退速度抑制距離ｄ２１で速度指令値が上限値となる。後退速度抑制距離ｄ２１までは、離間距離Ｌが短くなるのに比例して速度指令値は大きくなり、後退速度抑制距離ｄ２１よりも離間距離Ｌが短くなると速度指令値は上限値で一定となる。後退モードでは、離間距離Ｌが所定距離ｄ０から前進開始距離ｄ２２までの範囲内の場合、制御装置３２は速度指令値を出力しない。前進開始距離ｄ２２とは、所定距離ｄ０に第２距離Ｌ２を加えた距離である。モードが後退モードの場合、所定距離ｄ０から前進開始距離ｄ２２の範囲は速度指令値が出力されない第２不感帯Ａ２といえる。第２不感帯Ａ２は、車両２０を移動させる制御が行われない範囲となる。モードが後退モードで、離間距離Ｌが前進開始距離ｄ２２よりも長くなると、制御装置３２は、モードを後退モードから前進モードに遷移させる。

上記したように、前進モード及び後退モードでは、ともに速度指令値が上限値に達するまでは、所定距離ｄ０と離間距離Ｌの差に比例して速度指令値が大きくなる。前進モードでの比例定数は、後退モードでの比例定数よりも大きい。したがって、所定距離ｄ０から離間距離Ｌまでの差が同一の場合、後退モードに比べて、前進モードのほうが車両２０の速度が速くなるように制御が行われることになる。車両２０の移動速度を離間距離Ｌに応じて速くするに際して、離間距離Ｌと所定距離ｄ０の差が前進モードと後退モードで同一の場合、後退モードでの移動速度に比べて、前進モードでの移動速度のほうが速くなるように制御が行われる。また、前進モードでの速度指令値の上限値は、後退モードでの速度指令値の上限値よりも高い。

第１不感帯Ａ１、及び、第２不感帯Ａ２は、速度指令値が出力されなくなってから車両２０が停止するまでに必要となる移動距離を考慮して定められている。仮に、両不感帯Ａ１，Ａ２が設定されていない場合、所定距離ｄ０を閾として、前進モードと後退モードとが切り替わることになる。車両２０が移動している状態で速度指令値が出力されなくなったとしても、車両２０は慣性により移動を継続するため、前進モードと後退モードとが小刻みに切り替わりことになる。これに対し両不感帯Ａ１，Ａ２を設定することで、前進モードと後退モードが小刻みに切り替わることを抑制できる。本実施形態では、第２距離Ｌ２は、第１距離Ｌ１に比べて短い。したがって、第２不感帯Ａ２は、第１不感帯Ａ１よりも短くなっている。

本実施形態の作用について説明する。
まず、モードの切り替えが行われない場合について説明を行う。
モードが前進モードの場合、制御装置３２は、離間距離Ｌが長いほど速度指令値を大きくする。走行制御装置２６は、速度指令値に追従するように制御を行うため、車両２０の実車速は速度指令値に略一致することになる。同様に、モードが後退モードの場合も、車両２０の実車速は速度指令値に略一致することになる。

所定距離ｄ０から離間距離Ｌまでの差が同一の場合、後退モードに比べて、前進モードのほうが大きい速度指令値が出力される。結果として、前進モードでは後退モードよりも加速度が大きくなる。例えば、図４に示すように、前進モード時に離間距離Ｌが所定距離ｄ０よりも距離Ｌ１０長いとする。このときの速度指令値は、後退モード時に離間距離Ｌが所定距離ｄ０よりも距離Ｌ１０短いときの速度指令値よりも大きくなる。即ち、所定距離ｄ０からの距離差に対する速度指令値の増加量は、後退モードより前進モードの方が多く、結果的に、前進モードでは後退モードよりも加速度が大きくなる。

次に、モードの切り替えが行われる場合について説明する。
モードが前進モードの状態で離間距離Ｌが後退開始距離ｄ１２より短くなると、前進モードが後退モードに遷移する。第１不感帯Ａ１の間は、速度指令値が出力されていないため、モードの切り替えが行われない場合に比べて、出力される速度指令値が急激に上昇することになる。すると、図４に二点鎖線で示すように、モードの切り替えが行われない場合に比べて、車両２０の実車速も急激に上昇することになる。即ち、モードの切り替えが行われない場合に比べて、加速度が速くなる。これは、急激に速度指令値が上昇すると、これに合わせて指令回転数と速度センサ２９により検出される回転数の偏差が大きくなることに起因する。時間経過に伴い偏差は解消されていき、車両２０の実速度は速度指令値に追従することになる。同様に、モードが後退モードから前進モードに切り替わる場合も、図４に二点鎖線で示すように、離間距離Ｌが前進開始距離ｄ２２よりも長くなると、車両２０の実車速は急激に上昇する。

本実施形態では、第２距離Ｌ２を第１距離Ｌ１よりも短くしていることで、第２不感帯Ａ２は、第１不感帯Ａ１よりも短い。即ち、後退モードから前進モードに切り替わるために必要となる距離が、前進モードから後退モードに切り替わるために必要となる距離に比べて短くなっている。

本実施形態のように、センサ３１により追尾対象Ｔを認識して、認識した追尾対象Ｔを追尾する自律移動体１０では、追尾対象Ｔとセンサ３１との距離が離れるほど、追尾対象Ｔの認識が困難になる。これは、自律移動体１０とセンサ３１との距離が離れるほど、自律移動体１０と追尾対象Ｔとの間に追尾対象Ｔ以外の物体が入りやすくなること、追尾対象Ｔとセンサ３１との距離が離れることで測定点同士の間隔が長くなることに起因する。

本実施形態のように、第２不感帯Ａ２を第１不感帯Ａ１よりも短くすることで、後退モードから前進モードへの切り替えが行われやすく、第２不感帯Ａ２と第１不感帯Ａ１とを同一とした場合に比べて、車両２０が追尾対象Ｔから離れにくい。

また、追尾対象Ｔが人であれば、モードが後退モードの場合、人は車両２０に向けて移動することになる。人は、車両２０との接触を回避するため、車両２０に向けて移動する場合には、車両２０から離れるように移動する場合に比べて緩やかに移動する傾向にある。このため、モードが後退モードの場合、前進モードに比べて車両２０の速度が緩やかになる。すると、速度指令値が出力されなくなった場合に車両２０の停止に必要となる移動距離は、前進モードの場合に比べて後退モードの場合のほうが短くなる。したがって、第２不感帯Ａ２は、第１不感帯Ａ１よりも短くできる。

更に、後退モードは、追尾対象Ｔが目的地を僅かに過ぎてしまった場合や、追尾対象Ｔが車両２０よりも後方にある荷を取ろうとする場合に、車両２０を後方へ移動させることで追尾対象Ｔとの接触を回避するために用いられることが多い。したがって、後退モードで車両２０が移動する距離は、僅かであることが多く、後退モードでは車両２０の速度が上がりにくい。

上記したように、第１距離Ｌ１は、車両２０の停止に必要となる移動距離を考慮した上で設定されている。第１距離Ｌ１としては、例えば、０．１０ｍ～０．２５ｍの範囲で設定される。また、第２距離Ｌ２は、車両２０の停止に必要となる移動距離に加えて、追尾対象Ｔの種類、追尾対象Ｔの認識しやすさ、前進モードと後退モードでの速度差・加速度差・最高速度差、などを加味して設定される。第２距離Ｌ２としては、例えば、０．０５ｍ～０．２０ｍの範囲で設定される。

本実施形態の効果について説明する。
（１）第２距離Ｌ２は、第１距離Ｌ１よりも短い。自律移動体１０が追尾対象Ｔから離れにくくなることで、制御装置３２が追尾対象Ｔの認識を行いやすい。

（２）後退モードは、前進モードに比べて車両２０の速度が速くなりにくい。このため、第２距離Ｌ２を短くしても、第２不感帯Ａ２の範囲内で車両２０が停止しやすい。
（３）後退モードでの車両２０の加速度は、前進モードでの車両２０の加速度よりも小さい。車両２０の停止に必要となる移動距離は、前進モードに比べて後退モードのほうが短くなる。このため、第２距離Ｌ２を短くしても、第２不感帯Ａ２の範囲内で車両２０が停止しやすい。

（４）後退モードでの速度指令値の上限値は、前進モードでの速度指令値の上限値よりも低い。後退モードの場合に車両２０が到達し得る最高速度は、前進モードの場合に車両２０が到達し得る最高速度に比べて低くなる。車両２０の停止に必要となる移動距離は、前進モードに比べて後退モードのほうが短くなる。このため、第２距離Ｌ２を短くしても、第２不感帯Ａ２の範囲内で車両２０が停止しやすい。

（５）制御装置３２は、車両２０を後退させることができる。追尾対象Ｔは、目的地を若干過ぎてしまった場合などに、車両２０を後退させることができる。車両２０が前進のみしか行えない場合、車両２０を後退させるためには追尾対象Ｔの登録を解除した上で車両２０を押す、外部機器を用いて車両２０を移動させる、あるいは、追尾対象Ｔが車体２１の向きを変更させるなど、作業効率の低下を招く。これに対し、車両２０の後退を可能とすることで、作業効率の低下を抑制できる。

本実施形態は、以下のように変更して実施することができる。本実施形態及び以下の変形例は、技術的に矛盾しない範囲で互いに組み合わせて実施することができる。
○図５に示すように、第１所定距離ｄ０１と、第２所定距離ｄ０２とは、異なる距離であってもよい。図５に示す例では、第２所定距離ｄ０２は、第１所定距離ｄ０１よりも長い。

また、図５に示すように、モードが前進モードから後退モードに切り替わった場合に、速度指令値の上限値が出力されるようにしてもよい。
○車両２０の加速度は、前進モードの場合に比べて、後退モードのほうが速くてもよい。また、車両２０の加速度は、前進モードと後退モードで同一にしてもよい。

○前進モードと後退モードとで、所定距離ｄ０と離間距離Ｌとの距離差に対する速度指令値の増加量が同一であってもよい。この場合、駆動機構２３により、後退モードの加速度が前進モードより遅くなるようにされてもよい。

○速度指令値は、線形に変化しなくてもよい。例えば、速度指令値は、段階的に上昇するように変化してもよい。
○離間距離Ｌとの距離差に応じて、出力される速度指令値は増減しなくてもよい。具体的にいえば、前進モード時に、離間距離Ｌが前進開始距離ｄ２２よりも長くなったときに出力される速度指令値は、一定であってもよい。同様に、後退モード時に、離間距離Ｌが後退開始距離ｄ１２よりも短くなったときに出力される速度指令値は、一定であってもよい。

○第２距離Ｌ２は、車両２０の停止に必要となる距離よりも短い距離に設定されていてもよい。実施形態で記載したように、第１不感帯Ａ１及び第２不感帯Ａ２は、慣性による車両２０の移動により、意図しないモード切り替えが生じることを抑制するために設定されている。第１距離Ｌ１を実施形態の第２距離Ｌ２と同一とした場合、車両２０の停止に際して前進モードから後退モードへの切り替えが意図せずに行われるおそれがある。意図せず前進モードから後退モードへの切り替えが行われると、離間距離Ｌが長くなり追尾対象Ｔを認識できなくなる原因となる。一方で、第２距離Ｌ２を第１距離Ｌ１よりも短くすることで、後退モードから前進モードへ意図せず切り替えが行われたとしても、車両２０は追尾対象Ｔに近付くため、離間距離Ｌは短くなる。このため、追尾対象Ｔを認識しやすい。

○車輪２２は、全方向移動車輪以外の車輪、即ち、車輪２２の回転軸線方向への移動を許容しない車輪であってもよい。この場合、車輪毎に個別の操舵機構を設けて、車輪毎に個別の操舵を行うことで車両２０は全方向への移動が可能となる。また、車輪２２として全方向移動車輪以外の車輪を用いる場合、車輪２２を回転させるためのモータ２４、及び、モータドライバ２５は１つであってもよい。具体的にいえば、駆動輪となる車輪２２と、車輪２２に連結させる車軸と、モータ２４の駆動力を車軸に伝達するためのギヤと、を備える構成であれば、モータ２４、及び、モータドライバ２５を車輪２２毎に設けなくてもよい。

○車両２０としては、少なくとも前進と後退を行えるものであればよく、横方向への移動は行えないものでもよい。
○移動体は、車両２０に限られず、二足歩行ロボットなどでもよい。

○駆動機構２３としては、速度指令値に追従するように車両２０の速度を制御することができれば、どのような構成のものでもよい。
○追尾対象Ｔは、人以外であってもよい。例えば、車両２０とは別の車両であってもよい。

○センサ３１として、ステレオカメラを用いてもよい。ステレオカメラは、複数のカメラによって周辺環境を撮像することで得られた視差画像から周辺環境を制御装置３２に認識させる。視差画像は、同一の特徴点について複数のカメラによって撮像を行った場合に、カメラ間で生じる画素差を示すものである。特徴点は、物体のエッジなど視差が得られる部分である。制御装置３２は、視差画像から対象物までの距離を測定できる。制御装置３２は、特徴点の集合である点群から車両２０の周辺に存在する物体の寸法などの情報を認識できる。なお、センサ３１としては、電波を用いるものなどを用いることもできる。自律移動体１０は、複数種類のセンサ３１を備えていてもよいし、１種類のセンサ３１を備えていてもよい。

○車両２０から追尾対象Ｔまでの離間距離Ｌは、車体２１の中心位置から追尾対象Ｔまでの距離ではなくてもよい。例えば、センサ３１が取り付けられる取付位置から追尾対象Ｔまでの距離を離間距離Ｌとしてもよい。この場合であっても、取付位置を基準として所定距離ｄ０などを設定することで、実施形態と同様の効果を得ることができる。

○制御装置３２は、離間距離Ｌが不感帯Ａ１，Ａ２の範囲内の場合に、車両２０の移動速度が０となるような指令を出力してもよい。即ち、車両２０を停止させるような指令が出力されるようにしてもよい。

○制御装置３２が、走行制御装置２６の機能を備えるようにしてもよい。制御装置３２がモータドライバ２５に指令回転数を出力し、モータドライバ２５はこの指令回転数に合わせてモータ２４を駆動するようにしてもよい。

上記実施形態及び変形例から把握できる技術的思想について記載する。
（イ）移動体に搭載されており、移動体から追尾対象までの離間距離を測定するセンサの検出結果に基づき、追尾対象を追尾するように移動体の制御を行う制御装置であって、離間距離が第１所定距離よりも長くなると追尾対象に近付くように移動体を移動させる前進モードと、離間距離が第２所定距離よりも短くなると追尾対象から離れるように移動体を移動させる後退モードと、を切り替え可能であり、前進モードから後退モードへの切り替えは、第１所定距離から第１距離を減じた後退開始距離よりも離間距離が短くなったときに行われ、後退モードから前進モードへの切り替えは、第２所定距離に第２距離を加えた前進開始距離よりも離間距離が長くなったときに行われ、第２距離は、第１距離よりも短い距離である。

Ｌ…離間距離、Ｔ…追尾対象、ｄ０…所定距離（第１所定距離、及び、第２所定距離）、Ｌ１…第１距離、Ｌ２…第２距離、ｄ１２…後退開始距離、ｄ２２…前進開始距離、１０…自律移動体、２０…車両、３１…センサ、３２…制御装置。

Claims (3)

1. 移動体と、
   前記移動体から追尾対象までの離間距離を測定するセンサと、
   前記追尾対象を追尾するように前記移動体の制御を行う制御装置と、を備え、
   前記制御装置は、
   前記離間距離が第１所定距離よりも長くなると前記追尾対象に近付くように前記移動体を移動させる前進モードと、前記離間距離が第２所定距離よりも短くなると前記追尾対象から離れるように前記移動体を移動させる後退モードと、を切り替え可能であり、
   前記前進モードから前記後退モードへの切り替えは、前記第１所定距離から第１距離を減じた後退開始距離よりも前記離間距離が短くなったときに行われ、
   前記後退モードから前記前進モードへの切り替えは、前記第２所定距離に第２距離を加えた前進開始距離よりも前記離間距離が長くなったときに行われ、
   前記第２距離は、前記第１距離よりも短い距離である自律移動体。
2. 前記制御装置は、
   前記前進モードでは、前記離間距離が前記第１所定距離よりも長いほど移動速度が速くなるように前記移動体を制御し、
   前記後退モードでは、前記離間距離が前記第２所定距離よりも短いほど移動速度が速くなるように前記移動体を制御し、
   前記移動体の移動速度を前記離間距離に応じて速くするに際して、前記離間距離と前記第１所定距離の差と、前記離間距離と前記第２所定距離との差とが同一の場合、前記後退モードでの移動速度に比べて、前記前進モードでの移動速度のほうが速くなるように前記移動体を制御する請求項１に記載の自律移動体。
3. 前記前進モードでの前記移動体の加速度は、前記後退モードでの前記移動体の加速度に比べて大きい請求項１又は請求項２に記載の自律移動体。

Images