JP7716705B2 - 制御方法、プログラム、制御システム、搬送装置、及び部品実装システム - Google Patents

Description

本開示は、一般に制御方法、プログラム、制御システム、搬送装置、及び部品実装システムに関する。より詳細には、本開示は、搬送装置を制御する制御方法、プログラム、制御システム、制御システムを搭載した搬送装置、及び搬送装置を用いた部品実装システムに関する。

特許文献１には、工場内等に敷設した軌道等の走行路に沿って複数台の無人搬送車（搬送装置）を走行させて、資材や製品等を搬送する設備が開示されている。

特開２０１２－５３８３８号公報

本開示は、搬送装置の基準姿勢からのずれを抑えながら、搬送装置を軌道に追従させやすい制御方法、プログラム、制御システム、搬送装置、及び部品実装システムを提供することを目的とする。

本開示の一態様に係る制御方法は、取得ステップと、補正ステップと、を有する。前記取得ステップは、搬送装置の、前記搬送装置が走行する軌道に対するずれに関するずれ情報を、複数のセンサの検知結果に基づいて取得するステップである。前記搬送装置は、前後方向に並ぶ複数の操向輪及び前記複数の操向輪の間に配置されている前記複数のセンサを有して搬送物を搬送する。前記補正ステップは、前記複数の操向輪の各々について、前記取得ステップにて取得した前記ずれ情報に基づいて舵角を補正するステップである。前記ずれ情報は、前記複数の操向輪の各々と前記軌道との位置ずれに関する複数の操向輪ずれ情報を含んでいる。前記補正ステップは、前記複数の操向輪の各々について、対応する操向輪ずれ情報に基づいて前記舵角を補正する。前記ずれ情報は、前記搬送装置の前記軌道に対する基準姿勢からの前記搬送装置の傾きのずれＤｒに関する回転ずれ情報、及び前記基準姿勢からの前記搬送装置の位置のずれＤｘに関する位置ずれ情報を含んでいる。前記補正ステップは、前記複数の操向輪のうち前記搬送装置の前方に位置する前輪の舵角θ３１と、前記複数の操向輪のうち前記搬送装置の後方に位置する後輪の舵角θ３２と、をＰＩＤ制御し、前記ＰＩＤ制御の比例項をθ１、θ２とすると、次式が成り立つ。
θ３１＝θ１＋θ２
θ３２＝θ１－θ２
θ１＝Ｋｘ・Ｄｘ
θ２＝Ｋｒ・Ｄｒ
ここで、Ｋｘは第１の比例係数、Ｋｒは第２の比例係数である。

本開示の一態様に係るプログラムは、１以上のプロセッサに、上記の制御方法を実行させる。

本開示の一態様に係る制御システムは、取得部と、補正部と、を備える。前記取得部は、搬送装置の、前記搬送装置が走行する軌道に対するずれに関するずれ情報を、複数のセンサの検知結果に基づいて取得する。前記搬送装置は、前後方向に沿って並ぶ複数の操向輪及び前記複数の操向輪の間に配置されている前記複数のセンサを有して搬送物を搬送する。前記補正部は、前記複数の操向輪の各々について、前記取得部にて取得した前記ずれ情報に基づいて舵角を補正する。前記ずれ情報は、前記複数の操向輪の各々と前記軌道との位置ずれに関する複数の操向輪ずれ情報を含んでいる。前記補正部は、前記複数の操向輪の各々について、対応する操向輪ずれ情報に基づいて前記舵角を補正する。前記ずれ情報は、前記搬送装置の前記軌道に対する基準姿勢からの前記搬送装置の傾きのずれＤｒに関する回転ずれ情報、及び前記基準姿勢からの前記搬送装置の位置のずれＤｘに関する位置ずれ情報を含んでいる。前記補正部は、前記複数の操向輪のうち前記搬送装置の前方に位置する前輪の舵角θ３１と、前記複数の操向輪のうち前記搬送装置の後方に位置する後輪の舵角θ３２と、をＰＩＤ制御し、前記ＰＩＤ制御の比例項をθ１、θ２とすると、次式が成り立つ。
θ３１＝θ１＋θ２
θ３２＝θ１－θ２
θ１＝Ｋｘ・Ｄｘ
θ２＝Ｋｒ・Ｄｒ
ここで、Ｋｘは第１の比例係数、Ｋｒは第２の比例係数である。

本開示の一態様に係る搬送装置は、上記の制御システムと、本体部と、を備える。前記本体部は、前記制御システムが搭載され、前記搬送物の搬送を行う。

本開示の一態様に係る部品実装システムは、部品を基板に実装する少なくとも１つの部品実装機を含むシステムである。前記部品実装機は、前記部品を供給する部品供給装置と、前記部品を前記基板に実装する実装ヘッドを含む実装本体と、を有する。前記部品供給装置は、上記の制御システムが制御する前記搬送装置によって前記実装本体まで搬送される。

本開示は、搬送装置の基準姿勢からのずれを抑えながら、搬送装置を軌道に追従させやすい、という利点がある。

図１は、実施形態１に係る制御システムが対象とする搬送装置の一例を示す概略平面図である。 図２は、同上の制御システムの概要を示すブロック図である。 図３は、同上の制御システムの動作における速度制御の一例を示す説明図である。 図４は、同上の制御システムを用いることで構築される部品実装システムの概要の説明図である。 図５は、同上の制御システムの動作の一例を示すフローチャートである。 図６は、比較例の制御システムによる搬送装置の制御の一例を示す説明図である。 図７は、実施形態１に係る制御システムの他の動作の一例を示す説明図である。 図８は、同上の制御システムの更に他の動作の一例を示す説明図である。 図９は、同上の搬送装置におけるセンサの配置の一例を示す概略平面図である。 図１０は、実施形態２に係る制御システムが対象とする搬送装置の一例を示す概略平面図である。 図１１は、同上の制御システムの動作における第１舵角の説明図である。 図１２は、同上の制御システムの動作における第２舵角の説明図である。 図１３は、同上の制御システムの動作における合成舵角の説明図である。 図１４は、同上の制御システムの動作における逆位相制御の説明図である。 図１５は、同上の制御システムの動作における逆位相制御の説明図である。 図１６は、同上の制御システムの動作における逆位相制御の説明図である。 図１７は、同上の制御システムの動作の一例を示すフローチャートである。

（実施形態１）
（１）概要
本実施形態に係る制御方法は、図１に示すように、搬送物Ａ１（図４参照）を搬送する搬送装置１を軌道Ｌ１に追従させるように搬送装置１を制御するための方法である。この制御方法は、制御システム１００（図２参照）にて実現される。本実施形態では、搬送物Ａ１は車輪Ａ１１を有しており、搬送装置１と共に移動可能に構成されている。

本実施形態では、搬送装置１は、搬送装置１の前後方向に並ぶ複数の操向輪２を有しており、移動面Ｂ１の上を移動して搬送物Ａ１を搬送する装置である。本開示でいう「前後方向」は、搬送装置１の長さ方向であって、搬送装置１が進行する向きを「前」、その逆の向きを「後」とする方向である。

図１における白抜きの矢印は、搬送装置１の進行方向を表している。また、図１における両向きの矢印は、搬送装置１の「前」及び「後」を表している。図１におけるこれらの矢印は、説明のために表記しているに過ぎず、実体を伴わない。また、図１において、搬送装置１の複数の操向輪２等の車輪は、実線で描かれているが、実際には、搬送装置１の本体部１０（後述する）に隠れている。さらに、図１において、軌道Ｌ１は実線で描かれているが、実際には、軌道Ｌ１のうち搬送装置１と重なる箇所は、搬送装置１の本体部１０に隠れている。図１以外の図面においても同様である。

搬送装置１は、例えば物流センター（配送センターを含む）、工場、オフィス、店舗、学校、及び病院等の施設に導入される。移動面Ｂ１は、その上を搬送装置１が移動する面であり、搬送装置１が施設内を移動する場合は施設の床面等が移動面Ｂ１となり、搬送装置１が屋外を移動する場合は地面等が移動面Ｂ１となる。以下では、工場に搬送装置１を導入する場合について説明する。なお、図１以外の図面においては、移動面Ｂ１の図示を省略している。

