(57)【要約】【課題】少ない電力で大きな駆動力が得られるように３以上の複数の駆動ユニットを協調して制御する無人搬送車の駆動操舵装置を提供すること。【解決手段】駆動操舵装置は、前輪及び後輪駆動ユニット４Ｆ，４Ｒに対する速度指令信号（ｖＦ＊，ｖＲ＊）及び操舵角指令信号（ΔθＦ＊，ΔθＲ＊）を生成する主制御部６２と、副駆動ユニット７に対する速度指令信号（ｖＳ＊）及び操舵角指令信号（ΔθＳ＊）を生成する副制御部６８と、を備える。副制御部６８は、副駆動輪操舵軸と前輪操舵軸とを通過する前輪取付軸に沿った副駆動ユニット７の速度成分と前輪駆動ユニット４Ｆの速度成分とが等しくなりかつ副駆動輪操舵軸と後輪操舵軸とを通過する後輪取付軸に沿った副駆動ユニット７の速度成分と後輪駆動ユニット４Ｒの速度成分とが等しくなるように、速度指令信号（ｖＳ＊）及び操舵角指令信号（ΔθＳ＊）を生成する。【選択図】図２
2019109864.tif 000002
【特許請求の範囲】
【請求項１】
台部に取り付けられた３以上の複数の駆動ユニットを用いて走行する無人搬送車の駆動操舵装置であって、
前記複数の駆動ユニットのうちの２つを第１主駆動ユニット及び第２主駆動ユニットとし、当該第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令を生成する主制御装置と、
前記複数の駆動ユニットのうち前記第１及び第２主駆動ユニット以外を副駆動ユニットとし、当該副駆動ユニットに対する副速度指令及び副操舵角指令を生成する副制御装置と、を備え、
前記副制御装置は、前記副駆動ユニットの副操舵軸と前記第１主駆動ユニットの操舵軸とを通過する軸を第１取付軸と定義し、前記副操舵軸と前記第２主駆動ユニットの操舵軸とを通過する軸を第２取付軸と定義し、前記第１取付軸に沿った前記副駆動ユニットの速度成分と前記第１主駆動ユニットの速度成分とが等しくなりかつ前記第２取付軸に沿った前記副駆動ユニットの速度成分と前記第２主駆動ユニットの速度成分とが等しくなるように、前記副速度指令及び前記副操舵角指令を生成することを特徴とする無人搬送車の駆動操舵装置。
【請求項２】
前記複数の駆動ユニットのうち、前記台部の平面視で最も離れている２つを前記第１主駆動ユニット及び前記第２主駆動ユニットとすることを特徴とする請求項１に記載の無人搬送車の駆動操舵装置。
【請求項３】
前記副制御装置は、前記第１取付軸に沿った前記第１主駆動ユニットの速度成分、及び前記第２取付軸に沿った前記第２主駆動ユニットの速度成分を、前記主制御装置によって生成された前記第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令に基づいて算出することを特徴と請求項１又は２に記載の無人搬送車の駆動操舵装置。
【請求項４】
前記台部の位置及び姿勢を検出し、検出位置と外部位置指令との間の位置ずれ及び検出姿勢と外部姿勢指令との間の姿勢ずれを出力するずれ検出器をさらに備え、
前記主制御装置は、前記第１主駆動ユニットの操舵軸と前記第２主駆動ユニットの操舵軸とを通過する軸を主取付軸と定義し、前記第１主駆動ユニットの前記主取付軸に沿った微小移動距離と前記第２主駆動ユニットの前記主取付軸に沿った微小移動距離とが等しくなりかつ前記位置ずれ及び前記姿勢ずれが無くなるように前記第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令を生成することを特徴とする請求項１から３の何れかに記載の無人搬送車の駆動操舵装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、無人搬送車の駆動操舵装置に関する。
【背景技術】
【０００２】
製品を製造する製造工場や製品を保管したり管理したりする倉庫等では、部品や箱等の搬送対象物を、人手を介さずに自動で搬送する無人搬送車が用いられている。無人搬送車は、搬送対象物が載置される荷台と、この荷台を磁気テープやマーカ等によって床面に指定された軌跡に沿って移動させる駆動操舵装置と、を備える。駆動操舵装置は、駆動操舵輪を備える少なくとも２つの全方位駆動ユニットと、これら全方位駆動ユニットを制御する制御装置と、を備える。
【０００３】
特許文献１には、このような無人搬送車の荷台の下部に設けられた２台の全方位駆動ユニットの各駆動操舵輪の駆動操舵方法が示されている。特許文献１の駆動操舵方法では、前側駆動操舵輪に対する前輪操舵角指令と荷台の中心点に対する速度指令とを外部指令として取得し、これら前輪操舵角指令及び速度指令に基づいて、旋回中心の座標位置、後輪操舵角指令、中心点の旋回半径、前側駆動操舵輪の旋回半径、及び後側駆動操舵輪の旋回半径を算出し、これら指令が実現するように前側及び後側の全方位駆動ユニットを制御する。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２０１０−２５６９４１号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
ところで搬送対象物が大きなものである場合や重いものである場合、荷台には、３つ以上の全方位駆動ユニットを取り付けることが望まれる場合がある。しかしながら従来では、大きな駆動力が得られるように３つの全方位駆動ユニットを協調して制御する方法については十分に検討されていない。
【０００６】
本発明は、少ない電力で大きな駆動力が得られるように３以上の複数の駆動ユニットを協調して制御する無人搬送車の駆動操舵装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
（１）本発明に係る駆動操舵装置（例えば、後述の駆動操舵装置３）は、台部（例えば、後述の荷台部２１）に取り付けられた３以上の複数の駆動ユニット（例えば、後述の前輪駆動ユニット４Ｆ、後輪駆動ユニット４Ｒ、副駆動ユニット７）を用いて走行する無人搬送車（例えば、後述の無人搬送車１）を駆動操舵するものであって、前記複数の駆動ユニットのうちの２つを第１主駆動ユニット（例えば、後述の前輪駆動ユニット４Ｆ）及び第２主駆動ユニット（例えば、後述の後輪駆動ユニット４Ｒ）とし、当該第１及び第２主駆動ユニットに対する主速度指令（ｖＦ＊，ｖＲ＊）及び主操舵角指令（ΔθＦ＊，ΔθＲ＊）を生成する主制御装置（例えば、後述の主制御部６２）と、前記複数の駆動ユニットのうち前記第１及び第２主駆動ユニット以外を副駆動ユニット（例えば、後述の副駆動ユニット７）とし、当該副駆動ユニットに対する副速度指令（ｖＳ＊）及び副操舵角指令（ΔθＳ＊）を生成する副制御装置（例えば、後述の副制御部６８）と、を備え、前記副制御装置は、前記副駆動ユニットの副操舵軸（例えば、後述の副駆動輪操舵軸７３）と前記第１主駆動ユニットの操舵軸（例えば、後述の前輪操舵軸４３Ｆ）とを通過する軸を第１取付軸（例えば、後述の前輪取付軸ＯＦＳ）と定義し、前記副操舵軸と前記第２主駆動ユニットの操舵軸（例えば、後述の後輪操舵軸４３Ｒ）とを通過する軸を第２取付軸（例えば、後述の後輪取付軸ＯＲＳ）と定義し、前記第１取付軸に沿った前記副駆動ユニットの速度成分と前記第１主駆動ユニットの速度成分とが等しくなりかつ前記第２取付軸に沿った前記副駆動ユニットの速度成分と前記第２主駆動ユニットの速度成分とが等しくなるように、前記副速度指令及び前記副操舵角指令を生成することを特徴とする。
【０００８】
（２）この場合、前記複数の駆動ユニットのうち、前記台部の平面視で最も離れている２つを前記第１主駆動ユニット及び前記第２主駆動ユニットとすることが好ましい。
【０００９】
（３）この場合、前記副制御装置は、前記第１取付軸に沿った前記第１主駆動ユニットの速度成分、及び前記第２取付軸に沿った前記第２主駆動ユニットの速度成分を、前記主制御装置によって生成された前記第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令に基づいて算出することが好ましい。
【００１０】
（４）この場合、前記駆動操舵装置は、前記台部の位置及び姿勢を検出し、検出位置と外部位置指令との間の位置ずれ（例えば、後述の走行誤差Δｙ）及び検出姿勢と外部姿勢指令との間の姿勢ずれ（例えば、後述の姿勢誤差Δψ）を出力するずれ検出器（例えば、後述のずれ検出器６１）をさらに備え、前記主制御装置は、前記第１主駆動ユニットの操舵軸（例えば、後述の前輪操舵軸４３Ｆ）と前記第２主駆動ユニットの操舵軸（例えば、後述の後輪操舵軸４３Ｒ）とを通過する軸を主取付軸（例えば、後述の主取付軸ＯＰＷＳ）と定義し、前記第１主駆動ユニットの前記主取付軸に沿った微小移動距離（ｄｌＦｃｏｓρＦ）と前記第２主駆動ユニットの前記主取付軸に沿った微小移動距離（ｄｌＲｃｏｓρＲ）とが等しくなりかつ前記位置ずれ及び前記姿勢ずれが無くなるように前記第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令を生成することが好ましい。
【発明の効果】
【００１１】
（１）本発明では、台部に取り付けられた３以上の複数の駆動ユニットのうちの２つを第１及び第２主駆動ユニットとし、これら第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令を主制御装置によって生成し、また複数の駆動ユニットのうち第１及び第２主駆動ユニット以外を副駆動ユニットとし、この（又はこれら）副駆動ユニットに対する副速度指令及び副操舵角指令を副制御装置によって生成する。特に本発明では、副制御装置は、副駆動ユニットの副操舵軸と第１主駆動ユニットの操舵軸とを通過する第１取付軸に沿った副駆動ユニットの速度成分と第１主駆動ユニットの速度成分とが等しくなり、かつ副駆動ユニットの副操舵軸と第２主駆動ユニットの操舵軸とを通過する第２取付軸に沿った副駆動ユニットの速度成分と第２主駆動ユニットの速度成分とが等しくなるように副速度指令及び副操舵角指令を生成する。これにより、副駆動ユニットと第１主駆動ユニットとの間及び副駆動ユニットと第２主駆動ユニットとの間に、力が作用しないように副駆動ユニットの速度及び操舵角を制御できる。換言すれば、本発明によれば、第１主駆動ユニット及び第２主駆動ユニットで発生した駆動力の一部が副駆動ユニットで発生した駆動力によって打ち消されないように副駆動ユニットの速度及び操舵角を制御できる。よって本発明によれば、少ない電力で大きな駆動力が得られるように３以上の複数の駆動ユニットを協調して制御できる。
【００１２】
（２）本発明では、副駆動ユニットの速度や操舵角は、第１及び第２主駆動ユニットの速度や操舵角によって一意的に決定されるため、台部の位置及び姿勢は第１及び第２主駆動ユニットの速度及び操舵角によって定まる。また、第１及び第２主駆動ユニットの位置が近くなると、主制御装置による第１及び第２主駆動ユニットの速度及び操舵角の制御の精度が悪化し、ひいては副制御装置による副駆動ユニットの速度及び操舵角の制御の精度も悪化するおそれがある。そこで本発明では、台部に取り付けられた３以上の複数の駆動ユニットのうち、台部の平面視で最も離れている２つを第１主駆動ユニット及び第２主駆動ユニットとする。これにより、全ての駆動ユニットの速度及び操舵角を精度よく制御できる。
【００１３】
（３）本発明では、副制御装置は、第１取付軸に沿った第１主駆動ユニットの速度成分及び第２取付軸に沿った第２主駆動ユニットの速度成分を、主制御装置によって生成された第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令に基づいて算出する。これにより、副制御装置では、簡易な演算で副駆動ユニットの速度及び操舵角を制御できる。
【００１４】
（４）本発明では、ずれ検出器によって台部の検出位置と外部位置指令との間の位置ずれ及び検出姿勢と外部姿勢指令との間の姿勢ずれを検出する。また主制御装置では、第１主駆動ユニットの主取付軸に沿った微小移動距離と第２主駆動ユニットの主取付軸に沿った微小移動距離とが等しくなり、かつずれ検出器によって検出された位置ずれ及び姿勢ずれが無くなるように第１及び第２主駆動ユニットに対する主速度指令及び主操舵角指令を生成する。これにより、３以上の複数の駆動ユニットを合せて大きな駆動力を発生させつつ、第１及び第２主駆動ユニットの間で無理な力が作用するのを防止しながら、台部を外部姿勢指令に応じた姿勢にて、外部位置指令に応じた経路に沿って走行させることができる。
【図面の簡単な説明】
【００１５】
【図１】本発明の一実施形態に係る無人搬送車及び駆動操舵装置を示す図である。
【図２】制御装置の制御回路の構成を示す図である。
【図３】台車の平面図であり、制御装置において規定される各種パラメータの定義を説明するための図である。
【図４】位置・姿勢ずれ検出制御の手順を説明するための図である。
【図５】台車の平面図であり、主制御部における主駆動操舵制御の具体的な手順を説明するための図である。
【図６】主制御部のブロック図である。
【図７】台車の平面図であり、副制御部において規定される各種パラメータの定義を説明するための図である。
【図８】前輪操舵軸、後輪操舵軸、及び副駆動輪操舵軸の位置ベクトルを示す図である。
【図９】副制御部のブロック図である。
【図１０】５つの駆動ユニットを取り付けた場合における荷台部の平面図である。
【発明を実施するための形態】
【００１６】
以下、本発明の一実施形態について、図面を参照しながら説明する。
図１は、本実施形態に係る無人搬送車１及びその駆動操舵装置３の構成を示す斜視図である。
【００１７】
無人搬送車１は、台車２と、この台車２に取り付けられ、床面Ｆに予め配設された線状の誘導ラインＬに沿って台車２を走行させる駆動操舵装置３と、を組み合わせて構成される。
【００１８】
台車２は、長方形の板状である荷台部２１と、この荷台部２１の床面Ｆ側の四隅に設けられたキャスタ２２と、荷台部２１のうち短辺縁部２４ＲＲに立設された枠状のハンドル２３と、を備える。なお以下では、説明の便宜上、荷台部２１のうちハンドル２３が設けられている短辺縁部２４ＲＲ側を台車２の後方側といい、ハンドル２３が設けられていない短辺縁部２４ＦＦ側を台車２の前方側という。なおこれら台車２の前方及び後方の定義は説明の便宜上のものであり、台車２の進行方向をこの向きに限定するものではない。また以下では、荷台部２１に搬送対象物（図示せず）を搭載し、この無人搬送車１単独で自走させる場合について説明するが、本発明はこれに限らない。無人搬送車１は、例えば搬送対象物が搭載されたパレット（図示せず）と台車２とを連結することにより、パレットの牽引車として用いることもできる。
【００１９】
駆動操舵装置３は、回転駆動及び操舵の両方が可能な駆動操舵輪である前輪４１Ｆを備える前輪駆動ユニット４Ｆと、回転駆動及び操舵の両方が可能な駆動操舵輪である後輪４１Ｒを備える後輪駆動ユニット４Ｒと、回転駆動及び操舵の両方が可能な駆動操舵輪である副駆動輪７１を備える副駆動ユニット７と、荷台部２１の床面Ｆに対する位置及び姿勢を検出するための前側センサ５Ｆ及び後側センサ５Ｒと、各駆動ユニット４Ｆ，４Ｒ，７に電力を供給するバッテリＢと、各センサ５Ｆ，５Ｒの検出信号を用いて各駆動ユニット４Ｆ，４Ｒ，７を制御する制御装置６と、を備える。
【００２０】
前輪駆動ユニット４Ｆは、荷台部２１の床面Ｆ側のうち前方側、より具体的には短辺縁部２４ＦＦ側でありかつ長辺縁部２５Ｌ寄りの位置に取り付けられる。前輪駆動ユニット４Ｆは、床面Ｆに接する前輪４１Ｆと、制御装置６から送信される後述の前輪速度指令信号及び前輪操舵角指令信号に応じて前輪４１Ｆを駆動操舵する駆動部４２Ｆと、を備える。駆動部４２Ｆは、前輪速度指令信号及び前輪操舵角指令信号が入力されると、これら指令が実現されるように、前輪４１Ｆを回転駆動したり、前輪４１Ｆを荷台部２１に対し垂直な前輪操舵軸４３Ｆを中心として操舵駆動したりする。なお以下では、前輪４１Ｆの回転速度を前輪速度ともいい、前輪４１Ｆの前輪操舵軸４３Ｆ周りでの角度を前輪操舵角ともいう。
【００２１】
また前輪駆動ユニット４Ｆには、前輪速度を検出し、検出値に応じた前輪速度検出信号を制御装置６に送信する前輪速度センサ４６Ｆ（後述の図２参照）や、前輪操舵角を検出し、検出値に応じた前輪操舵角検出信号を制御装置６に送信する前輪操舵角センサ４７Ｆ（後述の図２参照）とが設けられている。
【００２２】
後輪駆動ユニット４Ｒは、荷台部２１の床面Ｆ側のうち前輪駆動ユニット４Ｆよりも後方側、より具体的には短辺縁部２４ＲＲ側でありかつ長辺縁部２５Ｒ寄りの位置に取り付けられる。後輪駆動ユニット４Ｒは、床面Ｆに接する後輪４１Ｒと、制御装置６から送信される後述の後輪速度指令信号及び後輪操舵角指令信号に応じて後輪４１Ｒを駆動操舵する駆動部４２Ｒと、を備える。駆動部４２Ｒは、後輪速度指令信号及び後輪操舵角指令信号が入力されると、これら指令が実現されるように、後輪４１Ｒを回転駆動したり、後輪４１Ｒを荷台部２１に対し垂直な後輪操舵軸４３Ｒを中心として操舵駆動したりする。なお以下では、後輪４１Ｒの回転速度を後輪速度ともいい、後輪４１Ｒの後輪操舵軸４３Ｒ周りでの角度を後輪操舵角ともいう。
【００２３】
また後輪駆動ユニット４Ｒには、後輪速度を検出し、検出値に応じた後輪速度検出信号を制御装置６に送信する後輪速度センサ４６Ｒ（後述の図２参照）や、後輪操舵角を検出し、検出値に応じた後輪操舵角検出信号を制御装置６に送信する後輪操舵角センサ４７Ｒ（後述の図２参照）とが設けられている。
【００２４】
副駆動ユニット７は、荷台部２１の床面Ｆ側のうち前輪駆動ユニット４Ｆと後輪駆動ユニット４Ｒとの間の位置に取り付けられる。副駆動ユニット７は、床面Ｆに接する副駆動輪７１と、制御装置６から送信される後述の副駆動輪速度指令信号及び副駆動輪操舵角指令信号に応じて副駆動輪７１を駆動操舵する駆動部７２と、を備える。駆動部７２は、副駆動輪速度指令信号及び副駆動輪操舵角指令信号が入力されると、これら指令が実現されるように、副駆動輪７１を回転駆動したり、副駆動輪７１を荷台部２１に対し垂直な副駆動輪操舵軸７３を中心として操舵駆動したりする。なお以下では、副駆動輪７１の回転速度を副駆動輪速度ともいい、副駆動輪７１の副駆動輪操舵軸７３周りでの角度を副駆動輪操舵角ともいう。
【００２５】
前側センサ５Ｆは、荷台部２１の床面Ｆ側のうち前方側に取り付けられる。より具体的には、前側センサ５Ｆは、平面視では後述の主軸ＯＡＧＶ上であって中心点ＰＡＧＶよりも前方側に設けられる（後述の図２参照）。前側センサ５Ｆには、例えば、床面Ｆを撮影するカメラが用いられる。前側センサ５Ｆは、床面Ｆのうち誘導ラインＬを含む画像を撮影し、画像信号を制御装置６へ送信する。
【００２６】
後側センサ５Ｒは、荷台部２１の床面Ｆ側のうち、前側センサ５Ｆよりも後方側に取り付けられる。より具体的には、後側センサ５Ｒは、平面視では後述の主軸ＯＡＧＶ上であって中心点ＰＡＧＶよりも後方側に設けられる（後述の図２参照）。後側センサ５Ｒには、例えば、床面Ｆを撮影するカメラが用いられる。後側センサ５Ｒは、床面Ｆのうち誘導ラインＬを含む画像を撮影し、画像信号を制御装置６へ送信する。荷台部２１の誘導ラインＬに対する位置及び姿勢は、これら前側センサ５Ｆ及び後側センサ５Ｒによって得られた画像信号に基づく後述のずれ検出器６１における演算によって特定される。
【００２７】
バッテリＢは、例えば、荷台部２１のうちハンドル２３側に取り付けられる。また制御装置６は、例えば、台車２のうちハンドル２３に取り付けられる。
【００２８】
図２は、制御装置６の制御回路の構成を示す図である。制御装置６は、台車２の位置及び姿勢のずれを検出するずれ検出器６１と、前輪駆動ユニット４Ｆ及び後輪駆動ユニット４Ｒを制御する主制御部６２と、副駆動ユニット７を制御する副制御部６８と、を備える。
【００２９】
次に、図３の台車２の平面図を参照しながら、台車２の位置及び姿勢を把握するために制御装置６において規定される各種パラメータ及び座標系の定義について説明する。なお図３には、説明を容易にするため副駆動ユニット７の図示を省略する。
【００３０】
上述のように、前輪４１Ｆの前輪操舵軸４３Ｆ及び後輪４１Ｒの後輪操舵軸４３Ｒは、台車２の荷台部２１に対し平面視で対角状に設けられる。以下では、前輪操舵軸４３Ｆ及び後輪操舵軸４３Ｒを通過する軸を主取付軸ＯＰＷＳという。またこの主取付軸ＯＰＷＳ上であって、前輪操舵軸４３Ｆと後輪操舵軸４３Ｒとの間の中間点を台車２の中心点ＰＡＧＶという。また以下では、前輪操舵軸４３Ｆと後輪操舵軸４３Ｒとの間の主取付軸ＯＰＷＳに沿った距離を前後輪距離ＨＡＧＶという。
【００３１】
また以下では、荷台部２１の長辺縁部２５Ｌ，２５Ｒと平行でありかつ中心点ＰＡＧＶを通過する軸を台車２の主軸ＯＡＧＶという。また以下では、主取付軸ＯＰＷＳと主軸ＯＡＧＶとの成す角を取付角φＡＧＶという。
【００３２】
前輪４１Ｆは、荷台部２１に対し平行な前輪回転軸４５Ｆを中心軸として回転自在に設けられている。以下では、前輪４１Ｆの前輪回転軸４５Ｆ周りでの回転速度を前輪速度ｖＦという。この前輪速度ｖＦは、前輪駆動ユニット４Ｆに設けられている前輪速度センサ４６Ｆ（図２参照）によって検出される。
【００３３】
また前輪４１Ｆは、荷台部２１に対し垂直な前輪操舵軸４３Ｆを中心として回転自在に設けられている。以下では、前輪４１Ｆの進行方向と主軸ＯＡＧＶとの成す角を前輪操舵角ΔθＦという。この前輪操舵角ΔθＦは、前輪駆動ユニット４Ｆに設けられている前輪操舵角センサ４７Ｆ（図２参照）によって検出される。また以下では、前輪４１Ｆの進行方向と主取付軸ＯＰＷＳとの成す角、すなわち前輪操舵角ΔθＦから取付角φＡＧＶを減じて得られる角も前輪操舵角ρＦという。
【００３４】
後輪４１Ｒは、荷台部２１に対し平行な後輪回転軸４５Ｒを中心軸として回転自在に設けられている。以下では、後輪４１Ｒの後輪回転軸４５Ｒ周りでの回転速度を後輪速度ｖＲという。この後輪速度ｖＲは、後輪駆動ユニット４Ｒに設けられている後輪速度センサ４６Ｒ（図２参照）によって検出される。
【００３５】
また後輪４１Ｒは、荷台部２１に対し垂直な後輪操舵軸４３Ｒを中心として回転自在に設けられている。以下では、後輪４１Ｒの進行方向と主軸ＯＡＧＶとの成す角を後輪操舵角ΔθＲという。この後輪操舵角ΔθＲは、後輪駆動ユニット４Ｒに設けられている後輪操舵角センサ４７Ｒ（後述の図２参照）によって検出される。また以下では、後輪４１Ｒの進行方向と主取付軸ＯＰＷＳとの成す角、すなわち後輪操舵角ΔθＲから取付角φＡＧＶを減じて得られる角も後輪操舵角ρＲという。
【００３６】
また以下では、台車２の中心点ＰＡＧＶが進行する方向を台車２の進行方向という。またこの進行方向と平行でありかつ中心点ＰＡＧＶを通過する軸を進行軸ＯΔという。また以下では、進行軸ＯΔと主取付軸ＯＰＷＳとの成す角を進行角λという。
【００３７】
制御装置６では、台車２の中心点ＰＡＧＶの位置を、進行軸座標系（図３中、実線矢印参照）と主取付軸座標系（図３中、破線矢印参照）との２つのデカルト座標系で把握する。
【００３８】
主取付軸座標系とは、そのＸ軸と主取付軸ＯＰＷＳとが平行になり、かつ主取付軸ＯＰＷＳの前輪４１Ｆ側をＸ軸の正側とした座標系である。以下では、主取付軸座標系における中心点ＰＡＧＶの位置ベクトルを、ＰＡＧＶＰＷＳ＝［ｘＡＧＶＰＷＳ，ｙＡＧＶＰＷＳ］と表記する。
【００３９】
進行軸座標系とは、そのＸ軸と台車２の進行軸ＯΔと進行方向とが平行になり、かつ台車２の進行方向を正側とした座標系である。以下では、進行軸座標系における中心点ＰＡＧＶの位置ベクトルを、ＰＡＧＶΔ＝［ｘＡＧＶΔ，ｙＡＧＶΔ］と表記する。なお、主取付軸座標系の位置ベクトルと進行軸座標系の位置ベクトルとは、下記式（３）に示す変換行列ＱΔによって相互に変換可能である。
【数１】
2019109864.tif 000003
【００４０】
また制御装置６では、台車２の姿勢を、その主軸ＯＡＧＶと所定の基準軸ＯＢＳとの成す角である車体角ψによって把握する。本実施形態では、この基準軸ＯＢＳは、後に図４を参照して説明するように誘導ラインＬの基準接線ＯＬとするが、本発明はこれに限るものではない。
【００４１】
図２に戻り、ずれ検出器６１は、台車２に設けられた前側センサ５Ｆ及び後側センサ５Ｒから送信される画像信号と、外部位置指令信号と、外部姿勢指令信号と、に基づいて以下で説明する位置・姿勢ずれ検出制御を行うことにより、位置誤差信号及び姿勢ずれ信号を生成し、主制御部６２へ送信する。
【００４２】
図４は、台車２の平面図であり、ずれ検出器６１における位置・姿勢ずれ検出制御の手順を説明するための図である。なお図４には、床面Ｆに配設された誘導ラインＬと、台車２のうち、台車２の床面Ｆに対する位置を特定する際の基準となる中心点ＰＡＧＶと、台車２の床面Ｆに対する姿勢を特定する際の基準となる進行軸ＯΔとを図示する。
【００４３】
先ず、ずれ検出器６１では、前側センサ５Ｆ及び後側センサ５Ｒから送信される画像信号に基づいて、誘導ラインＬの位置及び形状に関する情報を取得する。次にずれ検出器６１では、取得した情報に基づいて、進行軸座標系における中心点ＰＡＧＶの位置と、中心点ＰＡＧＶを通過しかつ進行軸ＯΔに対し垂直な線と誘導ラインＬとの交点である基準点ＰＬの位置とを算出する。なお以下では、進行軸座標系の原点の位置を基準点ＰＬに設定する。これにより、台車２の中心点ＰＡＧＶの位置は、基準点ＰＬから中心点ＰＡＧＶまでの距離ｙＡＧＶΔで表される。以下では、中心点ＰＡＧＶと基準点ＰＬとの間の距離を台車２の検出走行位置ｙＡＧＶΔという。またずれ検出器６１では、取得した情報に基づいて、誘導ラインＬの基準点ＰＬにおける接線である基準接線ＯＬの向きを算出し、さらに主軸ＯＡＧＶと基準接線ＯＬとの成す角ψを算出する。以下では、主軸ＯＡＧＶと基準接線ＯＬとの成す角を検出車体角ψという。
【００４４】
ずれ検出器６１では、図示しない無線通信手段を利用することにより、上記検出走行位置ｙＡＧＶΔに対する指令値に相当する位置指令値ｙ＊に応じた外部位置指令信号と、上記検出車体角ψに対する指令値に相当する姿勢指令値ψ＊に応じた外部姿勢指令信号と、を取得する。次にずれ検出器６１では、位置指令値ｙ＊から検出走行位置ｙＡＧＶΔを減算することによって走行誤差Δｙ（＝ｙ＊−ｙＡＧＶΔ）を算出し、さらに姿勢指令値ψ＊から検出姿勢ψを減算することによって姿勢誤差Δψを算出するとともに、走行誤差Δｙに応じた位置誤差信号と姿勢誤差Δψに応じた姿勢ずれ信号とを主制御部６２へ出力する。
【００４５】
以上のように、制御装置６では、外部位置指令信号及び外部姿勢指令信号を用いることにより、台車２の中心点ＰＡＧＶと誘導ラインＬとの間の距離や、台車２の主軸ＯＡＧＶの誘導ラインＬの接線に対する角度を自由に指定することができる。すなわち、台車２を、その中心点ＰＡＧＶが誘導ラインＬの直上をトレースするように走行させたい場合には、外部位置指令信号の位置指令値ｙ＊を０とすればよく、台車２を、その主軸ＯＡＧＶが誘導ラインＬの接線と常に平行になるように走行させたい場合には、外部姿勢指令信号の姿勢指令値ψ＊を０とすればよい。
【００４６】
図２に戻り、主制御部６２は、ずれ検出器６１によって検出された走行誤差Δｙ及び姿勢誤差Δψと、台車２の速度に対する指令値ｖ＊に応じた外部速度指令信号と、各駆動ユニット４Ｆ，４Ｒに設けられた操舵角センサ４７Ｆ，４７Ｒによって検出された両輪の操舵角ΔθＦ，ΔθＲと、に基づいて、以下で説明する主駆動操舵制御を実行することにより、走行誤差Δｙ及び姿勢誤差Δψが０になりかつ指令値ｖ＊が実現されるように、前輪速度ｖＦに対する指令値ｖＦ＊に応じた前輪速度指令信号と、後輪速度ｖＲに対する指令値ｖＲ＊に応じた後輪速度指令信号と、前輪操舵角ΔθＦに対する指令値ΔθＦ＊に応じた前輪操舵角指令信号と、後輪操舵角ΔθＲに対する指令値ΔθＲ＊に応じた後輪操舵角指令信号と、を生成し、これら指令信号を各駆動ユニット４Ｆ，４Ｒに入力する。
【００４７】
以下では主制御部６２における主駆動操舵制御の具体的な手順を説明する前に、台車２に対し成立する運動方程式について、図５を参照しながら説明する。なお主制御部６２における主駆動操舵制御では、副駆動ユニット７の存在を無視して前輪及び後輪速度指令信号並びに前輪及び後輪操舵角指令信号を生成する。
【００４８】
先ず、前輪４１Ｆ及び後輪４１Ｒは、台車２に対し前輪操舵軸４３Ｆ及び後輪操舵軸４３Ｒに固定されているため、前後輪距離ＨＡＧＶは常に一定である。このため、図５に示すように、台車２の主取付軸ＯＰＷＳに沿った微小移動距離ｄｌと、前輪４１Ｆの微小移動距離ｄｌＦと、後輪４１Ｒの微小移動距離ｄｌＲと、の間には下記式（２）が成立する。なお、図５では、理解を容易にするため、微小移動距離ｄｌを誇張して図示する。
【数２】
2019109864.tif 000004
【００４９】
また前輪４１Ｆ及び後輪４１Ｒがそれぞれ空転せずに移動する場合、両輪４１Ｆ，４１Ｒはそれぞれ仮想的な旋回中心点ＲＡＧＶを中心とした円周上を移動する。またこの旋回中心点ＲＡＧＶの位置は、図５に示すように、荷台部２１の中心点ＰＡＧＶの位置と、前輪操舵角ρＦと、後輪操舵角ρＲと、によって定まる。また後輪４１Ｒと旋回中心点ＲＡＧＶとの間の距離である後輪旋回半径ＲＲ及び前輪４１Ｆと旋回中心点ＲＡＧＶとの間の距離である前輪旋回半径ＲＦは、それぞれ各操舵角ρＦ，ρＲを用いて下記式（３−１）及び（３−２）のように算出される。
【数３】
2019109864.tif 000005
【００５０】
また上記前輪旋回半径ＲＦ及び微小移動距離ｄｌＦを用いると、荷台部２１の車体角ψの微小変化量ｄψに対し、下記式（４−１）及び（４−２）が導出される。したがって下記式（４−２）が台車２の車体角ψに対する運動方程式となる。
【数４】
2019109864.tif 000006
【００５１】
図５に示すように、主取付軸座標系における前輪４１Ｆの位置ベクトルＰＦＰＷＳの微小変化量ｄＰＦＰＷＳ及び後輪４１Ｒの位置ベクトルＰＲＰＷＳの微小変化量ｄＰＲＰＷＳは、それぞれ下記式（５−１）及び（５−２）のようになる。
【数５】
2019109864.tif 000007
【００５２】
従って、前輪４１Ｆと後輪４１Ｒの中間点である荷台部２１の中心点ＰＡＧＶの主取付軸座標系における位置ベクトルＰＡＧＶＰＷＳの微小変化量ｄＰＡＧＶＰＷＳに対し、下記式（６−１）及び（６−２）が導出される。したがって下記式（６−２）が、主取付軸座標系における位置ベクトルＰＡＧＶＰＷＳ＝［ｘＡＧＶＰＷＳ，ｙＡＧＶＰＷＳ］の運動方程式となる。
【数６】
2019109864.tif 000008
【００５３】
なお、上記式（６−２）に示す運動方程式は、主取付軸ＯＰＷＳを基準とした主取付軸座標系における位置ベクトルＰＡＧＶＰＷＳに対する運動方程式である。従って進行軸ＯΔを基準とした進行軸座標系における位置ベクトルＰＡＧＶΔ＝［ｘＡＧＶΔ，ｙＡＧＶΔ］に対する運動方程式は、式（６−２）に対し、上記式（１）に示す変換行列ＱΔを乗算することにより、下記式（７）のように導出される。
【数７】
2019109864.tif 000009
【００５４】
また３つのパラメータ（α，β，γ）を導入することにより、上記式（４−２）及び（７）に示す台車２の位置及び姿勢に対する運動方程式は、下記式（８−１）及び（８−２）に示すように書き換えられる。
【数８】
2019109864.tif 000010
【００５５】
ここでパラメータγは、上記式（８−１）より、下記式（９）に示すように表される。
【数９】
2019109864.tif 000011
【００５６】
また上記式（８−１）及び（８−２）より、前輪操舵角ΔθＦ及び後輪操舵角ΔθＲは、パラメータ（α，β，γ）を用いて下記式（１０−１）及び（１０−２）のように表すことができる。これはすなわち、パラメータαを走行誤差Δｙを入力としたフィードバックコントローラの出力とし、パラメータβを姿勢誤差Δψを入力としたフィードバックコントローラの出力とした場合、これらフィードバックコントローラの出力であるパラメータα，βに基づいて下記式（１０−１）及び（１０−２）に示す非干渉化演算によって前輪操舵角ΔθＦ及び後輪操舵角ΔθＲを決定すると、走行誤差Δｙと姿勢誤差Δψとをそれぞれ独立して制御できることを意味する。
【数１０】
2019109864.tif 000012
【００５７】
次に、図６のブロック図を参照しながら、主制御部６２における主駆動操舵制御の具体的な手順、すなわち主制御部６２において前輪速度指令信号、後輪速度指令信号、前輪操舵角指令信号、及び後輪操舵角指令信号を生成する具体的な手順を説明する。
【００５８】
主制御部６２は、上記式（９）によって定義される角度パラメータγの値を算出する角度パラメータ演算部６３と、台車２の主取付軸ＯＰＷＳに沿った微小移動距離ｄｌの値を算出する微小移動距離演算部６４と、進行角λの値を算出する進行角演算部６７と、前輪速度指令値ｖＦ＊及び後輪速度指令値ｖＲ＊を算出する速度制御部６５と、前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊を算出する操舵角制御部６６と、を備える。
【００５９】
進行角演算部６７は、進行軸ＯＡと取付軸ＯＰＷＳとの成す角である進行角λの値を算出する（図９参照）。より具体的には、進行角演算部６７は、車体角ψ（基準軸ＯＢＳ（すなわち、誘導ラインＬの基準接線ＯＬ）と主軸ＯＡＧＶとの成す角）に対する指令値である姿勢指令値ψ＊と、主軸ＯＡＧＶと取付軸ＯＰＷＳとの成す角である取付角φＡＧＶとを用いることにより、下記式（１１）に従って進行角λの値を算出する。
【数１１】
2019109864.tif 000013
【００６０】
角度パラメータ演算部６３は、前輪操舵角センサ４７Ｆによって検出された前輪操舵角ΔθＦと、後輪操舵角センサ４７Ｒによって検出された後輪操舵角ΔθＲと、を用いて、上記式（９）に示す演算を行うことによって角度パラメータγの値を算出する。
【００６１】
速度制御部６５は、外部速度指令値ｖ＊と、前輪操舵角センサ４７Ｆによって検出された前輪操舵角ΔθＦと、後輪操舵角センサ４７Ｒによって検出された後輪操舵角ΔθＲと、を用いることにより、前輪４１Ｆの主取付軸ＯＰＷＳに沿った微小移動距離ｄｌＦｃｏｓρＦと、後輪４１Ｒの主取付軸ＯＰＷＳに沿った微小移動距離ｄｌＲｃｏｓρＲと、が等しくなるように、すなわち上記式（２）が成立するように、前輪速度指令値ｖＦ＊及び後輪速度指令値ｖＲ＊を算出する。また速度制御部６５は、算出した前輪速度指令値ｖＦ＊に応じた前輪速度指令信号及び後輪速度指令値ｖＲ＊に応じた後輪速度指令信号を生成し、これら指令信号を各駆動ユニット４Ｆ，４Ｒへ入力する。
【００６２】
より具体的には、速度制御部６５では、外部速度指令値ｖ＊と、検出された操舵角ρＦ，ρＲと、に基づいて下記式（１２）に示す演算を行うことによって前輪速度指令値ｖＦ＊及び後輪速度指令値ｖＲ＊を算出する。
【数１２】
2019109864.tif 000014
【００６３】
微小移動距離演算部６４は、角度パラメータ演算部６３によって算出された角度パラメータγの値と、前輪操舵角センサ４７Ｆによって検出された前輪操舵角ΔθＦと、後輪操舵角センサ４７Ｒによって検出された後輪操舵角ΔθＲと、前輪速度センサ４６Ｆによって検出された前輪速度ｖＦと、後輪速度センサ４６Ｒによって検出された後輪速度ｖＲと、に基づいて、微小時間ｄｔにわたる台車２の中心点ＰＡＧＶの主取付軸ＯＰＷＳに沿った微小移動距離ｄｌの値を算出する。より具体的には、微小移動距離演算部６４は、下記式（１３）に従って演算を行うことにより、微小移動距離ｄｌの値を算出する。
【数１３】
2019109864.tif 000015
【００６４】
操舵角制御部６６は、微小移動距離演算部６４によって算出された微小移動距離ｄｌの値と、ずれ検出器６１によって算出された走行誤差Δｙ及び姿勢誤差Δψと、を用いることにより、走行誤差Δｙ及び姿勢誤差Δψが何れも０になるように、前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊を算出する。また操舵角制御部６６は、算出した前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊に応じた前輪操舵角指令信号及び後輪操舵角指令信号を生成し、これら指令信号を各駆動ユニット４Ｆ，４Ｒへ入力する。
【００６５】
より具体的には、操舵角制御部６６は、走行誤差フィードバックコントローラ６６１と、姿勢誤差フィードバックコントローラ６６２と、非干渉コントローラ６６３と、を備え、これらを用いることによって走行誤差Δｙ及び姿勢誤差Δψが何れも０になるような指令値ΔθＦ＊，ΔθＲ＊を算出する。
【００６６】
走行誤差フィードバックコントローラ６６１は、ずれ検出器６１によって検出された走行誤差Δｙに基づいて既知のフィードバック制御則に従った演算を行うことにより、走行誤差Δｙを０にするような第１制御入力αを生成し、この第１制御入力αを非干渉コントローラ６６３に入力する。
【００６７】
より具体的には、走行誤差フィードバックコントローラ６６１は、下記式（１４）に示すように、微小移動距離演算部６４によって算出された微小移動距離ｄｌを変数としたＰＩＤ制御則に従って第１制御入力αを生成する。ここで下記式（１４）において、係数ＫＰｙ，ＫＤｙ，ＫＩｙは、ＰＩＤ制御係数である。
【数１４】
2019109864.tif 000016
【００６８】
姿勢誤差フィードバックコントローラ６６２は、ずれ検出器６１によって検出された姿勢誤差Δψに基づいて既知のフィードバック制御則に従った演算を行うことにより、姿勢誤差Δψを０にするような第２制御入力βを生成し、この第２制御入力βを非干渉コントローラ６６３に入力する。
【００６９】
より具体的には、姿勢誤差フィードバックコントローラ６６２は、下記式（１５）に示すように、微小移動距離演算部６４によって算出された微小移動距離ｄｌを変数としたＰＩＤ制御則に従って第２制御入力βを生成する。ここで下記式（１５）において、係数ＫＰψ，ＫＤψ，ＫＩψは、ＰＩＤ制御係数である。
【数１５】
2019109864.tif 000017
【００７０】
非干渉コントローラ６６３は、走行誤差Δｙと姿勢誤差Δψとが干渉しないように、第１制御入力αと、第２制御入力βと、予め定められた取付角φＡＧＶと、角度パラメータ演算部６３によって算出された角度パラメータγの値と、進行角演算部６７によって算出された進行角λの値と、に基づいて、前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊を算出する。より具体的には、非干渉コントローラ６６３は、上記式（１０−１）及び（１０−２）を用いて導出される下記式（１６−１）及び（１６−２）に従って演算を行うことによって、前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊を算出する。
【数１６】
2019109864.tif 000018
【００７１】
ところで、利用者による利便性を考慮すると、走行誤差Δｙ及び姿勢誤差Δψが何れも０である場合、各フィードバックコントローラ６６１，６６２の出力である制御入力α，βは何れも０となり、さらに非干渉コントローラ６６３によって算出される前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊は、所定の基準軸（例えば、台車２の進行軸ＯΔ）に対し平行になっていることが好ましい。そこで非干渉コントローラ６６３は、上記式（１６−１）及び（１６−２）の代わりに、下記式（１７−１）及び（１７−２）に従って前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊を算出してもよい。
【数１７】
2019109864.tif 000019
【００７２】
上記式（１７−１）及び（１７−２）において、α０は、上記式（８−１）及び（８−２）における積分定数であり、進行角λ及び角度パラメータγを用いて下記式（１８−１）によって表される。これにより、上記式（１７−１）及び（１７−２）は、下記式（１８−２）及び（１８−３）で書き換えられる。非干渉コントローラ６６３では、下記式（１８−２）及び（１８−３）に従って前輪操舵角指令値ΔθＦ＊及び後輪操舵角指令値ΔθＲ＊を算出することにより、フィードバックコントローラ６６１，６６２の制御入力α，βが０であるときには、前輪４１Ｆ及び後輪４１Ｒを進行軸ＯΔと平行にすることができる。
【数１８】
2019109864.tif 000020
【００７３】
なお上記式（１８−２）及び（１８−３）は、下記式（１９−１）及び（１９−２）によって定義される角度δＦ，δＲを用いて、下記式（１９−３）及び（１９−４）に示すように書き換えることもできる。
【数１９】
2019109864.tif 000021
【００７４】
図２に戻り、副制御部６８は、上述のような主制御部６２における主駆動操舵制御によって前輪駆動ユニット４Ｆ及び後輪駆動ユニット４Ｒで発生する駆動力の一部が副駆動ユニット７で発生する駆動力によって打ち消されないように副駆動ユニット７の速度及び操舵角を制御する。より具体的には、副制御部６８は、主制御部６２において算出された前輪速度指令値ｖＦ＊と、後輪速度指令値ｖＲ＊と、前輪操舵角指令値ΔθＦ＊と、後輪操舵角指令値ΔθＲ＊と、に基づいて、以下で説明する副駆動操舵制御を実行することにより、副駆動輪速度ｖＳに対する指令値ｖＳ＊に応じた副駆動輪速度指令信号と、副駆動輪操舵角ΔθＳに対する指令値ΔθＳ＊に応じた副駆動輪操舵角指令信号と、を生成し、これら指令信号を副駆動ユニット７に入力する。
【００７５】
図７は、台車２の平面図であり、副制御部６８における副駆動操舵制御の概念を説明するための図である。
【００７６】
上述のように副駆動輪７１の副駆動輪操舵軸７３は、台車２の荷台部２１に対し平面視で前輪操舵軸４３Ｆと後輪操舵軸４３Ｒとの間に設けられる。以下では、副駆動輪操舵軸７３及び前輪操舵軸４３Ｆを通過する軸を前輪取付軸ＯＦＳという。また副駆動輪操舵軸７３及び後輪操舵軸４３Ｒを通過する軸を後輪取付軸ＯＲＳという。
【００７７】
副駆動輪７１は、荷台部２１に対し平行な副駆動輪回転軸７５を中心軸として回転自在に設けられている。以下では、副駆動輪７１の副駆動輪回転軸７５周りでの回転速度を副駆動輪速度ｖＳという。
【００７８】
また副駆動輪７１は、荷台部２１に対し垂直な副駆動輪操舵軸７３を中心として回転自在に設けられている。以下では、副駆動輪７１の進行方向と主軸ＯＡＧＶとの成す角を副駆動輪操舵角ΔθＳという。
【００７９】
副制御部６８では、台車２に設けられている副駆動輪操舵軸７３や前輪操舵軸４３Ｆ等の位置を主軸座標系（図７中、実線矢印参照）で把握する。主軸座標系とは、そのＸ軸と主軸ＯＡＧＶとが平行になり、かつ主軸ＯＡＧＶの前輪４１Ｆ側をＸ軸の正側とした座標系である。
【００８０】
図８は、前輪操舵軸４３Ｆ、後輪操舵軸４３Ｒ、及び副駆動輪操舵軸７３の位置ベクトルを示す図である。
【００８１】
以下では、主軸座標系における前輪操舵軸４３Ｆの位置ベクトルＰＦ、後輪操舵軸４３Ｒの位置ベクトルＰＲ、副駆動輪操舵軸７３の位置ベクトルＰＳを、それぞれ下記式（２０）のように表記する。
【数２０】
2019109864.tif 000022
【００８２】
主軸座標系における前輪４１Ｆの速度ベクトルＶＦ、後輪４１Ｒの速度ベクトルＶＲ、副駆動輪７１の速度ベクトルＶＳを、それぞれ下記式（２１）のように表記する。
【数２１】
2019109864.tif 000023
【００８３】
また前輪４１Ｆの速度ベクトルｖＦ及び後輪４１Ｒの速度ベクトルＶＲの各成分は、前輪速度ｖＦ、後輪速度ｖＲ、前輪操舵角ΔθＦ、及び後輪操舵角ΔθＲを用いると、下記式（２２）のように表される。
【数２２】
2019109864.tif 000024
【００８４】
また主軸座標系において、副駆動輪操舵軸７３から前輪操舵軸４３Ｆへ前輪取付軸ＯＦＳに沿って延びる差分ベクトルΔＰＦＳ、及び副駆動輪操舵軸７３から後輪操舵軸４３Ｒへ後輪取付軸ＯＲＳに沿って延びる差分ベクトルΔＰＲＳは、上記式（２０）に示す位置ベクトルを用いて、下記式（２３−１）及び（２３−２）のように表される。
【数２３】
2019109864.tif 000025
【００８５】
上述のように、前輪駆動ユニット４Ｆ、後輪駆動ユニット４Ｒ、及び副駆動ユニット７は、それぞれ同一の荷台部２１に取り付けられている。このため、前輪駆動ユニット４Ｆで発生する駆動力の一部が副駆動ユニット７で発生する駆動力によって打ち消されないようにし、かつ後輪駆動ユニット４Ｒで発生する駆動力の一部が副駆動ユニット７で発生する駆動力によって打ち消されないようにするためには、下記式（２４−１）及び（２４−２）に示すように、差分ベクトルΔＰＦＳと速度ベクトルｖＳとの内積を差分ベクトルΔＰＦＳと速度ベクトルｖＦとの内積と等しくし、かつ差分ベクトルΔＰＲＳと速度ベクトルｖＳとの内積を差分ベクトルΔＰＲＳと速度ベクトルｖＲとの内積と等しくする必要がある。換言すれば、副駆動輪７１の前輪取付軸ＯＦＳに沿った速度成分を前輪４１Ｆの前輪取付軸ＯＦＳに沿った速度成分と等しくし、かつ副駆動輪７１の後輪取付軸ＯＲＳに沿った速度成分を後輪４１Ｒの後輪取付軸ＯＲＳに沿った速度成分と等しくする必要がある。
【数２４】
2019109864.tif 000026
【００８６】
従って上記式（２４−１）及び（２４−２）を用いると、副駆動輪７１の速度ベクトルＶＳの各成分は、差分ベクトルΔＰＦＳ，ΔＰＲＳ及び速度ベクトルＶＦ，ＶＲを用いて下記式（２５）のように表される。
【数２５】
2019109864.tif 000027
【００８７】
また上記式（２５）によって算出された速度ベクトルＶＳの各成分の値を用いると、副駆動輪７１の副駆動輪操舵角ΔθＳ及び副駆動輪速度ｖＳは、下記式（２６）のように算出される。よって、副制御部６８では、これら式（２５）及び（２６）に基づいて副駆動輪操舵角指令信号及び副駆動輪速度指令信号を生成することにより、前輪駆動ユニット４Ｆ及び後輪駆動ユニット４Ｒで発生した駆動力の一部が打ち消されないように副駆動ユニット７を制御する。
【数２６】
2019109864.tif 000028
【００８８】
次に、図９のブロック図を参照しながら、副制御部６８における副駆動操舵制御の具体的な手順、すなわち副制御部６８において副駆動輪速度指令信号及び副駆動輪操舵角指令信号を生成する具体的な手順を説明する。
【００８９】
副制御部６８は、前後輪速度指令ベクトル演算部６８１と、副駆動輪速度指令ベクトル演算部６８２と、指令値演算部６８３と、を備える。
【００９０】
前後輪速度指令ベクトル演算部６８１は、主制御部６２において算出された前輪速度指令値ｖＦ＊と、後輪速度指令値ｖＲ＊と、前輪操舵角指令値ΔθＦ＊と、後輪操舵角指令値ΔθＲ＊とを用いることにより、指令値に基づく前輪４１Ｆの速度指令ベクトルＶＦ＊及び後輪４１Ｒの速度指令ベクトルＶＲ＊の主軸座標系における各成分の値を算出する。より具体的には、主制御部６２において算出された４つの指令値（ｖＦ＊，ｖＲ＊，ΔθＦ＊，ΔθＲ＊）を、上記式（２２）から導出される下記式（２７）に入力することによって、速度指令ベクトルＶＦ＊，ＶＲ＊の各成分の値を算出する。
【数２７】
2019109864.tif 000029
【００９１】
副駆動輪速度指令ベクトル演算部６８２は、前後輪速度指令ベクトル演算部６８１において算出された速度指令ベクトルＶＦ＊，ＶＲ＊を用いて、副駆動輪７１の速度ベクトルＶＳに対する指令値に相当する速度指令ベクトルＶＳ＊の各成分の値を算出する。より具体的には、速度指令ベクトルＶＦ＊，ＶＲ＊の各成分の値（ｖＦｘ＊，ｖＦｙ＊，ｖＲｘ＊，ｖＲｙ＊）と、予め定められた差分ベクトルΔＰＦＳ，ΔＰＲＳの各成分の値（ΔＰＦＳｘ＊，ΔＰＦＳｙ＊，ΔＰＲＳｘ＊，ΔＰＲＳｙ＊）とを、上記式（２５）から導出される下記式（２８）に入力することによって、速度指令ベクトルＶＳ＊の各成分の値を算出する。
【数２８】
2019109864.tif 000030
【００９２】
指令値演算部６８３は、副駆動輪速度指令ベクトル演算部６８２によって算出された速度指令ベクトルＶＳ＊の各成分の値（ｖＳｘ＊，ｖＳｙ＊）を、上記式（２６）から導出される下記式（２９）に入力することによって、副駆動輪操舵角指令値ΔθＳ＊及び副駆動輪速度指令値ｖＳ＊を算出する。また副制御部６８は、以上のようにして算出した副駆動輪操舵角指令値ΔθＳ＊に応じた副駆動操舵角指令信号及び副駆動輪速度指令値ｖＳ＊に応じた副駆動輪速度指令信号を生成し、これら指令信号を副駆動ユニット７に入力する。
【数２９】
2019109864.tif 000031
【００９３】
本実施形態に係る無人搬送車１の駆動操舵装置３によれば、以下の効果を奏する。
（１）駆動操舵装置３では、荷台部２１に取り付けられた３つの駆動ユニット４Ｆ，４Ｒ，７のうちの２つを前輪駆動ユニット４Ｆ及び後輪駆動ユニット４Ｒとし、これら前輪び後輪駆動ユニット４Ｆ，４Ｒに対する速度指令信号（ｖＦ＊，ｖＲ＊）及び操舵角指令信号（ΔθＦ＊，ΔθＲ＊）を主制御部６２によって生成し、また３つのうちの残りである副駆動ユニット７に対する速度指令信号（ｖＳ＊）及び操舵角指令信号（ΔθＳ＊）を副制御部６８によって生成する。特に駆動操舵装置３では、副制御部６８は、副駆動ユニット７の副駆動輪操舵軸７３と前輪操舵軸４３Ｆとを通過する前輪取付軸ＯＦＳに沿った副駆動ユニット７の速度成分と前輪駆動ユニット４Ｆの速度成分とが等しくなり、かつ副駆動輪操舵軸７３と後輪駆動ユニット４Ｒの後輪操舵軸４３Ｒとを通過する後輪取付軸ＯＲＳに沿った副駆動ユニット７の速度成分と後輪駆動ユニット４Ｒの速度成分とが等しくなるように速度指令信号（ｖＳ＊）及び操舵角指令信号（ΔθＳ＊）を生成する。これにより、副駆動ユニット７と前輪駆動ユニット４Ｆとの間及び副駆動ユニット７と後輪駆動ユニット４Ｒとの間に、力が作用しないように副駆動ユニット７の速度及び操舵角を制御できる。換言すれば、駆動操舵装置３によれば、前輪駆動ユニット４Ｆ及び後輪駆動ユニット４Ｒで発生した駆動力の一部が副駆動ユニット７で発生した駆動力によって打ち消されないように副駆動ユニット７の速度及び操舵角を制御できる。よって駆動操舵装置３によれば、少ない電力で大きな駆動力が得られるように３つの駆動ユニット４Ｆ，４Ｒ，７を協調して制御できる。
【００９４】
（２）本実施形態の駆動操舵装置３では、副駆動ユニット７の速度指令値ｖＳ＊や操舵角指令値ΔθＳ＊は、前輪及び後輪駆動ユニット４Ｆ，４Ｒの速度指令値（ｖＦ＊，ｖＲ＊）や操舵角指令値（ΔθＦ＊，ΔθＲ＊）によって一意的に決定されるため、台車２の位置及び姿勢は前輪及び後輪駆動ユニット４Ｆ，４Ｒの速度指令値及び操舵角指令値によって定まる。また、前輪及び後輪駆動ユニット４Ｆ，４Ｒの位置が近くなると、主制御部６２による前輪及び後輪駆動ユニット４Ｆ，４Ｒの速度及び操舵角の制御の精度が悪化し、ひいては副制御部６８による副駆動ユニット７の速度及び操舵角の制御の精度も悪化するおそれがある。そこで本実施形態の駆動操舵装置３では、荷台部２１に取り付けられた３つの複数の駆動ユニット４Ｆ，４Ｒ，７のうち、平面視で最も離れている２つである前輪及び後輪駆動ユニット４Ｆ，４Ｒを主とし、これら主の駆動ユニット４Ｆ，４Ｒを主制御部６２で制御し、残りの１つである副駆動ユニット７を副とし、この副の駆動ユニット７を副制御部６８によって制御する。これにより、全ての駆動ユニット４Ｆ，４Ｒ，７の速度及び操舵角を精度よく制御できる。
【００９５】
（３）駆動操舵装置３では、副制御部６８は、前輪取付軸ＯＦＳに沿った前輪駆動ユニット４Ｆの速度成分及び後輪取付軸ＯＲＳに沿った後輪駆動ユニット４Ｒの速度成分を、主制御部６２によって生成された前輪及び後輪駆動ユニット４Ｆ，４Ｒに対する速度指令信号（ｖＦ＊，ｖＲ＊）及び操舵角指令信号（ΔθＦ＊，ΔθＲ＊）に基づいて算出する。これにより、副制御部６８では、簡易な演算で副駆動ユニット７の速度及び操舵角を制御できる。
【００９６】
（４）駆動操舵装置３では、ずれ検出器６１によって台車２の検出位置と外部位置指令との間の走行誤差Δｙ及び検出姿勢と外部姿勢指令との間の姿勢誤差Δψを検出する。また主制御部６２では、前輪駆動ユニット４Ｆの主取付軸ＯＰＷＳに沿った微小移動距離（ｄｌＦｃｏｓρＦ）と後輪駆動ユニット４Ｒの主取付軸ＯＰＷＳに沿った微小移動距離（ｄｌＲｃｏｓρＲ）とが等しくなり、かつずれ検出器６１によって検出された走行誤差Δｙ及び姿勢誤差Δψが無くなるように前輪及び後輪駆動ユニット４Ｆ，４Ｒに対する速度指令信号（ｖＦ＊，ｖＲ＊）及び操舵角指令信号（ΔθＦ＊，ΔθＲ＊）を生成する。これにより、３つの駆動ユニット４Ｆ，４Ｒ，７を合せて大きな駆動力を発生させつつ、前輪及び後輪駆動ユニット４Ｆ，４Ｒの間で無理な力が作用するのを防止しながら、台車２を外部姿勢指令に応じた姿勢にて、外部位置指令に応じた経路に沿って走行させることができる。
【００９７】
以上、本発明の一実施形態について説明したが、本発明はこれに限らない。本発明の趣旨の範囲内で、細部の構成を適宜変更してもよい。
【００９８】
例えば、上記実施形態では、荷台部２１に設けた３つの駆動ユニット４Ｆ，４Ｒ，７のうち、平面視で最も離れた２つの前輪駆動ユニット４Ｆ及び後輪駆動ユニット４Ｒを主とし、これら主の駆動ユニット４Ｆ，４Ｒを主制御部６２で制御し、残りの１つの副駆動ユニット７を副とし、この副の駆動ユニット７を副制御部６８で制御した場合について説明したが、本発明はこれに限らない。主制御部６２で制御する２つの主の駆動ユニットは、駆動ユニット４Ｆ，７としてもよいし、駆動ユニット４Ｒ，７としてもよい。
【００９９】
また上記実施形態では、荷台部２１に３つの駆動ユニット４Ｆ，４Ｒ，７を取り付けた場合について説明したが、本発明はこれに限らない。荷台部２１には、４つ以上の駆動ユニットを取り付けてもよい。
【０１００】
図１０には、荷台部２１に５つの駆動ユニット８１，８２，８３，８４，８５を取り付けた場合における荷台部２１の平面図である。この場合、平面視で最も離れている２つの駆動ユニット８１，８５を主の駆動ユニットとして選択し、これら２つの主の駆動ユニット８１，８５を主制御部６２で制御し、残りの駆動ユニット８２，８３，８４を副の駆動ユニットとして選択し、これら３つの副の駆動ユニットを、それぞれ副制御部６８で制御することが好ましい。
【符号の説明】
【０１０１】
１…無人搬送車
２…台車
２１…荷台部（台部）
３…駆動操舵装置
４Ｆ…前輪駆動ユニット（第１主駆動ユニット）
４１Ｆ…前輪
４３Ｆ…前輪操舵軸（操舵軸）
４Ｒ…後輪駆動ユニット（第２主駆動ユニット）
４１Ｒ…後輪
４３Ｒ…後輪操舵軸（操舵軸）
７…副駆動ユニット
７１…副駆動輪
７３…副駆動輪操舵軸
６…制御装置
６１…ずれ検出器
６２…主制御部（主制御装置）
６８…副制御部（副制御装置）
６８１…前後輪速度指令ベクトル演算部
６８２…副駆動輪速度指令ベクトル演算部
６８３…指令値演算部
【図１】
2019109864.tif 000032
【図２】
2019109864.tif 000033
【図３】
2019109864.tif 000034
【図４】
2019109864.tif 000035
【図５】
2019109864.tif 000036
【図６】
2019109864.tif 000037
【図７】
2019109864.tif 000038
【図８】
2019109864.tif 000039
【図９】
2019109864.tif 000040
【図１０】
2019109864.tif 000041