特許 6951611 全方向移動装置及びその姿勢制御方法

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】6951611

(24)【登録日】2021年9月29日

(45)【発行日】2021年10月20日

(54)【発明の名称】全方向移動装置及びその姿勢制御方法

(51)【国際特許分類】

   B60B 19/00 20060101AFI20211011BHJP

   B60B 19/14 20060101ALI20211011BHJP

   B60B 33/08 20060101ALI20211011BHJP

   B62K 1/00 20060101ALI20211011BHJP

【ＦＩ】

   B60B19/00 H

   B60B19/14

   B60B33/08 Z

   B62K1/00

【請求項の数】11

【全頁数】31

(21)【出願番号】特願2018-525231(P2018-525231)

(86)(22)【出願日】2017年6月28日

(86)【国際出願番号】JP2017023822

(87)【国際公開番号】WO2018003886

(87)【国際公開日】20180104

【審査請求日】2020年5月27日

(31)【優先権主張番号】特願2016-132090(P2016-132090)

(32)【優先日】2016年7月1日

(33)【優先権主張国】JP

(31)【優先権主張番号】特願2016-170938(P2016-170938)

(32)【優先日】2016年9月1日

(33)【優先権主張国】JP

(73)【特許権者】

【識別番号】518212241

【氏名又は名称】公立大学法人公立諏訪東京理科大学

(74)【代理人】

【識別番号】110001519

【氏名又は名称】特許業務法人太陽国際特許事務所

(72)【発明者】

【氏名】星野 祐

【審査官】 森本 康正

(56)【参考文献】

【文献】 米国特許出願公開第２０１３／０２５７１３８（ＵＳ，Ａ１）

【文献】 特開２０１６−０４９９２１（ＪＰ，Ａ）

【文献】 特開２０１４−１６１９９１（ＪＰ，Ａ）

【文献】 特開２０１３−２５５６７３（ＪＰ，Ａ）

【文献】 米国特許第８４５９３８３（ＵＳ，Ｂ１）

【文献】 特開２００９−２３４５２４（ＪＰ，Ａ）

(58)【調査した分野】（Int.Cl.，ＤＢ名）

Ｂ６０Ｂ １９／００−１９／１４

Ｂ６０Ｂ ３３／０８

Ｂ６２Ｋ １／００

(57)【特許請求の範囲】

【請求項2】

球状の回転体と、
前記回転体を転動させて、車体を前進方向に移動させる回転軸の前記回転体の中心よりも一端側の軸周りであって、前記回転体の球面と前記回転軸に垂直な平面の交線である第１緯線上において、前記回転体の上半球の表面に接して前記第１緯線上に複数配設され、円周方向に回転して前記回転体に前記第１緯線に沿って動力を伝達し、かつ、円周方向と交差する方向に前記回転体を転動可能とし、かつ、前記回転体を垂直軸周りに旋回可能とする動力を伝達する第１ホイールと、
前記第１緯線上における前記回転体の下半球の表面の特定位置に対する、前記回転体の中心対称位置の表面であって、前記回転軸の前記回転体の中心よりも他端側の軸周りであり、前記回転体の球面と前記回転軸に垂直な平面の交線である第２緯線上に接して配設され、円周方向に回転して前記回転体に前記第２緯線に沿って動力を伝達し、かつ、円周方向と交差する方向に前記回転体を転動可能とし、かつ、前記回転体を垂直軸周りに旋回可能とする動力を伝達する第２ホイールと、を備え、
前記第１ホイールと前記第２ホイールが前記車体に取付けられた全方向移動装置。

【請求項3】

球状の回転体と、
前記回転体を転動させて、車体を前進方向に移動させる回転軸の前記回転体の中心よりも一端側の軸周りであって、前記回転体の球面と前記回転軸に垂直な平面の交線である第１緯線上において、前記回転体の上半球の表面に接して前記第１緯線上に複数配設され、円周方向に回転して前記回転体に前記第１緯線に沿って動力を伝達し、かつ、円周方向と交差する方向に前記回転体を転動可能とし、かつ、前記回転体を垂直軸周りに旋回可能とする動力を伝達する第１ホイールと、
前記回転軸の前記回転体の中心よりも他端側の軸周りであって、前記回転体の球面と前記回転軸に垂直な平面の交線である第２緯線上に接して配設され、円周方向に回転して前記回転体に前記第２緯線に沿って動力を伝達し、かつ、円周方向と交差する方向に前記回転体を転動可能とし、かつ、前記回転体を垂直軸周りに旋回可能とする動力を伝達する第２ホイールと、を備え、
前記第１ホイールと前記第２ホイールが前記車体に取付けられた全方向移動装置。

【請求項4】

前記第１ホイール及び前記第２ホイールは、オムニホイール又はメカナムホイールである請求項２又は請求項３に記載の全方向移動装置。

【請求項5】

前記第１ホイールは２個配設され、前記第２ホイールは１個又は２個配設されている請求項２又は請求項３に記載の全方向移動装置。

【請求項6】

前記第１ホイール及び前記第２ホイールは、前記回転体との接点の位置ベクトルと前記接点における接線ベクトルとで決まる動力伝達行列の行列要素のうち、前記回転軸の行列要素の列毎に絶対値が等しくなる位置に配設されている請求項２又は請求項３に記載の全方向移動装置。

【請求項7】

前記動力伝達行列は、角速度を表す伝達行列を含んでいる請求項６に記載の全方向移動装置。

【請求項8】

前記回転体の下半球の表面に接して又は近接させて、円周方向に回転し、かつ、円周方向とは交差する方向に前記回転体を転動可能とする補助輪を更に備えている請求項２又は請求項３に記載の全方向移動装置。

【請求項9】

前記回転体上に設けられた前記車体と、
前記車体に取り付けられ、かつ、前記第１ホイールを回転させる第１駆動装置と、
前記車体に取り付けられ、かつ、前記第２ホイールを回転させる第２駆動装置と、
前記車体に配設され、前記車体の姿勢を安定に維持する姿勢安定システムと、
を更に備えた請求項２又は請求項３に記載の全方向移動装置。

【請求項10】

前記姿勢安定システムは、
前記車体に装着され、前記車体の姿勢角度及び当該姿勢角度の変化に伴う第１角速度を検出する姿勢角度検出部と、
前記第１ホイール及び前記第２ホイールの回転数を検出する回転数検出部と、
前記回転数検出部による回転数の検出結果に基づいて、前記回転体が転動する第２角速度を検出する角速度検出部と、
前記姿勢角度検出部により検出される姿勢角度情報、第１角速度情報及び前記角速度検出部により検出される第２角速度情報に基づいて、前記車体の姿勢を維持する前記第１ホイール及び前記第２ホイールのホイール操作トルクを算出し、このホイール操作トルク情報に従って前記第１駆動装置及び前記第２駆動装置を作動させる演算処理部と、
を備えた請求項９に記載の全方向移動装置。

【請求項11】

前記演算処理部は、
前記姿勢角度情報、前記第１角速度情報及び前記第２角速度情報に基づいて、前記車体の姿勢を維持させる、前記回転体が転動する角加速度の目標値及び前記車体が旋回する角加速度の目標値を算出し、
前記目標値に一致させる前記回転体の第３角加速度を算出し、
当該第３角加速度に基づいて前記回転体を操作する回転体操作トルクを算出し、
前記回転体操作トルク情報に基づいて、前記第１ホイール及び前記第２ホイールを操作する前記ホイール操作トルクを算出する
請求項１０に記載の全方向移動装置。

【請求項12】

前記請求項１０に記載された全方向移動装置の姿勢安定システムが、
前記姿勢角度情報、前記第１角速度情報及び前記第２角速度情報を取得し、
前記姿勢角度情報、前記第１角速度情報及び前記第２角速度情報に基づいて、前記車体の姿勢を維持させる、前記回転体が転動する角加速度の目標値及び前記車体が旋回する角加速度の目標値を算出し、
前記目標値に一致させる前記回転体の第３角加速度を算出し、
当該第３角加速度に基づいて前記回転体を操作する回転体操作トルクを算出し、
前記回転体操作トルク情報に基づいて、前記第１ホイール及び前記第２ホイールを操作する前記ホイール操作トルクを算出する
全方向移動装置の姿勢制御方法。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、全方向移動装置及びその姿勢制御方法に関する。

【背景技術】

【0002】

特許文献１には、搬送装置及び駆動機構が開示されている。この搬送装置は、１つの球状回転体と、３個のオムニホイールとを備えている。オムニホイールは、球状回転体に接して球状回転体を転動させ、更に球状回転体を転動する方向と異なる方向への移動を可能としている。３個のオムニホイールは、球状回転体の上半球において球状回転体の垂直軸（Z 軸）周りに等間隔で配置されている。オムニホイールのそれぞれにはホイール駆動部が接続されている。球状回転体上にはフレーム部を介して荷台が設けられ、ホイール駆動部はフレーム部に固定されている。

【0003】

上記搬送装置では、荷台の姿勢を傾けて、傾けた方向へ前後左右に移動することができ、更に旋回することができる。すなわち、搬送装置は、全方向へ自由度の高い動きを可能としている。

【先行技術文献】

【特許文献】

【0004】

【特許文献1】特開２００９−２３４５２４号公報

【発明の概要】

【発明が解決しようとする課題】

【0005】

ところで、上記搬送装置では、すべてのホイール駆動部の出力が同一の場合、旋回のときに最大出力が得られるものの、本来、搬送装置として出力が必要とされる前進や左右の移動のときに最大出力を得ることができない。例えば、前進の移動では、旋回のときの約半分の出力しか得ることができない。このため、改善の余地があった。

【0006】