本実施形態では、複数の操向輪２は、搬送装置１の前方に位置する前輪２１と、搬送装置１の後方に位置する後輪２２と、からなる。つまり、搬送装置１は、２つの操向輪２により移動面Ｂ１の上を移動するように構成されている。なお、本実施形態では、搬送装置１は、２つの操向輪２の他に、２つの補助輪３を有しているが、これらの補助輪３は、制御システム１００により舵角θを変更可能な操向輪２には含まれない。本開示でいう「舵角」は、搬送装置１を上方から見た平面視において、搬送装置１の前後方向と、車輪（操向輪２）の車輪面（言い換えれば、車輪の転動方向）とがなす角度をいう。本開示でいう「車輪面」は、車輪（操向輪２）の移動面Ｂ１に接している面をいう。

本開示でいう「軌道」は、搬送装置１が搬送物Ａ１を目的地まで搬送する際における、搬送装置１の移動経路を規定している。本実施形態では、軌道Ｌ１は、搬送装置１が移動する移動面Ｂ１に設置されている。具体的には、軌道Ｌ１は、移動面Ｂ１に設置されている磁気テープ、又は磁気マーカ等の線状の物体である。制御システム１００は、搬送装置１に搭載されたセンサ４（後述する）による軌道Ｌ１の検知に基づいて、搬送装置１が軌道Ｌ１に追従するように搬送装置１を制御する。これにより、搬送装置１は、軌道Ｌ１に追従しながら搬送物Ａ１を目的地まで搬送することが可能である。なお、「軌道に追従する」とは、搬送装置１が軌道Ｌ１の上を移動することの他、搬送装置１が軌道Ｌ１と重ならないように軌道Ｌ１に沿って移動することを含み得る。

本実施形態の搬送装置１の制御方法は、取得ステップＳＴ１と、補正ステップＳＴ２と、を有している（図５参照）。

取得ステップＳＴ１は、ずれ情報を取得するステップである。ずれ情報は、搬送装置１の、搬送装置１が走行する軌道Ｌ１に対するずれに関する情報である。本実施形態では、センサ４の軌道Ｌ１に対するずれに関する情報を、ずれ情報として取得する。

補正ステップＳＴ２は、複数の操向輪２の各々について、取得ステップＳＴ１にて取得したずれ情報に基づいて舵角θを補正するステップである。つまり、本実施形態では、ずれ情報に基づいて、複数の操向輪２を一括して同じ舵角θとなるように補正するのではなく、複数の操向輪２の各々の舵角θを個別に補正する。もちろん、補正ステップＳＴ２の結果として、複数の操向輪２の各々の舵角θが同じとなる場合はあり得る。

したがって、本実施形態では、搬送装置１の基準姿勢からのずれを抑えながら、搬送装置１を軌道Ｌ１に追従させやすい、という利点がある。本開示でいう「基準姿勢」は、搬送装置１の前後方向が軌道Ｌ１と平行となるような搬送装置１の姿勢をいう。なお、「平行」とは、完全な平行のみならず、ほぼ平行を含む概念である。

（２）詳細
（２．１）全体構成
以下、本実施形態に係る制御システム１００について図１及び図２を参照して説明する。本実施形態では、制御システム１００は、搬送装置１の本体部１０（後述する）に内蔵されており、上位システム６と互いに通信可能に構成されている。つまり、搬送装置１は、制御システム１００と、制御システム１００が搭載されて搬送物Ａ１の搬送を行う本体部１０と、を備えている。本開示における「通信可能」とは、有線通信又は無線通信の適宜の通信方式により、直接的、又はネットワークＮＴ１若しくは中継器７等を介して間接的に、情報を授受できることを意味する。本実施形態では、上位システム６と複数台の搬送装置１の各々とは、互いに双方向に通信可能であって、上位システム６から搬送装置１への情報の送信、及び搬送装置１から上位システム６への情報の送信の両方が可能である。

上位システム６は、複数台の搬送装置１を統括的に制御するためのシステムであって、例えばサーバ装置で実現されている。上位システム６は、複数台の搬送装置１の各々に対して指示を出すことで、複数台の搬送装置１を間接的に制御する。

本実施形態では、上位システム６は、１以上のプロセッサ及びメモリを有するコンピュータシステムを主構成とする。そのため、１以上のプロセッサがメモリに記録されているプログラムを実行することにより、上位システム６の機能が実現される。プログラムはメモリに予め記録されていてもよいし、インターネット等の電気通信回線を通して提供されてもよく、メモリカード等の非一時的記録媒体に記録されて提供されてもよい。

（２．２）搬送装置
次に、本実施形態の搬送装置１の構成について、より詳細に説明する。搬送装置１は、図１に示すように、搬送物Ａ１を運搬するための無人搬送車であり、搬送物Ａ１を連結して目的地まで自律走行する。本実施形態では、上位システム６が、ネットワークＮＴ１及び中継器７を介して搬送装置１と通信し、搬送装置１の移動を間接的に制御する。

搬送装置１は、例えば床面等からなる平坦な移動面Ｂ１を自律走行する。ここでは一例として、搬送装置１は、蓄電池を備え、蓄電池に蓄積された電気エネルギを用いて動作することとする。本実施形態では、搬送装置１は、搬送物Ａ１を連結した状態で移動面Ｂ１上を走行する。これにより、搬送装置１は、例えば、ある場所に置かれている搬送物Ａ１を、搬送装置１でけん引したり、搬送装置１で押し動かしたりすることで、別の場所に搬送することが可能である。

搬送装置１は、本体部１０を備えている。本体部１０は、直方体状に形成されている。本実施形態では、本体部１０の側面には、例えばフック等、搬送物Ａ１の一部を引っ掛けることが可能な連結部５が設けられている。ここでいう「本体部の側面」は、搬送装置１が基準姿勢をとっている場合に、軌道Ｌ１に沿う一面をいう。このため、本実施形態では、連結部５に搬送物Ａ１の一部を引っ掛けることで、搬送装置１により搬送物Ａ１を連結することが可能である。つまり、搬送装置１は、搬送装置１の本体部１０における軌道Ｌ１に沿った一面（側面）にて、搬送物Ａ１を連結する連結部５を有している。

搬送装置１は、本体部１０の下部に複数（ここでは、４つ）の車輪を有している。４つの車輪のうち、本体部１０の前部に位置する前輪２１と、本体部１０の後部に位置する後輪２２とは、いずれも操向輪２である。また、４つの車輪のうち、本体部１０の中央部において幅方向の両端に位置する２つの車輪は、いずれも補助輪（従動輪）である。本実施形態では、２つの操向輪２は、いずれも駆動輪を兼ねており、これら駆動輪が個別に駆動されることにより、搬送装置１が移動面Ｂ１上を所望の方向に移動可能となる。また、２つの操向輪２の各々は、搬送装置１が軌道Ｌ１に追従する経路からずれた場合に、この経路に復帰するのに十分な範囲で舵角θを変更可能に構成されている。

（２．３）制御システム
次に、本実施形態の制御システム１００の構成について、より詳細に説明する。制御システム１００は、図２に示すように、検知部１０１と、制御部１０２と、通信部１０３と、記憶部１０４と、走行装置１０５と、を備えている。本実施形態では、検知部１０１、制御部１０２、通信部１０３、記憶部１０４、及び走行装置１０５が制御システム１００の構成要件に含まれているが、制御部１０２のみが制御システム１００の構成要件に含まれていてもよい。

検知部１０１は、本体部１０の挙動、及び本体部１０の周辺状況等を検知する。本開示でいう「挙動」は、動作及び様子等を意味する。つまり、本体部１０の挙動は、本体部１０が走行中／停止中を表す本体部１０の動作状態、本体部１０の速度（及び速度変化）、本体部１０に作用する加速度、及び本体部１０の姿勢等を含む。具体的には、検知部１０１は、例えば、速度センサ、加速度センサ、ジャイロセンサ等のセンサを含み、これらのセンサにて本体部１０の挙動を検知する。また、検知部１０１は、例えば、イメージセンサ（カメラ）、ソナーセンサ、レーダ、及びＬｉＤＡＲ（Light Detection and Ranging）等のセンサを含み、これらのセンサにて本体部１０の周辺状況を検知する。

