搬送車システム
【課題】左右の車輪を独立して駆動可能な搬送車において、曲線部走行時にモータの過負荷を防止する。
【解決手段】搬送車システムにおいて、速度パターン発生部６２は、搬送車が曲線部を走行するときに２個の走行車輪に対して基準速度に対して内外輪にそれぞれ速度差が生じるように、速度指令を発生して２個のモータ２６，２９に与える。速度パターン発生部６２は、搬送車が加速中に曲線部に進入することを光電センサ４７が検出すれば、第１速度比率変化区間において、外輪となる走行車輪に対応するモータに対して進入時の加速度ａ０１以下の加速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。
【解決手段】搬送車システムにおいて、速度パターン発生部６２は、搬送車が曲線部を走行するときに２個の走行車輪に対して基準速度に対して内外輪にそれぞれ速度差が生じるように、速度指令を発生して２個のモータ２６，２９に与える。速度パターン発生部６２は、搬送車が加速中に曲線部に進入することを光電センサ４７が検出すれば、第１速度比率変化区間において、外輪となる走行車輪に対応するモータに対して進入時の加速度ａ０１以下の加速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、搬送車システムに関し、特に、左右の車輪を独立して駆動可能な搬送車が用いられた搬送車システムに関する。
【背景技術】
【０００２】
大型化したガラス基板やそれが複数枚収納されたカセットを搬送するための搬送車が知られている。搬送車は、工場のクリーンルーム内を自動走行して、処理装置間で物品を搬送する。搬送車が走行する軌道は、例えば、天井から吊り下げられたレールであり、この場合にレール及び搬送車が走行する空間はクリーンルームになっている。
搬送車は、左右両側に車輪を有しており、一方の車輪にモータが接続されて駆動輪になっており、他方の車輪が従動輪になっている。搬送車は、さらに、左右のガイドレールにガイドされるためのガイドローラを有している。
また、左右の車輪に別個のモータを接続して、搬送車がカーブを走行する際には、左右の車輪に適切な速度差が生じさせるようにした二輪差速度制御を行う搬送車システムも知られている（例えば、特許文献１を参照。）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００８−５２３２３号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
従来の搬送車では、左右２輪駆動の搬送車構造において、カーブ走行時に外輪と内輪に異なる速度にするために、それぞれ独立した速度指令が各モータに与えられている。各速度指令は、中心速度に対して、予め用意された左右速度差変換テーブル（中心速度に対する内輪と外輪の速度比率）を乗算することで生成される。
各モータには、機械特性的に許容できる加速度が定まっている。しかし、曲線部走行時に加速する場合に直線走行時の加速度（例えば、最大加速度）が生じるように速度指令を生成すると、外輪側のモータの加減速度が上限値を超えてしまうことになる。つまり、外輪側のモータが過負荷になってしまい、場合によってはサーボアンプの許容負荷を超えてモータが異常状態になることも考えられる。
【０００５】
本発明の課題は、左右の車輪を独立して駆動可能な搬送車において、曲線部走行時にモータの過負荷を防止することにある。
【課題を解決するための手段】
【０００６】
以下に、課題を解決するための手段として複数の態様を説明する。これら態様は、必要に応じて任意に組み合せることができる。
【０００７】
本発明の一見地に係る搬送車システムは、予め定められた経路を走行する搬送車と、搬送車の走行を制御する制御部とを備えている。搬送車は、車体と、車体の左右に設けられた２個の走行車輪と、２個の走行車輪にそれぞれ接続された２個のモータと、を有している。制御部は、速度指令発生部と、検出部と、を有している。速度指令発生部は、搬送車が曲線部を走行するときに基準速度に対して内外輪にそれぞれ速度差が生じるように、曲線部の中間にある内外輪速度比率一定区間と曲線部の両端にある内外輪速度比率変化区間とにおいて速度指令を発生して２個のモータに与える。検出部は、搬送車が曲線部を走行していることを検出可能である。速度指令発生部は、搬送車が加速中に曲線部に進入することを検出部が検出すれば、内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して進入時の加速度以下の加速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。つまり、内輪となる走行車輪に対応するモータに与えられる速度指令は、内輪となる走行車輪の速度が外輪となる走行車輪の速度より速度差分以上を減らした速度となるような値である。
この搬送車システムでは、搬送車が加速しながら曲線部に進入した場合に、外輪となるモータに高負荷がかからない。
【０００８】
制御部は、加速中に曲線部への進入を検出部が検出すれば、外輪となる走行車輪に対応するモータが現加速度を維持すれば内外輪速度比率変化区間内で最大速度に到達するか否かを判断する判断部をさらに有していてもよい。最大速度に達しないと判断部が判断すれば、速度指令発生部は、外輪となる走行車輪に対応するモータに対して現加速度を維持するような速度指令を生成して与える。
この搬送車システムでは、速度指令発生部において計算負荷が高くならない。
【０００９】
速度指令発生部は、上記の場合に最大速度に達すると判断されれば、内外輪速度比率変化区間の終了点以降で外輪となる走行車輪が最大速度になるような速度指令を生成して、外輪となる走行車輪に対応するモータに対して速度指令を与えてもよい。
この搬送車システムでは、外輪となる走行車輪に対応するモータが現加速度を維持すれば内外輪速度比率変化区間内で最大速度に到達してしまう場合でも、外輪が最大速度を超えることが防止される。
【００１０】
速度指令発生部は、搬送車が減速中に曲線部から退出することを検出部が検出すれば、内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して退出時の減速度以下の減速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与えてもよい。つまり、内輪となる走行車輪に対応するモータに与えられる速度指令は、内輪となる走行車輪の速度が外輪となる走行車輪の速度より速度差分以上を減らした速度となるような値である。
この搬送車システムでは、搬送車が減速しながら曲線部から退出した場合に、外輪となる走行車輪に対応するモータに高負荷がかからない。
【００１１】
速度指令発生部は、搬送車が減速中に曲線部に進入することを検出部が検出すれば、内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して進入時の減速度以下の減速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与えてもよい。つまり、外輪となる走行車輪に対応するモータに与えられる速度指令は、外輪となる走行車輪の速度が内輪となる走行車輪の速度より速度差分以上を増やした速度となるような値である。
この搬送車システムでは、搬送車が減速しながら曲線部から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
【００１２】
速度指令発生部は、搬送車が加速中に曲線部から退出することを検出部が検出すれば、内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して退出時の加速度以下の加速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与えてもよい。つまり、外輪となる走行車輪に対応するモータに与えられる速度指令は、外輪となる走行車輪の速度が内輪となる走行車輪の速度より速度差分以上を増やした速度となるような値である。
この搬送車システムでは、搬送車が加速しながら曲線部から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
【００１３】
搬送車システムは、経路に沿って設けられたガイドレールをさらに備えていてもよい。その場合、搬送車は、走行車輪の前側及び後側にそれぞれ設けられた前側ガイドローラ対及び後側ガイドローラ対をさらに有している。制御部は、搬送車が曲線部を走行するときに前側ガイドローラ対及び後側ガイドローラ対がガイドレールに接触しない走行軌跡情報を保持している。速度指令発生部は、走行軌跡情報に基づいて速度指令発生のための速度指令変換テーブルを作成する。
搬送車が曲線部を走行するときには、前側ガイドローラ対及び後側ガイドローラ対がガイドレールに近接したガイド位置にある。一方、制御部は、搬送車が曲線部を走行するときに、理想的な走行軌跡情報に基づいて作成した速度指令変換テーブルを利用して速度指令を作成している。したがって、前側ガイドローラ対及び後側ガイドローラ対は曲線部においてガイドレールに接触しにくい。従来であれば曲線部の入口と出口において搬送車の前側ガイドローラ対及び後側ガイドローラ対がガイドレールに接触することを前提とした制御を行っていたので、両者の衝突や摩擦の問題が大きかった。それに対しては、この搬送車システムでは、曲線部の入口と出口において搬送車の前側ガイドローラ対及び後側ガイドローラ対がガイド位置にあってもガイドレールに接触しないように積極的に制御をしている。したがって、ガイドローラがガイドレールに接触しにくい。
【発明の効果】
【００１４】
本発明に係る搬送車システムでは、左右の車輪を独立して駆動可能な搬送車において、曲線部走行時にモータの過負荷が防止される。
【図面の簡単な説明】
【００１５】
【図１】本発明の一実施形態が採用された搬送車システムの模式図。
【図２】搬送車システムの部分平面図。
【図３】搬送車システムの制御構成を示すブロック構成図。
【図４】搬送車の走行制御部を示すブロック構成図。
【図５】計算によって得られた理想的な走行軌跡を示す平面図。
【図６】図５の部分拡大図。
【図７】走行車輪の寸法関係を示す図。
【図８】曲線部におけるガイドレールとガイドローラの位置関係を模式的に示した図。
【図９】曲線部走行時の速度比率テーブル。
【図１０】曲線部走行時の走行制御部の動作を示すフローチャート。
【図１１】加速しながらカーブに進入する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【図１２】加速しながらカーブに進入する場合で、２輪速度比率変化区間内で外輪が最大速度に達しないように速度指令を発生した場合に、各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【図１３】加速しながらカーブに進入する場合で、２輪速度比率変化区間内で旋回軸中心が基準速度に達しないように速度指令を発生した場合に、各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ
【図１４】カーブ中から発進した場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【図１５】減速しながらカーブから退出する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【発明を実施するための形態】
【００１６】
（１）搬送車システム
図１を用いて、本発明の一実施形態が採用された搬送車システム１について説明する。図１は、本発明の一実施形態が採用された搬送車システムの模式図である。
【００１７】
搬送車システム１は、軌道２と、軌道２上を走行する搬送車３と有している。この実施形態では、軌道２は天井から吊り下げられており、さらに、軌道２の周囲はクリーンルームになっている。
【００１８】
軌道２は、走行レール４とガイドレール６を有している。走行レール４は、左右の第１走行レール４ａ及び第２走行レール４ｂから構成されている。第１走行レール４ａ及び第２走行レール４ｂは、平坦な走行面を有している。
【００１９】
ガイドレール６は、第１ガイドレール６ａ及び第２ガイドレール６ｂを有している。第１ガイドレール６ａ及び第２ガイドレール６ｂは、第１走行レール４ａ及び第２走行レール４ｂの外側端にそれぞれ設けられている。第１ガイドレール６ａ及び第２ガイドレール６ｂは上方に延びている。
【００２０】
また、第１走行レール４ａ及び第２走行レール４ｂに沿って、図示しない給電線が設けられている。
【００２１】
図２を用いて、搬送車システム１のレイアウトを説明する。図２は、搬送車システムの部分平面図である。軌道２は、図２に示すように、第１直線部２０１と、第１直線部２０１の先にある分岐部２０６と、分岐部２０６から右側に曲がるカーブ又は曲線部２０３と、分岐部２０６からそのまま直線状に延びる第２直線部２０２とを有している。以下、搬送車３の曲線部走行の説明には、曲線部２０３を曲線部の一例として用いる。
【００２２】
第１走行レール４ａと第２走行レール４ｂは、第１直線部２０１から、分岐部２０６を通って、第２直線部２０２と曲線部２０３の両方に分かれて延びている。
【００２３】
第１直線部２０１から第２直線部２０２に向かう部分の第１走行レール４ａには、分岐部２０６において第１ガイドレール６ａが設けられていない。さらに、第１直線部２０１から曲線部２０３に向かう部分の第２走行レール４ｂには、分岐部２０６において第２ガイドレール６ｂが設けられていない。
【００２４】
（２）搬送車
搬送車３は、搬送車本体１５と、駆動走行部１８と、従動走行部１９を有している。搬送車本体１５の構造は従来と同じであるので説明を省略する。駆動走行部１８及び従動走行部１９は、搬送車本体１５に対してそれぞれ回動自在に取り付けられるボギー台車である。図１には、駆動走行部１８の旋回軸中心３８が示されている。
【００２５】
図１を用いて、駆動走行部１８を説明する。駆動走行部１８は、主に、本体フレーム２０と、第１駆動輪ユニット２１と、第２駆動輪ユニット２２と、固定ガイドローラ機構（３１，３２）と、分岐ガイドローラ機構（３３，３４，３５）とを有している。
【００２６】
第１駆動輪ユニット２１は、本体フレーム２０の右側端部に装着されており、第１走行車輪２５と、第１モータ２６と、第１エンコーダ２７とを有している。第１走行車輪２５は、第１走行レール４ａの走行面の上に載っている。第１モータ２６は、第１走行車輪２５に連結されている。第１エンコーダ２７は、第１モータ２６の回転を計測して、パルス信号を送信する。これにより、第１モータ２６の回転速度や回転回数が得られる。
【００２７】
第２駆動輪ユニット２２は、本体フレーム２０の左側端部に装着されており、第２走行車輪２８と、第２モータ２９と、第２エンコーダ３０とを有している。第２走行車輪２８は、第２走行レール４ｂの走行面の上に載っている。第２モータ２９は第２走行車輪２８に連結されている。第２エンコーダ３０は、第２モータ２９の回転を計測して、パルス信号を送信する。これにより、第２モータ２９の回転速度や回転回数が得られる。
【００２８】
固定ガイドローラ機構（３１，３２）は、一対の第１固定ガイドローラ３１と、一対の第２固定ガイドローラ３２とを有している。一対の第１固定ガイドローラ３１は、本体フレーム２０の右側端部に走行方向前後に離れて配置されている。より具体的には、第１固定ガイドローラ３１は、第１走行車輪２５の走行方向前後両側に離れて配置され、第１ガイドレール６ａの内側に常に近接している。一対の第２固定ガイドローラ３２は、本体フレーム２０の左側端部に走行方向前後に離れて配置されている。より具体的には、第２固定ガイドローラ３２は、第２走行車輪２８の走行方向前後両側に離れて配置され、第２ガイドレール６ｂの内側に常に近接している。
【００２９】
分岐ガイドローラ機構（３３，３４，３５）は、分岐部２０６において分岐動作を行うための機構であり、一対の第１分岐ガイドローラ３３と、第２分岐ガイドローラ３４と、第１分岐ガイドローラ駆動部３５（図３）とを有している。
第１分岐ガイドローラ３３は、第１固定ガイドローラ３１に対応して配置されており、両者によって前側ガイドローラ対８１と後側ガイドローラ対８３を構成している。第２分岐ガイドローラ３４は、第２固定ガイドローラ３２に対応して配置されており、両者によって前側ガイドローラ対８５と後側ガイドローラ対８７とを構成している。第１分岐ガイドローラ駆動部３５（図３）は、第１分岐ガイドローラ３３と、第２分岐ガイドローラ３４の位置を変更するための機構である。
【００３０】
以上の構造により、第１分岐ガイドローラ駆動部３５（図３）によって、第１分岐ガイドローラ３３及び第２分岐ガイドローラ３４がガイド位置と非ガイド位置との間で移動する。ガイド位置では、第１分岐ガイドローラ３３及び第２分岐ガイドローラ３４は、第１ガイドレール６ａの外側に近接する。非ガイド位置では、第１分岐ガイドローラ３３及び第２分岐ガイドローラ３４は、第１ガイドレール６ａから上方に離れている。
【００３１】
従動走行部１９は、主に、本体フレーム２３と、第１従動輪３６と、第２従動輪３７と、第２固定ガイドローラ機構（４０，４１）と、第２分岐ガイドローラ機構（４２，４３，４４）とを有している。
第１従動輪３６は、走行レール４の第１走行レール４ａの上に載っている。第２従動輪３７は、走行レール４の第２走行レール４ｂの上に載っている。
【００３２】
第２固定ガイドローラ機構（４０，４１）は、一対の第３固定ガイドローラ４０と、一対の第４固定ガイドローラ４１とを有している。第３固定ガイドローラ４０は、本体フレーム２３の右側端部に走行方向前後に離れて配置されている。より具体的には、第３固定ガイドローラ４０は、第１従動輪３６の走行方向前後両側に離れて配置され、第１ガイドレール６ａの内側に常に近接している。第４固定ガイドローラ４１は、本体フレーム２３の左側端部に走行方向前後に離れて配置されている。より具体的には、第４固定ガイドローラ４１は、第２従動輪３７の走行方向前後両側に離れて配置され、第２ガイドレール６ｂの内側に常に近接している。
【００３３】
第２分岐ガイドローラ機構（４２，４３，４４）は、分岐部２０６において分岐動作を行うための機構であり、一対の第３分岐ガイドローラ４２と、第４分岐ガイドローラ４３と、第２分岐ガイドローラ駆動部４４（図３）とを有している。
【００３４】
第３分岐ガイドローラ４２は、第３固定ガイドローラ４０に対応して配置されている。第４分岐ガイドローラ４３は、第４固定ガイドローラ４１に対応して配置されている。第２分岐ガイドローラ駆動部４４（図３）は、第３分岐ガイドローラ４２と、第４分岐ガイドローラ４３の位置を変更するための機構である。
【００３５】
以上の構造により、第２分岐ガイドローラ駆動部４４（図３）によって、第３分岐ガイドローラ４２及び第４分岐ガイドローラ４３がガイド位置と非ガイド位置との間で移動する。ガイド位置では、第３分岐ガイドローラ４２及び第４分岐ガイドローラ４３は、第１ガイドレール６ａの外側に近接する。非ガイド位置では、第３分岐ガイドローラ４２及び第４分岐ガイドローラ４３は、第１ガイドレール６ａから上方に離れている。
【００３６】
搬送車３が図２において曲線部２０３を走行するときには、第１分岐ガイドローラ３３と第３分岐ガイドローラ４２はガイド位置に配置されている。一方、そのときに、第２分岐ガイドローラ３４及び第４分岐ガイドローラ４３は非ガイド位置に配置されている。なお、搬送車３が第１直線部２０１を走行するときには、各分岐ガイドローラは非ガイド位置及びガイド位置のいずれに配置されていてもよい。
【００３７】
（３）被検出部及びセンサ
図２を用いて、走行レール４に沿って設けられた複数種類の被検出部について説明する。被検出部は、反射テープ１１と、バーコード１３と、磁気マーク１４とを含んでいる。なお、図２では、反射テープ１１と、バーコード１３と、磁気マーク１４は、走行レール４の内側に図示されているが、実際には走行レール４上又はガイドレール６上面に設けられている。
反射テープ１１は、曲線部２０３において搬送車３の位置を検出するための部材であり、曲線部２０３に配置されている。なお、この実施形態では、反射テープ１１の開始端１１ａは、曲線部２０３の実際の開始位置２０３ａより走行方向手前に配置されている。また、反射テープ１１の終了端（図示せず）は、実際の曲線部の終了位置（図示せず）より手前に配置されている。
バーコード１３は、走行レール４の原点マーク及び複数の基準マークとして機能している。
磁気マーク１４は、搬送車３の停止位置を示す部材である。磁気マーク１４は、鋼などの磁性体や、銅やアルミなどの非磁性体で構成されている。この実施形態では、磁気マーク１４は、第１直線部２０１に配置されており、磁気マーク１４の中間が停止位置８０になっている。
【００３８】
駆動走行部１８及び従動走行部１９には、さらに、図３に示すように、光電センサ４７と、リニアスケール４９と、バーコードリーダ５０とが設けられている。光電センサ４７は、反射テープ１１を検出するためのものである。なお、図における光電センサ４７は、右側に曲がる曲線部を走行中の位置を検出するためのセンサであり、左側に曲がる曲線部用のセンサ（図示せず）は別に設けられている。リニアスケール４９は、磁気マーク１４を検出するためのものである。リニアスケール４９は、磁気マーク１４に対する搬送車３の絶対位置、言い換えれば磁気マーク１４を基準とする位置を求める。バーコードリーダ５０は、バーコード１３を検出するためのものである。
【００３９】
（４）制御構成
図３を用いて、搬送車システム１の制御構成を説明する。図３は、搬送車システムの制御構成を示すブロック構成図である。
【００４０】
搬送車システム１は、搬送車コントローラ５２を有している。搬送車コントローラ５２は、複数の搬送車３の走行を管理するためのコントローラである。搬送車コントローラ５２は搬送車３と交信可能である。搬送車コントローラ５２は、コントローラ本体５４と、メモリ５５を有している。コントローラ本体５４は、ＣＰＵ、ＲＡＭ、ＲＯＭ等からなりプログラムを実行するコンピュータである。メモリ５５内には、ルートマップが記憶されている。ルートマップとは、走行ルートの配置、原点の位置、原点を基準とする基準位置や移載位置の座標を記載したマップである。座標は、原点からの走行距離を搬送車のエンコーダの出力パルス数などに換算したものである。
【００４１】
搬送車３は、走行制御部５９を有している。走行制御部５９は、搬送車コントローラ５２からの指令に基づいて第１モータ２６と第２モータ２９に駆動信号を送信できる。走行制御部５９は、さらに、分岐制御部６０に接続されている。分岐制御部６０は、搬送車コントローラ５２からの指令に基づいて第１分岐ガイドローラ駆動部３５及び第２分岐ガイドローラ駆動部４４に駆動信号を送信できる。
【００４２】
（５）搬送車の走行制御系
図４を用いて、走行制御部５９を説明する。図４は、搬送車の走行制御部を示すブロック構成図である。
走行制御部５９は、ＣＰＵ、ＲＡＭ、ＲＯＭ等からなりプログラムを実行するコンピュータである。走行制御部５９は、ルートマップ６１と、速度パターン発生部６２と、第１モータ制御部６３と、第２モータ制御部６４、補償速度比率テーブル９０とを有している。ルートマップ６１と補償速度比率テーブル９０は、走行制御部５９内のメモリに保存されている。速度パターン発生部６２は、搬送車コントローラ５２と交信可能である。
さらに、走行制御部５９には、第１エンコーダ２７、第２エンコーダ３０、光電センサ４７，リニアスケール４９及びバーコードリーダ５０が接続されている。
【００４３】
走行制御部５９は、搬送車コントローラ５２から搬送指令を受け取ると、ルートマップ６１に基づいて現在位置から停止位置までの距離を求めて、当該距離を速度パターン発生部６２に入力する。速度パターン発生部６２は、ルートマップ６１上の現在位置の座標と、目的位置の座標との差から走行距離を算出し、これによって停止位置までの走行速度のパターンを発生する。
【００４４】
第１モータ制御部６３は、第１誤差増幅部６５Ａと、第１フィードバック制御部６６Ａと、第１アンプ６７Ａとを主に有している。第１誤差増幅部６５Ａは誤差を増幅する。第１フィードバック制御部６６Ａは、第１誤差増幅部６５Ａで求めた誤差に基づいて、例えばＰＩＤ制御又はＰＩ制御を行う。ＰＩＤ制御とＰＩ制御は切り替え可能である。第１アンプ６７Ａは、電流増幅された速度指令を第１モータ２６へ送信する。第１エンコーダ２７が、第１モータ２６の回転軸の回転数を検出し、これにより得られる第１走行車輪２５の現在位置と速度が、速度パターン発生部６２又は第１誤差増幅部６５Ａに入力される。なお、第１モータ制御部６３の構成は一実施例である。
【００４５】
第２モータ制御部６４は、第２誤差増幅部６５Ｂと、第２フィードバック制御部６６Ｂと、第２アンプ６７Ｂとを主に有している。第２誤差増幅部６５Ｂは誤差を増幅する。第２フィードバック制御部６６Ｂは、第２誤差増幅部６５Ｂで求めた誤差に基づいてＰＩＤ制御又はＰＩ制御を行う。ＰＩＤ制御とＰＩ制御は切り替え可能である。第２アンプ６７Ｂは、電流増幅された速度指令を第２モータ２９へ送信する。第２エンコーダ３０が、第２モータ２９の回転軸の回転数を検出し、これにより得られる第２走行車輪２８の現在位置と速度が、速度パターン発生部６２又は第２誤差増幅部６５Ｂに入力される。なお、第２モータ制御部６４の構成は一実施例であって、本発明はこれに限定されない。
【００４６】
（６）走行制御動作の概略説明
搬送車３は、一般的に、軌道２に沿って、ルートマップ６１から求めた所要走行距離と、第１エンコーダ２７及び第２エンコーダ３０から求めた現在位置ならびに現在速度により走行制御を行う。
【００４７】
搬送車３が曲線部２０３を走行する際の制御動作について説明する。曲線部２０３を走行する際には、一般的に、左右のモータが完全な同期を取れないことに起因して、走行軌跡が実際のカーブレールとは一致せず、走行車輪がガイドレールに衝突するなどの挙動不安定になる問題が考えられる。本発明はその問題を解決するための以下のような手段を用いている。
【００４８】
光電センサ４７からの検出結果ならびに第１エンコーダ２７及び第２エンコーダ３０からの検出結果を照合して、速度パターン発生部６２は、搬送車３の現在位置を確認する。速度パターン発生部６２は、現在位置情報及び補償速度比率テーブル９０（後述）を使用することで、適切な左右速度差が生じるように別個の目標速度信号を生成してそれらを第１モータ制御部６３及び第２モータ制御部６４にそれぞれ送信する。
【００４９】
速度パターン発生部６２は、一定速度で曲線部２０３に進入すると、内輪を減速して外輪を加速することで、搬送車３の中心速度を規定速度（例えば、６０ｍ／分）に合わせて走行させる。速度パターン発生部６２は、予め算出した補償速度比率テーブル９０を使用することで、演算効率を向上させており、処理負荷を軽減している。
【００５０】
以上より、搬送車３が曲線部２０３を走行する際には、左右のモータが完全な同期を取れないにもかかわらず、挙動が安定している。
【００５１】
（７）曲線部走行軌跡
速度パターン発生部６２は、理想的な曲線部走行軌跡テーブル９８を予め有している。曲線部走行軌跡は、ガイドローラがガイドレール形状を正確にトレースできる軌跡である。つまり、この軌跡においては、ガイドローラがガイドレールに接触することはない。
【００５２】
図５〜図８を用いて、曲線部走行軌跡の求め方を説明する。図５は、計算によって得られた理想的な走行軌跡を示す平面図である。図６は、図５の部分拡大図である。図７は、走行車輪の寸法関係を示す図である。図８は、曲線部におけるガイドレールとガイドローラの位置関係を模式的に示した図である。
【００５３】
理想的な曲線部走行軌跡は以下のようにして得られる。最初に、基準入口軌跡が求められる。具体的には、後側ガイドローラ対の位置ｘａを、開始位置２０３ａから前側ガイドローラ対８１と後側ガイドローラ対８３のピッチＬ以上に離れた位置まで、所定間隔Δｘａ分解能で旋回軸中心軌道Ｐ０、内輪軌道Ｐ１、外輪軌道Ｐ２の座標を求めていく。例えば、ｘａを変化させる区間の距離は、開始位置２０３ａから５００ｍｍであり、両ガイドローラ対のピッチＬが４８０ｍｍであり、Δｘａが０．０５ｍｍであり、Ｐ０、Ｐ１及びＰ２は１０００ヶ所分得られる。
【００５４】
具体的な計算式は以下の通りである。
最初に、旋回角度α２が算出される。なお、Ｒは第１ガイドレール６ａの半径であり、Ｌは両ガイドローラ対の前後ピッチであり、ｘａは後側ガイドローラ対のｘ座標であり、ｘＲは開始位置２０３ａのＸ座標である。
ｌ＝√（（ｘＲ−ｘａ）２＋Ｒ２）
Ｒ２＝ｌ２＋Ｌ２−２ｌＬｃｏｓα１
α１＝ｃｏｓ−１（（Ｒ２−ｌ２−Ｌ２）／（−２ｌＬ））
α０＝ｔａｎ−１Ｒ／（ｘＲ−ｘａ）
α２＝α０−α１
【００５５】
次に、旋回角度α２から、Ｐ０、Ｐ１及びＰ２の座標が算出される。
θ０＝θ００−α２
θ１＝θ１０−α２
θ２＝θ２０−α２
これより、Ｐ０、Ｐ１及びＰ２の座標は以下の通りになる。
Ｐ０（ｘ０，ｙ０）＝（ｘａ＋ｌ０ｃｏｓθ０，ｌ０ｓｉｎθ０）
Ｐ１（ｘ１，ｙ１）＝（ｘａ＋ｌ１ｃｏｓθ１，ｌ１ｓｉｎθ１）
Ｐ２（ｘ２，ｙ２）＝（ｘａ＋ｌ２ｃｏｓθ２，ｌ２ｓｉｎθ２）
Ｐ０、Ｐ１、Ｐ２のそれぞれの間隔が積算されることで、第１走行車輪２５、第２走行車輪２８、旋回軸中心３８の移動距離が得られる。
図８を用いて、曲線部入口におけるガイドレールとガイドローラの位置関係を説明する。前側ガイドローラ対８１同士の中間点を第１中間点９５として、後側ガイドローラ対８３同士の中間点を第２中間点９７とする。図８において、前側ガイドローラ対８１と後側ガイドローラ対８３は、第１直線部２０１において符号Ａで示され、前側ガイドローラ対８１が開始位置２０３ａに到達した位置にある状態を符号Ｂで示され、後側ガイドローラ対８３が開始位置２０３ａに到達した位置にある状態を符号Ｃで示され、曲線部２０３において符号Ｄで示されている。いずれの位置においても、第１中間点９５及び第２中間点９７は、第１ガイドレール６ａの幅方向中間に一致するようになっている。このようにして、第１ガイドレール６ａに対して両側のガイドローラが常に最大の隙間を空けるように配置される。
基準出口軌跡は、基準入口軌跡の計算結果から抽出される。具体的には、後側ガイドローラ対８３が曲線部２０３に入った地点を変化終了地点として検索し、そこから逆方向に並び替える。さらに、Ｐ１、Ｐ２それぞれの間隔が積算されることで、第１走行車輪２５、第２走行車輪２８、旋回軸中心３８の移動距離が得られる。
以上のようにして得られて基準入口軌跡と基準出口軌跡は、速度パターン発生部６２において、曲線部走行軌跡テーブル９８に記憶されている。
【００５６】
（８）速度比率テーブル
図９を用いて、速度パターン発生部６２が基準速度指令として利用しているカーブ走行時の基準速度比率テーブル（車輪速度変換テーブル）７０について説明する。基準速度比率テーブル７０は、カーブ走行の時間に対する左右の駆動輪の基準速度比率を定めたテーブルであって、カーブ入口における第１速度比率変化区間１０１と、カーブ出口における第２速度比率変化区間１０２と、カーブ中間における速度比率一定区間１０３とを有している。
【００５７】
カーブ開始点では内輪と外輪の速度比率はいずれも１００％である。そして、第１速度比率変化区間１０１では、基準外輪速度比率７１が大きくなるにつれて、基準内輪速度比率７３が小さくなっていく。そして、基準外輪速度比率７１が１００＋α％（例えば、合計１１５％）になりさらに基準内輪速度比率７３が１００−α％（例えば、合計８５％）になると、その状態が速度比率一定区間１０３で続く。そして、最後に、第２速度比率変化区間１０２では、基準外輪速度比率７１が小さくなっていき、それにつれて基準内輪速度比率７３が大きくなっていき、最後に両者が１００％になる。
なお、上記のαの値は、左右の駆動車輪間隔とカーブ曲率に従って異なるように設定されている。
【００５８】
次に、基準速度比率テーブル７０の作成方法について説明する。速度パターン発生部６２は、基準軌跡の出力から、旋回軸中心Ｐ０での移動速度が設定された一定の値（例えば、６０ｍ／分）となるように、Ｐ１、Ｐ２位置を時間軸基準で抽出する。具体的には、Ｐ０位置で区切って、曲線部入口からで出口までの速度パターンを発生する。時間軸の分解能であるΔｔはΔｘａより十分に大きくなることが必要であり、例えば１ミリ秒である。Ｐ０位置による境界条件分け及び速度パターン作成方法は、以下の通りである。
・直線部定速移動・・・Ｐ０と平行移動
・入口（二輪差速度差開始位置１〜二輪差速度差終了位置１）・・・基準入口軌跡から抽出
・カーブ中定速移動・・カーブ速度参照（カーブ半径から単純計算）
・出口（二輪差速度差開始位置２〜二輪差速度差終了位置２）・・・基準出口軌跡から抽出
・直線部定速移動・・・Ｐ０と平行移動
【００５９】
搬送車３が図２において曲線部２０３を走行するときには、内輪側すなわちガイドレールを保持している側では、第１モータ制御部６３の第１フィードバック制御部６６Ａが、第１モータ２６に対して継続してＰＩＤ制御を行っている。それに対して、外輪側すなわちガイドレールを保持していない側では、第２モータ制御部６４の第２フィードバック制御部６６ＢがＰＩＤ制御からＰＩ制御に切り替えられている。つまり、曲線部走行時には、第１モータ２６はＰＩＤ制御され、第２モータ２９はＰＩ制御される。理想軌跡を走行するように速度指令を形成するにもかかわらず、このように内輪ＰＩＤ−外輪ＰＩ制御を残す理由は、レール形状誤差及び据え付け誤差からガイドローラがガイドレールに接触することはあり得るので、その接触時の負荷を減らすためである。
【００６０】
次に、基準速度指令に対するサーボ追従補償を説明する。サーボ追従補償は、基準速度指令に対して、フィードフォワード制御を加えることで、内輪ＰＩＤ−外輪ＰＩ制御に起因する左右輪の差を補償するために行われる。本実施形態で採用されたサーボ追従補償のパラメータは、レスポンスと偏差である。レスポンスとは、挙動変化開始時の遅れ時間及び挙動変化終了時の遅れ時間である。偏差とは、曲線部一定速度到達時点の所望速度に対するパーセンテージである。
【００６１】
図９を用いて、速度パターン発生部６２がサーボ追従補償を行った速度度指令として利用しているカーブ走行時の補償速度比率テーブル９０について説明する。補償速度比率テーブル９０は、補償外輪速度比率９１と補償内輪速度比率９３とを有している。補償外輪速度比率９１は、基準外輪速度比率７１に比べて、挙動変化開始時及び挙動変化終了時が早くなっている。補償内輪速度比率９３も、基準内輪速度比率７３に比べて、挙動変化開始時及び挙動変化終了時が早くなっている。補償外輪速度比率９１は、補償内輪速度比率９３に比べても、挙動変化開始時及び挙動変化終了時が早くなっている。
さらに、補償外輪速度比率９１は、基準外輪速度比率７１に比べて、一定速度の大きさが大きくなっている。
【００６２】
補償速度比率テーブル９０は、以下のようにして作成される。最初に、時間遅れと、速度偏差は、別途行われた実験によって得られる。速度パターン発生部６２は、時間領域で基準入口軌跡と基準出口軌跡を作成し、さらに、基準速度指令から境界時間を抽出する。さらに、速度パターン発生部６２は、例えば、時間領域で単純に直線補完することで、補償テーブルを作成する。
速度パターン発生部６２は、補償テーブルから、境界時間で区切って曲線部入口から出口までの速度パターンを生成する。
時間による境界条件分け及び速度パターン作成方法は以下の通りである。
・直線部定速移動・・・Ｐ０と平行移動
・入口（二輪差速度差開始時間１〜二輪差速度差終了時間１）・・・補償入口軌跡から抽出
・カーブ中定速移動・・カーブ速度参照（カーブ半径から単純計算）
・出口（二輪差速度差開始時間２〜二輪差速度差終了時間２）・・・補償出口軌跡から抽出
・直線部定速移動・・・Ｐ０と平行移動
【００６３】
（９）曲線部走行制御の詳細説明
以下、図１０〜図１３を用いて、速度パターン発生部６２の制御動作を説明する。図１０は、曲線部走行時の走行制御部の動作を示すフローチャートである。図１１〜１２は、加速しながらカーブに進入する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフである。図１１〜図１３では、実線を用いて内輪速度、外輪速度及び旋回軸中心速度を示しており、２点鎖線を用いて補償速度比率テーブル９０を示している。なお、これらの図では、補償速度比率テーブル９０は、速度比率が速度に一致するように描かれている。
図において、Ｖ１は速度比率一定区間１０３において想定される内輪速度の最大値を表しており、Ｖ２は速度比率一定区間１０３において想定される外輪速度の最大値を表しており、Ｖｃは速度比率一定区間１０３において想定される旋回軸中心速度の最大値を表している。
以下の説明では、図１１〜図１３に示すように、搬送車３が第１直線部２０１から発進して一定の加速度ａ０１で曲線部２０３に進入する場合の動作を説明する。このときの加速度ａ０１は、許容される最大値又はその近傍であってもよい。
なお、速度パターン発生部６２は、曲線部２０３に入る前からも速度指令を第１モータ２６及び第２モータ２９に与え続けている。
【００６４】
ステップＳ１では、速度パターン発生部６２は、曲線部２０３の開始位置２０３ａに到達するのを待つ。開始位置２０３ａに到達したことは、光電センサ４７が反射テープ１１の開始端１１ａを検出することによって把握される。なお、このとき、図１１において、走行車輪の速度はｖである。
【００６５】
ステップＳ２では、速度パターン発生部６２は、搬送車３が加速しているか否か（この場合は、加速していない場合としては、一定速度で走行しているとする）を判断する。「Ｙｅｓ」であればプロセスはステップＳ３に移行し、「Ｎｏ」であればプロセスは通常カーブ走行制御に移行する。通常カーブ走行制御では、旋回軸中心速度に対して補償速度比率テーブル９０が乗算されることで内輪速度と外輪速度が決定される。
【００６６】
ステップＳ３では、速度パターン発生部６２は、現在の加速度ａ０１を続けた場合に外輪が第１速度比率変化区間１０１を走行するのにかかる時間ｔ１１を算出する。なお、この実施形態ではｔ１１を算出するための加速度は、ａ０１と同じであってもよいが、それ未満であってもよい。
また、速度パターン発生部６２は、基準速度に対して補償速度比率テーブル９０を乗算して内輪速度を算出する。したがって、内輪速度は、外輪速度より通常の速度差（基準速度と内輪速度との差）分以上を減らした速度となる。
【００６７】
ステップＳ４では、速度パターン発生部６２は、ｔ１１経過までの間の旋回軸中心３８の加速度ａ１１を求める。具体的には、最初に、速度パターン発生部６２は、ｔ１１経過時の外輪速度と補償速度比率テーブル９０から、ｔ１１経過時の旋回軸中心速度ｖ１１を算出する。次に、速度パターン発生部６２は、ｖ、ｖ１１及びｔ１１に基づいて、ｔ１１までの間の旋回軸中心３８の加速度ａ１１を算出する。具体的には、ａ１１＝（ｖ１１−ｖ）／ｔ１１の式が用いられる。なお、図から明らかなようにａ１１はａ０１より小さくなっている。
【００６８】
ステップＳ５では、速度パターン発生部６２は、第１速度比率変化区間１０１内で外輪速度が外輪最大速度Ｖ２になるか否かを判断する。「Ｎｏ」であればプロセスはステップＳ６に移行し、「Ｙｅｓ」であればプロセスはステップＳ１７に移行する。
【００６９】
ステップＳ６では、速度パターン発生部６２は、旋回軸中心速度に基づいた基準速度指令を発生する。
【００７０】
ステップＳ７では、速度パターン発生部６２は、補償速度比率テーブル９０を用いて基準速度指令を左右速度差指令に変換する。具体的には、曲線部２０３における搬送車３の位置と補償速度比率テーブル９０により該当位置の乗率を求めて、現在の基準速度に乗率を乗じることで、該当位置での内輪速度及び外輪速度を算出する。つまり、旋回軸中心速度に対して補償外輪速度比率９１の値を積算することで外輪速度指令を作成し、さらに旋回軸中心速度に対して補償内輪速度比率９３の値を積算することで内輪速度指令を作成する。
【００７１】
ステップＳ８では、速度パターン発生部６２は、左右速度差指令を第１モータ制御部６３と第２モータ制御部６４にそれぞれ出力する。
【００７２】
ステップＳ９では、速度パターン発生部６２は、旋回軸中心速度がｔ１１経過の前に基準速度Ｖｃに到達したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ１０に移行し、「Ｙｅｓ」であればプロセスはステップＳ２２に移行する。
【００７３】
ステップＳ１０では、速度パターン発生部６２は、ｔ１１が経過したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ６に戻り、「Ｙｅｓ」であればプロセスはステップＳ１１に移行する。以上より、旋回軸中心速度が基準速度Ｖｃに到達するか又はｔ１１が経過するまで、ステップＳ６〜８が繰り返し実行される。
【００７４】
ステップＳ１１では、速度パターン発生部６２は、外輪が現在の加速度ａ０１を続けた場合に外輪の速度が外輪最大速度Ｖ２に到達するまでの時間ｔ１２を算出する。なお、ｔ１２を算出するための加速度は、ａ０１と同じであってもよいが、それ未満であってもよい。
【００７５】
ステップＳ１２では、速度パターン発生部６２は、Ｖｃ、ｖ１１及びｔ１２に基づいて、ｔ１２までの間の旋回軸中心３８の加速度ａ１２を求める。具体的には、ａ１２＝（Ｖｃ−ｖ１１）／ｔ１２の式が用いられる。図から明らかなようにａ１２は、ａ０１より小さく、かつａ１１より大きい。
【００７６】
ステップＳ１３では、速度パターン発生部６２は、旋回軸中心速度に基づいた基準速度指令を発生する。
【００７７】
ステップＳ１４では、速度パターン発生部６２は、ｔ１２経過後に外輪の速度が外輪最大速度Ｖ２になるようにかつ内輪が内輪最大速度Ｖ１になるように変化していく左右の速度指令を発生する。
【００７８】
ステップＳ１５では、速度パターン発生部６２は、左右速度差指令を第１モータ制御部６３と第２モータ制御部６４にそれぞれ出力する。
【００７９】
ステップＳ１６では、速度パターン発生部６２は、ｔ１２が経過したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ１３に戻り、「Ｙｅｓ」であればプロセスは通常カーブ走行制御に移行する。以上より、ｔ１２が経過するまで、ステップＳ１３〜Ｓ１５が繰り返し実行される。
【００８０】
次に、図１２を用いて、第１速度比率変化区間１０１において外輪の速度が外輪最大速度Ｖ２に達してしまう場合の制御動作であるステップＳ１７〜ステップＳ２１を説明する。
【００８１】
図１０のステップＳ１７では、速度パターン発生部６２は、旋回軸中心３８の第１速度比率変化区間１０１における加速度ａ１１を再計算する。具体的には、速度パターン発生部６２は、Ｖ２、ｖ及びｔ１１に基づいて、ｔ１１までの間の旋回軸中心３８の加速度ａ１１を求める。具体的には、ａ１１＝（Ｖ２−ｖ）／ｔ１１である。この結果、外輪の速度がｔ１１経過時すなわち第１速度比率変化区間１０１終了時に外輪最大速度Ｖ２となる。図１２から明らかなように、ｔ１１の間における外輪の加速度ａ０１’は、カーブ進入時の外輪の加速度ａ０１より小さい。
【００８２】
ステップＳ１８では、速度パターン発生部６２は、旋回軸中心速度に基づいた基準速度指令を発生する。
【００８３】
ステップＳ１９では、速度パターン発生部６２は、ｔ１１経過後に外輪の速度が外輪最大速度Ｖ２になるようにかつ内輪の速度が内輪最大速度Ｖ１になるように変化していく左右の速度指令を発生する。
【００８４】
ステップＳ２０では、速度パターン発生部６２は、左右速度差指令を第１モータ制御部６３と第２モータ制御部６４にそれぞれ出力する。
【００８５】
ステップＳ２１では、速度パターン発生部６２は、ｔ１１が経過したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ１８に戻り、「Ｙｅｓ」であればプロセスは通常カーブ走行制御に移行する。以上より、ｔ１１が経過するまで、ステップＳ１８〜ステップＳ２０が繰り返し実行される。
【００８６】
次に、図１３を用いて、第１速度比率変化区間１０１において旋回軸中心３８の速度が基準速度Ｖｃに達してしまう場合の制御動作であるステップＳ２２〜ステップＳ２５を説明する。
【００８７】
図１０のステップＳ２２〜ステップＳ２４では、速度パターン発生部６２は、旋回軸中心の基準速度指令を発生し、さらに内外輪速度指令を作成し、最後にそれらをモータに送信する。より具体的には、速度パターン発生部６２は、旋回軸中心３８の速度が基準速度Ｖｃになるまでは、旋回軸中心３８の加速度ａ１１が維持されるように旋回軸中心３８の基準速度指令を発生し、さらに内外輪速度指令を作成する。そして、速度パターン発生部６２は、旋回軸中心３８の速度が旋回軸中心最大速度Ｖｃになると以後は、旋回軸中心３８の速度を一定に維持する。さらに、速度パターン発生部６２は、外輪速度についてはそれまでの加速度が維持されるように設定する。そして、速度パターン発生部６２は、内輪速度については、旋回軸中心速度を中心に外輪速度と対称となるように設定する。
【００８８】
ステップＳ２５では、速度パターン発生部６２は、外輪の速度が外輪最大速度Ｖ２に到達したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ２２に戻り、「Ｙｅｓ」であればプロセスは通常カーブ走行制御に移行する。以上より、外輪の速度が外輪最大速度Ｖ２に到達するまで、ステップＳ２２〜Ｓ２４が繰り返し実行される。
【００８９】
（１０）カーブの途中から発進した場合
図１４を用いて、曲線部２０３の途中から搬送車３が発進した場合の速度制御について説明する。図１４は、カーブ中から発進した場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフである。
【００９０】
この実施形態では、搬送車３は曲線部２０３において第１速度比率変化区間１０１からスタートする。この場合、速度パターン発生部６２は、外輪の加速度ａ０１を基準にして、外輪の速度が外輪最大速度Ｖ２に達したときに旋回軸中心３８が基準速度Ｖｃに達し内輪の速度が内輪最大速度Ｖ１に達するように、旋回軸中心３８の加速度ａ１１及び内輪の加速度ａ１２を決定する。そして、速度パターン発生部６２は、上述の加速度が実現されるような速度指令を内輪と外輪に与え続ける。
【００９１】
（１１）カーブ出口における速度制御
図１５を用いて、搬送車３が曲線部２０３を減速しながら退出していく場合の速度制御を説明する。図１５は、減速しながらカーブから退出する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフである。
【００９２】
速度パターン発生部６２は、減速を開始すると、現在の減速度ａ０２を続けた場合に外輪の速度が０になるまでにかかる時間ｔ２１を算出する。具体的には、ｔ２１＝Ｖ２／ａ０１が用いられる。なお、ｔ２１を算出するための減速度は、ａ０２と同じであってもよいが、それ未満であってもよい。
【００９３】
速度パターン発生部６２は、第２速度比率変化区間１０２での旋回軸中心３８の減速度ａ２１を求める。具体的には、最初に、速度パターン発生部６２は、ｔ２１経過後に旋回軸中心３８の速度がゼロになるような減速度ａ２１を求め、そのような減速度が実現されるように旋回軸中心の速度指令を生成する。
【００９４】
反射テープＯＦＦ時には、速度パターン発生部６２は、第２速度比率変化区間１０２が終了するまでの時間であるｔ２２を求め、さらに、ｔ２２経過時の速度ｖ２２を求める。さらに、ｖ２２からｔ２２中の減速度ａ２２を求める。ａ２２＝（ｖ２２−ｖ１１）／ｔ２２である。
【００９５】
速度パターン発生部６２は、減速度ａ２２が維持されるように旋回軸中心の基準速度指令を発生する。さらに、速度パターン発生部６２は、基準速度指令に速度パターン発生部６２を乗算して左右の車輪の速度を算出し、その速度指令を各モータに与える。
搬送車が曲線部の終了点に達すると、速度パターン発生部６２は、旋回軸中心３８の減速度がａ０１になるように速度指令を生成する。このときに、左右の車輪の速度は旋回軸中心３８の速度と一致する。
【００９６】
前記実施形態では曲線部への進入及び退出において加減速度を許容最大値又はそれに近い値にしていても、曲線部の入口及び出口において加減速度の最大値を超えることがない。したがって、モータに過負荷が生じにくい。また、曲線部への進入及び退出において加減速度を許容最大値又はそれに近い値にできるので、走行効率が低下しない。
【００９７】
（１２）特徴
前記実施形態は下記のようにも表現できる。
（Ａ）搬送車システム１は、予め定められた経路を走行する搬送車３と、搬送車３の走行を制御する走行制御部５９とを備えている。搬送車３は、搬送車本体１５と、搬送車本体１５の左右に設けられた２個の走行車輪２５，２８と、２個の走行車輪２５，２８にそれぞれ接続された２個のモータ２６，２９と、を有している。走行制御部５９は、速度パターン発生部６２と、光電センサ４７と、を有している。速度パターン発生部６２は、搬送車３が曲線部２０３を走行するときに２個の走行車輪２５，２８に対して基準速度に対して内外輪に対してそれぞれ速度差が生じるように、曲線部２０３の中間にある速度比率一定区間１０３と曲線部２０３の両端にある速度比率変化区間１０１，１０２とにおいて速度指令を発生して２個のモータ２６，２９に与える。光電センサ４７は、搬送車３が曲線部２０３を走行していることを検出可能である。
図１１に示すように、速度パターン発生部６２は、搬送車３が加速中に曲線部２０３に進入することを光電センサ４７が検出すれば、第１速度比率変化区間１０１において、外輪となる走行車輪に対応するモータに対して進入時の加速度ａ０１以下の加速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が加速しながら曲線部２０３に進入した場合に、外輪となるモータに高負荷がかからない。
【００９８】
（Ｂ）速度パターン発生部６２は、加速中に曲線部２０３への進入を光電センサ４７が検出すれば、外輪となる走行車輪に対応するモータが現加速度を維持すれば第１速度比率変化区間１０１内で外輪最大速度Ｖ２に到達するか否かを判断する。図１１に示すように外輪最大速度Ｖ２に達しないと判断されれば、速度パターン発生部６２は、外輪となる走行車輪に対応するモータに対して現加速度ａ０１を維持するような速度指令を生成して与える。
この搬送車システム１では、速度パターン発生部６２において計算負荷が高くならない。
【００９９】
（Ｃ）上記の場合に最大速度に達すると判断されれば、図１２に示すように、速度パターン発生部６２は、第１速度比率変化区間１０１の終了点以降で外輪となる走行車輪が外輪最大速度Ｖ２になるような速度指令を生成して、外輪となる走行車輪に対応するモータに対して速度指令を与える。
この搬送車システム１では、外輪となる走行車輪に対応するモータが現加速度ａ０１を維持すれば第１速度比率変化区間１０１内で外輪最大速度Ｖ２に到達してしまう場合でも、外輪となる走行車輪が外輪最大速度Ｖ２を超えることが防止される。
【０１００】
（Ｄ）図１５に示すように、速度パターン発生部６２は、搬送車３が減速中に曲線部２０３から退出することを検出部が検出すれば、第２速度比率変化区間１０２において、外輪となる走行車輪に対応するモータに対して退出時の減速度ａ０２以下の減速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が減速しながら曲線部２０３から退出した場合に、外輪となる走行車輪に対応するモータに高負荷がかからない。
【０１０１】
（１３）他の実施形態
以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。特に、本明細書に書かれた複数の実施形態及び変形例は必要に応じて任意に組み合せ可能である。
【０１０２】
（ａ）搬送車が減速しながら曲線部に進入する場合
速度パターン発生部６２は、搬送車３が減速中に曲線部２０３に進入することを検出部が検出すれば、第１速度比率変化区間１０１において、内輪となる走行車輪に対応するモータに対して進入時の減速度以下の減速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が減速しながら曲線部２０３から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
【０１０３】
（ｂ）搬送車が加速しながら曲線部から退出する場合
速度パターン発生部６２は、搬送車３が加速中に曲線部２０３から退出することを検出部が検出すれば、第２速度比率変化区間１０２において、内輪となる走行車輪に対応するモータに対して退出時の加速度以下の加速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が加速しながら曲線部２０３から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
（ｃ）前記実施形態では、搬送車が曲線部の開始と終了をセンサによって検出していたが、本発明はこれに限定されない。例えば、搬送車がエンコーダによってソフト的に判断してもよい。
（ｄ）前記実施形態では反射テープは曲線部に沿って連続的に設けられていたが、本発明はこれに限定されない。反射テープは断続的に設けられていてもよい。
（ｅ）前記実施形態では搬送車は天井から吊り下げられた軌道上を走行していたが、本発明はこれに限定されない。軌道は地上に設けられていてもよいし、搬送車が軌道から吊り下げられていてもよい。
（ｆ）前記実施形態ではエンコーダはモータの回転を計測していたが、本発明はこれに限定されない。エンコーダは駆動輪又は従動輪の回転を計測してもよい。
（ｇ）被検出部及びセンサの組み合せの種類及び検出目的は、前記実施形態に限定されない。
（ｈ）被検出部の設置位置や数は、前記実施形態に限定されない。
（ｉ）前記実施形態では、補償速度比率テーブルを用いて左右速度差指令を形成していたが、基準速度比率テーブルを用いて左右速度差指令を形成してもよい。その場合でも、速度パターン発生部は、搬送車が曲線部を走行するときに、理想的な走行軌跡に基づいて作成した速度指令を第１モータ及び第２モータに与えているので、曲線部において前側ガイドローラ対及び後側ガイドローラ対はガイドレールに接触しにくい。
（ｊ）前記実施形態はサーボ追従補償のパラメータはレスポンスと偏差であるが、いずれか一方であってもよい。
（ｋ）前記実施形態では車体の前側に駆動走行部を設けさらに後側に従動走行部を設けた搬送車システムを説明したが、本発明はそれに限定されない。例えば、前側と両側を駆動走行部とすることで、４輪駆動台車とした構造にも本発明を適用できる。その場合、各駆動部は、それぞれ独立して左右モータの速度指令を作成することが好ましい。なお、４輪駆動台車以外に、６輪駆動台車、８輪駆動台車にも本発明を適用できる。
（ｌ）前記実施形態では、進入と退出及び加速と減速の全ての組合せについて制御動作を説明したが、全ての制御動作が一台の搬送車において実現される必要はない。
【産業上の利用可能性】
【０１０４】
本発明は、左右の車輪に別個にモータが設けられて独立して車輪を駆動可能な搬送車に広く適用できる。
【符号の説明】
【０１０５】
１ 搬送車システム
２ 軌道
３ 搬送車
４ 走行レール
４ａ 第１走行レール
４ｂ 第２走行レール
６ ガイドレール
６ａ 第１ガイドレール
６ｂ 第２ガイドレール
１１ 反射テープ
１１ａ 開始端
１３ バーコード
１４ 磁気マーク
１５ 搬送車本体（車体）
１８ 駆動走行部
１９ 従動走行部
２０ 本体フレーム
２１ 第１駆動輪ユニット
２２ 第２駆動輪ユニット
２３ 本体フレーム
２５ 第１走行車輪
２６ 第１モータ
２７ 第１エンコーダ
２８ 第２走行車輪
２９ 第２モータ
３０ 第２エンコーダ
３１ 第１固定ガイドローラ
３２ 第２固定ガイドローラ
３３ 第１分岐ガイドローラ
３４ 第２分岐ガイドローラ
３５ 第１分岐ガイドローラ駆動部
３６ 第１従動輪
３７ 第２従動輪
３８ 旋回軸中心
４０ 第３固定ガイドローラ
４１ 第４固定ガイドローラ
４２ 第３分岐ガイドローラ
４３ 第４分岐ガイドローラ
４４ 第２分岐ガイドローラ駆動部
４７ 光電センサ（検出部）
４９ リニアスケール
５０ バーコードリーダ
５２ 搬送車コントローラ
５４ コントローラ本体
５５ メモリ
５９ 走行制御部（制御部）
６０ 分岐制御部
６１ ルートマップ
６２ 速度パターン発生部（速度指令発生部）
６３ 第１モータ制御部
６４ 第２モータ制御部
６５Ａ 第１誤差増幅部
６５Ｂ 第２誤差増幅部
６６Ａ 第１フィードバック制御部
６６Ｂ 第２フィードバック制御部
６７Ａ 第１アンプ
６７Ｂ 第２アンプ
７０ 基準速度比率テーブル
７１ 基準外輪速度比率
７３ 基準内輪速度比率
８０ 停止位置
８１ 前側ガイドローラ対
８３ 後側ガイドローラ対
８５ 前側ガイドローラ対
８７ 後側ガイドローラ対
９０ 補償速度比率テーブル（速度指令変換テーブル）
９１ 補償外輪速度比率
９３ 補償内輪速度比率
９５ 第１中間点
９７ 第２中間点
９８ 曲線部走行軌跡テーブル
１０１ 第１速度比率変化区間
１０２ 第２速度比率変化区間
１０３ 速度比率一定区間
２０１ 第１直線部
２０２ 第２直線部
２０３ 曲線部
２０３ａ 開始位置
２０６ 分岐部
【技術分野】
【０００１】
本発明は、搬送車システムに関し、特に、左右の車輪を独立して駆動可能な搬送車が用いられた搬送車システムに関する。
【背景技術】
【０００２】
大型化したガラス基板やそれが複数枚収納されたカセットを搬送するための搬送車が知られている。搬送車は、工場のクリーンルーム内を自動走行して、処理装置間で物品を搬送する。搬送車が走行する軌道は、例えば、天井から吊り下げられたレールであり、この場合にレール及び搬送車が走行する空間はクリーンルームになっている。
搬送車は、左右両側に車輪を有しており、一方の車輪にモータが接続されて駆動輪になっており、他方の車輪が従動輪になっている。搬送車は、さらに、左右のガイドレールにガイドされるためのガイドローラを有している。
また、左右の車輪に別個のモータを接続して、搬送車がカーブを走行する際には、左右の車輪に適切な速度差が生じさせるようにした二輪差速度制御を行う搬送車システムも知られている（例えば、特許文献１を参照。）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２００８−５２３２３号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
従来の搬送車では、左右２輪駆動の搬送車構造において、カーブ走行時に外輪と内輪に異なる速度にするために、それぞれ独立した速度指令が各モータに与えられている。各速度指令は、中心速度に対して、予め用意された左右速度差変換テーブル（中心速度に対する内輪と外輪の速度比率）を乗算することで生成される。
各モータには、機械特性的に許容できる加速度が定まっている。しかし、曲線部走行時に加速する場合に直線走行時の加速度（例えば、最大加速度）が生じるように速度指令を生成すると、外輪側のモータの加減速度が上限値を超えてしまうことになる。つまり、外輪側のモータが過負荷になってしまい、場合によってはサーボアンプの許容負荷を超えてモータが異常状態になることも考えられる。
【０００５】
本発明の課題は、左右の車輪を独立して駆動可能な搬送車において、曲線部走行時にモータの過負荷を防止することにある。
【課題を解決するための手段】
【０００６】
以下に、課題を解決するための手段として複数の態様を説明する。これら態様は、必要に応じて任意に組み合せることができる。
【０００７】
本発明の一見地に係る搬送車システムは、予め定められた経路を走行する搬送車と、搬送車の走行を制御する制御部とを備えている。搬送車は、車体と、車体の左右に設けられた２個の走行車輪と、２個の走行車輪にそれぞれ接続された２個のモータと、を有している。制御部は、速度指令発生部と、検出部と、を有している。速度指令発生部は、搬送車が曲線部を走行するときに基準速度に対して内外輪にそれぞれ速度差が生じるように、曲線部の中間にある内外輪速度比率一定区間と曲線部の両端にある内外輪速度比率変化区間とにおいて速度指令を発生して２個のモータに与える。検出部は、搬送車が曲線部を走行していることを検出可能である。速度指令発生部は、搬送車が加速中に曲線部に進入することを検出部が検出すれば、内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して進入時の加速度以下の加速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。つまり、内輪となる走行車輪に対応するモータに与えられる速度指令は、内輪となる走行車輪の速度が外輪となる走行車輪の速度より速度差分以上を減らした速度となるような値である。
この搬送車システムでは、搬送車が加速しながら曲線部に進入した場合に、外輪となるモータに高負荷がかからない。
【０００８】
制御部は、加速中に曲線部への進入を検出部が検出すれば、外輪となる走行車輪に対応するモータが現加速度を維持すれば内外輪速度比率変化区間内で最大速度に到達するか否かを判断する判断部をさらに有していてもよい。最大速度に達しないと判断部が判断すれば、速度指令発生部は、外輪となる走行車輪に対応するモータに対して現加速度を維持するような速度指令を生成して与える。
この搬送車システムでは、速度指令発生部において計算負荷が高くならない。
【０００９】
速度指令発生部は、上記の場合に最大速度に達すると判断されれば、内外輪速度比率変化区間の終了点以降で外輪となる走行車輪が最大速度になるような速度指令を生成して、外輪となる走行車輪に対応するモータに対して速度指令を与えてもよい。
この搬送車システムでは、外輪となる走行車輪に対応するモータが現加速度を維持すれば内外輪速度比率変化区間内で最大速度に到達してしまう場合でも、外輪が最大速度を超えることが防止される。
【００１０】
速度指令発生部は、搬送車が減速中に曲線部から退出することを検出部が検出すれば、内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して退出時の減速度以下の減速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与えてもよい。つまり、内輪となる走行車輪に対応するモータに与えられる速度指令は、内輪となる走行車輪の速度が外輪となる走行車輪の速度より速度差分以上を減らした速度となるような値である。
この搬送車システムでは、搬送車が減速しながら曲線部から退出した場合に、外輪となる走行車輪に対応するモータに高負荷がかからない。
【００１１】
速度指令発生部は、搬送車が減速中に曲線部に進入することを検出部が検出すれば、内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して進入時の減速度以下の減速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与えてもよい。つまり、外輪となる走行車輪に対応するモータに与えられる速度指令は、外輪となる走行車輪の速度が内輪となる走行車輪の速度より速度差分以上を増やした速度となるような値である。
この搬送車システムでは、搬送車が減速しながら曲線部から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
【００１２】
速度指令発生部は、搬送車が加速中に曲線部から退出することを検出部が検出すれば、内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して退出時の加速度以下の加速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与えてもよい。つまり、外輪となる走行車輪に対応するモータに与えられる速度指令は、外輪となる走行車輪の速度が内輪となる走行車輪の速度より速度差分以上を増やした速度となるような値である。
この搬送車システムでは、搬送車が加速しながら曲線部から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
【００１３】
搬送車システムは、経路に沿って設けられたガイドレールをさらに備えていてもよい。その場合、搬送車は、走行車輪の前側及び後側にそれぞれ設けられた前側ガイドローラ対及び後側ガイドローラ対をさらに有している。制御部は、搬送車が曲線部を走行するときに前側ガイドローラ対及び後側ガイドローラ対がガイドレールに接触しない走行軌跡情報を保持している。速度指令発生部は、走行軌跡情報に基づいて速度指令発生のための速度指令変換テーブルを作成する。
搬送車が曲線部を走行するときには、前側ガイドローラ対及び後側ガイドローラ対がガイドレールに近接したガイド位置にある。一方、制御部は、搬送車が曲線部を走行するときに、理想的な走行軌跡情報に基づいて作成した速度指令変換テーブルを利用して速度指令を作成している。したがって、前側ガイドローラ対及び後側ガイドローラ対は曲線部においてガイドレールに接触しにくい。従来であれば曲線部の入口と出口において搬送車の前側ガイドローラ対及び後側ガイドローラ対がガイドレールに接触することを前提とした制御を行っていたので、両者の衝突や摩擦の問題が大きかった。それに対しては、この搬送車システムでは、曲線部の入口と出口において搬送車の前側ガイドローラ対及び後側ガイドローラ対がガイド位置にあってもガイドレールに接触しないように積極的に制御をしている。したがって、ガイドローラがガイドレールに接触しにくい。
【発明の効果】
【００１４】
本発明に係る搬送車システムでは、左右の車輪を独立して駆動可能な搬送車において、曲線部走行時にモータの過負荷が防止される。
【図面の簡単な説明】
【００１５】
【図１】本発明の一実施形態が採用された搬送車システムの模式図。
【図２】搬送車システムの部分平面図。
【図３】搬送車システムの制御構成を示すブロック構成図。
【図４】搬送車の走行制御部を示すブロック構成図。
【図５】計算によって得られた理想的な走行軌跡を示す平面図。
【図６】図５の部分拡大図。
【図７】走行車輪の寸法関係を示す図。
【図８】曲線部におけるガイドレールとガイドローラの位置関係を模式的に示した図。
【図９】曲線部走行時の速度比率テーブル。
【図１０】曲線部走行時の走行制御部の動作を示すフローチャート。
【図１１】加速しながらカーブに進入する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【図１２】加速しながらカーブに進入する場合で、２輪速度比率変化区間内で外輪が最大速度に達しないように速度指令を発生した場合に、各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【図１３】加速しながらカーブに進入する場合で、２輪速度比率変化区間内で旋回軸中心が基準速度に達しないように速度指令を発生した場合に、各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ
【図１４】カーブ中から発進した場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【図１５】減速しながらカーブから退出する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフ。
【発明を実施するための形態】
【００１６】
（１）搬送車システム
図１を用いて、本発明の一実施形態が採用された搬送車システム１について説明する。図１は、本発明の一実施形態が採用された搬送車システムの模式図である。
【００１７】
搬送車システム１は、軌道２と、軌道２上を走行する搬送車３と有している。この実施形態では、軌道２は天井から吊り下げられており、さらに、軌道２の周囲はクリーンルームになっている。
【００１８】
軌道２は、走行レール４とガイドレール６を有している。走行レール４は、左右の第１走行レール４ａ及び第２走行レール４ｂから構成されている。第１走行レール４ａ及び第２走行レール４ｂは、平坦な走行面を有している。
【００１９】
ガイドレール６は、第１ガイドレール６ａ及び第２ガイドレール６ｂを有している。第１ガイドレール６ａ及び第２ガイドレール６ｂは、第１走行レール４ａ及び第２走行レール４ｂの外側端にそれぞれ設けられている。第１ガイドレール６ａ及び第２ガイドレール６ｂは上方に延びている。
【００２０】
また、第１走行レール４ａ及び第２走行レール４ｂに沿って、図示しない給電線が設けられている。
【００２１】
図２を用いて、搬送車システム１のレイアウトを説明する。図２は、搬送車システムの部分平面図である。軌道２は、図２に示すように、第１直線部２０１と、第１直線部２０１の先にある分岐部２０６と、分岐部２０６から右側に曲がるカーブ又は曲線部２０３と、分岐部２０６からそのまま直線状に延びる第２直線部２０２とを有している。以下、搬送車３の曲線部走行の説明には、曲線部２０３を曲線部の一例として用いる。
【００２２】
第１走行レール４ａと第２走行レール４ｂは、第１直線部２０１から、分岐部２０６を通って、第２直線部２０２と曲線部２０３の両方に分かれて延びている。
【００２３】
第１直線部２０１から第２直線部２０２に向かう部分の第１走行レール４ａには、分岐部２０６において第１ガイドレール６ａが設けられていない。さらに、第１直線部２０１から曲線部２０３に向かう部分の第２走行レール４ｂには、分岐部２０６において第２ガイドレール６ｂが設けられていない。
【００２４】
（２）搬送車
搬送車３は、搬送車本体１５と、駆動走行部１８と、従動走行部１９を有している。搬送車本体１５の構造は従来と同じであるので説明を省略する。駆動走行部１８及び従動走行部１９は、搬送車本体１５に対してそれぞれ回動自在に取り付けられるボギー台車である。図１には、駆動走行部１８の旋回軸中心３８が示されている。
【００２５】
図１を用いて、駆動走行部１８を説明する。駆動走行部１８は、主に、本体フレーム２０と、第１駆動輪ユニット２１と、第２駆動輪ユニット２２と、固定ガイドローラ機構（３１，３２）と、分岐ガイドローラ機構（３３，３４，３５）とを有している。
【００２６】
第１駆動輪ユニット２１は、本体フレーム２０の右側端部に装着されており、第１走行車輪２５と、第１モータ２６と、第１エンコーダ２７とを有している。第１走行車輪２５は、第１走行レール４ａの走行面の上に載っている。第１モータ２６は、第１走行車輪２５に連結されている。第１エンコーダ２７は、第１モータ２６の回転を計測して、パルス信号を送信する。これにより、第１モータ２６の回転速度や回転回数が得られる。
【００２７】
第２駆動輪ユニット２２は、本体フレーム２０の左側端部に装着されており、第２走行車輪２８と、第２モータ２９と、第２エンコーダ３０とを有している。第２走行車輪２８は、第２走行レール４ｂの走行面の上に載っている。第２モータ２９は第２走行車輪２８に連結されている。第２エンコーダ３０は、第２モータ２９の回転を計測して、パルス信号を送信する。これにより、第２モータ２９の回転速度や回転回数が得られる。
【００２８】
固定ガイドローラ機構（３１，３２）は、一対の第１固定ガイドローラ３１と、一対の第２固定ガイドローラ３２とを有している。一対の第１固定ガイドローラ３１は、本体フレーム２０の右側端部に走行方向前後に離れて配置されている。より具体的には、第１固定ガイドローラ３１は、第１走行車輪２５の走行方向前後両側に離れて配置され、第１ガイドレール６ａの内側に常に近接している。一対の第２固定ガイドローラ３２は、本体フレーム２０の左側端部に走行方向前後に離れて配置されている。より具体的には、第２固定ガイドローラ３２は、第２走行車輪２８の走行方向前後両側に離れて配置され、第２ガイドレール６ｂの内側に常に近接している。
【００２９】
分岐ガイドローラ機構（３３，３４，３５）は、分岐部２０６において分岐動作を行うための機構であり、一対の第１分岐ガイドローラ３３と、第２分岐ガイドローラ３４と、第１分岐ガイドローラ駆動部３５（図３）とを有している。
第１分岐ガイドローラ３３は、第１固定ガイドローラ３１に対応して配置されており、両者によって前側ガイドローラ対８１と後側ガイドローラ対８３を構成している。第２分岐ガイドローラ３４は、第２固定ガイドローラ３２に対応して配置されており、両者によって前側ガイドローラ対８５と後側ガイドローラ対８７とを構成している。第１分岐ガイドローラ駆動部３５（図３）は、第１分岐ガイドローラ３３と、第２分岐ガイドローラ３４の位置を変更するための機構である。
【００３０】
以上の構造により、第１分岐ガイドローラ駆動部３５（図３）によって、第１分岐ガイドローラ３３及び第２分岐ガイドローラ３４がガイド位置と非ガイド位置との間で移動する。ガイド位置では、第１分岐ガイドローラ３３及び第２分岐ガイドローラ３４は、第１ガイドレール６ａの外側に近接する。非ガイド位置では、第１分岐ガイドローラ３３及び第２分岐ガイドローラ３４は、第１ガイドレール６ａから上方に離れている。
【００３１】
従動走行部１９は、主に、本体フレーム２３と、第１従動輪３６と、第２従動輪３７と、第２固定ガイドローラ機構（４０，４１）と、第２分岐ガイドローラ機構（４２，４３，４４）とを有している。
第１従動輪３６は、走行レール４の第１走行レール４ａの上に載っている。第２従動輪３７は、走行レール４の第２走行レール４ｂの上に載っている。
【００３２】
第２固定ガイドローラ機構（４０，４１）は、一対の第３固定ガイドローラ４０と、一対の第４固定ガイドローラ４１とを有している。第３固定ガイドローラ４０は、本体フレーム２３の右側端部に走行方向前後に離れて配置されている。より具体的には、第３固定ガイドローラ４０は、第１従動輪３６の走行方向前後両側に離れて配置され、第１ガイドレール６ａの内側に常に近接している。第４固定ガイドローラ４１は、本体フレーム２３の左側端部に走行方向前後に離れて配置されている。より具体的には、第４固定ガイドローラ４１は、第２従動輪３７の走行方向前後両側に離れて配置され、第２ガイドレール６ｂの内側に常に近接している。
【００３３】
第２分岐ガイドローラ機構（４２，４３，４４）は、分岐部２０６において分岐動作を行うための機構であり、一対の第３分岐ガイドローラ４２と、第４分岐ガイドローラ４３と、第２分岐ガイドローラ駆動部４４（図３）とを有している。
【００３４】
第３分岐ガイドローラ４２は、第３固定ガイドローラ４０に対応して配置されている。第４分岐ガイドローラ４３は、第４固定ガイドローラ４１に対応して配置されている。第２分岐ガイドローラ駆動部４４（図３）は、第３分岐ガイドローラ４２と、第４分岐ガイドローラ４３の位置を変更するための機構である。
【００３５】
以上の構造により、第２分岐ガイドローラ駆動部４４（図３）によって、第３分岐ガイドローラ４２及び第４分岐ガイドローラ４３がガイド位置と非ガイド位置との間で移動する。ガイド位置では、第３分岐ガイドローラ４２及び第４分岐ガイドローラ４３は、第１ガイドレール６ａの外側に近接する。非ガイド位置では、第３分岐ガイドローラ４２及び第４分岐ガイドローラ４３は、第１ガイドレール６ａから上方に離れている。
【００３６】
搬送車３が図２において曲線部２０３を走行するときには、第１分岐ガイドローラ３３と第３分岐ガイドローラ４２はガイド位置に配置されている。一方、そのときに、第２分岐ガイドローラ３４及び第４分岐ガイドローラ４３は非ガイド位置に配置されている。なお、搬送車３が第１直線部２０１を走行するときには、各分岐ガイドローラは非ガイド位置及びガイド位置のいずれに配置されていてもよい。
【００３７】
（３）被検出部及びセンサ
図２を用いて、走行レール４に沿って設けられた複数種類の被検出部について説明する。被検出部は、反射テープ１１と、バーコード１３と、磁気マーク１４とを含んでいる。なお、図２では、反射テープ１１と、バーコード１３と、磁気マーク１４は、走行レール４の内側に図示されているが、実際には走行レール４上又はガイドレール６上面に設けられている。
反射テープ１１は、曲線部２０３において搬送車３の位置を検出するための部材であり、曲線部２０３に配置されている。なお、この実施形態では、反射テープ１１の開始端１１ａは、曲線部２０３の実際の開始位置２０３ａより走行方向手前に配置されている。また、反射テープ１１の終了端（図示せず）は、実際の曲線部の終了位置（図示せず）より手前に配置されている。
バーコード１３は、走行レール４の原点マーク及び複数の基準マークとして機能している。
磁気マーク１４は、搬送車３の停止位置を示す部材である。磁気マーク１４は、鋼などの磁性体や、銅やアルミなどの非磁性体で構成されている。この実施形態では、磁気マーク１４は、第１直線部２０１に配置されており、磁気マーク１４の中間が停止位置８０になっている。
【００３８】
駆動走行部１８及び従動走行部１９には、さらに、図３に示すように、光電センサ４７と、リニアスケール４９と、バーコードリーダ５０とが設けられている。光電センサ４７は、反射テープ１１を検出するためのものである。なお、図における光電センサ４７は、右側に曲がる曲線部を走行中の位置を検出するためのセンサであり、左側に曲がる曲線部用のセンサ（図示せず）は別に設けられている。リニアスケール４９は、磁気マーク１４を検出するためのものである。リニアスケール４９は、磁気マーク１４に対する搬送車３の絶対位置、言い換えれば磁気マーク１４を基準とする位置を求める。バーコードリーダ５０は、バーコード１３を検出するためのものである。
【００３９】
（４）制御構成
図３を用いて、搬送車システム１の制御構成を説明する。図３は、搬送車システムの制御構成を示すブロック構成図である。
【００４０】
搬送車システム１は、搬送車コントローラ５２を有している。搬送車コントローラ５２は、複数の搬送車３の走行を管理するためのコントローラである。搬送車コントローラ５２は搬送車３と交信可能である。搬送車コントローラ５２は、コントローラ本体５４と、メモリ５５を有している。コントローラ本体５４は、ＣＰＵ、ＲＡＭ、ＲＯＭ等からなりプログラムを実行するコンピュータである。メモリ５５内には、ルートマップが記憶されている。ルートマップとは、走行ルートの配置、原点の位置、原点を基準とする基準位置や移載位置の座標を記載したマップである。座標は、原点からの走行距離を搬送車のエンコーダの出力パルス数などに換算したものである。
【００４１】
搬送車３は、走行制御部５９を有している。走行制御部５９は、搬送車コントローラ５２からの指令に基づいて第１モータ２６と第２モータ２９に駆動信号を送信できる。走行制御部５９は、さらに、分岐制御部６０に接続されている。分岐制御部６０は、搬送車コントローラ５２からの指令に基づいて第１分岐ガイドローラ駆動部３５及び第２分岐ガイドローラ駆動部４４に駆動信号を送信できる。
【００４２】
（５）搬送車の走行制御系
図４を用いて、走行制御部５９を説明する。図４は、搬送車の走行制御部を示すブロック構成図である。
走行制御部５９は、ＣＰＵ、ＲＡＭ、ＲＯＭ等からなりプログラムを実行するコンピュータである。走行制御部５９は、ルートマップ６１と、速度パターン発生部６２と、第１モータ制御部６３と、第２モータ制御部６４、補償速度比率テーブル９０とを有している。ルートマップ６１と補償速度比率テーブル９０は、走行制御部５９内のメモリに保存されている。速度パターン発生部６２は、搬送車コントローラ５２と交信可能である。
さらに、走行制御部５９には、第１エンコーダ２７、第２エンコーダ３０、光電センサ４７，リニアスケール４９及びバーコードリーダ５０が接続されている。
【００４３】
走行制御部５９は、搬送車コントローラ５２から搬送指令を受け取ると、ルートマップ６１に基づいて現在位置から停止位置までの距離を求めて、当該距離を速度パターン発生部６２に入力する。速度パターン発生部６２は、ルートマップ６１上の現在位置の座標と、目的位置の座標との差から走行距離を算出し、これによって停止位置までの走行速度のパターンを発生する。
【００４４】
第１モータ制御部６３は、第１誤差増幅部６５Ａと、第１フィードバック制御部６６Ａと、第１アンプ６７Ａとを主に有している。第１誤差増幅部６５Ａは誤差を増幅する。第１フィードバック制御部６６Ａは、第１誤差増幅部６５Ａで求めた誤差に基づいて、例えばＰＩＤ制御又はＰＩ制御を行う。ＰＩＤ制御とＰＩ制御は切り替え可能である。第１アンプ６７Ａは、電流増幅された速度指令を第１モータ２６へ送信する。第１エンコーダ２７が、第１モータ２６の回転軸の回転数を検出し、これにより得られる第１走行車輪２５の現在位置と速度が、速度パターン発生部６２又は第１誤差増幅部６５Ａに入力される。なお、第１モータ制御部６３の構成は一実施例である。
【００４５】
第２モータ制御部６４は、第２誤差増幅部６５Ｂと、第２フィードバック制御部６６Ｂと、第２アンプ６７Ｂとを主に有している。第２誤差増幅部６５Ｂは誤差を増幅する。第２フィードバック制御部６６Ｂは、第２誤差増幅部６５Ｂで求めた誤差に基づいてＰＩＤ制御又はＰＩ制御を行う。ＰＩＤ制御とＰＩ制御は切り替え可能である。第２アンプ６７Ｂは、電流増幅された速度指令を第２モータ２９へ送信する。第２エンコーダ３０が、第２モータ２９の回転軸の回転数を検出し、これにより得られる第２走行車輪２８の現在位置と速度が、速度パターン発生部６２又は第２誤差増幅部６５Ｂに入力される。なお、第２モータ制御部６４の構成は一実施例であって、本発明はこれに限定されない。
【００４６】
（６）走行制御動作の概略説明
搬送車３は、一般的に、軌道２に沿って、ルートマップ６１から求めた所要走行距離と、第１エンコーダ２７及び第２エンコーダ３０から求めた現在位置ならびに現在速度により走行制御を行う。
【００４７】
搬送車３が曲線部２０３を走行する際の制御動作について説明する。曲線部２０３を走行する際には、一般的に、左右のモータが完全な同期を取れないことに起因して、走行軌跡が実際のカーブレールとは一致せず、走行車輪がガイドレールに衝突するなどの挙動不安定になる問題が考えられる。本発明はその問題を解決するための以下のような手段を用いている。
【００４８】
光電センサ４７からの検出結果ならびに第１エンコーダ２７及び第２エンコーダ３０からの検出結果を照合して、速度パターン発生部６２は、搬送車３の現在位置を確認する。速度パターン発生部６２は、現在位置情報及び補償速度比率テーブル９０（後述）を使用することで、適切な左右速度差が生じるように別個の目標速度信号を生成してそれらを第１モータ制御部６３及び第２モータ制御部６４にそれぞれ送信する。
【００４９】
速度パターン発生部６２は、一定速度で曲線部２０３に進入すると、内輪を減速して外輪を加速することで、搬送車３の中心速度を規定速度（例えば、６０ｍ／分）に合わせて走行させる。速度パターン発生部６２は、予め算出した補償速度比率テーブル９０を使用することで、演算効率を向上させており、処理負荷を軽減している。
【００５０】
以上より、搬送車３が曲線部２０３を走行する際には、左右のモータが完全な同期を取れないにもかかわらず、挙動が安定している。
【００５１】
（７）曲線部走行軌跡
速度パターン発生部６２は、理想的な曲線部走行軌跡テーブル９８を予め有している。曲線部走行軌跡は、ガイドローラがガイドレール形状を正確にトレースできる軌跡である。つまり、この軌跡においては、ガイドローラがガイドレールに接触することはない。
【００５２】
図５〜図８を用いて、曲線部走行軌跡の求め方を説明する。図５は、計算によって得られた理想的な走行軌跡を示す平面図である。図６は、図５の部分拡大図である。図７は、走行車輪の寸法関係を示す図である。図８は、曲線部におけるガイドレールとガイドローラの位置関係を模式的に示した図である。
【００５３】
理想的な曲線部走行軌跡は以下のようにして得られる。最初に、基準入口軌跡が求められる。具体的には、後側ガイドローラ対の位置ｘａを、開始位置２０３ａから前側ガイドローラ対８１と後側ガイドローラ対８３のピッチＬ以上に離れた位置まで、所定間隔Δｘａ分解能で旋回軸中心軌道Ｐ０、内輪軌道Ｐ１、外輪軌道Ｐ２の座標を求めていく。例えば、ｘａを変化させる区間の距離は、開始位置２０３ａから５００ｍｍであり、両ガイドローラ対のピッチＬが４８０ｍｍであり、Δｘａが０．０５ｍｍであり、Ｐ０、Ｐ１及びＰ２は１０００ヶ所分得られる。
【００５４】
具体的な計算式は以下の通りである。
最初に、旋回角度α２が算出される。なお、Ｒは第１ガイドレール６ａの半径であり、Ｌは両ガイドローラ対の前後ピッチであり、ｘａは後側ガイドローラ対のｘ座標であり、ｘＲは開始位置２０３ａのＸ座標である。
ｌ＝√（（ｘＲ−ｘａ）２＋Ｒ２）
Ｒ２＝ｌ２＋Ｌ２−２ｌＬｃｏｓα１
α１＝ｃｏｓ−１（（Ｒ２−ｌ２−Ｌ２）／（−２ｌＬ））
α０＝ｔａｎ−１Ｒ／（ｘＲ−ｘａ）
α２＝α０−α１
【００５５】
次に、旋回角度α２から、Ｐ０、Ｐ１及びＰ２の座標が算出される。
θ０＝θ００−α２
θ１＝θ１０−α２
θ２＝θ２０−α２
これより、Ｐ０、Ｐ１及びＰ２の座標は以下の通りになる。
Ｐ０（ｘ０，ｙ０）＝（ｘａ＋ｌ０ｃｏｓθ０，ｌ０ｓｉｎθ０）
Ｐ１（ｘ１，ｙ１）＝（ｘａ＋ｌ１ｃｏｓθ１，ｌ１ｓｉｎθ１）
Ｐ２（ｘ２，ｙ２）＝（ｘａ＋ｌ２ｃｏｓθ２，ｌ２ｓｉｎθ２）
Ｐ０、Ｐ１、Ｐ２のそれぞれの間隔が積算されることで、第１走行車輪２５、第２走行車輪２８、旋回軸中心３８の移動距離が得られる。
図８を用いて、曲線部入口におけるガイドレールとガイドローラの位置関係を説明する。前側ガイドローラ対８１同士の中間点を第１中間点９５として、後側ガイドローラ対８３同士の中間点を第２中間点９７とする。図８において、前側ガイドローラ対８１と後側ガイドローラ対８３は、第１直線部２０１において符号Ａで示され、前側ガイドローラ対８１が開始位置２０３ａに到達した位置にある状態を符号Ｂで示され、後側ガイドローラ対８３が開始位置２０３ａに到達した位置にある状態を符号Ｃで示され、曲線部２０３において符号Ｄで示されている。いずれの位置においても、第１中間点９５及び第２中間点９７は、第１ガイドレール６ａの幅方向中間に一致するようになっている。このようにして、第１ガイドレール６ａに対して両側のガイドローラが常に最大の隙間を空けるように配置される。
基準出口軌跡は、基準入口軌跡の計算結果から抽出される。具体的には、後側ガイドローラ対８３が曲線部２０３に入った地点を変化終了地点として検索し、そこから逆方向に並び替える。さらに、Ｐ１、Ｐ２それぞれの間隔が積算されることで、第１走行車輪２５、第２走行車輪２８、旋回軸中心３８の移動距離が得られる。
以上のようにして得られて基準入口軌跡と基準出口軌跡は、速度パターン発生部６２において、曲線部走行軌跡テーブル９８に記憶されている。
【００５６】
（８）速度比率テーブル
図９を用いて、速度パターン発生部６２が基準速度指令として利用しているカーブ走行時の基準速度比率テーブル（車輪速度変換テーブル）７０について説明する。基準速度比率テーブル７０は、カーブ走行の時間に対する左右の駆動輪の基準速度比率を定めたテーブルであって、カーブ入口における第１速度比率変化区間１０１と、カーブ出口における第２速度比率変化区間１０２と、カーブ中間における速度比率一定区間１０３とを有している。
【００５７】
カーブ開始点では内輪と外輪の速度比率はいずれも１００％である。そして、第１速度比率変化区間１０１では、基準外輪速度比率７１が大きくなるにつれて、基準内輪速度比率７３が小さくなっていく。そして、基準外輪速度比率７１が１００＋α％（例えば、合計１１５％）になりさらに基準内輪速度比率７３が１００−α％（例えば、合計８５％）になると、その状態が速度比率一定区間１０３で続く。そして、最後に、第２速度比率変化区間１０２では、基準外輪速度比率７１が小さくなっていき、それにつれて基準内輪速度比率７３が大きくなっていき、最後に両者が１００％になる。
なお、上記のαの値は、左右の駆動車輪間隔とカーブ曲率に従って異なるように設定されている。
【００５８】
次に、基準速度比率テーブル７０の作成方法について説明する。速度パターン発生部６２は、基準軌跡の出力から、旋回軸中心Ｐ０での移動速度が設定された一定の値（例えば、６０ｍ／分）となるように、Ｐ１、Ｐ２位置を時間軸基準で抽出する。具体的には、Ｐ０位置で区切って、曲線部入口からで出口までの速度パターンを発生する。時間軸の分解能であるΔｔはΔｘａより十分に大きくなることが必要であり、例えば１ミリ秒である。Ｐ０位置による境界条件分け及び速度パターン作成方法は、以下の通りである。
・直線部定速移動・・・Ｐ０と平行移動
・入口（二輪差速度差開始位置１〜二輪差速度差終了位置１）・・・基準入口軌跡から抽出
・カーブ中定速移動・・カーブ速度参照（カーブ半径から単純計算）
・出口（二輪差速度差開始位置２〜二輪差速度差終了位置２）・・・基準出口軌跡から抽出
・直線部定速移動・・・Ｐ０と平行移動
【００５９】
搬送車３が図２において曲線部２０３を走行するときには、内輪側すなわちガイドレールを保持している側では、第１モータ制御部６３の第１フィードバック制御部６６Ａが、第１モータ２６に対して継続してＰＩＤ制御を行っている。それに対して、外輪側すなわちガイドレールを保持していない側では、第２モータ制御部６４の第２フィードバック制御部６６ＢがＰＩＤ制御からＰＩ制御に切り替えられている。つまり、曲線部走行時には、第１モータ２６はＰＩＤ制御され、第２モータ２９はＰＩ制御される。理想軌跡を走行するように速度指令を形成するにもかかわらず、このように内輪ＰＩＤ−外輪ＰＩ制御を残す理由は、レール形状誤差及び据え付け誤差からガイドローラがガイドレールに接触することはあり得るので、その接触時の負荷を減らすためである。
【００６０】
次に、基準速度指令に対するサーボ追従補償を説明する。サーボ追従補償は、基準速度指令に対して、フィードフォワード制御を加えることで、内輪ＰＩＤ−外輪ＰＩ制御に起因する左右輪の差を補償するために行われる。本実施形態で採用されたサーボ追従補償のパラメータは、レスポンスと偏差である。レスポンスとは、挙動変化開始時の遅れ時間及び挙動変化終了時の遅れ時間である。偏差とは、曲線部一定速度到達時点の所望速度に対するパーセンテージである。
【００６１】
図９を用いて、速度パターン発生部６２がサーボ追従補償を行った速度度指令として利用しているカーブ走行時の補償速度比率テーブル９０について説明する。補償速度比率テーブル９０は、補償外輪速度比率９１と補償内輪速度比率９３とを有している。補償外輪速度比率９１は、基準外輪速度比率７１に比べて、挙動変化開始時及び挙動変化終了時が早くなっている。補償内輪速度比率９３も、基準内輪速度比率７３に比べて、挙動変化開始時及び挙動変化終了時が早くなっている。補償外輪速度比率９１は、補償内輪速度比率９３に比べても、挙動変化開始時及び挙動変化終了時が早くなっている。
さらに、補償外輪速度比率９１は、基準外輪速度比率７１に比べて、一定速度の大きさが大きくなっている。
【００６２】
補償速度比率テーブル９０は、以下のようにして作成される。最初に、時間遅れと、速度偏差は、別途行われた実験によって得られる。速度パターン発生部６２は、時間領域で基準入口軌跡と基準出口軌跡を作成し、さらに、基準速度指令から境界時間を抽出する。さらに、速度パターン発生部６２は、例えば、時間領域で単純に直線補完することで、補償テーブルを作成する。
速度パターン発生部６２は、補償テーブルから、境界時間で区切って曲線部入口から出口までの速度パターンを生成する。
時間による境界条件分け及び速度パターン作成方法は以下の通りである。
・直線部定速移動・・・Ｐ０と平行移動
・入口（二輪差速度差開始時間１〜二輪差速度差終了時間１）・・・補償入口軌跡から抽出
・カーブ中定速移動・・カーブ速度参照（カーブ半径から単純計算）
・出口（二輪差速度差開始時間２〜二輪差速度差終了時間２）・・・補償出口軌跡から抽出
・直線部定速移動・・・Ｐ０と平行移動
【００６３】
（９）曲線部走行制御の詳細説明
以下、図１０〜図１３を用いて、速度パターン発生部６２の制御動作を説明する。図１０は、曲線部走行時の走行制御部の動作を示すフローチャートである。図１１〜１２は、加速しながらカーブに進入する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフである。図１１〜図１３では、実線を用いて内輪速度、外輪速度及び旋回軸中心速度を示しており、２点鎖線を用いて補償速度比率テーブル９０を示している。なお、これらの図では、補償速度比率テーブル９０は、速度比率が速度に一致するように描かれている。
図において、Ｖ１は速度比率一定区間１０３において想定される内輪速度の最大値を表しており、Ｖ２は速度比率一定区間１０３において想定される外輪速度の最大値を表しており、Ｖｃは速度比率一定区間１０３において想定される旋回軸中心速度の最大値を表している。
以下の説明では、図１１〜図１３に示すように、搬送車３が第１直線部２０１から発進して一定の加速度ａ０１で曲線部２０３に進入する場合の動作を説明する。このときの加速度ａ０１は、許容される最大値又はその近傍であってもよい。
なお、速度パターン発生部６２は、曲線部２０３に入る前からも速度指令を第１モータ２６及び第２モータ２９に与え続けている。
【００６４】
ステップＳ１では、速度パターン発生部６２は、曲線部２０３の開始位置２０３ａに到達するのを待つ。開始位置２０３ａに到達したことは、光電センサ４７が反射テープ１１の開始端１１ａを検出することによって把握される。なお、このとき、図１１において、走行車輪の速度はｖである。
【００６５】
ステップＳ２では、速度パターン発生部６２は、搬送車３が加速しているか否か（この場合は、加速していない場合としては、一定速度で走行しているとする）を判断する。「Ｙｅｓ」であればプロセスはステップＳ３に移行し、「Ｎｏ」であればプロセスは通常カーブ走行制御に移行する。通常カーブ走行制御では、旋回軸中心速度に対して補償速度比率テーブル９０が乗算されることで内輪速度と外輪速度が決定される。
【００６６】
ステップＳ３では、速度パターン発生部６２は、現在の加速度ａ０１を続けた場合に外輪が第１速度比率変化区間１０１を走行するのにかかる時間ｔ１１を算出する。なお、この実施形態ではｔ１１を算出するための加速度は、ａ０１と同じであってもよいが、それ未満であってもよい。
また、速度パターン発生部６２は、基準速度に対して補償速度比率テーブル９０を乗算して内輪速度を算出する。したがって、内輪速度は、外輪速度より通常の速度差（基準速度と内輪速度との差）分以上を減らした速度となる。
【００６７】
ステップＳ４では、速度パターン発生部６２は、ｔ１１経過までの間の旋回軸中心３８の加速度ａ１１を求める。具体的には、最初に、速度パターン発生部６２は、ｔ１１経過時の外輪速度と補償速度比率テーブル９０から、ｔ１１経過時の旋回軸中心速度ｖ１１を算出する。次に、速度パターン発生部６２は、ｖ、ｖ１１及びｔ１１に基づいて、ｔ１１までの間の旋回軸中心３８の加速度ａ１１を算出する。具体的には、ａ１１＝（ｖ１１−ｖ）／ｔ１１の式が用いられる。なお、図から明らかなようにａ１１はａ０１より小さくなっている。
【００６８】
ステップＳ５では、速度パターン発生部６２は、第１速度比率変化区間１０１内で外輪速度が外輪最大速度Ｖ２になるか否かを判断する。「Ｎｏ」であればプロセスはステップＳ６に移行し、「Ｙｅｓ」であればプロセスはステップＳ１７に移行する。
【００６９】
ステップＳ６では、速度パターン発生部６２は、旋回軸中心速度に基づいた基準速度指令を発生する。
【００７０】
ステップＳ７では、速度パターン発生部６２は、補償速度比率テーブル９０を用いて基準速度指令を左右速度差指令に変換する。具体的には、曲線部２０３における搬送車３の位置と補償速度比率テーブル９０により該当位置の乗率を求めて、現在の基準速度に乗率を乗じることで、該当位置での内輪速度及び外輪速度を算出する。つまり、旋回軸中心速度に対して補償外輪速度比率９１の値を積算することで外輪速度指令を作成し、さらに旋回軸中心速度に対して補償内輪速度比率９３の値を積算することで内輪速度指令を作成する。
【００７１】
ステップＳ８では、速度パターン発生部６２は、左右速度差指令を第１モータ制御部６３と第２モータ制御部６４にそれぞれ出力する。
【００７２】
ステップＳ９では、速度パターン発生部６２は、旋回軸中心速度がｔ１１経過の前に基準速度Ｖｃに到達したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ１０に移行し、「Ｙｅｓ」であればプロセスはステップＳ２２に移行する。
【００７３】
ステップＳ１０では、速度パターン発生部６２は、ｔ１１が経過したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ６に戻り、「Ｙｅｓ」であればプロセスはステップＳ１１に移行する。以上より、旋回軸中心速度が基準速度Ｖｃに到達するか又はｔ１１が経過するまで、ステップＳ６〜８が繰り返し実行される。
【００７４】
ステップＳ１１では、速度パターン発生部６２は、外輪が現在の加速度ａ０１を続けた場合に外輪の速度が外輪最大速度Ｖ２に到達するまでの時間ｔ１２を算出する。なお、ｔ１２を算出するための加速度は、ａ０１と同じであってもよいが、それ未満であってもよい。
【００７５】
ステップＳ１２では、速度パターン発生部６２は、Ｖｃ、ｖ１１及びｔ１２に基づいて、ｔ１２までの間の旋回軸中心３８の加速度ａ１２を求める。具体的には、ａ１２＝（Ｖｃ−ｖ１１）／ｔ１２の式が用いられる。図から明らかなようにａ１２は、ａ０１より小さく、かつａ１１より大きい。
【００７６】
ステップＳ１３では、速度パターン発生部６２は、旋回軸中心速度に基づいた基準速度指令を発生する。
【００７７】
ステップＳ１４では、速度パターン発生部６２は、ｔ１２経過後に外輪の速度が外輪最大速度Ｖ２になるようにかつ内輪が内輪最大速度Ｖ１になるように変化していく左右の速度指令を発生する。
【００７８】
ステップＳ１５では、速度パターン発生部６２は、左右速度差指令を第１モータ制御部６３と第２モータ制御部６４にそれぞれ出力する。
【００７９】
ステップＳ１６では、速度パターン発生部６２は、ｔ１２が経過したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ１３に戻り、「Ｙｅｓ」であればプロセスは通常カーブ走行制御に移行する。以上より、ｔ１２が経過するまで、ステップＳ１３〜Ｓ１５が繰り返し実行される。
【００８０】
次に、図１２を用いて、第１速度比率変化区間１０１において外輪の速度が外輪最大速度Ｖ２に達してしまう場合の制御動作であるステップＳ１７〜ステップＳ２１を説明する。
【００８１】
図１０のステップＳ１７では、速度パターン発生部６２は、旋回軸中心３８の第１速度比率変化区間１０１における加速度ａ１１を再計算する。具体的には、速度パターン発生部６２は、Ｖ２、ｖ及びｔ１１に基づいて、ｔ１１までの間の旋回軸中心３８の加速度ａ１１を求める。具体的には、ａ１１＝（Ｖ２−ｖ）／ｔ１１である。この結果、外輪の速度がｔ１１経過時すなわち第１速度比率変化区間１０１終了時に外輪最大速度Ｖ２となる。図１２から明らかなように、ｔ１１の間における外輪の加速度ａ０１’は、カーブ進入時の外輪の加速度ａ０１より小さい。
【００８２】
ステップＳ１８では、速度パターン発生部６２は、旋回軸中心速度に基づいた基準速度指令を発生する。
【００８３】
ステップＳ１９では、速度パターン発生部６２は、ｔ１１経過後に外輪の速度が外輪最大速度Ｖ２になるようにかつ内輪の速度が内輪最大速度Ｖ１になるように変化していく左右の速度指令を発生する。
【００８４】
ステップＳ２０では、速度パターン発生部６２は、左右速度差指令を第１モータ制御部６３と第２モータ制御部６４にそれぞれ出力する。
【００８５】
ステップＳ２１では、速度パターン発生部６２は、ｔ１１が経過したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ１８に戻り、「Ｙｅｓ」であればプロセスは通常カーブ走行制御に移行する。以上より、ｔ１１が経過するまで、ステップＳ１８〜ステップＳ２０が繰り返し実行される。
【００８６】
次に、図１３を用いて、第１速度比率変化区間１０１において旋回軸中心３８の速度が基準速度Ｖｃに達してしまう場合の制御動作であるステップＳ２２〜ステップＳ２５を説明する。
【００８７】
図１０のステップＳ２２〜ステップＳ２４では、速度パターン発生部６２は、旋回軸中心の基準速度指令を発生し、さらに内外輪速度指令を作成し、最後にそれらをモータに送信する。より具体的には、速度パターン発生部６２は、旋回軸中心３８の速度が基準速度Ｖｃになるまでは、旋回軸中心３８の加速度ａ１１が維持されるように旋回軸中心３８の基準速度指令を発生し、さらに内外輪速度指令を作成する。そして、速度パターン発生部６２は、旋回軸中心３８の速度が旋回軸中心最大速度Ｖｃになると以後は、旋回軸中心３８の速度を一定に維持する。さらに、速度パターン発生部６２は、外輪速度についてはそれまでの加速度が維持されるように設定する。そして、速度パターン発生部６２は、内輪速度については、旋回軸中心速度を中心に外輪速度と対称となるように設定する。
【００８８】
ステップＳ２５では、速度パターン発生部６２は、外輪の速度が外輪最大速度Ｖ２に到達したか否かを判断する。「Ｎｏ」であればプロセスはステップＳ２２に戻り、「Ｙｅｓ」であればプロセスは通常カーブ走行制御に移行する。以上より、外輪の速度が外輪最大速度Ｖ２に到達するまで、ステップＳ２２〜Ｓ２４が繰り返し実行される。
【００８９】
（１０）カーブの途中から発進した場合
図１４を用いて、曲線部２０３の途中から搬送車３が発進した場合の速度制御について説明する。図１４は、カーブ中から発進した場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフである。
【００９０】
この実施形態では、搬送車３は曲線部２０３において第１速度比率変化区間１０１からスタートする。この場合、速度パターン発生部６２は、外輪の加速度ａ０１を基準にして、外輪の速度が外輪最大速度Ｖ２に達したときに旋回軸中心３８が基準速度Ｖｃに達し内輪の速度が内輪最大速度Ｖ１に達するように、旋回軸中心３８の加速度ａ１１及び内輪の加速度ａ１２を決定する。そして、速度パターン発生部６２は、上述の加速度が実現されるような速度指令を内輪と外輪に与え続ける。
【００９１】
（１１）カーブ出口における速度制御
図１５を用いて、搬送車３が曲線部２０３を減速しながら退出していく場合の速度制御を説明する。図１５は、減速しながらカーブから退出する場合の各車輪の時間−速度の関係と、カーブ走行時の速度比率テーブルと示したグラフである。
【００９２】
速度パターン発生部６２は、減速を開始すると、現在の減速度ａ０２を続けた場合に外輪の速度が０になるまでにかかる時間ｔ２１を算出する。具体的には、ｔ２１＝Ｖ２／ａ０１が用いられる。なお、ｔ２１を算出するための減速度は、ａ０２と同じであってもよいが、それ未満であってもよい。
【００９３】
速度パターン発生部６２は、第２速度比率変化区間１０２での旋回軸中心３８の減速度ａ２１を求める。具体的には、最初に、速度パターン発生部６２は、ｔ２１経過後に旋回軸中心３８の速度がゼロになるような減速度ａ２１を求め、そのような減速度が実現されるように旋回軸中心の速度指令を生成する。
【００９４】
反射テープＯＦＦ時には、速度パターン発生部６２は、第２速度比率変化区間１０２が終了するまでの時間であるｔ２２を求め、さらに、ｔ２２経過時の速度ｖ２２を求める。さらに、ｖ２２からｔ２２中の減速度ａ２２を求める。ａ２２＝（ｖ２２−ｖ１１）／ｔ２２である。
【００９５】
速度パターン発生部６２は、減速度ａ２２が維持されるように旋回軸中心の基準速度指令を発生する。さらに、速度パターン発生部６２は、基準速度指令に速度パターン発生部６２を乗算して左右の車輪の速度を算出し、その速度指令を各モータに与える。
搬送車が曲線部の終了点に達すると、速度パターン発生部６２は、旋回軸中心３８の減速度がａ０１になるように速度指令を生成する。このときに、左右の車輪の速度は旋回軸中心３８の速度と一致する。
【００９６】
前記実施形態では曲線部への進入及び退出において加減速度を許容最大値又はそれに近い値にしていても、曲線部の入口及び出口において加減速度の最大値を超えることがない。したがって、モータに過負荷が生じにくい。また、曲線部への進入及び退出において加減速度を許容最大値又はそれに近い値にできるので、走行効率が低下しない。
【００９７】
（１２）特徴
前記実施形態は下記のようにも表現できる。
（Ａ）搬送車システム１は、予め定められた経路を走行する搬送車３と、搬送車３の走行を制御する走行制御部５９とを備えている。搬送車３は、搬送車本体１５と、搬送車本体１５の左右に設けられた２個の走行車輪２５，２８と、２個の走行車輪２５，２８にそれぞれ接続された２個のモータ２６，２９と、を有している。走行制御部５９は、速度パターン発生部６２と、光電センサ４７と、を有している。速度パターン発生部６２は、搬送車３が曲線部２０３を走行するときに２個の走行車輪２５，２８に対して基準速度に対して内外輪に対してそれぞれ速度差が生じるように、曲線部２０３の中間にある速度比率一定区間１０３と曲線部２０３の両端にある速度比率変化区間１０１，１０２とにおいて速度指令を発生して２個のモータ２６，２９に与える。光電センサ４７は、搬送車３が曲線部２０３を走行していることを検出可能である。
図１１に示すように、速度パターン発生部６２は、搬送車３が加速中に曲線部２０３に進入することを光電センサ４７が検出すれば、第１速度比率変化区間１０１において、外輪となる走行車輪に対応するモータに対して進入時の加速度ａ０１以下の加速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が加速しながら曲線部２０３に進入した場合に、外輪となるモータに高負荷がかからない。
【００９８】
（Ｂ）速度パターン発生部６２は、加速中に曲線部２０３への進入を光電センサ４７が検出すれば、外輪となる走行車輪に対応するモータが現加速度を維持すれば第１速度比率変化区間１０１内で外輪最大速度Ｖ２に到達するか否かを判断する。図１１に示すように外輪最大速度Ｖ２に達しないと判断されれば、速度パターン発生部６２は、外輪となる走行車輪に対応するモータに対して現加速度ａ０１を維持するような速度指令を生成して与える。
この搬送車システム１では、速度パターン発生部６２において計算負荷が高くならない。
【００９９】
（Ｃ）上記の場合に最大速度に達すると判断されれば、図１２に示すように、速度パターン発生部６２は、第１速度比率変化区間１０１の終了点以降で外輪となる走行車輪が外輪最大速度Ｖ２になるような速度指令を生成して、外輪となる走行車輪に対応するモータに対して速度指令を与える。
この搬送車システム１では、外輪となる走行車輪に対応するモータが現加速度ａ０１を維持すれば第１速度比率変化区間１０１内で外輪最大速度Ｖ２に到達してしまう場合でも、外輪となる走行車輪が外輪最大速度Ｖ２を超えることが防止される。
【０１００】
（Ｄ）図１５に示すように、速度パターン発生部６２は、搬送車３が減速中に曲線部２０３から退出することを検出部が検出すれば、第２速度比率変化区間１０２において、外輪となる走行車輪に対応するモータに対して退出時の減速度ａ０２以下の減速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より速度差分以上を減らした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が減速しながら曲線部２０３から退出した場合に、外輪となる走行車輪に対応するモータに高負荷がかからない。
【０１０１】
（１３）他の実施形態
以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。特に、本明細書に書かれた複数の実施形態及び変形例は必要に応じて任意に組み合せ可能である。
【０１０２】
（ａ）搬送車が減速しながら曲線部に進入する場合
速度パターン発生部６２は、搬送車３が減速中に曲線部２０３に進入することを検出部が検出すれば、第１速度比率変化区間１０１において、内輪となる走行車輪に対応するモータに対して進入時の減速度以下の減速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が減速しながら曲線部２０３から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
【０１０３】
（ｂ）搬送車が加速しながら曲線部から退出する場合
速度パターン発生部６２は、搬送車３が加速中に曲線部２０３から退出することを検出部が検出すれば、第２速度比率変化区間１０２において、内輪となる走行車輪に対応するモータに対して退出時の加速度以下の加速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より速度差分以上を増やした速度となるような速度指令を生成して与える。
この搬送車システム１では、搬送車３が加速しながら曲線部２０３から退出した場合に、内輪となる走行車輪に対応するモータに高負荷がかからない。
（ｃ）前記実施形態では、搬送車が曲線部の開始と終了をセンサによって検出していたが、本発明はこれに限定されない。例えば、搬送車がエンコーダによってソフト的に判断してもよい。
（ｄ）前記実施形態では反射テープは曲線部に沿って連続的に設けられていたが、本発明はこれに限定されない。反射テープは断続的に設けられていてもよい。
（ｅ）前記実施形態では搬送車は天井から吊り下げられた軌道上を走行していたが、本発明はこれに限定されない。軌道は地上に設けられていてもよいし、搬送車が軌道から吊り下げられていてもよい。
（ｆ）前記実施形態ではエンコーダはモータの回転を計測していたが、本発明はこれに限定されない。エンコーダは駆動輪又は従動輪の回転を計測してもよい。
（ｇ）被検出部及びセンサの組み合せの種類及び検出目的は、前記実施形態に限定されない。
（ｈ）被検出部の設置位置や数は、前記実施形態に限定されない。
（ｉ）前記実施形態では、補償速度比率テーブルを用いて左右速度差指令を形成していたが、基準速度比率テーブルを用いて左右速度差指令を形成してもよい。その場合でも、速度パターン発生部は、搬送車が曲線部を走行するときに、理想的な走行軌跡に基づいて作成した速度指令を第１モータ及び第２モータに与えているので、曲線部において前側ガイドローラ対及び後側ガイドローラ対はガイドレールに接触しにくい。
（ｊ）前記実施形態はサーボ追従補償のパラメータはレスポンスと偏差であるが、いずれか一方であってもよい。
（ｋ）前記実施形態では車体の前側に駆動走行部を設けさらに後側に従動走行部を設けた搬送車システムを説明したが、本発明はそれに限定されない。例えば、前側と両側を駆動走行部とすることで、４輪駆動台車とした構造にも本発明を適用できる。その場合、各駆動部は、それぞれ独立して左右モータの速度指令を作成することが好ましい。なお、４輪駆動台車以外に、６輪駆動台車、８輪駆動台車にも本発明を適用できる。
（ｌ）前記実施形態では、進入と退出及び加速と減速の全ての組合せについて制御動作を説明したが、全ての制御動作が一台の搬送車において実現される必要はない。
【産業上の利用可能性】
【０１０４】
本発明は、左右の車輪に別個にモータが設けられて独立して車輪を駆動可能な搬送車に広く適用できる。
【符号の説明】
【０１０５】
１ 搬送車システム
２ 軌道
３ 搬送車
４ 走行レール
４ａ 第１走行レール
４ｂ 第２走行レール
６ ガイドレール
６ａ 第１ガイドレール
６ｂ 第２ガイドレール
１１ 反射テープ
１１ａ 開始端
１３ バーコード
１４ 磁気マーク
１５ 搬送車本体（車体）
１８ 駆動走行部
１９ 従動走行部
２０ 本体フレーム
２１ 第１駆動輪ユニット
２２ 第２駆動輪ユニット
２３ 本体フレーム
２５ 第１走行車輪
２６ 第１モータ
２７ 第１エンコーダ
２８ 第２走行車輪
２９ 第２モータ
３０ 第２エンコーダ
３１ 第１固定ガイドローラ
３２ 第２固定ガイドローラ
３３ 第１分岐ガイドローラ
３４ 第２分岐ガイドローラ
３５ 第１分岐ガイドローラ駆動部
３６ 第１従動輪
３７ 第２従動輪
３８ 旋回軸中心
４０ 第３固定ガイドローラ
４１ 第４固定ガイドローラ
４２ 第３分岐ガイドローラ
４３ 第４分岐ガイドローラ
４４ 第２分岐ガイドローラ駆動部
４７ 光電センサ（検出部）
４９ リニアスケール
５０ バーコードリーダ
５２ 搬送車コントローラ
５４ コントローラ本体
５５ メモリ
５９ 走行制御部（制御部）
６０ 分岐制御部
６１ ルートマップ
６２ 速度パターン発生部（速度指令発生部）
６３ 第１モータ制御部
６４ 第２モータ制御部
６５Ａ 第１誤差増幅部
６５Ｂ 第２誤差増幅部
６６Ａ 第１フィードバック制御部
６６Ｂ 第２フィードバック制御部
６７Ａ 第１アンプ
６７Ｂ 第２アンプ
７０ 基準速度比率テーブル
７１ 基準外輪速度比率
７３ 基準内輪速度比率
８０ 停止位置
８１ 前側ガイドローラ対
８３ 後側ガイドローラ対
８５ 前側ガイドローラ対
８７ 後側ガイドローラ対
９０ 補償速度比率テーブル（速度指令変換テーブル）
９１ 補償外輪速度比率
９３ 補償内輪速度比率
９５ 第１中間点
９７ 第２中間点
９８ 曲線部走行軌跡テーブル
１０１ 第１速度比率変化区間
１０２ 第２速度比率変化区間
１０３ 速度比率一定区間
２０１ 第１直線部
２０２ 第２直線部
２０３ 曲線部
２０３ａ 開始位置
２０６ 分岐部
【特許請求の範囲】
【請求項１】
予め定められた経路を走行する搬送車と、
前記搬送車の走行を制御する制御部とを備え、
前記搬送車は、
車体と、
前記車体の左右に設けられた２個の走行車輪と、
前記２個の走行車輪にそれぞれ接続された２個のモータと、を有し、
前記制御部は、
前記搬送車が曲線部を走行するときに基準速度に対して内外輪にそれぞれ速度差が生じるように、曲線部の中間にある内外輪速度比率一定区間と曲線部の両端にある内外輪速度比率変化区間とにおいて速度指令を発生して前記２個のモータに与える速度指令発生部と、
前記搬送車が曲線部を走行していることを検出可能な検出部と、を有し、
前記速度指令発生部は、前記搬送車が加速中に曲線部に進入することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して進入時の加速度以下の加速度となるような速度指令を発生して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より前記速度差分以上を減らした速度となるように速度指令を発生して与える、
搬送車システム。
【請求項２】
前記制御部は、加速中に曲線部への進入を前記検出部が検出すれば、外輪となる走行車輪に対応するモータが現加速度を維持すれば内外輪速度比率変化区間内で最大速度に到達するか否かを判断する判断部をさらに有し、
最大速度に達しないと前記判断部が判断すれば、前記速度指令発生部は、外輪となる走行車輪に対応するモータに対して現加速度を維持するような速度指令を生成して与える、請求項１に記載の搬送車システム。
【請求項３】
前記速度指令発生部は、最大速度に達すると判断されれば、前記内外輪速度比率変化区間の終了点以降で外輪となる走行車輪が最大速度になるような速度指令を生成して、外輪となる走行車輪に対応するモータに対して前記速度指令を与える、請求項２に記載の搬送車システム。
【請求項４】
前記速度指令発生部は、前記搬送車が減速中に曲線部から退出することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して退出時の減速度以下の減速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より前記速度差分以上を減らした速度となるように速度指令を生成して与える、請求項１〜３のいずれかに記載の搬送車システム。
【請求項５】
前記速度指令発生部は、前記搬送車が減速中に曲線部に進入することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して進入時の減速度以下の減速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より前記速度差分以上を増やした速度となるような速度指令を生成して与える、請求項１〜４のいずれかに記載の搬送車システム。
【請求項６】
前記速度指令発生部は、前記搬送車が加速中に曲線部から退出することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して退出時の加速度以下の加速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より前記速度差分以上を増やした速度となるような速度指令を生成して与える、請求項１〜５のいずれかに記載の搬送車システム。
【請求項７】
前記経路に沿って設けられたガイドレールをさらに備え、
前記搬送車は、前記走行車輪の前側及び後側にそれぞれ設けられた前側ガイドローラ対及び後側ガイドローラ対をさらに有しており、
前記制御部は、前記搬送車が曲線部を走行するときに前記前側ガイドローラ対及び前記後側ガイドローラ対が前記ガイドレールに接触しない走行軌跡情報を保持しており、
前記速度指令発生部は、前記走行軌跡情報に基づいて速度指令発生のための速度指令変換テーブルを作成する、請求項１〜６のいずれかに記載の搬送車システム。
【請求項１】
予め定められた経路を走行する搬送車と、
前記搬送車の走行を制御する制御部とを備え、
前記搬送車は、
車体と、
前記車体の左右に設けられた２個の走行車輪と、
前記２個の走行車輪にそれぞれ接続された２個のモータと、を有し、
前記制御部は、
前記搬送車が曲線部を走行するときに基準速度に対して内外輪にそれぞれ速度差が生じるように、曲線部の中間にある内外輪速度比率一定区間と曲線部の両端にある内外輪速度比率変化区間とにおいて速度指令を発生して前記２個のモータに与える速度指令発生部と、
前記搬送車が曲線部を走行していることを検出可能な検出部と、を有し、
前記速度指令発生部は、前記搬送車が加速中に曲線部に進入することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して進入時の加速度以下の加速度となるような速度指令を発生して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より前記速度差分以上を減らした速度となるように速度指令を発生して与える、
搬送車システム。
【請求項２】
前記制御部は、加速中に曲線部への進入を前記検出部が検出すれば、外輪となる走行車輪に対応するモータが現加速度を維持すれば内外輪速度比率変化区間内で最大速度に到達するか否かを判断する判断部をさらに有し、
最大速度に達しないと前記判断部が判断すれば、前記速度指令発生部は、外輪となる走行車輪に対応するモータに対して現加速度を維持するような速度指令を生成して与える、請求項１に記載の搬送車システム。
【請求項３】
前記速度指令発生部は、最大速度に達すると判断されれば、前記内外輪速度比率変化区間の終了点以降で外輪となる走行車輪が最大速度になるような速度指令を生成して、外輪となる走行車輪に対応するモータに対して前記速度指令を与える、請求項２に記載の搬送車システム。
【請求項４】
前記速度指令発生部は、前記搬送車が減速中に曲線部から退出することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、外輪となる走行車輪に対応するモータに対して退出時の減速度以下の減速度となるような速度指令を生成して与え、内輪となる走行車輪に対応するモータに対して外輪となる走行車輪の速度より前記速度差分以上を減らした速度となるように速度指令を生成して与える、請求項１〜３のいずれかに記載の搬送車システム。
【請求項５】
前記速度指令発生部は、前記搬送車が減速中に曲線部に進入することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して進入時の減速度以下の減速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より前記速度差分以上を増やした速度となるような速度指令を生成して与える、請求項１〜４のいずれかに記載の搬送車システム。
【請求項６】
前記速度指令発生部は、前記搬送車が加速中に曲線部から退出することを前記検出部が検出すれば、前記内外輪速度比率変化区間において、内輪となる走行車輪に対応するモータに対して退出時の加速度以下の加速度となるような速度指令を生成して与え、外輪となる走行車輪に対応するモータに対して内輪となる走行車輪の速度より前記速度差分以上を増やした速度となるような速度指令を生成して与える、請求項１〜５のいずれかに記載の搬送車システム。
【請求項７】
前記経路に沿って設けられたガイドレールをさらに備え、
前記搬送車は、前記走行車輪の前側及び後側にそれぞれ設けられた前側ガイドローラ対及び後側ガイドローラ対をさらに有しており、
前記制御部は、前記搬送車が曲線部を走行するときに前記前側ガイドローラ対及び前記後側ガイドローラ対が前記ガイドレールに接触しない走行軌跡情報を保持しており、
前記速度指令発生部は、前記走行軌跡情報に基づいて速度指令発生のための速度指令変換テーブルを作成する、請求項１〜６のいずれかに記載の搬送車システム。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図１０】
【図１１】
【図１２】
【図１３】
【図１４】
【図１５】
【公開番号】特開２０１２−１７３７６０（Ｐ２０１２−１７３７６０Ａ）
【公開日】平成２４年９月１０日（２０１２．９．１０）
【国際特許分類】
【出願番号】特願２０１１−３１８５０（Ｐ２０１１−３１８５０）
【出願日】平成２３年２月１７日（２０１１．２．１７）
【出願人】（０００００６２９７）村田機械株式会社 (4,916)
【Ｆターム（参考）】
【公開日】平成２４年９月１０日（２０１２．９．１０）
【国際特許分類】
【出願日】平成２３年２月１７日（２０１１．２．１７）
【出願人】（０００００６２９７）村田機械株式会社 (4,916)
【Ｆターム（参考）】
[ Back to top ]