本発明は、上記課題を考慮し、最大出力により回転体を直進方向へ移動させることができる全方向移動装置及び車体の姿勢を安定に維持することができる全方向移動装置の姿勢制御方法を提供する。

【課題を解決するための手段】

【0007】

上記課題を解決するため、本発明の第１実施態様に係る全方向移動装置は、球状の回転体と、回転体を転動させて直進方向に移動させる回転軸の軸周りにおいて回転体の表面に接して複数配設され、円周方向に回転して回転体に動力を伝達し、かつ、円周方向とは交差する方向に回転体を転動可能とするホイールと、を備えている。

【0008】

第１実施態様に係る全方向移動装置は、球状の回転体と、回転体の表面に接して配設されたホイールとを備える。ホイールは、円周方向に回転して回転体に動力を伝達し、かつ、円周方向とは交差する方向に回転体を転動可能とする。

【0009】

ここで、ホイールは、回転体を転動させて直進方向に移動させる回転軸の軸周りにおいて回転体の表面に複数配設される。このため、直進方向の移動に際して、ホイールから回転体へ動力が効率良く伝達され、最大出力により回転体を直進方向へ転動させることができる。

【0010】

本発明の第２実施態様に係る全方向移動装置は、球状の回転体と、回転体を転動させて直進方向に移動させる回転軸の一端側の軸周りにおいて回転体の上半球の表面に接して複数配設され、円周方向に回転して回転体に動力を伝達し、かつ、円周方向と交差する方向に回転体を転動可能とする第１ホイールと、回転軸の一端側の軸周りにおいて回転体の下半球の表面の特定位置に対する、回転体の中心対称位置の表面に接して配設され、円周方向に回転して回転体に動力を伝達し、かつ、円周方向と交差する方向に回転体を転動可能とする第２ホイールと、を備えている。

【0011】

第２実施態様に係る全方向移動装置は、球状の回転体と、回転体の表面に接して配設された第１ホイール及び第２ホイールとを備える。第１ホイール及び第２ホイールは、いずれも、円周方向に回転して回転体に動力を伝達し、円周方向と交差する方向に回転体を転動可能とする。

【0012】

ここで、第１ホイールは、回転体を転動させて直進方向に移動させる回転軸の一端側の軸周りにおいて回転体の上半球の表面に複数配設される。一方、第２ホイールは、回転軸の一端側の軸周りにおいて回転体の下半球の表面の特定位置に対する、回転体の中心対称位置の表面に配設される。このため、直進方向の移動に際して、第１ホイール、第２ホイールのそれぞれから回転体へ動力が効率良く伝達され、最大出力により回転体を直進方向へ転動させることができる。

【0013】

本発明の第３実施態様に係る全方向移動装置は、球状の回転体と、回転体を転動させて直進方向に移動させる回転軸の一端側の軸周りにおいて回転体の上半球の表面に接して複数配設され、円周方向に回転して回転体に動力を伝達し、かつ、円周方向と交差する方向に回転体を転動可能とする第１ホイールと、回転軸の他端側の軸周りにおいて回転体の上半球の表面に接して配設され、円周方向に回転して回転体に動力を伝達し、かつ、円周方向と交差する方向に回転体を転動可能とする第２ホイールと、を備えている。

【0014】

第３実施態様に係る全方向移動装置は、球状の回転体と、回転体の表面に接して配設された第１ホイール及び第２ホイールとを備える。第１ホイール及び第２ホイールは、いずれも、円周方向に回転して回転体に動力を伝達し、かつ、円周方向と交差する方向に回転体を転動可能とする。

【0015】

ここで、第１ホイールは、回転体を転動させて直進方向に移動させる回転軸の一端側の軸周りにおいて回転体の上半球の表面に複数配設される。一方、第２ホイールは、回転軸の他端側の軸周りにおいて回転体の上半球の表面に配設される。このため、直進方向の移動に際して、第１ホイール、第２ホイールのそれぞれから回転体へ動力が効率良く伝達され、最大出力により回転体を直進方向へ転動させることができる。

【0016】

本発明の第４実施態様に係る全方向移動装置では、第２実施態様又は第３実施態様に係る全方向移動装置において、第１ホイール及び第２ホイールは、オムニホイール又はメカナムホイールである。

【0017】

第４実施態様に係る全方向移動装置によれば、第１ホイール及び第２ホイールがオムニホイール又はメカナムホイールとされるので、最大出力により回転体を直進方向へ転動させることができ、かつ、直進方向以外の方向へも回転体を転動させることができる。

【0018】

本発明の第５実施態様に係る全方向移動装置では、第２実施態様又は第３実施態様に係る全方向移動装置において、第１ホイールは２個配設され、第２ホイールは１個又は２個配設されている。

【0019】

第５実施態様に係る全方向移動装置によれば、第１ホイールは２個、第２ホイールは１個又は２個配設されるので、最小限のホイール数により、部品点数並びに重量を最小限として、回転体を全方向へ転動させることができる。

【0020】

本発明の第６実施態様に係る全方向移動装置では、第２実施態様又は第３実施態様に係る全方向移動装置において、第１ホイール及び第２ホイールは、回転体との接点の位置ベクトルと接点における接線ベクトルとで決まる動力伝達行列の行列要素のうち、回転軸の行列要素の列毎に絶対値が等しくなる位置に配設されている。

【0021】

第６実施態様に係る全方向移動装置によれば、動力伝達行列の行列要素のうち、回転体を直進方向に移動させる回転軸の行列要素の列毎に絶対値が等しくなる位置に第１ホイール及び第２ホイールが配設される。このため、直進方向の移動に際して、第１ホイール、第２ホイールのそれぞれから回転体へ動力が効率良く伝達され、最大出力により回転体を直進方向へ転動させることができる。

【0022】

本発明の第７実施態様に係る全方向移動装置では、第６実施態様に係る全方向移動装置において、動力伝達行列は、角速度を表す伝達行列を含んでいる。

【0023】

第７実施態様に係る全方向移動装置によれば、動力伝達行列は角速度を表す伝達行列を含む。回転体を直進方向に移動させる回転軸の角速度を表す伝達行列において行列要素の列毎に絶対値が等しくなる位置に、第１ホイール、第２ホイールがそれぞれ配設される。このため、直進方向の移動に際して、第１ホイール、第２ホイールのそれぞれから回転体へ動力が効率良く伝達され、最大出力により回転体を直進方向へ転動させることができる。

【0024】

本発明の第８実施態様に係る全方向移動装置は、第２実施態様又は第３実施態様に係る全方向移動装置において、回転体の下半球の表面に接して又は近接させて、円周方向に回転し、かつ、円周方向と交差する方向に回転体を転動可能とする補助輪を更に備えている。

【0025】

第８実施態様に係る全方向移動装置は、回転体の下半球の表面に接して又は近接させて補助輪を備える。補助輪は、円周方向に回転し、かつ、円周方向と交差する方向に回転体を転動可能とする。このため、回転体の上半球が第１ホイール及び第２ホイールに接し、回転体の下半球に補助輪が設けられるので、回転体を全方向へ転動可能としつつ、回転体の抜けを防ぐことができる。

【0026】

本発明の第９実施態様に係る全方向移動装置では、第２実施態様又は第３実施態様に係る全方向移動装置において、回転体上に設けられた車体と、車体に取り付けられ、かつ、第１ホイールを回転させる第１駆動装置と、車体に取り付けられ、かつ、第２ホイールを回転させる第２駆動装置と、車体に配設され、車体の姿勢を安定に維持する姿勢安定システムと、を更に備えている。

【0027】

第９実施態様に係る全方向移動装置によれば、回転体上には車体が設けられる。第１ホイールの回転軸には第１駆動装置が接続され、第１駆動装置は車体に取り付けられる。また、第２ホイールの回転軸には第２駆動装置が接続され、第２駆動装置は車体に取り付けられる。第１ホイール、第２ホイールはいずれも回転体の上半球の表面に接する。このため、車体の荷重が第１駆動装置を介して第１ホイール及び第２駆動装置を介して第２ホイールにより支えられ、姿勢安定システムにより車体の姿勢が安定に維持された状態において、最大出力により回転体を直進方向へ転動させることができる。

【0028】

本発明の第１０実施態様に係る全方向移動装置では、第９実施態様に係る全方向移動装置において、姿勢安定システムは、車体に装着され、車体の姿勢角度及び姿勢角度の変化に伴う第１角速度を検出する姿勢角度検出部と、第１ホイール及び第２ホイールの回転数を検出する回転数検出部と、回転数検出部による回転数の検出結果に基づいて、回転体が転動する第２角速度を検出する角速度検出部と、姿勢角度検出部により検出される姿勢角度情報、第１角速度情報及び角速度検出部により検出される第２角速度情報に基づいて、車体の姿勢を維持する第１ホイール及び第２ホイールのホイール操作トルクを算出し、このホイール操作トルク情報に従って第１駆動装置及び第２駆動装置を作動させる演算処理部と、を備えている。

【0029】

第１０実施態様に係る全方向移動装置によれば、姿勢安定システムは、姿勢角度検出部と、回転数検出部と、角速度検出部と、演算処理部とを備える。姿勢角度検出部は、車体に装着され、車体の姿勢角度及び姿勢角度の変化に伴う第１角速度を検出する。回転数検出部は、第１ホイール及び第２ホイールの回転数を検出する。角速度検出部は、回転数検出部による回転数の検出結果に基づいて、回転体が転動する第２角速度を検出する。

【0030】