また、検知部１０１は、本体部１０の位置、つまり搬送装置１の現在位置を特定する位置特定部を有している。位置特定部は、一例として、複数の発信器から電波で送信されるビーコン信号を受信する受信機を含む。複数の発信器は、搬送装置１が移動する範囲内の複数箇所に配置されている。位置特定部は、複数の発信器の位置と、受信機でのビーコン信号の受信電波強度とに基づいて、本体部１０の位置を測定する。位置特定部は、ＧＰＳ（Global Positioning System）等の衛星測位システムを用いて実現されてもよい。

さらに、検知部１０１は、複数のセンサ４を含んでいる。複数のセンサ４は、それぞれ複数の操向輪２の近傍に設置されている。本実施形態では、複数の操向輪２は、前輪２１及び後輪２２の２つである。したがって、複数のセンサ４は、前輪２１の近傍（ここでは、本体部１０の前端）に設置される第１センサ４１、及び後輪２２の近傍（ここでは、本体部１０の後端）に設置される第２センサ４２である。

複数のセンサ４は、いずれも棒状の磁気センサであって、軌道Ｌ１の発生する磁束を検知することでセンサ４と軌道Ｌ１との相対的な位置関係、つまりセンサ４の軌道Ｌ１に対する位置ずれを検知する。本実施形態では、第１センサ４１は、第１センサ４１の軌道Ｌ１に対する位置ずれを検知することで、前輪２１の軌道Ｌ１に対する位置ずれを検知する。また、第２センサ４２は、第２センサ４２の軌道Ｌ１に対する位置ずれを検知することで、後輪２２の軌道Ｌ１に対する位置ずれを検知する。ここでいう「位置ずれ」は、一例として、センサ４の中心と軌道Ｌ１との最短距離により表される。

通信部１０３は、上位システム６と通信可能に構成されている。本実施形態では、通信部１０３は、搬送装置１を運用するエリア内に設置された複数の中継器７のいずれかと、電波を媒体とする無線通信によって通信を行う。そのため、通信部１０３と上位システム６とは、少なくともネットワークＮＴ１及び中継器７を介して、間接的に通信を行うことになる。

つまり、各中継器７は、通信部１０３と上位システム６との間の通信を中継する機器（アクセスポイント）である。中継器７は、ネットワークＮＴ１を介して、上位システム６と通信する。本実施形態では一例として、中継器７と通信部１０３との間の通信には、Wi-Fi（登録商標）、Bluetooth（登録商標）、ZigBee（登録商標）又は免許を必要としない小電力無線（特定小電力無線）等の規格に準拠した、無線通信を採用する。また、ネットワークＮＴ１は、インターネットに限らず、例えば、搬送装置１を運用するエリア内又はこのエリアの運営会社内のローカルな通信ネットワークが適用されてもよい。

記憶部１０４は、例えば、書換可能な不揮発性の半導体メモリ等の非一時的記録媒体にて実現される。記憶部１０４は、例えば、搬送装置１を運用するエリアのマップに関する地図情報、及び上位システム６から与えられた指令情報等を記憶する。

走行装置１０５は、制御部１０２からの制御命令を受けて、本体部１０に備えられた複数の駆動輪（本実施形態では、２つの操向輪２）を個別に駆動することで、搬送装置１を所望の方向に走行させる。

制御部１０２は、１以上のプロセッサ及びメモリを有するコンピュータシステムを主構成とする。そのため、１以上のプロセッサがメモリに記録されているプログラムを実行することにより、制御部１０２の機能が実現される。プログラムはメモリに予め記録されていてもよいし、インターネット等の電気通信回線を通して提供されてもよく、メモリカード等の非一時的記録媒体に記録されて提供されてもよい。

制御部１０２は、検知部１０１の検知結果に基づいて、搬送装置１を制御する。本実施形態では、制御部１０２は、搬送装置１を制御するために、取得部１１と、補正部１２と、を有している。取得部１１及び補正部１２は、いずれも制御部１０２の実行する機能として実現される。

取得部１１は、複数のセンサ４と通信することにより、搬送装置１の軌道Ｌ１に対するずれに関するずれ情報を取得する。つまり、取得部１１は、取得ステップＳＴ１の実行主体である。ずれ情報は、センサ４が検知結果に対して適宜の処理を実行することで生成される情報であってもよいし、センサ４の検知結果を受けた取得部１１が、センサ４の検知結果に対して適宜の処理を実行することで生成される情報であってもよい。

ここで、複数のセンサ４のうち第１センサ４１から取得する情報は、第１センサ４１の近傍に位置する前輪２１と軌道Ｌ１との位置ずれに関する情報に相当する。また、複数のセンサ４のうち第２センサ４２から取得する情報は、第２センサ４２の近傍に位置する後輪２２と軌道Ｌ１との位置ずれに関する情報に相当する。つまり、本実施形態では、取得部１１が取得するずれ情報は、複数の操向輪２の各々と軌道Ｌ１との位置ずれに関する複数の操向輪ずれ情報を含んでいる。本実施形態では、複数の操向輪ずれ情報は、前輪２１と軌道Ｌ１との位置ずれに関する第１ずれ情報と、後輪２２と軌道Ｌ１との位置ずれに関する第２ずれ情報と、を含む。

補正部１２は、複数の操向輪２の各々について、取得部１１にて取得したずれ情報に基づいて舵角θを補正する。つまり、補正部１２は、補正ステップＳＴ２の実行主体である。本実施形態では、補正部１２は、複数の操向輪２の各々について、取得部１１にて取得した複数の操向輪ずれ情報のうち対応する操向輪ずれ情報に基づいて舵角θを補正する。言い換えれば、補正ステップＳＴ２は、複数の操向輪２の各々について、対応する操向輪ずれ情報に基づいて舵角θを補正するステップである。

具体的には、補正部１２は、取得部１１にて取得した第１ずれ情報に基づいて、前輪２１の車輪面が軌道Ｌ１に沿うように、前輪２１の舵角θを補正する。また、補正部１２は、取得部１１にて取得した第２ずれ情報に基づいて、後輪２２の車輪面が軌道Ｌ１に沿うように、後輪２２の舵角θを補正する。本実施形態では、前輪２１及び後輪２２の各々の舵角θの補正量は、ＰＩＤ（Proportional-Integral-Differential）制御により決定される。

一例として、前輪２１の舵角θを「θｆ」、後輪２２の舵角θを「θｂ」として、各舵角θｆ，θｂは、それぞれ以下の式（１）、（２）で表される。式（１）において、「Ｄｆ」は前輪２１のずれ量、「Ｋｆ」は前輪２１の補正係数（比例係数）を表している。また、式（２）において、「Ｄｂ」は後輪２２のずれ量、「Ｋｂ」は後輪２２の補正係数（比例係数）を表している。

ここで、式（１）、（２）で表される各舵角θｆ，θｂは、いずれもＰＩＤ制御での比例項（Ｐ項）を表している。ＰＩＤ制御での積分項、及び微分項を含めると、各舵角θｆ，θｂは、それぞれ以下の式（３）、（４）で表される。式（３）において、「Ｄｆｉ」は前輪２１のずれ積分量、「Ｄｆｄ」は前輪２１のずれ微分量、「Ｋｆｉ」は前輪２１の補正係数（積分係数）、「Ｋｆｄ」は前輪２１の補正係数（微分係数）を表している。式（４）において、「Ｄｂｉ」は後輪２２のずれ積分量、「Ｄｂｄ」は後輪２２のずれ微分量、「Ｋｂｉ」は後輪２２の補正係数（積分係数）、「Ｋｂｄ」は後輪２２の補正係数（微分係数）を表している。