ここで、演算処理部は、姿勢角度検出部により検出される姿勢角度情報、第１角速度情報及び角速度検出部により検出される第２角速度情報に基づいて、車体の姿勢を維持する第１ホイール及び第２ホイールのホイール操作トルクを算出する。そして、演算処理部は、このホイール操作トルク情報に従って第１駆動装置及び第２駆動装置を作動させる。このため、姿勢安定システムでは、車体の姿勢を安定に維持する動力が第１ホイール及び第２ホイールから回転体へ伝達されるので、車体の姿勢が安定に維持された状態において、最大出力により回転体を直進方向へ転動させることができる。

【0031】

本発明の第１１実施態様に係る全方向移動装置では、第１０実施態様に係る全方向移動装置において、演算処理部は、姿勢角度情報、第１角速度情報及び第２角速度情報に基づいて、車体の姿勢を維持させる、回転体が転動する角加速度の目標値及び車体が旋回する角加速度の目標値を算出し、目標値に一致させる回転体の第３角加速度を算出し、第３角加速度に基づいて回転体を操作する回転体操作トルクを算出し、回転体操作トルク情報に基づいて、第１ホイール及び第２ホイールを操作するホイール操作トルクを算出する。

【0032】

第１１実施態様に係る全方向移動装置によれば、演算処理部では、姿勢角度情報、第１角速度情報及び第２角速度情報に基づいて、車体の姿勢を維持させる、回転体が転動する角加速度の目標値及び車体が旋回する角加速度の目標値が算出される。演算処理部では、更に目標値に一致させる回転体の第３角加速度が算出され、第３角加速度に基づいて回転体を操作する回転体操作トルクが算出される。この回転体操作トルク情報に基づいて、演算処理部では、第１ホイール及び第２ホイールを操作するホイール操作トルクが算出される。この結果、演算処理部において、車体の姿勢を安定に維持する動力が算出される。このため、動力が第１ホイール及び第２ホイールから回転体へ伝達されるので、車体の姿勢が安定に維持された状態において、最大出力により回転体を直進方向へ転動させることができる。

【0033】

本発明の第１２実施態様に係る全方向移動装置の姿勢制御方法では、第１０実施態様に係る全方向移動装置の姿勢安定システムが、姿勢角度情報、第１角速度情報及び第２角速度情報を取得し、姿勢角度情報、第１角速度情報及び第２角速度情報に基づいて、車体の姿勢を維持させる、回転体が転動する角加速度の目標値及び車体が旋回する角加速度の目標値を算出し、目標値に一致させる回転体の第３角加速度を算出し、第３角加速度に基づいて回転体を操作する回転体操作トルクを算出し、回転体操作トルク情報に基づいて、第１ホイール及び第２ホイールを操作するホイール操作トルクを算出する。

【0034】

第１２実施態様に係る全方向移動装置の姿勢制御方法によれば、姿勢安定システムが、まず最初に、姿勢角度情報、第１角速度情報及び第２角速度情報を取得する。次に、姿勢角度情報、第１角速度情報及び第２角速度情報に基づいて、車体の姿勢を維持させる、回転体が転動する角加速度の目標値及び車体が旋回する角加速度の目標値が算出される。次に、目標値に一致させる回転体の第３角加速度が算出され、更に第３角加速度に基づいて回転体を操作する回転体操作トルクが算出される。そして、回転体操作トルク情報に基づいて、第１ホイール及び第２ホイールを操作するホイール操作トルクが算出される。この結果、姿勢安定システムにおいて、車体の姿勢を安定に維持する動力が算出される。

【0035】

このため、動力が第１ホイール及び第２ホイールから回転体へ伝達されるので、全方向移動装置では、最大出力により回転体を直進方向へ転動させることができ、車体の姿勢を安定に維持することができる。

【発明の効果】

【0036】

本発明によれば、最大出力により回転体を直進方向へ移動させることができる全方向移動装置及び車体の姿勢を安定に維持することができる全方向移動装置の姿勢制御方法を提供することができる。

【図面の簡単な説明】

【0037】

【図1】本発明の第１実施の形態に係る全方向移動装置の外観構成図であり、（Ａ）は左側面図、（Ｂ）は進行方向から見た正面図、（Ｃ）は背面図、（Ｄ）は底面図である。

【図2】図１に示される全方向移動装置の駆動ユニットの要部拡大斜視図である。

【図3】図１に示される全方向移動装置の回転体と図２に示される駆動ユニットのオムニホイールとの位置関係を示す図であり、（Ａ）は全方向移動装置の進行方向右側から見た側面図、（Ｂ）は全方向移動装置の進行方向左側から見た側面図である。

【図4】図１に示される全方向移動装置に組み込まれる姿勢安定システムを説明するブロック図である。

【図5】図４に示される姿勢安定システムの姿勢制御方法を説明するフローチャートである。

【図6】図４に示される姿勢安定システムのアルゴリズムを説明する図である。

【図7】第１実施の形態に係る動力伝達行列を説明する回転体及び３個のオムニホイールを示す概略図である。

【図8】第１実施の形態に係る動力伝達行列を説明する回転体及び４個のオムニホイールを示す概略図である。

【図9】比較例に係る動力伝達行列を説明する回転体及び３個のオムニホイールを示す概略図である。

【図10】比較例に係る動力伝達行列を説明する回転体及び４個のオムニホイールを示す概略図である。

【図11】本発明の第２実施の形態に係る全方向移動装置の動力伝達行列を説明する回転体及び４個のメカナムホイールを示す概略図である。

【発明を実施するための形態】

【0038】

（第１実施の形態）
以下、図１〜図１０を用いて、本発明の第１実施の形態に係る全方向移動装置を説明する。なお、図中、適宜示される矢印X 方向は全方向移動装置の車体前方側であって進行方向を示し、矢印Y 方向は車体幅方向を示している。また、矢印Z 方向は、矢印X 方向及び矢印Y 方向に対して直交する上方向を示している。

【0039】

［全方向移動装置の構成］
図１（Ａ）〜図１（Ｄ）及び図２に示されるように、本実施の形態に係る全方向移動装置１０は、単一の球状の回転体１２と、この回転体１２上に配設された車体１４とを含んで構成されている。

【0040】

回転体１２は、例えば、直径３００ｍｍ、厚さ１．５ｍｍのステンレス鋼を用いて形成された球殻を回転体本体とし、回転体本体の表面を回転体本体よりも軟質材料により被覆して形成されている。軟質材料として、例えば、厚さ５ｍｍの天然ゴム（NR：Natural Rubber）を実用的に使用することができる。

【0041】

図１（Ａ）〜図１（Ｄ）に示されるように、車体１４は車体幅方向（矢印Y 方向）に一対に配設された車体本体１４Ａ及び車体本体１４Ｂを備えている。車体本体１４Ａ及び車体本体１４Ｂは、各々、車体前後方向（矢印X 方向）を長手方向として延在し、車体幅方向に離間して配置されている。車体本体１４Ａ及び車体本体１４Ｂは、平面視において、回転体１２と重なる位置に配設されている。車体本体１４Ａ及び車体本体１４Ｂには、上方向へ立設されたサドルサポート１６を介してサドル１８が取り付けられている。サドルサポート１６は管材により形成されている。サドル１８は全方向移動装置１０の搭乗者が着座する構成とされている。

【0042】

車体本体１４Ａ及び車体本体１４Ｂの車体前方側には、車体１４を構成する車体前部１４Ｃが配設されている。車体前部１４Ｃは、上下方向において車体本体１４Ａ及び車体本体１４Ｂの上面よりも下方向であって回転体１２の中心点付近に配置され、車体本体１４Ａ及び車体本体１４Ｂの前壁１４Ｄに一体的に取り付けられている。車体前部１４Ｃは管材を折り曲げて形成され、車体前部１４Ｃの輪郭が平面視においてＣ字状に形成されている。

【0043】

車体前部１４Ｃ上には足置き部２０が車体幅方向に一対に配設されている。足置き部２０は搭乗者の足の置き場として使用される。また、車体前部１４Ｃには、上方向に向けてやや車体後方側に傾斜して立設されたハンドルサポート２２が配設され、ハンドルサポート２２の上端部にはハンドル２４が取り付けられている。ハンドル２４は車体幅方向外側へ向かって左右にそれぞれ突出された棒状に形成され、搭乗者はハンドル２４を把持して全方向移動装置１０を走行させる。ハンドル２４は、ここでは垂直軸（Z 軸）周りに旋回しない固定式により形成されている。図示を省略しているが、全方向移動装置１０の走行の開始や停止を行う始動スイッチ、全方向移動装置１０の走行中の速度を制動するブレーキ等はハンドル２４周りに装着されている。また、保安部品として、ライト、フロントウインカ等が、ハンドル２４又はハンドルサポート２２に装着可能である。さらに、保安部品としてのリアウインカ、ブレーキランプ等が、車体１４の車体後端部の適正箇所に装着可能である。

【0044】

車体本体１４Ａ及び車体本体１４Ｂ下において、回転体１２の周囲に沿ってリング状の枠部２６が配設されている。この枠部２６は車体幅方向両端部にそれぞれ設けられた枠サポート２８を介して車体本体１４Ａ、車体本体１４Ｂのそれぞれに取り付けられている。

【0045】

また、車体本体１４Ａ及び車体本体１４Ｂの車体前端部には、補助輪サポート３０を介して補助輪３２が配設されている。補助輪サポート３０は車体本体１４Ａ及び車体本体１４Ｂから回転体１２の中心点よりも下方側まで延設され、補助輪サポート３０の下端部に補助輪３２が回転自在に取り付けられている。同様に、車体本体１４Ａ及び車体本体１４Ｂの車体後端部には、補助輪サポート３４を介して補助輪３６が配設されている。補助輪サポート３４は車体本体１４Ａ及び車体本体１４Ｂから回転体１２の中心点よりも下方側まで延設され、補助輪サポート３４の下端部に補助輪３６が回転自在に取り付けられている。補助輪３２、補助輪３６は、いずれも回転体１２の下半球１２Ａ側に回り込む位置に配置され、下半球１２Ａの表面に接するか、或いは一定のクリアランスを持って離間（近接）されている。補助輪３２及び補助輪３６を備えることにより、車体１４からの回転体１２の抜けが防止されている。本実施の形態では、補助輪３２、補助輪３６のそれぞれに、後述するホイール、ここではオムニホイールが使用されている。

【0046】

図１（Ａ）〜図１（Ｄ）に示される全方向移動装置１０では、サドル１８に着座状態の搭乗者から見て車体幅方向右側において、車体本体１４Ａ下の車体前方側に、符号を省略した外装カバーにより被覆された第１駆動ユニット４０が取り付けられている。車体本体１４Ａ下の車体後方側には第２駆動ユニット４２が取り付けられている。一方、車体幅方向左側において、車体本体１４Ｂ下の車体前方側に第３駆動ユニット４４が取り付けられ、車体本体１４Ｂの車体後方側に第４駆動ユニット４６が取り付けられている。

【0047】

ここで、本実施の形態では、第１駆動ユニット４０〜第４駆動ユニット４６の合計４個の駆動ユニットが配設されているが、第１駆動ユニット４０〜第３駆動ユニット４４の合計３個の駆動ユニットが配設される場合が含まれる。３個の駆動ユニットが配設される場合、第３駆動ユニット４４は車体本体１４Ｂの車体前後方向の中間部に配設される。

【0048】

［オムニホイールの構成］
図２に示されるように、第１駆動ユニット４０は、第１オムニホイールとしてのオムニホイール４０１と、減速機４４１と、第１駆動装置としての例えば交流（ＡＣ）サーボモータ４４２（１）とを含んで構成されている。オムニホイール４０１は、シャフト（回転軸）４３０を介して減速機４４１に連結されている。

【0049】

オムニホイール４０１は、シャフト４３０の回転に従ってシャフト４３０の回転軸周りに回転し、かつ、回転軸方向に２連をなす第１ホイール４１０及び第２ホイール４２０を備えている。第１ホイール４１０のホイール本体４１１の円周上には、等間隔に配設された複数の樽状のローラ（バレル）４１２〜４１４が回転軸４１５を中心に回転自在に取り付けられている。ここで、等間隔とは１２０度間隔であり、３つのローラ４１２〜４１４が取り付けられている。第２ホイール４２０は第１ホイール４１０の減速機４４１側とは反対側に配設されている。第２ホイール４２０のホイール本体４２１の円周上には、同様に、等間隔に配設された複数の樽状のローラ４２２〜４２４が回転軸４２５を中心として回転自在に取り付けられている。第２ホイール４２０のローラ４２２〜４２４の配置間隔は、第１ホイール４１０のローラ４１２〜４１４の配置間隔に対して、半ピッチ、具体的には６０度ずれている。このような構成により、オムニホイール４０１は、円周方向Ａに回転して回転体１２に動力を伝達し、かつ、円周方向Ａと交差する方向（ここでは直交する方向）Ｂに回転体１２を転動可能としている。
ここで、図２に示されるように、オムニホイール４０１のシャフト４３０の回転軸をａとし、ローラ４１２〜４１４の回転軸４１５をｂとすれば、回転軸ｂは回転軸ａに対してねじれの位置において直交している。

【0050】

第２駆動ユニット４２、第３駆動ユニット４４、第４駆動ユニット４６のそれぞれの構成は、第１駆動ユニット４０の構成と同一である。すなわち、図２に示されるように、第２駆動ユニット４２は、第１オムニホイールとしてのオムニホイール４０２と、減速機４４１と、第１駆動装置としてのＡＣサーボモータ４４２（２）とを含んで構成されている。第３駆動ユニット４４は、第２オムニホイールとしてのオムニホイール４０３と、減速機４４１と、第２駆動装置としてのＡＣサーボモータ４４２（３）とを含んで構成されている。第４駆動ユニット４６は、第２オムニホイールとしてのオムニホイール４０４と、減速機４４１と、第２駆動装置としてのＡＣサーボモータ４４２（４）とを含んで構成されている。

【0051】

本実施の形態に係る全方向移動装置１０では、前後方向及び左右方向への移動が可能とされ、かつ、旋回が可能とされている。勿論、斜め方向への移動、旋回しながらの前後方向、左右方向又は斜め方向の移動が可能である。そして、全方向移動装置１０では、前進方向に最大出力が得られる構成とされている。

【0052】

［オムニホイールの配置］
一般的に、複数のオムニホイールは垂直軸（Z 軸）の軸周りに等間隔に配置されている（図９及び図１０参照）。これに対して、図３（Ａ）に示されるように、全方向移動装置１０では、オムニホイール４０１及び４０２が、回転体１２を転動させて直進方向に移動させる回転軸１２０の一端側の軸周り１２１において、回転体１２の上半球１２Ｂの表面に接して配設されている。ここで、回転体１２には固定された回転軸が存在するのではなく、回転軸１２０は直進方向に回転体１２が転動された際の回転体１２の実効的な回転中心である。回転軸１２０の軸方向は、回転体１２が直進方向（矢印X 方向）に転動するので、車体幅方向（矢印Y 方向）に一致する。また、回転軸１２０の一端側の軸周り１２１は、搭乗者から見て車体幅方向右側において、回転体１２を天体と見なしたときの緯線に相当する。

【0053】

オムニホイール４０３及び４０４は、図３（Ｂ）に示されるように、回転軸１２０の他端側の軸周り１２２において回転体１２の上半球１２Ｂの表面に接して配設されている。回転軸１２０の他端側の軸周り１２２は、搭乗者から見て車体幅方向左側において、回転体１２を天体と見なしたときの緯線に相当する。オムニホイール４０３及び４０４の配置位置は、図３（Ａ）に示される回転軸１２０の一端側の軸周り１２１において回転体１２の下半球１２Ａの表面の特定位置４０３Ｐ及び４０４Ｐに対する回転体１２の中心対称位置である。

【0054】

本来、オムニホイール４０３は軸周り１２１において下半球１２Ａに配置され、オムニホイール４０４は軸周り１２１において下半球１２Ａに配置される。特定位置４０３Ｐは、進行方向に最大出力を得る際に、軸周り１２１の下半球１２Ａにおいてオムニホイール４０３の配置に適した位置である。また、同様に、特定位置４０４Ｐは軸周り１２１の下半球１２Ａにおいてオムニホイール４０４の配置に適した位置である。本実施の形態では、下半球１２Ａ側に第３駆動ユニット４４及び第４駆動ユニット４６が装着し難いので、軸周り１２２において回転体１２の上半球１２Ｂ側にオムニホイール４０３及び４０４が配設されている。

【0055】

なお、第１駆動ユニット４０〜第３駆動ユニット４４を備える場合には、回転軸１２０の一端側の軸周り１２１において回転体１２の上半球１２Ｂに接してオムニホイール４０１及び４０２が配設される（図３（Ａ）参照）。そして、オムニホイール４０３は、回転軸１２０の他端側の軸周り１２２において回転体１２の上半球１２Ｂに接してオムニホイール４０３が配設される（図３（Ｂ）参照）。この場合、回転軸１２０の軸方向から見て、オムニホイール４０３は、図３（Ｂ）に示されるオムニホイール４０３とオムニホイール４０４との中間部に配設される。

【0056】

図１（Ａ）〜図１（Ｄ）に戻って、全方向移動装置１０の車体１４上であってサドル１８下にはセンサユニット５０が配設されている。また、車体１４上の車体後方側には、制御ユニット６０が配設されている。センサユニット５０及び制御ユニット６０は図４に示される姿勢安定システム６００を構築し、この姿勢安定システム６００は、車体１４の姿勢を安定に維持し、又車体１４の姿勢を安定に維持した状態において車体１４を走行させる。

【0057】

［姿勢安定システムの構成］
図４に示されるように、全方向移動装置１０の姿勢安定システム６００は、センサユニット５０及び制御ユニット６０を含んで構成されている。
センサユニット５０には姿勢角度検出部５０１が含まれている。姿勢角度検出部５０１には例えば慣性計測装置（IMU：Inertial Measurement Unit）が使用されている。この姿勢角度検出部５０１では、車体１４の姿勢角度及び車体１４の各軸周りの姿勢角度の変化に伴う第１角速度としての角速度が検出される。姿勢角度は姿勢角度情報として、角速度は第１角速度情報として、姿勢角度検出部５０１から出力される。

【0058】

制御ユニット６０は、操作表示部６０１と、演算処理部（コントローラ）６０２と、デジタルアナログ変換器（Ｄ／Ａ変換器）６０３と、角速度検出部６０４と、サーボアンプ６０５（１）〜サーボアンプ６０５（４）と、電源６０６とを備えている。ここで、姿勢安定システム６００には、第１駆動ユニット４０のＡＣサーボモータ４２２（１）〜第４駆動ユニット４６のＡＣサーボモータ４２２（４）が回転数検出部６０７として組み込まれている。ＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）の各々には図示を省略した例えばエンコーダが装着され、エンコーダを用いてオムニホイール４０１〜オムニホイール４０４の回転数が検出される。回転数検出部６０７は、ＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）と、サーボアンプ６０５（１）〜サーボアンプ６０５（４）とを含んで構成されている。

【0059】

操作表示部６０１は、姿勢安定システム６００の起動及び終了の操作、姿勢安定システム６００の動作状態の表示等を行う。

【0060】