また、本実施形態では、補正部１２は、上記のように複数の操向輪２の各々について舵角θを補正する他に、複数の操向輪（駆動輪）２の各々の速度を補正する。具体的には、補正部１２は、複数の操向輪２の各々について、上記のように補正した舵角θに基づいて、対応する操向輪２の速度（周速度）を補正する。言い換えれば、制御方法は、複数の操向輪２の各々について、補正ステップＳＴ２で補正する舵角θに基づいて、対応する操向輪２の速度を補正する速度補正ステップＳＴ３を更に有している。

以下、複数の操向輪２の各々の速度を決定する過程について、図３を参照して説明する。図３では、搬送装置１が右向きに移動している、と仮定する。また、図３において、「α」は前輪２１の舵角θ、「β」は後輪２２の舵角θ、「Ｖ_α」は前輪２１の速度、「Ｖ_β」は後輪２２の速度、「Ｗ」は前輪２１の中心と後輪２２の中心との間の距離を表している。また、図３において、「ｒ_α」は前輪２１の軸方向と後輪２２の軸方向との交点Ｘ１を中心とする前輪２１の旋回半径、「ｒ_β」は前輪２１の軸方向と後輪２２の軸方向との交点Ｘ１を中心とする後輪２２の旋回半径を表している。

ここで、前輪２１の舵角θ、及び後輪２２の舵角θに応じて、前輪２１の旋回半径、及び後輪２２の旋回半径は変化する。したがって、基本的に、前輪２１の旋回半径と、後輪２２の旋回半径とは互いに異なっている。このため、前輪２１の速度と後輪２２の速度とを同じにした場合、前輪２１の角速度と後輪２２の角速度とが一致せずに前輪２１の動きと後輪２２の動きとの整合が取れず、いずれか一方の操向輪２が空転する等して、搬送装置１を軌道Ｌ１に追従させにくくなる可能性がある。

そこで、本実施形態では、補正部１２は、複数の操向輪２の各々について、舵角θに基づいて速度を補正することで、前輪２１の角速度と後輪２２の角速度とを一致させ、前輪２１の動きと後輪２２の動きとの整合を取るようにしている。ここで、前輪２１の角速度と後輪２２の角速度とが一致する場合における前輪２１の速度と後輪２２の速度との比（以下、単に「速度比」という）は、以下の式（５）で表される。

つまり、速度比は、搬送装置１の寸法（例えば、前輪２１の中心と後輪２２の中心との間の距離「Ｗ」等）に依らず、前輪２１の舵角θと後輪２２の舵角θとに基づいて決定することが可能である。

上述のように、補正部１２は、前輪２１及び後輪２２の各々について、舵角θを補正し、かつ、補正した舵角θに基づいて前輪２１及び後輪２２の各々の速度を補正することで、搬送装置１を軌道Ｌ１に追従するように制御する。

（２．４）部品実装システム
本実施形態では、図４に示すように、搬送物Ａ１は、一例として、１以上のフィーダを有する部品供給装置８である。部品供給装置８は、工場内に設置された部品実装機９の実装本体９０に対して部品を供給するために用いられる。ここでいう「部品実装機」は、例えば基板等の対象物に部品を実装する機械である。実装本体９０は、部品を基板に実装する実装ヘッドを含んでいる。つまり、本実施形態では、搬送装置１は、制御システム１００に制御されることにより、搬送物Ａ１としての部品供給装置８を、部品実装機９の実装本体９０の設置場所まで搬送する。これにより、部品実装システム２００を構築することが可能である。言い換えれば、部品実装システム２００は、部品を基板に実装する少なくとも１つの部品実装機９を含むシステムである。そして、部品供給装置８は、制御システム１００が制御する搬送装置１によって実装本体９０まで搬送される。

ここで、搬送装置１は、部品供給装置８のうち部品を実装本体９０に排出する部位と反対側の部位と連結可能であるのが好ましい。この場合、部品供給装置８を部品実装機９の実装本体９０の設置場所まで搬送した際に、部品供給装置８における部品を排出する部位が実装本体９０の方を向くことになる。したがって、部品供給装置８を部品実装機９の実装本体９０の設置場所まで搬送した際に、上記の排出する部位が実装本体９０に向くように部品供給装置８の向きを変える作業をしなくて済む。

（３）動作
以下、本実施形態の制御システム１００の動作の一例について図５を参照して説明する。図５に示す動作例では、搬送装置１が搬送物Ａ１を搬送しながら軌道Ｌ１を追従して目的地まで移動中である、と仮定する。搬送装置１の移動中において、取得部１１は、第１センサ４１から定期的に検知結果を取得することにより、第１ずれ情報を取得する（Ｓ１）。同様に、取得部１１は、第２センサ４２から定期的に検知結果を取得することにより、第２ずれ情報を取得する（Ｓ２）。取得部１１による第１ずれ情報及び第２ずれ情報の取得は、殆ど同時に実行される。ステップＳ１，Ｓ２は、取得ステップＳＴ１に相当する。

次に、補正部１２は、取得部１１にて取得した第１ずれ情報に基づいて、前輪２１の舵角θを補正する（Ｓ３）。同様に、補正部１２は、取得部１１にて取得した第２ずれ情報に基づいて、後輪２２の舵角θを補正する（Ｓ４）。補正部１２による前輪２１の舵角θの補正と、後輪２２の舵角θの補正とは、殆ど同時に実行される。ステップＳ３，Ｓ４は、補正ステップＳＴ２に相当する。

その後、補正部１２は、補正後の前輪２１の舵角θ及び後輪２２の舵角θに基づいて、前輪２１及び後輪２２の速度比を補正する（Ｓ５）。つまり、補正部１２は、前輪２１の速度と、後輪２２の速度と、を補正する。ステップＳ５は、速度補正ステップＳＴ３に相当する。

そして、制御部１０２は、補正部１２にて補正した前輪２１の舵角θ及び前輪２１の速度に基づいて、前輪２１を制御する（Ｓ６）。同様に、制御部１０２は、補正部１２にて補正した後輪２２の舵角θ及び後輪２２の速度に基づいて、後輪２２を制御する（Ｓ７）。以下、搬送装置１が目的地に到達するまで（Ｓ８：Ｙｅｓ）、上記の処理を周期的に（例えば、数十ミリ秒ごとに）繰り返す。これにより、搬送装置１は、基準姿勢からのずれを抑えながら、軌道Ｌ１に追従して目的地に向かって移動することになる。

（４）利点
以下、本実施形態の制御システム１００の利点について、比較例の制御システムとの比較を交えて説明する。比較例の制御システムは、図６に示すように、搬送物Ａ１を搬送する搬送装置１を制御している、と仮定する。この搬送装置１は、２つのセンサ４の代わりに、搬送装置１の前端に位置するセンサ４０を有している。そして、比較例の制御システムは、センサ４０の検知結果に基づいて、搬送装置１が軌道Ｌ１に追従するように搬送装置１を制御する。

比較例の制御システムは、搬送装置１が軌道Ｌ１に追従するように搬送装置１を制御した場合、センサ４０の軌道Ｌ１に対する位置ずれを補正することはできるが、搬送装置１全体の軌道Ｌ１に対するずれは補正することが難しい。

ここで、図６に示すような搬送装置１では、搬送物Ａ１の重心から離れた位置に操向輪２が位置するため、走行抵抗の偏りが発生することにより、搬送装置１の直進性が失われやすい。したがって、比較例の制御システムにより搬送物Ａ１を搬送する搬送装置１を制御した場合、搬送物Ａ１と搬送装置１との走行抵抗の偏りにより、搬送装置１が基準姿勢から傾いた状態で軌道Ｌ１に追従することになる。このため、比較例の制御システムで搬送装置１を制御した場合、通路の幅に対して搬送装置１及び搬送物Ａ１が占める割合が大きくなりやすく、搬送装置１を狭路にて移動させることが難しい、という問題があった。