演算処理部６０２には、例えばmini-ITX規格準拠の組込み用パーソナルコンピュータが使用されている。演算処理部６０２では、少なくとも下記処理（Ａ）〜処理（Ｄ）が実行される。
（Ａ）車体１４の姿勢角度を検出して得られる姿勢角度情報及び姿勢角度の変化に伴う角速度を検出して得られる第１角速度情報が姿勢角度検出部５０１から取得される。
（Ｂ）回転数検出部６０７ではオムニホイール４０１〜４０４の回転数が検出される。この回転数の検出結果が回転数検出部６０７から取得され、この検出結果に基づいて、回転体１２が転動する第２角速度としての角速度が算出される。この第２角速度は第２角速度情報として取得される。
（Ｃ）姿勢角度情報、第１角速度情報及び第２角速度情報に基づいて、車体１４の姿勢を安定に維持するオムニホイール４０１〜オムニホイール４０４のホイール操作トルクが算出される。
（Ｄ）ホイール操作トルク情報に従って第１駆動ユニット４０〜第４駆動ユニット４６が作動される。

【0061】

さらに、演算処理部６０２では、処理（Ｄ）において、下記処理（ａ）〜処理（ｄ）が実行される。
（ａ）姿勢角度情報、第１角速度情報及び第２角速度情報に基づいて、車体１４の姿勢を安定に維持させる、回転体１２が転動する角加速度の目標値及び車体１４が旋回する角加速度の目標値が算出される。
（ｂ）目標値に一致させる回転体１２の第３角加速度としての角加速度が算出される。
（ｃ）第３角加速度情報に基づいて、回転体１２を操作する回転体操作トルクが算出される。
（ｄ）回転体操作トルク情報に基づいて、オムニホイール４０１〜オムニホイール４０４を操作するホイール操作トルクが算出される。

【0062】

演算処理部６０２から出力されるホイール操作トルク情報（デジタル情報）はトルク指令としてデジタルアナログ変換器６０３へ出力される。デジタルアナログ変換器６０３ではトルク指令がアナログ情報に変換され、アナログ情報に変換されたトルク指令はデジタルアナログ変換器６０３からサーボアンプ６０５（１）〜サーボアンプ６０５（４）の各々へ出力される。また、サーボアンプ６０５（１）〜サーボアンプ６０５（４）には演算処理部６０２からシーケンス指令が出力される。サーボアンプ６０５（１）〜サーボアンプ６０５（４）は、トルク指令に従ってＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）のそれぞれを制御する。

【0063】

一方、回転数検出部６０７においてＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）の各々の回転数が検出されると、この検出結果はサーボアンプ６０５（１）〜サーボアンプ６０５（４）のそれぞれを介して角速度検出部６０４へ出力される。角速度検出部６０４は、ここではパルスカウンタにより構成され、単位時間当たりの回転数をカウントして角速度情報を生成する。この角速度情報は演算処理部６０２へ出力される。

【0064】

そして、姿勢安定システム６００には着脱自在とされる電源６０６が搭載されている。電源６０６には二次電池、具体的にはバッテリが使用されている。また、電源６０６は、制御系に電源を供給する二次電池と、動力系に電源を供給する二次電池とを含んで構成されている。詳しく説明すると、制御系には、姿勢角度検出部５０１、操作表示部６０１、演算処理部６０２、デジタルアナログ変換器６０３及び角速度検出部６０４が含まれている。一方、動力系には、サーボアンプ６０５（１）〜サーボアンプ６０５（４）及びＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）が含まれている。

【0065】

［全方向移動装置の姿勢制御方法］
前述の全方向移動装置１０の姿勢制御方法は以下の通りである。ここで、図５は姿勢制御方法を説明するフローチャートである。図６は姿勢制御方法を実現するアルゴリズムである。また、姿勢制御方法の説明では、適宜、図１〜図４が参酌される。

【0066】

１．３個のオムニホイールを有する全方向移動装置の姿勢制御方法
（１）車体の姿勢角度及び第１角速度の取得
まず最初に、図４及び図６に示される姿勢角度検出部５０１を用いて、車体１４の姿勢角度θ_b 及び姿勢角度の変化に伴う車体１４の第１角速度（θ_b の１回微分）が検出される。図４〜図６に示されるように、演算処理部６０２は、姿勢角度検出部５０１から姿勢角度情報及び第１角速度情報を取得する（Ｓ１０）。

【0067】

（２）オムニホイールの回転数の取得
次に、図４に示される回転数検出部６０７のＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（３）を用いて、オムニホイール４０１〜４０３の回転数が検出される。検出された回転数は、図４及び図６に示されるように、サーボアンプ６０５（１）〜サーボアンプ６０５（３）を介して角速度検出部６０４に出力される。角速度検出部６０４では、角速度情報θ₀ としてオムニホイール４０１〜４０３の回転数を取得する。図５に示されるように、演算処理部６０２は、角速度検出部６０４から角速度情報θ₀ を取得する（Ｓ１１）。

【0068】

（３）回転体の第２角速度の取得
ここで、図７に、全方向移動装置１０の回転体１２に対する３個のオムニホイール４０１〜４０３の配置位置を、原点O₀とするX₀軸、Y₀ 軸及びZ₀ 軸を含む３次元座標系により表した概略図が示されている。
回転体１２に対するオムニホイール４０１〜４０３の各々の配置位置及び駆動力は、回転体１２とオムニホイール４０１〜４０３の各々との接点の位置ベクトルp_k と、接点における接線ベクトルt_k により表される。n をオムニホイールの数として、k は１からn の整数である。位置ベクトルp₁ は、回転体１２の中心O_b から回転体１２とオムニホイール４０１との接点までの位置ベクトルである。同様に、位置ベクトルp₂ は中心O_b から回転体１２とオムニホイール４０２との接点までの位置ベクトル、位置ベクトルp₃ は中心O_b から回転体１２とオムニホイール４０３との接点までの位置ベクトルである。
接線ベクトルt₁ は、回転体１２とオムニホイール４０１との接点における単位接線ベクトルである。同様に、接線ベクトルt₂ は回転体１２とオムニホイール４０２との接点における単位接線ベクトル、接線ベクトルt₃ は回転体１２とオムニホイール４０３との接点における単位接線ベクトルである。

【0069】

回転体１２の角速度ベクトルω_sは、回転体１２の車体前後方向の軸周りの角速度をω_x とし、回転体１２の車体幅方向の軸周りの角速度をω_y とし、回転体１２の車体上下方向の軸周りの角速度をω_z とすると、下記式（１）により表される（図６参照）。

【数1】

【数2】

【0070】

動力伝達行列T は、位置ベクトルp_{1 ，}p_{2 ，}p₃、接線ベクトルt_{1 ，}t_{2 ，}t₃ 及びオムニホイール４０１〜４０３の半径r₀ から、下記式（３）により表される。

【数3】

【数4】

【0071】

また、式（４）は、動力伝達行列T の一般化逆行列を用いると、下記式（５）により表される（図６参照）。

【数5】

上記式（５）により、オムニホイール４０１〜オムニホイール４０３の角速度から回転体１２の第２角速度が算出される。図６に示されるように、第２角速度は演算処理部６０２を用いて算出され、図５に示されるように、演算処理部６０２は第２角速度を第２角速度情報として取得する（Ｓ１２）。

【0072】

（４）目標値の算出
車体１４の姿勢を回転体１２上において安定に維持するには、車体１４の姿勢角度と車体１４の第１角速度とに基づいて、車体１４の姿勢を補正する回転体１２の転動の際の角加速度の目標値及び車体１４の旋回の際の角加速度の目標値が必要になる。目標値をu とすれば、目標値u は下記式（６）により算出される（図６参照）。

【数6】

【0073】

目標値u は、下記式（７）に示されるように、車体１４の旋回の目標角加速度u₁ と、回転体１２の車体前後方向の軸周りの目標角加速度u₂ と、回転体１２の車体幅方向の軸周りの目標角加速度u₃ とを纏めたベクトルである。

【数7】

【0074】

ロール角をγ、ピッチ角をβ、ヨー角をαとすると、式（６）のx_d は下記式（８）により表される。

【数8】

【0075】

また、K_d は、フィードバックゲイン行列であり、車体１４と回転体１２の質量、重心位置、慣性モーメント等に基づいて決定される。
図５及び図６に示されるように、目標値u 、すなわち回転体１２が転動する角加速度の目標値及び車体１４が旋回する角加速度の目標値は演算処理部６０２を用いて算出される（Ｓ１３）。

【0076】

（５）回転体の操作角加速度の算出

【0077】

車体１４の姿勢を回転体１２上で安定化する際に外乱の影響を低減する必要がある。このため、目標値ｕにＰＩＤ制御（Ｐｒｏｐｏｒｔｉｏｎａｌ Ｉｎｔｅｇｒａｌ Ｄｉｆｆｅｒｅｎｔｉａｌ Ｃｏｎｔｒｏｌｌｅｒ）が付加され、新たな角加速度の操作量が算出される（図６参照）。

【数9】

【0078】

ω_ｘｄは回転体１２の車体前後方向の軸周りの目標角速度であり、目標角速度ω_ｘｄは下記式（１０）により表される。

【数10】

【0079】

θ_ｘｄは回転体１２の車体前後方向の軸周りの目標角度であり、この目標角度θ_ｘｄは下記式（１１）により表される。

【数11】

θ_ｘは回転体１２の車体前後方向の軸周りの角度であり、角度θ_ｘは回転体１２の車体前後方向の軸周りの角速度ω_ｘから下記式（１２）により表される。

【数12】

【0080】

ω_ydは回転体１２の車体幅方向の軸周りの目標角速度であり、目標角速度ω_yd は下記式（１３）により表される。

【数13】

θ_ydは回転体１２の車体幅方向の軸周りの目標角度であり、この目標角度θ_yd は下記式（１４）により表される。

【数14】

【0081】

θ_yは回転体１２の車体幅方向の軸周りの角度であり、角度θ_y は回転体１２の車体幅方向の軸周りの角速度ω_y から下記式（１５）により表される。

【数15】

回転体１２の操作角加速度は、第３角加速度として、図５及び図６に示されるように、演算処理部６０２を用いて算出される（Ｓ１４）。

【0082】

（６）回転体の操作トルクの算出

【数16】

【0083】

ここで、慣性行列の部分行列は、下記式（１７）、式（１８）及び式（１９）により表される。

【数17】

【数18】

【数19】

【0084】

また、重力項は下記式（２０）により表される。下記式（２１）は入力軸の入れ替えを表す行列である。

【数20】

【数21】

【0085】

上記式（１７）、式（１８）において、I_s は回転体１２と地面との接点周りの回転体１２の慣性モーメントである。慣性モーメントI_s は下記式（２２）により表される。

【数22】

ここで、I_bxx ，I_bxy ，I_bxz ，I_byy ，I_byz ，I_bzz は車体１４の慣性モーメントと慣性乗積である。m_b は車体１４の質量である。s_z は回転体１２の中心O_b から車体１４の重心までの距離である。r_s は回転体１２の半径である。g は重力加速度定数である。m_s は回転体１２の質量である。

【数23】

【0086】

回転体１２の操作トルクは、図５及び図６に示されるように、演算処理部６０２を用いて算出される（Ｓ１５）。

【0087】

（７）オムニホイールの操作トルクの算出
回転体１２にトルクを生じさせるために、各オムニホイール４０１〜４０３が発生すべき操作トルクτ_o は下記式（２３）により算出される。

【数24】

【0088】

オムニホイール４０１〜４０３の操作トルクτ_oは、図５及び図６に示されるように、演算処理部６０２を用いて算出される（Ｓ１６）。この操作トルクτ_oは、ホイール操作トルクとして、ＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（３）を介してオムニホイール４０１〜４０３に伝達される。
以上説明した姿勢制御方法の手順が実行されると、全方向移動装置１０では、車体１４の姿勢を回転体１２上において安定に維持することができる。そして、車体１４の姿勢を安定に維持した状態において、全方向移動装置１０を走行させることができる。

【0089】

２．４個のオムニホイールを有する全方向移動装置の姿勢制御方法
４個のオムニホイール４０１〜４０４を有する全方向移動装置１０の姿勢制御方法は、基本的には３個のオムニホイール４０１〜４０３を有する全方向移動装置１０の姿勢制御方法とほぼ同一である。ここでの姿勢制御方法の説明は、図４〜図６を用いて、重複する説明を極力省略しつつ、異なる手順だけを簡潔に説明する。

【0090】

（１）車体の姿勢角度及び第１角速度の取得
図４及び図６に示される姿勢角度検出部５０１を用いて、車体１４の姿勢角度及び車体１４の第１角速度が検出される。図４〜図６に示されるように、演算処理部６０２は、姿勢角度検出部５０１から姿勢角度情報及び第１角速度情報を取得する（Ｓ１０）。

【0091】

（２）オムニホイールの回転数の取得
次に、図４に示される回転数検出部６０７のＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）を用いて、オムニホイール４０１〜４０４の回転数が検出される。検出された回転数は、図４及び図６に示されるように、サーボアンプ６０５（１）〜サーボアンプ６０５（４）を介して角速度検出部６０４に出力される。図５に示されるように、演算処理部６０２は角速度検出部６０４から角速度情報θ₀ を取得する（Ｓ１１）。

【0092】

（３）回転体の第２角速度の取得
ここで、図８に、全方向移動装置１０の回転体１２に対する４個のオムニホイール４０１〜４０４の配置位置を３次元座標系により表した概略図が示されている。
回転体１２に対するオムニホイール４０１〜４０４の各々の配置位置及び駆動力は、回転体１２とオムニホイール４０１〜４０４の各々との接点の位置ベクトルp_k と、接点における接線ベクトルt_k により表される。位置ベクトルp₁ は、回転体１２の中心O_bから回転体１２とオムニホイール４０１との接点までの位置ベクトルである。同様に、位置ベクトルp₂ は中心O_bから回転体１２とオムニホイール４０２との接点までの位置ベクトル、位置ベクトルp₃ は中心O_bから回転体１２とオムニホイール４０３との接点までの位置ベクトルである。そして、位置ベクトルp₄ は中心O_bから回転体１２とオムニホイール４０４との接点までの位置ベクトルである。
接線ベクトルt₁ は、回転体１２とオムニホイール４０１との接点における単位接線ベクトルである。同様に、接線ベクトルt₂ は回転体１２とオムニホイール４０２との接点における単位接線ベクトル、接線ベクトルｔ_３は回転体１２とオムニホイール４０３との接点における単位接線ベクトルである。そして、接線ベクトルｔ_４は回転体１２とオムニホイール４０４との接点における単位接線ベクトルである。

【0093】

回転体１２の角速度ベクトルω_ｓは、回転体１２の車体前後方向の軸周りの角速度をω_ｘとし、回転体１２の車体幅方向の軸周りの角速度をω_ｙとし、回転体１２の車体上下方向の軸周りの角速度をω_ｚとすると、前述の式（１）により表される。

【数25】

【0094】

動力伝達行列Ｔは、位置ベクトルｐ_１，ｐ_２，ｐ_３，ｐ_４、接線ベクトルｔ_１，ｔ_２，ｔ_３，ｔ_４及びオムニホイール４０１〜４０４の半径γ_０から、下記式（２５）により表される。

【数26】

前述の式（４）に基づいて、式（２５）に表される動力伝達行列Ｔの一般化逆行列を用いると、前述の式（５）が得られ、オムニホイール４０１〜オムニホイール４０４の角速度から回転体１２の第２角速度が算出される。図６に示されるように、第２角速度は演算処理部６０２を用いて算出され、図５に示されるように、演算処理部６０２は第２角速度情報を取得する（Ｓ１２）。

【0095】

（４）目標値の算出
車体１４の姿勢角度と車体１４の第１角速度とに基づいて、回転体１２の転動の際の角加速度の目標値及び車体１４の旋回の際の角加速度の目標値が算出される。目標値はu とされる。図５及び図６に示されるように、目標値uは、演算処理部６０２を用いて前述の式（６）により算出される（Ｓ１３）。

【0096】

（５）回転体の操作角加速度の算出
目標値u にPID 制御が付加され、新たな角加速度の操作量が算出される（図６参照）。回転体１２の操作角加速度は、第３角加速度として、図５及び図６に示されるように、演算処理部６０２を用いて算出される（Ｓ１４）。

【0097】

（６）回転体の操作トルクの算出
回転体１２のトルクτ_s は前述の式（１６）を用いて算出される（図６参照）。ここで、慣性行列の部分行列は前述の式（１７）、式（１８）及び式（１９）により表され、又重力項は前述の式（２０）、式（２１）により表される。
回転体１２の操作トルクは、図５及び図６に示されるように、演算処理部６０２を用いて算出される（Ｓ１５）。

【0098】

（７）オムニホイールの操作トルクの算出
各オムニホイール４０１〜４０４が発生すべき操作トルクτ_oは前述の式（２３）により算出される。操作トルクτ_oは、図５及び図６に示されるように、演算処理部６０２を用いて算出される（Ｓ１６）。この操作トルクτ_oは、ホイール操作トルクとして、ＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）を介してオムニホイール４０１〜４０４に伝達される。
以上説明した姿勢制御方法の手順が実行されると、全方向移動装置１０では、車体１４の姿勢を回転体１２上において安定に維持することができる。そして、車体１４の姿勢を安定に維持した状態において、全方向移動装置１０を走行させることができる。

【0099】

（本実施の形態の作用及び効果）
図１（Ａ）〜図１（Ｄ）に示される全方向移動装置１０は、図２、図３（Ａ）及び図３（Ｂ）に示されるように、球状の回転体１２と、回転体１２の表面に接して配設されたホイールとしてのオムニホイール４０１及び４０２、又はオムニホイール４０３及び４０４とを備える。オムニホイール４０１〜４０４は、円周方向Ａに回転して回転体１２に動力を伝達し、かつ、円周方向Ａとは交差する方向Ｂに回転体１２を転動可能とする。

【0100】

ここで、オムニホイール４０１及び４０２は、回転体１２を転動させて直進方向に移動させる回転軸１２０の軸周り１２１において回転体１２の表面に複数配設される。また、オムニホイール４０３及び４０４は、回転体１２を転動させて直進方向に移動させる回転軸１２０の軸周り１２２において回転体１２の表面に複数配設される。
このため、直進方向の移動に際して、オムニホイール４０１及び４０２、又はオムニホイール４０３及び４０４から回転体１２へ動力が効率良く伝達され、最大出力により回転体１２を直進方向へ転動させることができる。

【0101】

また、図１（Ａ）〜図１（Ｄ）に示される全方向移動装置１０は、図２、図３（Ａ）及び図３（Ｂ）に示されるように、球状の回転体１２と、回転体１２の表面に接して配設された第１オムニホイールとしてのオムニホイール４０１及び４０２と第２オムニホイールとしてのオムニホイール４０３及び４０４とを備える。オムニホイール４０１〜４０４は、いずれも、円周方向Ａに回転して回転体１２に動力を伝達し、円周方向Ａと交差する方向Ｂに回転体１２を転動可能する。

【0102】

ここで、図３（Ａ）に示されるように、オムニホイール４０１及び４０２は、回転体１２を転動させて直進方向に移動させる回転軸１２０の一端側の軸周り１２１において回転体１２の上半球１２Ｂの表面に複数配設される。一方、オムニホイール４０３及び４０４は、回転軸１２０の一端側の軸周り１２１において回転体１２の下半球１２Ａの表面の特定位置４０３Ｐ、４０４Ｐに対する、回転体１２の中心対称位置の表面に配設される。また、オムニホイール４０３及び４０４は、回転軸１２０の他端側の軸周り１２２において回転体１２の上半球１２Ｂの表面に配設される。