これに対して、本実施形態では、補正部１２は、複数の操向輪２の各々について、取得部１１にて取得した複数の操向輪ずれ情報のうち対応する操向輪ずれ情報に基づいて舵角θを補正している。つまり、本実施形態では、前輪２１の軌道Ｌ１に対する位置ずれについては前輪２１が軌道Ｌ１に追従するように補正し、後輪２２の軌道Ｌ１に対する位置ずれについては後輪２２が軌道Ｌ１に追従するように補正している。

このため、本実施形態では、全ての操向輪２（ここでは、前輪２１及び後輪２２）が軌道Ｌ１に追従するように搬送装置１が制御されるので、搬送物Ａ１を搬送しながら移動している場合であっても、搬送装置１の姿勢が基準姿勢となるように修正されることになる。したがって、本実施形態では、搬送装置１の基準姿勢からのずれを抑えながら、搬送装置１を軌道Ｌ１に追従させやすい、という利点がある。

（５）変形例
上述の実施形態は、本開示の様々な実施形態の一つに過ぎない。上述の実施形態は、本開示の目的を達成できれば、設計等に応じて種々の変更が可能である。また、上述の実施形態に係る制御方法（制御システム１００）と同様の機能は、コンピュータプログラム、又はコンピュータプログラムを記録した非一時的記録媒体等で具現化されてもよい。本開示の一態様に係るプログラムは、１以上のプロセッサに、上記の制御方法を実行させる。

以下、上述の実施形態の変形例を列挙する。以下に説明する変形例は、適宜組み合わせて適用可能である。

本開示における制御システム１００は、例えば、制御部１０２等に、コンピュータシステムを含んでいる。コンピュータシステムは、ハードウェアとしてのプロセッサ及びメモリを主構成とする。コンピュータシステムのメモリに記録されたプログラムをプロセッサが実行することによって、本開示における制御システム１００としての機能が実現される。プログラムは、コンピュータシステムのメモリに予め記録されてもよく、電気通信回線を通じて提供されてもよく、コンピュータシステムで読み取り可能なメモリカード、光学ディスク、ハードディスクドライブ等の非一時的記録媒体に記録されて提供されてもよい。コンピュータシステムのプロセッサは、半導体集積回路（ＩＣ）又は大規模集積回路（ＬＳＩ）を含む１ないし複数の電子回路で構成される。ここでいうＩＣ又はＬＳＩ等の集積回路は、集積の度合いによって呼び方が異なっており、システムＬＳＩ、ＶＬＳＩ（Very Large Scale Integration）、又はＵＬＳＩ（Ultra Large Scale Integration）と呼ばれる集積回路を含む。さらに、ＬＳＩの製造後にプログラムされる、ＦＰＧＡ（Field-Programmable Gate Array）、又はＬＳＩ内部の接合関係の再構成若しくはＬＳＩ内部の回路区画の再構成が可能な論理デバイスについても、プロセッサとして採用することができる。複数の電子回路は、１つのチップに集約されていてもよいし、複数のチップに分散して設けられていてもよい。複数のチップは、１つの装置に集約されていてもよいし、複数の装置に分散して設けられていてもよい。ここでいうコンピュータシステムは、１以上のプロセッサ及び１以上のメモリを有するマイクロコントローラを含む。したがって、マイクロコントローラについても、半導体集積回路又は大規模集積回路を含む１ないし複数の電子回路で構成される。

また、制御システム１００における複数の機能が、１つの筐体内に集約されていることは制御システム１００に必須の構成ではなく、制御システム１００の構成要素は、複数の筐体に分散して設けられていてもよい。さらに、制御システム１００の少なくとも一部の機能がクラウド（クラウドコンピューティング）等によって実現されてもよい。

上述の実施形態において、制御システム１００は、例えば図７に示すように、複数の操向輪２の舵角θを固定して、複数の操向輪２の各々の速度差を利用して搬送装置１を移動させる、いわゆる差動型の制御により搬送装置１を軌道Ｌ１に追従させてもよい。

上述の実施形態において、制御システム１００は、例えば図８に示すように、複数の操向輪２の舵角θを固定して、複数の操向輪２の各々の軸方向が交差する交点Ｘ１を中心とする円周軌道を複数の操向輪２が辿るように、搬送装置１を旋回させてもよい。

上述の実施形態において、例えば図９に示すように、複数のセンサ４は、複数の操向輪２の間に配置されていてもよい。図９において、複数のセンサ４は実線で描かれているが、実際には、搬送装置１の本体部１０（後述する）に隠れている。図１０～図１６においても同様である。

上述の実施形態において、補正部１２は、複数の操向輪２の各々の速度を補正する制御は実行しなくてもよい。この場合、上述の実施形態のように、複数の操向輪２の全てが駆動輪を兼ねている必要はなく、少なくともいずれか１つの操向輪２が駆動輪を兼ねていればよい。

上述の実施形態において、補正部１２は、複数の操向輪２の各々の速度を補正する代わりに、複数の操向輪２の各々の軸に加わるトルクを補正してもよい。

上述の実施形態において、複数の操向輪２の各々の舵角θの補正量は、ＰＩＤ制御により決定される他に、Ｐ（Proportional）制御又はＰＩ（Proportional-Integral）制御により決定されてもよい。

上述の実施形態において、軌道Ｌ１は、移動面Ｂ１に設置されていなくてもよい。つまり、軌道Ｌ１は、実体を有していなくてもよい。例えば、軌道Ｌ１は、搬送装置１に与えられる地図情報における仮想的な軌道であってもよい。この場合、センサ４は、磁気センサではなく、例えばＧＰＳ等の衛星測位システム及びＬｉＤＡＲ等の組み合わせにより、センサ４の位置の仮想的な軌道に対する位置ずれを検知する態様であればよい。

上述の実施形態では、制御システム１００は搬送装置１に搭載されているが、これに限らない。例えば、上位システム６が制御システム１００として機能してもよい。この場合、上位システム６は、搬送装置１からセンサ４の検知結果を無線通信により取得することで、ずれ情報を取得する取得ステップＳＴ１を実行する。また、この場合、上位システム６は、取得したずれ情報に基づいて複数の操向輪２の各々について舵角θ及び速度を補正し、補正した舵角θ及び速度に変更させる指令を無線通信により搬送装置１に送信することで、補正ステップＳＴ２及び速度補正ステップＳＴ３を実行する。

上述の実施形態において、連結部５は、フック等の搬送物Ａ１の一部を引っ掛ける態様に限らず、電磁石により搬送物Ａ１を吸引する態様であってもよい。

上述の実施形態において、搬送装置１は、連結部５を有していなくてもよい。例えば、搬送装置１は、搬送装置１の上に搬送物Ａ１を積載する構造を有していてもよい。つまり、搬送装置１は、搬送物Ａ１を搬送可能な態様であればよい。

（実施形態２）
（１）詳細
本実施形態の搬送装置１では、図１０に示すように、複数のセンサ４（ここでは、第１センサ４１及び第２センサ４２）が複数の操向輪２（ここでは、前輪２１及び後輪２２）の間に配置されている点で、上述の実施形態１の搬送装置１と相違する。

また、本実施形態の制御システム１００では、取得部１１により取得するずれ情報が、上述の実施形態１の制御システム１００と相違する。具体的には、本実施形態では、ずれ情報は、回転ずれ情報、及び位置ずれ情報を含んでいる。回転ずれ情報は、搬送装置１の軌道Ｌ１に対する基準姿勢からの搬送装置１の傾きのずれに関する情報である。位置ずれ情報は、基準姿勢からの搬送装置１の位置のずれに関する情報である。

本実施形態では、取得部１１は、第１センサ４１及び第２センサ４２の各々の検知結果に基づいて、回転ずれ情報及び位置ずれ情報を取得する。具体的には、取得部１１は、第１センサ４１の中心と軌道Ｌ１との間の距離と、第２センサ４２の中心と軌道Ｌ１との間の距離との中間値（つまり、搬送装置１の本体部１０の制御点Ｐ１と軌道Ｌ１との位置ずれ量Ｄ１）を、位置ずれ情報として取得する。制御点Ｐ１は、搬送装置１の本体部１０の中心である。また、取得部１１は、第１センサ４１の中心と第２センサ４２の中心との間の距離Ｄ１１と、差分Ｄ１２と、を正接（tangent）とする角度である回転ずれ量Ｄ２を、回転ずれ情報として取得する。差分Ｄ１２は、第１センサ４１の中心と軌道Ｌ１との間の距離と、第２センサ４２の中心と軌道Ｌ１との間の距離との差分である。