【0103】

図９に、比較例に係る回転体R_b と３個のオムニホイールOh₁ 〜Oh₃ との配置関係が示されている。回転体R_bを駆動するオムニホイールOh₁ 〜Oh₃ の配置に関するパラメータは位置ベクトルp_k 及び単位接線ベクトルt_k である。ここで、位置ベクトルp_kは、回転体R_bの中心O_b を始点とする、k 番目のオムニホイールOh_kの回転体R_bとの接点の位置ベクトルである。k は１以上の整数である。単位接線ベクトルt_kは、接点におけるk 番目のオムニホイールOh_kの単位接線ベクトルである。

【0104】

垂直軸Z_b周りおいて回転体R_bの上半球R_buに３個のオムニホイールOh₁ 〜Oh₃ が等配されたときの位置ベクトルp_k は、垂直軸Z_bに対して位置ベクトルp_kが４５度の傾きに設定されたとき、下記式（２６）により表される。

【数27】

ここで、r_s は回転体R_bの半径である。

【0105】

また、単位接線ベクトルt_kは下記式（２７）により表される。

【数28】

【0106】

回転体R_bの角速度とオムニホイールOh₁ 〜Oh₃ の角速度との関係は下記式（２８）により表される。

【数29】

ここで、r₀ はオムニホイールOh₁ 〜Oh₃の半径である。

【0107】

【数30】

T は動力伝達行列である。

【0108】

図９に示される比較例では、上記式（２８）の動力伝達行列T の３列目の行列要素の絶対値が等しくなるので、旋回軸（垂直軸Z_b）の出力が最大になる。進行方向の出力は半減されている。

【0109】

上記比較例に対して、図７に、本実施の形態に係る回転体１２と３個のオムニホイール４０１〜４０３との配置関係が示されている。回転軸１２０の一端側の軸周り１２１の上半球１２Ｂに２個のオムニホイール４０１及び４０２が配置され（図３（Ａ）参照）、回転軸１２０の他端側の軸周り１２２の上半球１２Ｂに１個のオムニホイール４０３が配置されている（図３（Ｂ）参照）。
このときの位置ベクトルp_kは、回転軸１２０に対して位置ベクトルp_kが４５度の傾きに設定されたとき、下記式（２９）により表される。

【数31】

また、単位接線ベクトルt_kは下記式（３０）により表される。

【数32】

【0110】

そして、回転体１２の角速度とオムニホイール４０１〜４０３の角速度との関係は下記式（３１）により表される。

【数33】

【0111】

図７に示される本実施の形態では、上記式（３１）の動力伝達行列T の２列目の行列要素の絶対値が等しくなるので、回転軸１２０（水平軸Y_b ）の出力が最大になる。すなわち、進行方向の出力が最大となる。このように、直進方向の移動に際して、オムニホイール４０１〜４０３のそれぞれから回転体１２へ動力が効率良く伝達され、最大出力により回転体１２を直進方向へ転動させることができる。

【0112】

また、図１０に、比較例に係る回転体R_b と４個のオムニホイールOh₁ 〜Oh₄ との配置関係が示されている。垂直軸Z_b 周りおいて回転体R_bの上半球R_buに４個のオムニホイールOh₁ 〜Oh₄ が等配されたときの位置ベクトルp_k は、垂直軸Z_bに対して位置ベクトルp_kが４５度の傾きに設定されたとき、下記式（３２）により表される。単位接線ベクトルt_kは、下記式（３３）により表される。

【数34】

【数35】

【0113】

回転体R_bの角速度とオムニホイールOh₁ 〜Oh₄ の角速度との関係は下記式（３４）により表される。

【数36】

図１０に示される比較例では、上記式（３４）の動力伝達行列の１列目〜３列目の行列要素の列毎に絶対値が等しくなるので、左右方向への回転軸（水平軸X_b ）、前進方向への回転軸（水平軸Y_b ）、旋回軸（垂直軸Z_b ）のそれぞれの出力が最大になる。

【0114】

上記比較例に対して、図８に、本実施の形態に係る回転体１２と４個のオムニホイール４０１〜４０４との配置関係が示されている。回転軸１２０の一端側の軸周り１２１の上半球１２Ｂに２個のオムニホイール４０１及び４０２が配置され（図３（Ａ）参照）、回転軸１２０の他端側の軸周り１２２の上半球１２Ｂに２個のオムニホイール４０３及び４０４が配置されている（図３（Ｂ）参照）。
このときの位置ベクトルp_kは、回転軸１２０に対して位置ベクトルp_kが４５度の傾きに設定されたとき、下記式（３５）により表される。

【数37】

また、単位接線ベクトルt_kは下記式（３６）により表される。

【数38】

【0115】

そして、回転体１２の角速度とオムニホイール４０１〜４０４の角速度との関係は下記式（３７）により表される。

【数39】

【0116】

図８に示される本実施の形態では、上記式（３７）の動力伝達行列T の１列目〜３列目の行列要素の列毎に絶対値がすべて等しくなるので、回転軸１２０（水平軸Y_b ）の出力が最大になるばかりか、左右方向の回転軸（水平軸X_b ）及び旋回軸（垂直軸Z_b ）の出力も最大になる。このように、直進方向の移動に際して、オムニホイール４０１〜４０４のそれぞれから回転体１２へ動力が効率良く伝達され、最大出力により回転体１２を直進方向へ転動させることができる。

【0117】

さらに、本実施の形態に係る全方向移動装置１０では、図２に示されるように、ホイールはオムニホイール４０１〜４０４とされる。オムニホイール４０１〜４０４では、図３（Ａ）及び図３（Ｂ）に示されるように、最大出力により回転体１２を直進方向へ転動させることができ、かつ、直進方向以外の方向へも回転体１２を転動させることができる。

【0118】

また、本実施の形態に係る全方向移動装置１０では、図７及び図８に示されるように、第１ホイールとして２個のオムニホイール４０１及び４０２が配設され、第２ホイールとして１個のオムニホイール４０３、或いは２個のオムニホイール４０３及び４０４が配設される。このため、最小限のホイール数により、部品点数並びに重量を最小限として、回転体１２を全方向へ転動させることができる。

【0119】

さらに、本実施の形態に係る全方向移動装置１０によれば、動力伝達行列T の行列要素のうち、回転体１２を直進方向に移動させる回転軸１２０の行列要素の列毎に絶対値が等しくなる位置にオムニホイール４０１〜４０４（又は４０１〜４０３）が配設される。このため、直進方向の移動に際して、オムニホイール４０１〜４０４のそれぞれから回転体１２へ動力が効率良く伝達され、最大出力により回転体１２を直進方向へ転動させることができる。

【0120】

また、全方向移動装置１０によれば、動力伝達行列T は角速度を表す伝達行列を含む。回転体１２を直進方向に移動させる回転軸１２０の角速度を表す伝達行列において行列要素の列毎に絶対値が等しくなる位置に、オムニホイール４０１〜４０４（又は４０１〜４０３）がそれぞれ配設される。このため、直進方向の移動に際して、オムニホイール４０１〜４０４から回転体１２へ動力が効率良く伝達され、最大出力により回転体１２を直進方向へ転動させることができる。

【0121】

さらに、全方向移動装置１０は、図１（Ａ）〜図１（Ｄ）に示されるように、回転体１２の下半球１２Ａの表面に接して、又は近接させて補助輪３２及び３６を備える。補助輪３２及び３６は、図２に示されるオムニホイール４０１〜４０４と同様に、円周方向Ａに回転し、かつ、円周方向Ａと交差する方向に回転体１２を転動可能とする。このため、回転体１２の上半球１２Ｂがオムニホイール４０１〜４０４に接し、回転体１２の下半球１２Ａに補助輪３２及び３６が設けられるので、回転体１２を全方向へ転動可能としつつ、回転体１２の抜けを防ぐことができる。

【0122】

また、図１及び図２に示されるように、全方向移動装置１０によれば、回転体１２上には車体１４が設けられる。オムニホイール４０１及び４０２のシャフト４３０にはＡＣサーボモータ４２２（１）及び４２２（２）が接続され、ＡＣサーボモータ４２２（１）及び４２２（２）は車体１４に取り付けられる。また、オムニホイール４０３及び４０４のシャフト４３０にはＡＣサーボモータ４２２（３）及び４２２（４）が接続され、ＡＣサーボモータ４２２（３）及び４２２（４）は車体１４に取り付けられる。オムニホイール４０１〜４０４はいずれも回転体１２の上半球１２Ｂの表面に接する。このため、車体１４の荷重がＡＣサーボモータ４２２（１）〜４２２（４）を介してオムニホイール４０１〜４０４により支えられ、図４及び図６に示される姿勢安定システム６００により車体１４の姿勢が安定に維持された状態において、最大出力により回転体１２を直進方向へ転動させることができる。

【0123】

さらに、図４に示されるように、全方向移動装置１０によれば、姿勢安定システム６００は、姿勢角度検出部５０１と、回転数検出部６０７と、角速度検出部６０４と、演算処理部６０２とを備える。姿勢角度検出部５０１は、図１に示される車体１４に装着され、車体１４の姿勢角度及び姿勢角度の変化に伴う第１角速度を検出する。回転数検出部６０７は、オムニホイール４０１〜オムニホイール４０４の回転数を検出する。角速度検出部６０４は、回転数検出部６０７による回転数の検出結果に基づいて、回転体１２が転動する第２角速度を検出する。