さらに、本実施形態の制御システム１００は、補正部１２による複数の操向輪２の各々の舵角θの補正が、上述の実施形態１の制御システム１００と相違する。具体的には、本実施形態では、補正部１２は、複数の操向輪２の各々について、取得部１１にて取得した回転ずれ情報及び位置ずれ情報に基づいて舵角θを補正する。言い換えれば、補正ステップＳＴ２は、複数の操向輪２の各々について、回転ずれ情報及び位置ずれ情報に基づいて舵角θを補正するステップである。

以下、補正部１２による複数の操向輪２の各々の舵角θを補正する過程について、図１１～図１３を参照して説明する。まず、補正部１２は、複数の操向輪２の各々について、第１舵角θ１を算出する。第１舵角θ１は、位置ずれ情報に基づいて得られる角度である。第１舵角θ１は、図１１に示すように、位置ずれ量Ｄ１（図１０参照）が零となる（つまり、制御点Ｐ１が軌道Ｌ１に乗る）ように搬送装置１を旋回させずに平行移動させる角度である。したがって、前輪２１の第１舵角θ１１と、後輪２２の第１舵角θ１２とは、同じ値となる。

次に、補正部１２は、複数の操向輪２の各々について、第２舵角θ２を算出する。第２舵角θ２は、回転ずれ情報に基づいて得られる角度である。第２舵角θ２は、図１２に示すように、回転ずれ量Ｄ２（図１０参照）が零となる（つまり、搬送装置１が基準姿勢となる）ように搬送装置１を旋回移動させる角度である。ここでは、前輪２１の第２舵角θ２１と、後輪２２の第２舵角θ２２とは、後述するように互いに逆位相となっている。

そして、補正部１２は、複数の操向輪２の各々について、算出した第１舵角θ１と第２舵角θ２とを合成した合成舵角θ３に基づいて舵角θを補正する。言い換えれば、補正ステップＳＴ２は、複数の操向輪２の各々について、第１舵角θ１と、第２舵角θ２と、を合成した合成舵角θ３に基づいて舵角θを補正するステップである。図１３に示すように、前輪２１の合成舵角θ３１は、前輪２１の第１舵角θ１１に、前輪２１の第２舵角θ２１を加算した角度となる。また、後輪２２の合成舵角θ３２は、後輪２２の第１舵角θ１２に、後輪２２の第２舵角θ２２を加算した角度となる。

ここで、補正部１２は、第２舵角θ２を算出する際には、前輪２１の第２舵角θ２１と、後輪２２の第２舵角θ２２と、が互いに逆位相となるように、複数の操向輪２の各々の第２舵角θ２を算出する、逆位相制御を実行する。本開示でいう「互いに逆位相」とは、前輪２１を時計回り又は反時計回りに回転させた場合の前輪２１の舵角θと、後輪２２を前輪２１とは逆回りに回転させた場合の後輪２２の舵角θとの関係をいう。例えば、前輪２１の第２舵角θ２１が３０度であると仮定すると、互いに逆位相の関係を満たす場合、後輪２２の第２舵角θ２２は－３０度となる。言い換えれば、補正ステップＳＴ２は、回転ずれ情報に基づいて舵角θを補正する場合、複数の操向輪２のうち搬送装置１の前方に位置する前輪２１の舵角θと、複数の操向輪２のうち搬送装置１の後方に位置する後輪２２の舵角θと、を互いに逆位相にするステップを有する。

以下、上記の逆位相制御の利点について、図１４～図１６を参照して説明する。まず、前輪２１及び後輪２２の各々の舵角θを、補正部１２で算出した第１舵角θ１で補正して搬送装置１を制御する、と仮定する。この場合、図１４に示すように、搬送装置１には、第１舵角θ１を向く慣性ベクトルＶ１で表される慣性が働く。

この状態で、前輪２１のみを更に第２舵角θ２１を加算した舵角θ１１０で補正して搬送装置１を制御する、と仮定する。この場合、図１５に示すように、後輪２２の移動面Ｂ１との接地点を中心とするヨーイングモーメントが搬送装置１に作用することで、慣性ベクトルＶ１が慣性ベクトルＶ２へと急峻に変化する。このように搬送装置１に働く慣性が急峻に変化すると、搬送装置１及び搬送物Ａ１のバランスが崩れやすくなったり、搬送装置１の推進力の損失が大きくなったりする、という問題が生じ得る。

そこで、本実施形態では、上記の逆位相制御を実行することにより、上記の問題の解消を図っている。すなわち、搬送装置１が図１４に示す状態において、補正部１２が逆位相制御を実行した場合、搬送装置１には、図１６に示すように、搬送装置１の旋回軌道の接線方向を向く慣性ベクトルＶ３で表される慣性が働く。この慣性ベクトルＶ３は、逆位相制御を実行する直前の慣性ベクトルＶ１と殆ど同じ向きであるため、搬送装置１に働く慣性の変化が極力抑えられることになる。したがって、本実施形態では、搬送装置１及び搬送物Ａ１のバランスが崩れにくく、かつ、搬送装置１の推進力の損失を抑えることができる、という利点がある。

一例として、前輪２１の合成舵角θ３１及び後輪２２の合成舵角θ３２は、それぞれ以下の式（６）～（９）で表される。式（８）において、「Ｄｘ」は位置ずれ量、「Ｋｘ」は位置補正係数（比例係数）を表している。また、式（９）において、「Ｄｒ」は回転ずれ量、「Ｋｒ」は回転補正係数（比例係数）を表している。

ここで、式（８）、（９）で表される各舵角θ１，θ２は、いずれもＰＩＤ制御での比例項（Ｐ項）を表している。ＰＩＤ制御での積分項、及び微分項を含めると、各舵角θ１，θ２は、それぞれ以下の式（１０）、（１１）で表される。式（１０）において、「Ｄｘｉ」は位置ずれの積分量、「Ｄｆｄ」は位置ずれの微分量、「Ｋｘｉ」は位置補正係数（積分係数）、「Ｋｘｄ」は位置補正係数（微分係数）を表している。式（１１）において、「Ｄｒｉ」は回転ずれの積分量、「Ｄｒｄ」は回転ずれの微分量、「Ｋｒｉ」は回転補正係数（積分係数）、「Ｋｒｄ」は回転補正係数（微分係数）を表している。

（２）動作
以下、本実施形態の制御システム１００の動作の一例について図１７を参照して説明する。図１７に示す動作例では、搬送装置１が搬送物Ａ１を搬送しながら軌道Ｌ１を追従して目的地まで移動中である、と仮定する。搬送装置１の移動中において、取得部１１は、第１センサ４１及び第２センサ４２から定期的に検知結果を取得することにより、位置ずれ情報及び回転ずれ情報を取得する（Ｓ９）。ステップＳ９は、取得ステップＳＴ１に相当する。

次に、補正部１２は、取得部１１にて取得した位置ずれ情報に基づいて、前輪２１及び後輪２２の各々の第１舵角θ１を算出する（Ｓ１０）。また、補正部１２は、取得部１１にて取得した回転ずれ情報に基づいて、前輪２１及び後輪２２の各々の第２舵角θ２を算出する（Ｓ１１）。そして、補正部１２は、算出した第１舵角θ１及び第２舵角θ２から、前輪２１及び後輪２２の各々の合成舵角θ３を算出する（Ｓ１２）。その後、補正部１２は、算出した合成舵角θ３に基づいて、前輪２１及び後輪２２の各々の舵角θを補正する（Ｓ１３）。ステップＳ１０～Ｓ１３は、補正ステップＳＴ２に相当する。

その後、補正部１２は、補正後の前輪２１の舵角θ及び後輪２２の舵角θに基づいて、前輪２１及び後輪２２の速度比を補正する（Ｓ１４）。つまり、補正部１２は、前輪２１の速度と、後輪２２の速度と、を補正する。ステップＳ１４は、速度補正ステップＳＴ３に相当する。

そして、制御部１０２は、補正部１２にて補正した前輪２１の舵角θ及び前輪２１の速度に基づいて、前輪２１を制御する（Ｓ１５）。同様に、制御部１０２は、補正部１２にて補正した後輪２２の舵角θ及び後輪２２の速度に基づいて、後輪２２を制御する（Ｓ１６）。以下、搬送装置１が目的地に到達するまで（Ｓ１７：Ｙｅｓ）、上記の処理を周期的に（例えば、数十ミリ秒ごとに）繰り返す。これにより、搬送装置１は、基準姿勢からのずれを抑えながら、軌道Ｌ１に追従して目的地に向かって移動することになる。

（３）利点
上述のように、本実施形態では、搬送装置１の軌道Ｌ１に対する基準姿勢からの搬送装置１の傾きのずれと、基準姿勢からの搬送装置１の位置のずれと、を修正するように、搬送装置１の全ての操向輪２（ここでは、前輪２１及び後輪２２）が制御される。このため、本実施形態では、搬送物Ａ１を搬送しながら移動している場合であっても、搬送装置１の姿勢が基準姿勢となるように修正されることになる。したがって、本実施形態では、実施形態１と同様に、搬送装置１の基準姿勢からのずれを抑えながら、搬送装置１を軌道Ｌ１に追従させやすい、という利点がある。

（４）変形例
実施形態２で説明した構成は、実施形態１で説明した種々の構成（変形例を含む）と適宜組み合わせて採用可能である。

また、上述の実施形態２において、補正部１２は、複数の操向輪２の各々について、合成舵角θ３に基づいて舵角θを補正しているが、これに限らない。例えば、補正部１２は、第１舵角θ１に基づいて舵角θを補正する処理と、第２舵角θ２に基づいて舵角θを補正する処理と、を交互に実行してもよい。言い換えれば、補正ステップＳＴ２は、複数の操向輪２の各々について、第１補正ステップと、第２補正ステップと、を交互に実行してもよい。第１補正ステップは、回転ずれ情報に基づいて舵角θを補正するステップであり、図１７のステップＳ１０にて算出した第１舵角θ１に基づいて舵角θを補正するステップに相当する。第２補正ステップは、位置ずれ情報に基づいて舵角θを補正するステップであり、図１７のステップＳ１１にて算出した第２舵角θ２に基づいて舵角θを補正するステップに相当する。

上述の実施形態２において、センサ４は、位置ずれ情報及び回転ずれ情報を生成可能な物理量を検知する態様であればよい。例えば、センサ４は、複数の棒状の磁気センサを環状に配置した態様であってもよいし、リング状の１つの磁気センサであってもよい。また、センサ４は、搬送装置１のいずれかに設けられて軌道Ｌ１を撮像する撮像装置であってもよい。さらに、センサ４は、搬送装置１の外側から搬送装置１を撮像する撮像装置であってもよい。その他、センサ４は、位置ずれ情報及び回転ずれ情報の精度を要求しないのであれば、ＧＰＳモジュール、又は地磁気センサであってもよい。

上述の実施形態２において、補正部１２は、第２舵角θ２を算出する際に、逆位相制御を実行しなくてもよい。つまり、補正部１２は、前輪２１の第２舵角θ２１と、後輪２２の第２舵角θ２２と、を互いに同位相としてもよい。

（まとめ）
以上述べたように、第１の態様に係る制御方法は、取得ステップ（ＳＴ１）と、補正ステップ（ＳＴ２）と、を有する。取得ステップ（ＳＴ１）は、搬送装置（１）の、搬送装置（１）が走行する軌道（Ｌ１）に対するずれに関するずれ情報を取得するステップである。搬送装置（１）は、前後方向に並ぶ複数の操向輪（２）を有して搬送物（Ａ１）を搬送する。補正ステップ（ＳＴ２）は、複数の操向輪（２）の各々について、取得ステップにて取得したずれ情報に基づいて舵角（θ）を補正するステップである。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第２の態様に係る制御方法では、第１の態様において、ずれ情報は、複数の操向輪（２）の各々と軌道（Ｌ１）との位置ずれに関する複数の操向輪ずれ情報を含んでいる。補正ステップ（ＳＴ２）は、複数の操向輪（２）の各々について、対応する操向輪ずれ情報に基づいて舵角（θ）を補正する。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第３の態様に係る制御方法では、第１の態様において、ずれ情報は、搬送装置（１）の軌道（Ｌ１）に対する基準姿勢からの搬送装置（１）の傾きのずれに関する回転ずれ情報、及び基準姿勢からの搬送装置（１）の位置のずれに関する位置ずれ情報を含んでいる。補正ステップ（ＳＴ２）は、複数の操向輪（２）の各々について、回転ずれ情報及び位置ずれ情報に基づいて舵角（θ）を補正する。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第４の態様に係る制御方法では、第３の態様において、補正ステップ（ＳＴ２）は、複数の操向輪（２）の各々について、第１補正ステップと、第２補正ステップと、を交互に実行する。第１補正ステップは、位置ずれ情報に基づいて舵角（θ）を補正する。第２補正ステップは、回転ずれ情報に基づいて舵角（θ）を補正する。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第５の態様に係る制御方法では、第３の態様において、補正ステップ（ＳＴ２）は、複数の操向輪（２）の各々について、合成舵角（θ３）に基づいて舵角（θ）を補正する。合成舵角（θ３）は、位置ずれ情報に基づいて得られる第１舵角（θ１）と、回転ずれ情報に基づいて得られる第２舵角（θ２）と、を合成した角度である。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第６の態様に係る制御方法では、第３～第５のいずれかの態様において、補正ステップ（ＳＴ２）は、回転ずれ情報に基づいて舵角（θ）を補正する場合、前輪（２１）の舵角（θ）と、後輪（２２）の舵角（θ）と、を互いに逆位相にする。前輪（２１）は、複数の操向輪（２）のうち搬送装置（１）の前方に位置する。後輪（２２）は、複数の操向輪（２）のうち搬送装置（１）の後方に位置する。

この態様によれば、搬送装置（１９及び搬送物（Ａ１）のバランスが崩れにくく、かつ、搬送装置（１）の推進力の損失を抑えることができる、という利点がある。

第７の態様に係る制御方法は、第１～第６のいずれかの態様において、速度補正ステップ（ＳＴ３）を更に有する。速度補正ステップ（ＳＴ３）は、複数の操向輪（２）の各々について、補正ステップ（ＳＴ２）で補正する舵角（θ）に基づいて、対応する操向輪（２）の速度を補正するステップである。

この態様によれば、複数の操向輪（２）の各々の動きの整合を取りやすいので、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第８の態様に係る制御方法では、第１～第７のいずれかの態様において、複数の操向輪（２）は、搬送装置（１）の前方に位置する前輪（２１）と、搬送装置（１）の後方に位置する後輪（２２）と、からなる。

この態様によれば、二輪型の搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第９の態様に係る制御方法では、第１～第８のいずれかの態様において、軌道（Ｌ１）は、搬送装置（１）が移動する移動面（Ｂ１）に設置されている。

この態様によれば、軌道（Ｌ１）が電子地図上の仮想的な軌道である場合と比較して、搬送装置（１）の軌道（Ｌ１）に対するずれを検知しやすい、という利点がある。

第１０の態様に係る制御方法では、第１～第９のいずれかの態様において、搬送装置（１）は、搬送装置（１）の本体部（１０）における軌道（Ｌ１）に沿った一面にて搬送物（Ａ１）を連結する連結部（５）を有する。

この態様によれば、搬送装置（１）に積載することが難しい搬送物（Ａ１）であっても搬送しやすい、という利点がある。