【0124】

ここで、演算処理部６０２は、図４〜図６に示されるように、車体１４の姿勢を維持するオムニホイール４０１〜４０４のホイール操作トルクを算出する（Ｓ１６）。このホイール操作トルクは、姿勢角度検出部５０１により検出される姿勢角度情報、第１角速度情報（Ｓ１０）及び角速度検出部６０４により検出される第２角速度情報（Ｓ１２）に基づいて、算出される。演算処理部６０２は、このホイール操作トルク情報に従って、図２及び図４に示されるＡＣサーボモータ４２２（１）〜ＡＣサーボモータ４２２（４）を作動させる。
このため、姿勢安定システム６００では車体１４の姿勢を安定に維持する動力がオムニホイール４０１〜４０４から回転体１２へ伝達されるので、車体１４の姿勢が安定に維持された状態において、最大出力により回転体１２を直進方向へ転動させることができる。

【0125】

また、図４〜図６に示されるように、全方向移動装置１０によれば、演算処理部６０２では、車体１４の姿勢を維持させる、回転体１２が転動する角加速度の目標値及び車体１４が旋回する角加速度の目標値が算出される（Ｓ１３）。目標値は姿勢角度情報、第１角速度情報（Ｓ１０）及び第２角速度情報（Ｓ１２）に基づいて算出される。演算処理部６０２では、更に目標値に一致させる回転体１２の第３角加速度が算出され（Ｓ１４）、第３角加速度に基づいて回転体１２を操作する回転体操作トルクが算出される（Ｓ１５）。この回転体操作トルクに基づいて、演算処理部６０２では、オムニホイール４０１〜４０４を操作するホイール操作トルクが算出される（Ｓ１６）。
この結果、演算処理部６０２において、車体１４の姿勢を安定に維持する動力が算出される。このため、動力がオムニホイール４０１〜４０４から回転体１２へ伝達されるので、車体１４の姿勢が安定に維持された状態において、最大出力により回転体１２を直進方向へ転動させることができる。

【0126】

さらに、全方向移動装置１０の姿勢制御方法によれば、図５に示されるように、姿勢安定システム６００が、まず最初に、姿勢角度情報、第１角速度情報及び第２角速度情報を取得する（Ｓ１０、Ｓ１２）。 次に、姿勢角度情報、第１角速度情報及び第２角速度情報に基づいて、車体１４の姿勢を維持させる、回転体１２が転動する角加速度の目標値及び車体１４が旋回する角加速度の目標値が算出される（Ｓ１３）。次に、目標値に一致させる回転体１２の第３角加速度が算出され（Ｓ１４）、更に第３角加速度情報に基づいて回転体１２を操作する回転体操作トルクが算出される（Ｓ１５）。そして、回転体操作トルク情報に基づいて、オムニホイール４０１〜４０４を操作するホイール操作トルクが算出される。

【0127】

この結果、姿勢安定システム６００において、車体１４の姿勢を安定に維持する動力が算出される。このため、動力がオムニホイール４０１〜４０４から回転体１２へ伝達されるので、全方向移動装置１０では、最大出力により回転体１２を直進方向へ転動させることができ、しかも車体１４の姿勢を安定に維持することができる。

【0128】

加えて、全方向移動装置１０の姿勢制御方法では、図６に示されるように、動力伝達行列T に基づいて、車体１４の姿勢が制御される。詳しく説明すると、演算処理部６０２の演算処理の入力段では、前述の式（５）に基づいて、動力伝達行列T の一般化逆行列から回転体１２の角速度ベクトルω_s が算出される（図５のＳ１２）。一方、演算処理部６０２の演算処理の出力段では、前述の式（２３）に基づいて、動力伝達行列T の一般化逆行列から回転体１２に伝達するオムニホイール４０１〜４０４のホイール操作トルクとしての操作トルクτ_oが算出される（図５のＳ１６）。
このため、オムニホイール４０１〜４０４の配置間隔、回転体１２の表面に対するオムニホイール４０１〜４０４の接触角度等に関係なく、車体１４の姿勢を安定に維持することができる。表現を代えれば、本実施の形態に係る姿勢制御方法は、本実施の形態に係る全方向移動装置１０の姿勢制御に適切な方法であると共に、他の装置の姿勢制御にも適用可能である。

【0129】

（第２実施の形態）
図１１を用いて、本発明の第２実施の形態に係る全方向移動装置１０を説明する。ここで、本実施の形態の説明において、第１実施の形態に係る全方向移動装置１０の構成要素と同一又は実質的に同一の構成要素には同一符号を付し、重複する説明は省略する。

【0130】

本実施の形態に係る全方向移動装置１０では、基本的に第１実施の形態に係る全方向移動装置１０と同一構成とされているが、ホイールにメカナムホイール４０５〜４０８（図１１参照）が使用されている。ここでは、４個のメカナムホイール４０５〜４０８が配設される例を説明するが、第１実施の形態に係る全方向移動装置１０と同様に、メカナムホイールは３個とされてもよい。
詳細な構造は省略するが、図２に示されるオムニホイール４０１〜４０４と同様に、メカナムホイール４０５〜４０８は、円周方向Ａに回転して回転体１２に駆動力を伝達し、かつ、円周方向Ａと交差する方向Ｂに回転体１２を転動可能とする。

【0131】

図１１に、本実施の形態に係る回転体１２と４個のメカナムホイール４０５〜４０８との配置関係が示されている。回転軸１２０の一端側の軸周り１２１の上半球１２Ｂに２個のメカナムホイール４０５及び４０６が配置され、回転軸１２０の他端側の軸周り１２２の上半球１２Ｂに２個のメカナムホイール４０７及び４０８が配置されている。

【0132】

メカナムホイール４０５〜４０８では、回転体１２との接点p₁ 〜p₄ における単位接線ベクトルt_kが、円周上の接線に対して、ここでは４５度をなす。回転体１２の半径をr_s とすると、位置ベクトルp_k は式（３８）により表され、単位接線ベクトルt_k は式（３９）により表される。

【数40】

【数41】

【0133】

そして、メカナムホイール４０５〜４０８の半径をr_m とすると、動力伝達行列T は下記式（４０）により表される。

【数42】

図１１に示される本実施の形態では、上記式（４０）の動力伝達行列T の１列目〜３列目の行列要素の列毎に絶対値がすべて等しくなる。

【0134】

また、トルク伝達行列T (T^T T )^-1は、下記式（４１）により表される。

【数43】

トルク伝達行列T (T^T T )^-1の１列目〜３列目の行列要素の列毎に絶対値がすべて等しくなる。

【0135】

以上説明したように、本実施の形態に係る全方向移動装置１０では、ホイールとしてメカナムホイール４０５〜４０８が採用されても、回転軸１２０（水平軸Y_b ）の出力が最大になるばかりか、左右方向の回転軸（水平軸X_b ）及び旋回軸（垂直軸Z_b ）の出力も最大になる。このように、直進方向の移動に際して、メカナムホイール４０５〜４０８のそれぞれから回転体１２へ動力が効率良く伝達され、最大出力により回転体１２を直進方向へ転動させることができる。

【0136】

また、本実施の形態に係る全方向移動装置１０及びその姿勢制御方法によれば、第１実施の形態に係る全方向移動装置１０及びその姿勢制御方法により得られる作用効果と同様の作用効果を得ることができる。

【0137】

（その他の実施の形態）
本発明は、上記実施の形態に限定されるものではなく、その要旨を逸脱しない範囲において、種々変形可能である。例えば、本発明は、３個のオムニホイール４０１〜４０３の場合、回転体１２の回転軸１２０の一端側と他端側とを入れ替えてもよい。また、本発明は、５以上のオムニホイールを備えてもよい。なお、全方向移動装置の小型化並びに軽量化を図るためにはオムニホイールは３個又は４個とすることが好ましい。

【0138】

また、上記実施の形態では、３個のオムニホイール４０１〜４０３或いは４個のオムニホイール４０１〜４０４が等間隔において配置されている。本発明では、動力伝達行列の行列要素のうち、回転体１２を直進方向に転動させる回転軸１２０の行列要素の列毎に絶対値が等しくなる位置であれば、オムニホイール４０１〜４０４の間隔は等間隔に限らない。

【0139】

さらに、上記実施の形態では、オムニホイール４０１〜４０４は２連のホイール４１０及び４２０により構成されているが、本発明では、１連又は３連以上のホイールによりオムニホイール４０１〜４０４が構成されてもよい。加えて、本発明では、ホイール４１０に４個以上のローラが配設され、ホイール４２０に４個以上のローラが配設されてもよい。

【0140】

また、上記実施の形態では、回転体１２を直進方向に転動させる回転軸１２０の一端側、他端側のそれぞれにオムニホイール４０１〜４０４が配設されているが、回転軸１２０の一端側或いは他端側の一方の軸周りに動力を伝達するオムニホイール４０１〜４０４が配設されてもよい。他端側の軸周りには、補助輪を配設することが好ましい。
さらに、上記変形例は、メカナムホイール４０５〜４０８についても同様である。

【符号の説明】

【0141】

１０ 全方向移動装置
１２ 回転体
１４ 車体
４０、４２、４４、４６ 駆動ユニット
４０１、４０２ オムニホイール（第１オムニホイール）
４０３、４０４ オムニホイール（第２オムニホイール）
４０５〜４０８ メカナムホイール
４４２（１）〜４４２（４） ＡＣサーボモータ（駆動装置）
５０１ 姿勢角度検出部
６００ 姿勢安定システム
６０２ 演算処理部
６０４ 角速度検出部
６０５、６０５（１）〜６０５（４） サーボアンプ
６０７ 回転数検出部

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】

【図10】

【図11】