第１１の態様に係るプログラムは、１以上のプロセッサに、第１～第１０のいずれかの態様の制御方法を実行させる。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第１２の態様に係る制御システム（１００）は、取得部（１１）と、補正部（１２）と、を備える。取得部（１１）は、搬送装置（１）の、搬送装置（１）が走行する軌道（Ｌ１）に対するずれに関するずれ情報を取得する。搬送装置（１）は、前後方向に沿って並ぶ複数の操向輪（２）を有して搬送物（Ａ１）を搬送する。補正部（１２）は、複数の操向輪（２）の各々について、取得部（１１）にて取得したずれ情報に基づいて舵角（θ）を補正する。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第１３の態様に係る搬送装置（１）は、第１２の態様の制御システム（１００）と、本体部（１０）と、を備える。本体部（１０）は、制御システム（１００）が搭載され、搬送物（Ａ１）の搬送を行う。

この態様によれば、搬送装置（１）の基準姿勢からのずれを抑えながら、搬送装置（１）を軌道（Ｌ１）に追従させやすい、という利点がある。

第１４の態様に係る部品実装システム（２００）は、部品を基板に実装する少なくとも１つの部品実装機（９）を含むシステムである。部品実装機（９）は、部品を供給する部品供給装置（８）と、部品を基板に実装する実装ヘッドを含む実装本体（９０）と、を有する。部品供給装置（８）は、第１２の態様の制御システム（１００）が制御する搬送装置（１）によって実装本体（９０）まで搬送される。

この態様によれば、搬送装置（１）により部品供給装置（８）を部品実装機（９）の実装本体（９０）の設置場所まで安定して搬送することができるので、実装本体（９０）に対する部品の供給の安定化を図りやすい、という利点がある。

第１５の態様に係る部品実装システム（２００）では、第１４の態様において、搬送装置（１）は、部品供給装置（８）のうち部品を実装本体（９０）に排出する部位と反対側の部位と連結可能である。

この態様によれば、部品供給装置（８）を部品実装機（９）の実装本体（９０）の設置場所まで搬送した際に、上記の排出する部位が実装本体（９０）に向くように部品供給装置（８）の向きを変える作業をしなくて済む、という利点がある。

第２～第１０の態様に係る方法については、制御方法に必須の方法ではなく、適宜省略可能である。

ところで、第７の態様に係る制御方法は、搬送装置１を軌道Ｌ１に追従するように補正する制御の有無を問わずに実行してもよい。すなわち、第１５の態様に係る制御方法は、搬送装置（１）の速度制御ステップを有する。搬送装置（１）は、前後方向に並ぶ複数の操向輪（２）を有して搬送物（Ａ１）を搬送する。速度制御ステップは、複数の操向輪（２）の各々について、舵角（θ）に基づいて、対応する操向輪（２）の速度を補正するステップである。

１００ 制御システム
２００ 部品実装システム
１１ 取得部
１２ 補正部
１ 搬送装置
１０ 本体部
２ 操向輪
２１ 前輪
２２ 後輪
５ 連結部
８ 部品供給装置
９ 部品実装機
９０ 実装本体
Ａ１ 搬送物
Ｂ１ 移動面
Ｌ１ 軌道
ＳＴ１ 取得ステップ
ＳＴ２ 補正ステップ
ＳＴ３ 速度補正ステップ
θ 舵角
θ１ 第１舵角
θ２ 第２舵角
θ３ 合成舵角

Claims (10)

1. 前後方向に並ぶ複数の操向輪及び前記複数の操向輪の間に配置されている複数のセンサを有して搬送物を搬送する搬送装置の、前記搬送装置が走行する軌道に対するずれに関するずれ情報を、前記複数のセンサの検知結果に基づいて取得する取得ステップと、
   前記複数の操向輪の各々について、前記取得ステップにて取得した前記ずれ情報に基づいて舵角を補正する補正ステップと、を有し、
   前記ずれ情報は、前記複数の操向輪の各々と前記軌道との位置ずれに関する複数の操向輪ずれ情報を含んでおり、
   前記補正ステップは、前記複数の操向輪の各々について、対応する操向輪ずれ情報に基づいて前記舵角を補正し、
   前記ずれ情報は、前記搬送装置の前記軌道に対する基準姿勢からの前記搬送装置の傾きのずれＤｒに関する回転ずれ情報、及び前記基準姿勢からの前記搬送装置の位置のずれＤｘに関する位置ずれ情報を含んでおり、
   前記補正ステップは、前記複数の操向輪のうち前記搬送装置の前方に位置する前輪の舵角θ３１と、前記複数の操向輪のうち前記搬送装置の後方に位置する後輪の舵角θ３２と、をＰＩＤ制御し、前記ＰＩＤ制御の比例項をθ１、θ２とすると、次式が成り立つ、
   θ３１＝θ１＋θ２
   θ３２＝θ１－θ２
   θ１＝Ｋｘ・Ｄｘ
   θ２＝Ｋｒ・Ｄｒ
   ここで、Ｋｘは第１の比例係数、Ｋｒは第２の比例係数である、
   制御方法。
2. 前記複数の操向輪の各々について、前記補正ステップで補正する前記舵角に基づいて、対応する操向輪の速度を補正する速度補正ステップを更に有する、
   請求項１に記載の制御方法。
3. 前記複数の操向輪の各々について、前記補正ステップで補正する前記舵角に基づいて、対応する操向輪の各々の軸に加わるトルクを補正するトルク補正ステップを更に有する、
   請求項１に記載の制御方法。
4. 前記軌道は、前記搬送装置が移動する移動面に設置されている、
   請求項１～３のいずれか１項に記載の制御方法。
5. 前記搬送装置は、前記搬送装置の本体部における前記軌道に沿った一面にて前記搬送物を連結する連結部を有する、
   請求項１～４のいずれか１項に記載の制御方法。
6. １以上のプロセッサに、
   請求項１～５のいずれか１項に記載の制御方法を実行させる、
   プログラム。
7. 前後方向に沿って並ぶ複数の操向輪及び前記複数の操向輪の間に配置されている複数のセンサを有して搬送物を搬送する搬送装置の、前記搬送装置が走行する軌道に対するずれに関するずれ情報を、前記複数のセンサの検知結果に基づいて取得する取得部と、
   前記複数の操向輪の各々について、前記取得部にて取得した前記ずれ情報に基づいて舵角を補正する補正部と、を備え、
   前記ずれ情報は、前記複数の操向輪の各々と前記軌道との位置ずれに関する複数の操向輪ずれ情報を含んでおり、
   前記補正部は、前記複数の操向輪の各々について、対応する操向輪ずれ情報に基づいて前記舵角を補正し、
   前記ずれ情報は、前記搬送装置の前記軌道に対する基準姿勢からの前記搬送装置の傾きのずれＤｒに関する回転ずれ情報、及び前記基準姿勢からの前記搬送装置の位置のずれＤｘに関する位置ずれ情報を含んでおり、
   前記補正部は、前記複数の操向輪のうち前記搬送装置の前方に位置する前輪の舵角θ３１と、前記複数の操向輪のうち前記搬送装置の後方に位置する後輪の舵角θ３２と、をＰＩＤ制御し、前記ＰＩＤ制御の比例項をθ１、θ２とすると、次式が成り立つ、
   θ３１＝θ１＋θ２
   θ３２＝θ１－θ２
   θ１＝Ｋｘ・Ｄｘ
   θ２＝Ｋｒ・Ｄｒ
   ここで、Ｋｘは第１の比例係数、Ｋｒは第２の比例係数である、
   制御システム。
8. 請求項７記載の制御システムと、
   前記制御システムが搭載され、前記搬送物の搬送を行う本体部と、を備える、
   搬送装置。
9. 部品を基板に実装する少なくとも１つの部品実装機を含む部品実装システムであって、
   前記部品実装機は、
   前記部品を供給する部品供給装置と、
   前記部品を前記基板に実装する実装ヘッドを含む実装本体と、を有し、
   前記部品供給装置は、
   請求項７記載の制御システムが制御する前記搬送装置によって前記実装本体まで搬送される、
   部品実装システム。
10. 前記搬送装置は、
    前記部品供給装置のうち前記部品を前記実装本体に排出する部位と反対側の部位と連結可能である、
    請求項９記載の部品実装システム。