(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2024135279
(43)【公開日】2024-10-04
(54)【発明の名称】搬送補助装置
(51)【国際特許分類】
A61G 7/08 20060101AFI20240927BHJP
B60B 19/00 20060101ALI20240927BHJP
【FI】
A61G7/08
B60B19/00 H
【審査請求】未請求
【請求項の数】6
【出願形態】OL
(21)【出願番号】P 2023045892
(22)【出願日】2023-03-22
(71)【出願人】
【識別番号】000167222
【氏名又は名称】株式会社ジェイテクトマシンシステム
(74)【代理人】
【識別番号】110001427
【氏名又は名称】弁理士法人前田特許事務所
(72)【発明者】
【氏名】大江 洋希
【テーマコード(参考)】
4C040
【Fターム(参考)】
4C040AA28
4C040BB03
4C040DD01
4C040EE05
(57)【要約】
【課題】キャスタ付きベッドのコーナリングを適切にアシストする。
【解決手段】搬送補助装置1は、ベッド10に取り付けられる第1及び第2メカナムホイール21R,21Lと、第1及び第2メカナムホイール21R,21Lと駆動連結された第1及び第2モータ22R,22Lと、第1及び第2メカナムホイール21R,21Lの回転状態に対応した信号を検出する状第1及び第2電流センサSW1,SW2と、搬送面Fに垂直な回転軸まわりにおけるベッド10の旋回を検出する6軸センサSW5と、コントローラ4と、を備える。コントローラ4は、ベッド10が前進又は後退中であってかつ非旋回中であると判定した場合には、手押移動を前後方向にアシストする一方、ベッド10が前進又は後退しながら旋回していると判定した場合には、前後方向と横方向との双方に手押移動をアシストする。
【選択図】
図16
【特許請求の範囲】
【請求項1】
キャスタ付きベッドの手押移動をアシストするための搬送補助装置において、
前記ベッドの下部に取り付けられ、該ベッドの搬送面に接する第1及び第2メカナムホイールと、
前記第1及び第2メカナムホイールのそれぞれに駆動連結された第1及び第2モータと、
前記第1及び第2メカナムホイールの回転状態に対応した信号を検出する状態センサと、
前記搬送面に垂直な回転軸まわりにおける前記ベッドの旋回を検出する旋回センサと、
前記第1及び第2モータを制御するコントローラと、を備え、
前記コントローラは、前記状態センサ及び前記旋回センサの検出信号に基づいて、前記ベッドが前進又は後退しているか否かの判定と、前記ベッドが旋回しているか否かの判定と、をそれぞれ実行し、
前記コントローラは、
前記ベッドが前進又は後退中であってかつ非旋回中であると判定した場合には、前記手押移動を前後方向にアシストするように、前記第1及び第2モータを介して前記第1及び第2メカナムホイールを駆動する一方、
前記ベッドが前進又は後退しながら旋回していると判定した場合には、前記前後方向と、該前後方向に直交しかつ前記搬送面に沿って延びる横方向と、の双方に前記手押移動をアシストするように、前記第1及び第2モータを介して前記第1及び第2メカナムホイールを駆動する
ことを特徴とする搬送補助装置。
【請求項2】
請求項1に記載された搬送補助装置において、
前記状態センサは、前記第1及び第2メカナムホイールそれぞれの回転に際して前記第1及び第2モータに流れる誘導電流を検出する第1及び第2電流センサによって構成され、
前記コントローラは、
前記第1及び第2電流センサの検出信号に基づいて、前記前後方向における前記第1及び第2メカナムホイールの加速度を示す縦加速度と、前記横方向における前記第1及び第2メカナムホイールの加速度を示す横加速度と、をそれぞれ推定し、
前記縦加速度及び前記横加速度の少なくとも一方に基づいて、前記手押移動に追従させるように前記第1及び第2モータの指令回転数を設定する第1制御を実行し、
前記コントローラは、前記ベッドが前進又は後退しながら旋回していると判定した場合、
前記前後方向については、前記縦加速度に基づいて前記第1制御を実行する一方、
前記横方向については、前記横加速度を、0を上回る所定比率で減少させるように調整の上、該調整後の横加速度に基づいて前記第1制御を実行する
ことを特徴とする搬送補助装置。
【請求項3】
請求項2に記載された搬送補助装置において、
前記所定比率は、前記ベッドの旋回中心を、前記第1及び第2メカナムホイールの中央位置から前記ベッドの前端側にシフトさせるように設定されている
ことを特徴とする搬送補助装置。
【請求項4】
請求項2に記載された搬送補助装置において、
前記コントローラは、前記ベッドが前進又は後退中であってかつ非旋回中であると判定した場合には、前記縦加速度に基づいて前記第1制御を実行するとともに、前記指令回転数を増加させる第2制御を実行し、
前記コントローラは、前記ベッドが前進又は後退しながら旋回していると判定した場合には、
前記前後方向については、前記縦加速度に基づいて前記第1制御及び前記第2制御を順番に実行し、
前記横方向については、前記調整後の横加速度に基づいて前記第1制御を実行の上、前記第2制御を未実行とする
ことを特徴とする搬送補助装置。
【請求項5】
請求項1から4のいずれか1項に記載された搬送補助装置において、
前記第1及び第2メカナムホイールは、前記横方向に並ぶように配置され、
前記第1及び第2メカナムホイールは、それぞれ、
前記横方向に延びる回転軸まわりに回転するホイール本体と、
前記ホイール本体の外周に沿って配置され、それぞれ前記前後方向及び前記横方向の双方に対して傾斜した傾斜軸まわりに回転する複数の樽型ローラと、を有し、
前記第1メカナムホイールの傾斜軸は、前記第2メカナムホイールの傾斜軸に対し、前記前後方向を基準とした線対称となるように傾斜している
ことを特徴とする搬送補助装置。
【請求項6】
請求項5に記載された搬送補助装置において、
前記コントローラは、
前記ベッドが前進又は後退中であってかつ非旋回中であると判定した場合には、前記第1及び第2メカナムホイールを双方とも前転又は後転させるようにそれぞれの指令回転数を設定するとともに、当該設定に際し、前記第1メカナムホイールと前記第2メカナムホイールとで前記指令回転数の絶対値を等しくし、
前記ベッドが前進又は後退しながら旋回していると判定した場合には、前記第1メカナムホイールと前記第2メカナムホイールとで異なる絶対値となるように、前記指令回転数を設定する
ことを特徴とする搬送補助装置。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、搬送補助装置に関する。
【背景技術】
【0002】
例えば特許文献1には、駆動部にメカナムホイールを用いた補助推進システムが開示されている。この補助推進システムは、シャーシに連結される一対のメカナムホイール(Mecanum車輪)と、各メカナムホイールを駆動するモータと、各モータの回転速度の変化を感知する制御システムと、を備えている。
【0003】
前記特許文献1によると、シャーシが所定方向に移動する場合、それと同じ方向への力が操作者によって印加される。印加された力によって各メカナムホイールが回転すると、それに伴う回転速度の変化が制御システムに報告される。その報告に基づいて、制御システムがモータの電動回転を始動させる。この電動回転によって、シャーシの移動がアシストされる。
【先行技術文献】
【特許文献】
【0004】
【発明の概要】
【発明が解決しようとする課題】
【0005】
ところで、前記特許文献1に記載の構成をキャスタ付きベッドに適用した場合において、該ベッドをコーナリングさせるような状況を考える。この場合、ベッドは旋回しつつも前後に押されることになるから、該ベッドを前後方向にアシストすることが考えられる。
【0006】
しかしながら、本願発明者らは、鋭意検討を重ねた結果、コーナリングに際して前後方向にアシストするだけでは、コーナリング半径が過度に小さくなってしまい、ベッドの前端又は後端部と、十字路、T字路等の通路の角部とが干渉し得ることに気付いた。そうした干渉は、コーナリングをアシストする上で不都合である。
【0007】
ここに開示する技術は、かかる点に鑑みてなされたものであり、その目的とするところは、キャスタ付きベッドのコーナリングを適切にアシストすることにある。
【課題を解決するための手段】
【0008】
本開示の第1の態様は、キャスタ付きベッドの手押移動をアシストするための搬送補助装置に係る。この搬送補助装置は、前記ベッドの下部に取り付けられ、該ベッドの搬送面に接する第1及び第2メカナムホイールと、前記第1及び第2メカナムホイールのそれぞれに駆動連結された第1及び第2モータと、前記第1及び第2メカナムホイールの回転状態に対応した信号を検出する状態センサと、前記搬送面に垂直な回転軸まわりにおける前記ベッドの旋回を検出する旋回センサと、前記第1及び第2モータを制御するコントローラと、を備え、前記コントローラは、前記状態センサ及び前記旋回センサの検出信号に基づいて、前記ベッドが前進又は後退しているか否かの判定と、前記ベッドが旋回しているか否かの判定と、をそれぞれ実行し、前記コントローラは、前記ベッドが前進又は後退中であってかつ非旋回中であると判定した場合には、前記手押移動を前後方向にアシストするように、前記第1及び第2モータを介して前記第1及び第2メカナムホイールを駆動する一方、前記ベッドが前進又は後退しながら旋回していると判定した場合には、前記前後方向と、該前後方向に直交しかつ前記搬送面に沿って延びる横方向と、の双方に前記手押移動をアシストするように、前記第1及び第2モータを介して前記第1及び第2メカナムホイールを駆動する。
【0009】
前記第1の態様によると、コントローラは、前後方向に加えて、横方向についても手押移動をアシストする。ベッドのコーナリングに際しては、コーナリングの半径方向、すなわちベッドの横方向にも力が加わると考えられる。したがって、そうした横方向の力をアシストすることで、コーナリング時に、ベッドを横方向にスライドさせることができる。これにより、コーナリング半径を大きくし、ベッドの前端又は後端部と、通路の角部との干渉を抑制することができる。これにより、キャスタ付きベッドのコーナリングを適切にアシストすることが可能になる。
【0010】
また、本開示の第2の態様によれば、前記状態センサは、前記第1及び第2メカナムホイールそれぞれの回転に際して前記第1及び第2モータに流れる誘導電流を検出する第1及び第2電流センサによって構成され、前記コントローラは、前記第1及び第2電流センサの検出信号に基づいて、前記前後方向における前記第1及び第2メカナムホイールの加速度を示す縦加速度と、前記横方向における前記第1及び第2メカナムホイールの加速度を示す横加速度と、をそれぞれ推定し、前記縦加速度及び前記横加速度の少なくとも一方に基づいて、前記手押移動に追従させるように前記第1及び第2モータの指令回転数を設定する第1制御を実行し、前記コントローラは、前記ベッドが前進又は後退しながら旋回していると判定した場合、前記前後方向については、前記縦加速度に基づいて前記第1制御を実行する一方、前記横方向については、前記横加速度を、0を上回る所定比率で減少させるように調整の上、該調整後の横加速度に基づいて前記第1制御を実行する、としてもよい。
【0011】
前記第2の態様によると、誘導電流を検出することで、その誘導電流が生じる起因となったトルク(メカナムホイールを回転させようとするトルク)、ひいては、そのトルクに対応した加速度を推定することができる。各ホイールの加速度を推定することで、外力が作用した方向を推定することが可能になる。
【0012】
そして、前後方向については手押移動に追従させるようなアシストを実行する一方、横方向については、同方向における加速度を減少させた上、その加速度に基づいた第1制御を行う。横方向における加速度を減少させることは、同方向に作用する外力を、実際に作用する外力よりも小さく見積もることに等しい。外力を小さく見積もることで、横方向については、手押移動に追従させるには及ばないようなアシストが実行される。その結果、横方向における過度のスライド(搬送者が意図した以上のスライド)を抑制し、コーナリング半径を、適切な範囲内に収めることができる。これにより、キャスタ付きベッドのコーナリングを適切にアシストする上で有利になる。
【0013】
また、本開示の第3の態様によれば、前記所定比率は、前記ベッドの旋回中心を、前記第1及び第2メカナムホイールの中央位置から前記ベッドの前端側にシフトさせるように設定されている、としてもよい。
【0014】
前記第3の態様によると、ベッドの旋回中心を前端側にシフトさせることで、ベッドのコーナリングに際し、前端側よりも後端側を大きく旋回させるような動作を実現することができる。後端側を大きく旋回させることで、その後端側の部位と、通路の角部との干渉を抑制することができる。これにより、キャスタ付きベッドのコーナリングを適切にアシストする上で有利になる。
【0015】
また、本開示の第4の態様によれば、前記コントローラは、前記ベッドが前進又は後退中であってかつ非旋回中であると判定した場合には、前記縦加速度に基づいて前記第1制御を実行するとともに、前記指令回転数を増加させる第2制御を実行し、前記コントローラは、前記ベッドが前進又は後退しながら旋回していると判定した場合には、前記前後方向については、前記縦加速度に基づいて前記第1制御及び前記第2制御を順番に実行し、前記横方向については、前記調整後の横加速度に基づいて前記第1制御を実行の上、前記第2制御を未実行とする、としてもよい。
【0016】
前記第4の態様によると、前後方向については第2制御を行うことで、単に手押移動に追従させるばかりでなく、指令回転数を増加させた分だけ搬送者の負荷を軽減することができる。これにより、前後方向におけるベッドの押し心地を向上し、適度な“アシスト感”を搬送者に与えることができる。一方、横方向については、第2制御を意図的に未実行とする。これにより、横方向における過度のスライド(搬送者が意図した以上のスライド)を抑制し、コーナリング半径を、適切な範囲内に収めることができる。これにより、キャスタ付きベッドのコーナリングを適切にアシストする上で有利になる。
【0017】
また、本開示の第5の態様によれば、前記第1及び第2メカナムホイールは、前記横方向に並ぶように配置され、前記第1及び第2メカナムホイールは、それぞれ、前記横方向に延びる回転軸まわりに回転するホイール本体と、前記ホイール本体の外周に沿って配置され、それぞれ前記前後方向及び前記横方向の双方に対して傾斜した傾斜軸まわりに回転する複数の樽型ローラと、を有し、前記第1メカナムホイールの傾斜軸は、前記第2メカナムホイールの傾斜軸に対し、前記前後方向を基準とした線対称となるように傾斜している、としてもよい。
【0018】
前記第5の態様のように構成することで、第1メカナムホイールと第2メカナムホイールとを反対方向に回転させたときに、ベッドを旋回動作させるような推力を発揮させることができる。このように構成することは、キャスタ付きベッドのコーナリングを適切にアシストする上で有効である。
【0019】
また、本開示の第6の態様によれば、前記コントローラは、前記ベッドが前進又は後退中であってかつ非旋回中であると判定した場合には、前記第1及び第2メカナムホイールを双方とも前転又は後転させるようにそれぞれの指令回転数を設定するとともに、当該設定に際し、前記第1メカナムホイールと前記第2メカナムホイールとで前記指令回転数の絶対値を等しくし、前記ベッドが前進又は後退しながら旋回していると判定した場合には、前記第1メカナムホイールと前記第2メカナムホイールとで異なる絶対値となるように、前記指令回転数を設定する、としてもよい。
【0020】
前記第6の態様によると、前後移動に際しては指令回転数の絶対値を等しくすることで、キャスタの向きにかかわらず、より安定した前後移動を実現することができる。一方、コーナリングに際しては意図的に絶対値を異ならせることで、所望の軌道に沿ったコーナリングを実現することができる。
【発明の効果】
【0021】
以上説明したように、本開示によれば、キャスタ付きベッドのコーナリングを適切にアシストすることができる。
【図面の簡単な説明】
【0022】
【
図1】搬送補助装置及びキャスタ付きベッドの全体構成を例示する側面図である。
【
図2】搬送補助装置及びキャスタ付きベッドの全体構成を例示する底面図である。
【
図3】搬送補助装置の構成を例示する斜視図である。
【
図4】搬送補助装置の構成を例示する平面図である。
【
図5】搬送補助装置の構成を例示する側面図である。
【
図6】搬送補助装置の制御系の構成を例示するブロック図である。
【
図7】第1及び第2メカナムホイールの動作について説明するための図である。
【
図8】6軸センサの検出対象について説明するための図である。
【
図9】コントローラが行う主要な処理を例示するフローチャートである。
【
図10】移動方向の判定に関する処理を例示するフローチャートである。
【
図11】コンプライアンス制御の構成を模式化した制御ブロック図である。
【
図12】コンプライアンス制御の基本概念について説明するための概念図である。
【
図13】回転数に対する速度増加量の変化を例示する図である。
【
図14】速度増加制御によって得られる指令回転数を例示する図である。
【
図15】コンプライアンス制御及び速度増加制御を例示するフローチャートである。
【
図16】コーナリングに関する制御を例示するフローチャートである。
【
図17】コーナリング時のベッドの軌跡を例示する図である。
【
図18】安全制限制御を例示するフローチャートである。
【発明を実施するための形態】
【0023】
以下、本開示の実施形態を図面に基づいて説明する。
【0024】
図1は搬送補助装置1及びキャスタ付きベッド10の全体構成を例示する側面図であり、
図2は搬送補助装置1及びキャスタ付きベッド10の全体構成を例示する底面図である。
【0025】
また、
図3は搬送補助装置1の構成を例示する斜視図であり、
図4は搬送補助装置1の構成を例示する平面図であり、
図5は搬送補助装置1の構成を例示する側面図である。
【0026】
また、
図6は、搬送補助装置1の制御系の構成を例示するブロック図であり、
図7は第1及び第2メカナムホイール21R,21Lの動作について説明するための図である。そして、
図8は、6軸センサSW5の検出対象について説明するための図である。
【0027】
図1及び
図2に示すように、本実施形態に係る搬送補助装置1は、キャスタ付きベッド(以下、単に「ベッド」という)10に取り付けられている。このベッド10は、前輪14F及び後輪14Bを含んだ複数のキャスタ14を備えており、例えば医療用ベッドとして用いられるようになっている。搬送補助装置1は、そうしたベッド10の手押移動をアシストするための装置である。
【0028】
以下、ベッド10の長手方向、つまりベッド10上で人が横たわる方向を「前後方向」又は「縦方向」とし、その前後方向に沿って足先に向かう方向を「前」とし、枕元に向かう方向を「後」とする。
【0029】
同様に、ベッド10の短手方向、つまり水平面上で前後方向に直交する方向を「左右方向」又は「横方向」とし、その左右方向に沿って
図1の紙面奥行側に向かう方向を「右」とし、
図1の紙面手前側に向かう方向を「左」とする(詳細は、
図2を参照)。なお、ここでいう「左右方向」とは、後側から前側に向かって見たときの左右方向をいう。以下の記載における「横移動」とは、この左右方向に沿った移動をいう。また、左右方向(横方向)とは、前後方向に直交しかつ搬送面(ベッド10が走行する床面)Fに沿って延びる方向であると定義することもできる。
【0030】
ベッド10は、搬送者100によって支持される。図例では、ベッド10は、その前後方向の一端側(例えば後端側)が支持されるようになっている。搬送補助装置1は、搬送者100によって支持されたベッド10の手押移動をアシストするように動作する。
【0031】
図1に示すように、ベッド10は、不図示のマットレスが載置されるベッド本体11と、ベッド本体11を下方から支持するフレーム12と、フレーム12に対してベッド本体11を昇降させる昇降部13と、ベッド10の下面に配置された複数(図例では4つ)のキャスタ14と、を備えている。医療用ベッドとして用いられる場合、ベッド10は、例えば60kg以上300kg以下となる。
【0032】
ここで、ベッド本体11は、ベッド10の後端側に配置されるヘッドボード11hと、前後方向において前記後端側の反対に位置する前端側に配置されるフットボード11fと、ベッド10の左右両側に配置されるサイドレール11sと、を有している。
【0033】
このうち、ヘッドボード11hは、ベッド10を手押し移動させるべく、搬送者100によって後側から支持される。ヘッドボード11hは、その搬送者100によって力が加えられる支持部として機能する。ハンドル、グリップ等の部材をヘッドボード11hに取り付けたり、ヘッドボード11hと一体化させたりすることで、それらの部材を支持部としてもよい。フットボード11f、サイドレール11s等が支持されてもよい。
【0034】
また、フレーム12は、
図2に示すように矩形枠状に構成されており、前フレーム12F、右フレーム12R、左フレーム12L及び後フレーム12Bによって四辺が構成されている。
【0035】
ここで、前フレーム12Fは、ベッド10の前側に配置されており、左右方向に沿って延びている。右フレーム12Rは、ベッド10の右側に配置されており、前後方向に沿って延びている。左フレーム12Lは、ベッド10の左側に配置されており、前後方向に沿って延びている。後フレーム12Bは、ベッド10の後側に配置されており、左右方向に沿って延びている。
【0036】
また、
図1及び
図2に示すように、複数のキャスタ14を構成する前輪14F及び後輪14Bは、ベッド10の下面の4隅に配置されている。前輪14F及び後輪14Bは、左右方向に沿って2つずつ設けられている。複数のキャスタ14は、搬送面Fに対してフレーム12、昇降部13及びベッド本体11を支持している。
【0037】
各キャスタ14は、いわゆるフリーキャスタであって、ベッド10の下面に固定される取付部14aと、この取付部14aに対して旋回軸Ocまわりに旋回可能なフォーク部14bと、フォーク部14bによって回転可能に支持された車輪14cと、を有している。各フォーク部14bの旋回軸Ocは、上下方向(ベッド10の高さ方向)に沿って延びている。各車輪14cの回転軸は、水平面に沿って延びている。この回転軸は、取付部14aに対してフォーク部14bが旋回することで、左右方向に対して傾斜するようになっている。
【0038】
そして、搬送補助装置1は、前述の右フレーム12Rにおける前後方向の中途の部位と、左フレームLにおける前後方向の中途の部位と、を架け渡すように配置されている。搬送補助装置1は、前後方向においては前輪14Fと後輪14Bとの間に配置され、左右方向においてはベッド10の中央に配置されている。
【0039】
図1~
図6に示すように、搬送補助装置1は、収容ボックス6と、取付具7と、第1及び第2メカナムホイール21R,21Lと、第1及び第2モータ22R,22Lと、コントローラ4と、状態センサとしての第1及び第2電流センサSW1,SW2と、第1及び第2回転センサSW3,SW4と、旋回センサとしての6軸センサSW5と、を備えている(第1及び第2モータ22R,22L、並びに各センサSW1~SW5は、
図6にのみ図示)。以下、第1及び第2メカナムホイール21R,21Lのうち、第1メカナムホイール21Rが右側に位置するものとし、第2メカナムホイール21Lが左側に位置するものとする。
【0040】
これらの要素のうち、コントローラ4及び6軸センサSW5は収容ボックス6に収容されており、取付具7、第1及び第2メカナムホイール21R,21L、第1及び第2モータ22R,22L、第1及び第2電流センサSW1,SW2、並びに第1及び第2回転センサSW3,SW4は、収容ボックス6外に配置されている。
【0041】
収容ボックス6は、前述のようにコントローラ4を収容している。収容ボックス6は、左右方向において、第1メカナムホイール21Rと第2メカナムホイール21Lの間に配置されている。
【0042】
収容ボックス6は、第1及び第2メカナムホイール21R,21Lと共に取付具7に組み付けられており、この取付具7を介してベッド10の下部に取り付けられている。取付具7は、ベッド10の下部に対して着脱可能である。すなわち、本実施形態に係る搬送補助装置1は、ベッド10に対して後付可能であって、必要に応じて取り外し可能とされている。
【0043】
詳しくは、本実施形態に係る取付具7は、
図2~
図5に示すように、前側レール部材71f及び後側レール部材71bと、第1及び第2メカナムホイール21R,21Lをそれぞれ回転可能に支持する第1及び第2アーム部材72R,72Lと、を有している。
【0044】
ここで、前側レール部材71fと後側レール部材71bは、前後方向に間隔を空けて配置されており、それぞれ、右フレーム12Rの前後方向中央部と、左フレーム12Lの前後方向中央部と、を架け渡している。前側レール部材71fと後側レール部材71bは、右フレーム12R及び左フレーム12Lに対して着脱可能である。第1及び第2メカナムホイール21R,21Lと収容ボックス6は、前後方向において、前側レール部材71fと後側レール部材71bの間に配置されるようになっている。
【0045】
一方、
図3及び
図4において右側に位置する第1アーム部材72Rは、後側レール部材71bによって揺動可能に支持されている。第1アーム部材72Rの前端部は、第1メカナムホイール21Rを回転可能に支持している。また、第1アーム部材72Rは、左右方向において、第1メカナムホイール21Rと収容ボックス6との間に配置されるようになっている。
【0046】
また、第1アーム部材72Rの上端部には、第1引張バネ75Rの一端部が係止されている。この第1引張バネ75Rの他端部は、前側レール部材71fに固定された第1ブラケット76Rに係止されている。
【0047】
そして、
図3及び
図4において左側に位置する第2アーム部材72Lは、第1アーム部材72Rと同様に、後側レール部材71bによって揺動可能に支持されている。第2アーム部材72Lの前端部は、第2メカナムホイール21Lを回転可能に支持している。また、第2アーム部材72Lは、左右方向において、第2メカナムホイール21Lと収容ボックス6との間に配置されるようになっている。
【0048】
また、第2アーム部材72Lの上端部には、第2引張バネ75Lの一端部が係止されている。この第2引張バネ75Lの他端部は、前側レール部材71fに固定された第2ブラケット76Lに係止されている(
図5も参照)。
【0049】
第1及び第2メカナムホイール21R,21Lは、
図1~
図2に示すように、ベッド10の下部(底部)に取り付けられている。第1及び第2メカナムホイール21R,21Lは、ベッド10の搬送面Fに接している。搬送面Fは、
図1にのみ示す。また、第1及び第2メカナムホイール21R,21Lは、前輪14Fの後側かつ後輪14Bの前側に配置されている。本実施形態の場合、第1及び第2メカナムホイール21R,21Lは、
図2に示すように、短手方向としての左右方向に並ぶように配置されている。
【0050】
詳しくは、
図3~
図5に示すように、第1メカナムホイール21Rは、第1回転軸Oy1まわりに回転する第1ホイール本体211Rと、第1ホイール本体211Rの外周に沿って配置され、それぞれ第1回転軸Oy1に対して傾斜した第1傾斜軸Orまわりに回転する複数の第1樽型ローラ212Rと、を有している。
【0051】
一方、第2メカナムホイール21Lは、第2回転軸Oy2まわりに回転する第2ホイール本体211Lと、第2ホイール本体211Lの外周に沿って配置され、それぞれ第2回転軸Oy2に対して第1傾斜軸Orとは異なる方向に傾斜した第2傾斜軸Olまわりに回転する複数の第2樽型ローラ212Lと、を有している。
【0052】
ここで、第1及び第2回転軸Oy1,Oy2は、双方とも、左右方向に延びている。そして、第1傾斜軸Orは、第2傾斜軸Olに対し、前後方向を基準(
図4の対称軸Osを参照)とした線対称となるように傾斜している。言い換えると、第1傾斜軸Orと第2傾斜軸Olは、上下方向及び前後方向に延びる平面を鏡映面とすると、その鏡映面に関して鏡映対称となるように延びている。
【0053】
さらに、
図4のように上方から見た場合(平面視した場合)、第1及び第2傾斜軸Or,Olは、それぞれ、前後方向に沿って後側から前側に向かうに従って、左右方向の内側から外側(左右方向の中央部から右側又は左側)に向かって延びている。
【0054】
詳しくは、第1傾斜軸Orは、前後方向に沿って後側から前側に向かうに従って、左右方向の中央部から右側に向かって延びている。一方、第2傾斜軸Olは、前後方向に沿って後側から前側に向かうに従って、左右方向の中央部から左側に向かって延びている。
【0055】
さらに詳しくは、第1回転軸Oy1に対する第1傾斜軸Orの傾斜角θrは、平面視で45°に設定されている。同様に、第2回転軸Oy2に対する第2傾斜軸Olの傾斜角θlは、同じく平面視で45°に設定されている。なお、各樽型ローラ212R,212Lの傾斜方向及び傾斜角度は、これらの例には限定されない。例えば、搬送補助装置1全体を、
図2に例示した状態から、上下方向に延びるz軸回りに所定角度回転させた状態に配置変更してもよい。
【0056】
また、前述のように、第1及び第2メカナムホイール21R,21Lは、
図3等に示した前側レール部材71f及び後側レール部材71bを介して相互に連結されている。したがって、第1及び第2メカナムホイール21R,21Lは、前後方向及び左右方向に一体的に移動したり、水平面に垂直な旋回軸まわりに一体的に旋回したりする。
【0057】
第1及び第2モータ22R,22Lは、第1及び第2メカナムホイール21R,21Lのそれぞれに駆動連結されている。具体的に、第1及び第2モータ22R,22Lは、それぞれ、いわゆる3相のDCブラシレスモータとして構成されている。第1及び第2モータ22R,22Lは、双方ともコントローラ4と電気的に接続されており、このコントローラ4によって制御されるようになっている。
【0058】
第1及び第2モータ22R,22Lには、それぞれの回転に際し、トルク負荷に対応したモータ電流が供給される。モータ電流を通じて、第1及び第2モータ22R,22Lの回転数と、正転及び逆転とを切り替えることができる。
【0059】
そして、第1モータ22Rは、第1メカナムホイール21Rに対し、駆動力(トルク)を伝達できるように連結されている。第2モータ22Lは、第2メカナムホイール21Lに対し、駆動力(トルク)を伝達できるように連結されている。
【0060】
第1モータ22Rが回転することで、その駆動力が伝達されて第1メカナムホイール21Rが回転する。同様に、第2モータ22Lが回転することで、その駆動力が伝達されて第2メカナムホイール21Lが回転する。
【0061】
本実施形態では、第1モータ22Rを正転させることで第1メカナムホイール21Rが前転し、第1モータ22Rを逆転させることで第1メカナムホイール21Rが後転するように構成されている。同様に、本実施形態では、第2モータ22Lを正転させることで第2メカナムホイール21Lが前転し、第2モータ22Lを逆転させることで第2メカナムホイール21Lが後転するように構成されている。
【0062】
なお、第1モータ22Rは第1メカナムホイール21Rに内蔵されており、第2モータ22Lは第2メカナムホイール21Lに内蔵されている。このように第1及び第2モータ22R,22Lを内蔵させることで、搬送補助装置1全体の簡素化及びコンパクト化を図ることができる。
【0063】
また、状態センサとしての第1及び第2電流センサSW1,SW2は、第1及び第2メカナムホイール22R,22Lの回転状態に対応した信号を検出する。
【0064】
具体的に、第1電流センサSW1は、第1メカナムホイール21Rの回転に際して第1モータ22Rに流れる誘導電流を検出する。つまり、外力を受けて第1メカナムホイール21Rが回転すると、第1モータ22Rにおいてロータとステータとが相対的に回転し、誘導電流が発生する。第1電流センサSW1によって検出される誘導電流は、q軸電流に相当する。
【0065】
ここで、誘導電流の大きさは、外力を受けて第1メカナムホイール21Rが回転したときに、その第1メカナムホイール21Rに作用したトルクに比例する。このトルクの大きさは、ベッド10が受けた外力の大きさ、ひいては、外力に起因したベッド10の速度変化量と関連している。また、誘導電流の符号は、外力を受けて第1メカナムホイール21Rが回転したときの、第1メカナムホイール21Rの回転方向と関連している。誘導電流の符号は、第1モータ22Rの駆動時に流れることになるモータ電流に対し、逆符号となる。
【0066】
第2電流センサSW2は、第2メカナムホイール21Lの回転に際して第2モータ22Lに流れる誘導電流を検出する。つまり、外力を受けて第2メカナムホイール21Lが回転すると、第2モータ22Lにおいてロータとステータとが相対的に回転し、誘導電流が発生する。第2電流センサSW2によって検出される誘導電流は、q軸電流に相当する。
【0067】
ここで、誘導電流の大きさは、外力を受けて第2メカナムホイール21Lが回転したときに、その第2メカナムホイール21Lに作用したトルクに比例する。このトルクの大きさは、ベッド10が受けた外力の大きさ、ひいては、外力に起因したベッド10の速度変化量と関連している。また、誘導電流の符号は、外力を受けて第2メカナムホイール21Lが回転したときの、第2メカナムホイール21Lの回転方向と関連している。誘導電流の符号は、第2モータ22Lの駆動時に流れることになるモータ電流に対し、逆符号となる。
【0068】
例えば、外力を受けて第1メカナムホイール21Rが前転すると同時に、第2メカナムホイール21Lが後転した場合、第1電流センサSW1は、第1モータ22Rを逆転させるときと同符号の誘導電流を検出することになる。第2電流センサSW2は、第2モータ22Lを正転させるときと同符号の誘導電流を検出することになる。
【0069】
以下に詳述するように、本実施形態に係るコントローラ4は、誘導電流に係るトルクをフィードバックする(より詳細には、トルクに対応した指令回転数で第1及び第2モータ22R,22Lを回転させる)ことで、順方向つまり外力の作用方向へのアシストを実行するように構成されている。
【0070】
また、第1及び第2回転センサSW3,SW4は、それぞれ、第1及び第2モータ22R、22Lの回転数を検出する。具体的に、本実施形態に係る第1及び第2回転センサSW3,SW4は、それぞれエンコーダによって構成されている。エンコーダとしての第1回転センサSW3は、第1モータ22Rの回転数及び回転角度を検出し、同じくエンコーダとしての第2回転センサSW4は、第2モータ22Lの回転数及び回転角度を検出する。
【0071】
また、
図8に示すように、旋回センサとしての6軸センサSW5は、搬送面Fに垂直な回転軸(
図8におけるz軸)まわりにおけるベッド10の旋回を検出する。詳しくは、この6軸センサSW5は、少なくとも、上下方向に沿ったz軸まわりの回転角(いわゆるヨー角ψ)の角速度を検出可能に構成されている。
【0072】
さらに詳しくは、本実施形態に係る6軸センサSW5は、ヨー角ψの角速度に加え、前後方向に延びるx軸、左右方向に延びるy軸、及び上下方向に延びるz軸それぞれに沿った3方向の加速度と、x軸まわりの回転角(いわゆるロール角φ)の角速度と、y軸まわりの回転角(いわゆるピッチ角θ)の角速度と、を検出することができる。6軸センサSW5の検出信号は、コントローラ4に入力される。
【0073】
コントローラ4は、各種センサSW1~SW5から入力された電気信号に基づいて、第1及び第2モータ22R,22Lを制御する。このコントローラ4は、CPU、メモリ及び入出力バスを有しており、例えば制御基板によって構成されている。
【0074】
具体的に、本実施形態に係るコントローラ4は、各種センサSW1~SW5から入力された検出信号に基づいて、第1及び第2モータ22R,22Lそれぞれの指令回転数を設定する。コントローラ4は、設定された指令回転数に対応したモータ電流を、第1及び第2モータ22R,22Lに入力する。これにより、第1及び第2モータ22R,22Lは、それぞれ、コントローラ4が設定した指令回転数で回転することになる。
【0075】
その際、第1メカナムホイール21Rは、第1モータ22Rと同じ回転数で回転し、第2メカナムホイール21Lは、第2モータ22Lと同じ回転数で回転する。すなわち、第1及び第2モータ22R,22Lそれぞれの指令回転数を設定することは、第1及び第2メカナムホイール21R,21Lそれぞれの指令回転数を設定することに等しい。
【0076】
また、各指令回転数の符号を変更することで、第1モータ22R及び第2モータ22Lの回転方向を個別に変更することができる。各モータ22R,22Lの回転方向を変更することで、対応するメカナムホイール21R,21Lを前転と後転とに切り替えることができる。
【0077】
本実施形態では、右側に位置する第1メカナムホイール21Rを前転させると、搬送補助装置1及びベッド10に対し、左斜め前方へと推力を付与することができる(
図7の矢印A
11を参照)。一方、左側に位置する第2メカナムホイール21Lを前転させると、搬送補助装置1は、ベッド10に対して右斜め前方へと推力を付与することができる(
図7の矢印A
12を参照)。
【0078】
したがって、例えば
図7の左上に示すように、第1及び第2メカナムホイール21R,21Lを双方とも前転させると、第1メカナムホイール21Rを前転させることで付与される左方への推力と、第2メカナムホイール21Lを前転させることで付与される右方への推力とを相殺し、搬送補助装置1全体では前方へと推力を付与することができる。この推力によって、ベッド10の前方への移動をアシストすることができる。
【0079】
同様に、右側に位置する第1メカナムホイール21Rを後転させると、搬送補助装置1及びベッド10に対し、右斜め後方へと推力を付与することができる(
図7の矢印A
21を参照)。一方、左側に位置する第2メカナムホイール21Lを後転させると、搬送補助装置1は、ベッド10に対して左斜め後方へと推力を付与することができる(
図7の矢印A
22を参照)。
【0080】
したがって、例えば
図7の右上に示すように、第1及び第2メカナムホイール21R,21Lを双方とも後転させると、第1メカナムホイール21Rを後転させることで付与される右方への推力と、第2メカナムホイール21Lを後転させることで付与される左方への推力とを相殺し、搬送補助装置1全体では後方へと推力を付与することができる。この推力によって、ベッド10の後方への移動をアシストすることができる。
【0081】
一方、第1及び第2メカナムホイール21R,21Lのうちの一方を前転させ、他方を後転させると、搬送補助装置1は、ベッド10に対して左右方向への推力を付与する。
【0082】
図7の左下に示す例では、第1メカナムホイール21Rを後転させるとともに第2メカナムホイール21Lを前転させることで、ベッド10には、右方向への推力が付与される。
【0083】
また、第1及び第2メカナムホイール21R,21Lのうちの一方のみを前転又は後転させると、搬送補助装置1は、ベッド10に対して斜め方向への推力を付与する。
【0084】
図7の右下に示す例では、第2メカナムホイール21Lのみを前転させたことで、右斜め前方へとベッド10を推進させることができる。一方、第1のメカナムホイール21Rのみを前転させると、左斜め前方へとベッド10の移動をアシストすることができる(図示省略)。
【0085】
そして、搬送補助装置1は、各種センサSW1~SW5の検出信号に基づいて第1及び第2モータ22R,22Lを作動させることで、前述のように付与される推力を通じて、搬送者100によるベッド10の搬送をアシストするように構成されている。
【0086】
そうしたアシストを実現すべく、本実施形態に係るコントローラ4は、各種センサSW1~SW5の検出信号に基づいて、外力が作用する方向(以下、単に「作用方向」ともいう)を判定し、その作用方向に沿って推力を発揮するように第1及び第2モータ22R,22Lを作動させる。
【0087】
例えば、ヘッドボード11hが後方から前方に押された結果、後側から前方に向かって外力が作用していると判定された場合、コントローラ4は、第1及び第2モータ22R,22Lを双方とも正転させることで、第1及び第2メカナムホイール21R,21Lを双方とも前転させる。これにより、
図7の左上に例示したようにベッド10の前進をアシストすることが可能になる。
【0088】
また、第1及び第2メカナムホイール21R,21Lは、対応するモータ22R,22Lを駆動していない場合も前転および後転が許容される。これにより、ベッド10を手押移動する際のふらつきを抑制し、ベッド10の搬送を安定させることができる。
【0089】
以下、コントローラ4によるアシストに関し、
図9等を用いて詳細に説明する。
【0090】
ここで、
図9は、コントローラ4が行う主要な処理を例示するフローチャートである。
図10は、移動方向の判定に関する処理を例示するフローチャートである。
図11は、コンプライアンス制御の構成を模式化した制御ブロック図である。
図12は、コンプライアンス制御の基本概念について説明するための概念図である。
図13は、回転数に対する速度増加量の変化を例示する図である。
図14は、速度増加制御によって得られる指令回転数を例示する図である。
図15は、コンプライアンス制御及び速度増加制御を例示するフローチャートである。
【0091】
また、
図16は、コーナリングに関する制御を例示するフローチャートである。
図17は、コーナリング時のベッド10の軌跡を例示する図である。
図18は、安全制限制御を例示するフローチャートである。
【0092】
まず、
図9のステップS1において、コントローラ4は、前述した5つのセンサSW1~SW5の検出信号を読み込む。
【0093】
続くステップS2において、コントローラ4は、第1及び第2電流センサSW1,SW2の検出信号に基づいて、第1及び第2メカナムホイール21R,21Lそれぞれの加速度を個別に推定する。
【0094】
以下、第1メカナムホイール21Rの加速度を「第1加速度」と呼称し、第2メカナムホイール21Rの加速度を「第2加速度」と呼称する。第1及び第2加速度は、双方とも、並進速度の時間微分、つまり、いわゆる接線加速度である。
【0095】
第1及び第2電流センサSW1,SW2それぞれによって検出された誘導電流の大きさは、第1及び第2メカナムホイール21R,21Lの回転時に、それらのホイールに作用したトルク(特に、反力に起因したトルク)に比例する。コントローラ4は、そうした比例関係に基づいて、第1メカナムホイール21Rに作用した第1トルクと、第2メカナムホイール21Lに作用した第2トルクと、を個別に推定する。その際、誘導電流からトルクに変換するための比例係数は、コントローラ4に事前に記憶させたものを用いることができる。
【0096】
本実施形態に係るコントローラ4は、第1及び第2トルクに対応した反力に逆らうように第1及び第2モータ22R、22Lを駆動することで、ベッド10の移動をアシストする。
【0097】
そうしたアシストを実現するために、コントローラ4は、下式(1)及び(2)に基づいて、第1トルクに対応した第1加速度と、第2トルクに対応した第2加速度とを推定する。
【0098】
ar=(-1)・Tr/(R・m) …(1)
al=(-1)・Tl/(R・m) …(2)
【0099】
上式(1)及び(2)において、Tr[Nm]は第1トルクであり、Tl[Nm]は第2トルクである。また、ar[m/s2]は、第1トルクに対応した第1加速度であり、al[m/s2]は、第2トルクに対応した第2加速度である。
【0100】
その他、R[m]は第1及び第2メカナムホイール21R,21Lそれぞれのタイヤ半径であり、m[kg]は第1及び第2メカナムホイール21R,21Lそれぞれの質量である。本実施形態におけるタイヤ半径及び質量の大きさは、第1メカナムホイール21Rと第2メカナムホイール21Lとで同一である。
【0101】
続くステップS3において、コントローラ4は、第1及び第2電流センサSW1,SW2の検出信号に基づいて、第1及び第2メカナムホイール21R,21Lの並進加速度を推定する。
【0102】
詳細には、コントローラ4は、第1及び第2電流センサSW1,SW2の検出信号に基づいて推定した第1及び第2加速度ar,alを用いて、前後方向における第1及び第2メカナムホイール21R,21Lの並進加速度を示す縦加速度と、横方向における第1及び第2メカナムホイール21R,21Lの並進加速度を示す横加速度と、をそれぞれ推定する。
【0103】
さらに詳しくは、
図3~
図5のように第1及び第2メカナムホイール21R,21Lを構成した場合、コントローラ4は、第1加速度a
rと第2加速度a
lとを加算することで縦加速度を推定し、第1加速度a
rと第2加速度a
lとの差分を演算することで横加速度を推定する。これらの演算の詳細は、下式(3)及び(4)に示す通りである。
【0104】
ax=(ar+al)/2 …(3)
ay=(ar-al)/2 …(4)
【0105】
上式(3)及び(4)において、ax[m/s2]が縦加速度であり、ay[m/s2]が横加速度である。式(3)の符号は、前方を正とし、後方を負とするように規定されている。前方と後方とで符号の正負を反転してもよい。同様に、式(4)の符号は、左方を正とし、右方を負とするように規定されている。左方と右方とで符号の正負を反転してもよい。
【0106】
なお、式(3)及び(4)の如き関係式は、第1及び第2モータ22R,22Lそれぞれの回転数(つまり、第1及び第2メカナムホイール21R,21Lそれぞれの回転数)についても成立する。
【0107】
ここで、rr[rpm]を前後方向における第1モータ22Rの回転数(以下、「第1回転数」ともいう)とし、rl[rpm]を前後方向における第2モータ22Lの回転数(以下、「第2回転数」ともいう)とする。これらの回転数のうち、第1回転数rrは第1回転センサSW3によって検出される回転数であり、第2回転数rlは第2回転センサSW4によって検出される回転数である。
【0108】
そして、rx[rpm]を前後方向における第1及び第2モータ22R,22L全体の回転数(以下、これを「縦回転数」ともいう)とし、ry[rpm]を左右方向における第1及び第2モータ22R,22L全体の回転数(以下、これを「横回転数」ともいう)とする。本実施形態のように第1及び第2メカナムホイール21R,21Lを構成及び配置した場合、下式(5)及び(6)が成立する。
【0109】
rx=(rr+rl)/2 …(5)
ry=(rr-rl)/2 …(6)
【0110】
上式(5)及び(6)は、下式(7)及び(8)のように変形可能である。下式(7)及び(8)に示すように、rxとryを設定することで、rrとrlを一意に決定することができる。
【0111】
rr=rx+ry …(7)
rl=rx-ry …(8)
【0112】
また、上式(7)及び(8)それぞれの両辺に、タイヤ半径R及び円周率等に依存した定数(=πR/30)を乗算することで、速度について同様の関係式を得ることもできる。つまり、vr[m/s]を前後方向における第1メカナムホイール21Rの速度とし、vl[m/s]を前後方向における第2メカナムホイール21Lの速度とする。そして、vx[m/s]を前後方向における第1及び第2メカナムホイール21R,21L全体の速度(以下、これを「縦速度」ともいう)とし、vy[m/s]を左右方向における第1及び第2メカナムホイール21R,21L全体の速度(以下、これを「横速度」ともいう)とする。そして、本実施形態のように第1及び第2メカナムホイール21R,21Lを構成及び配置した場合、下式(9)及び(10)が成立する。
【0113】
なお、この場合の「速度」とは、角運動する物体の並進速度(接線速度)を示す。
【0114】
vx=(vr+vl)/2 …(9)
vy=(vr-vl)/2 …(10)
【0115】
上式(9)及び(10)は、下式(11)及び(12)のように変形可能である。下式(11)及び(12)に示すように、vxとvyを設定することで、vrとvlを一意に設定することができる。
【0116】
vr=vx+vy …(11)
vl=vx-vy …(12)
【0117】
また、式同士の関係を利用することで、例えば、縦速度vx及び/又は横速度vyの指令値を決定したときに、それら指令値の実現に要する縦回転数rrと横回転数rlを一意に決定したり、縦回転数rr及び/又は横回転数rlに対応した第1回転数rrと第2回転数rlを決定したりすることができる。
【0118】
続いて、コントローラ4は、第1及び第2回転センサSW3,SW4の検出信号に基づいて、第1及び第2メカナムホイール21R,21Lの回転数が所定(第1閾値)以上になったことを条件に、第1及び第2メカナムホイール21R,21Lの駆動を許容する。
【0119】
具体的に、ステップS3から続くステップS4において、コントローラ4は、以下の関係式(13)及び(14)のいずれか一方が満足されているか否かを判定する。この判定を通じて、実際にベッド10が搬送されているか否か(実際にベッド10が移動しているか否か)を確認することができる。
【0120】
rx≧T1 …(13)
ry≧T1 …(14)
【0121】
上式(13)及び(14)において、T1[1/s]は第1閾値である。第1閾値の大きさは、コントローラ4のメモリ等に事前に記憶されており、上式(13)と(14)とで等しくなるように設定されている。
【0122】
ここで、上式(13)及び(14)が双方とも満足されていない場合、コントローラ4は、ベッド10が搬送されていないと判定し、第1及び第2モータ22R,22Lそれぞれの駆動を許容しない(ステップS4:NO)。この場合、制御プロセスはステップS5に進む。このステップS5において、コントローラ4は、第1及び第2モータ22R,22Lそれぞれの指令回転数をゼロにする。
【0123】
ステップS5に進んだ場合、それ以降のステップS7~S9において、第1及び第2モータ22R、22Lの指令回転数(より詳細には、後述のアシスト速度)はゼロのまま維持される(ステップS7~S9の詳細は後述)。この場合、コントローラ4は、第1及び第2モータ22R,22Lを駆動することなく、
図9に示すフローを終了する。
【0124】
一方、上式(13)及び(14)のうちの少なくとも一方が満足されている場合、コントローラ4は、外力によって実際にベッド10が搬送されていると判定し、第1及び第2モータ22R、22Lそれぞれの駆動を許容する(ステップS4:YES)。この場合、制御プロセスはステップS6に進む。このステップS6において、コントローラ4は、外力による手押移動をアシストすべく、第1及び第2モータ22R,22Lそれぞれの指令回転数(アシスト回転数)を設定する。このアシスト回転数は、前述の縦回転数rx及び横回転数ryの指令値に相当する。
【0125】
図10のステップS11~S15は、それぞれ、
図9のステップS6で実行される処理を例示している。つまり、制御プロセスがステップS6に進むと、コントローラ4は、
図10のステップS11を開始する。
【0126】
このステップS11において、コントローラ4は、
図9のステップS3で推定した縦加速度a
x及び横加速度a
yに基づいて、ベッド10の移動方向を判定する。詳しくは、本実施形態に係るコントローラ4は、縦加速度a
x及び横加速度a
yに基づいて、ベッド10の移動方向が前後方向であるか(ベッド10が前進又は後退しているか)、或いは、左右方向であるかを判定する。
【0127】
さらに詳しくは、ステップS11において、コントローラ4は、以下の関係式(15)が満足されているか否かを判定する。
【0128】
|ay|<T2 …(15)
【0129】
上式(15)において、T2[m/s2]は第2閾値である。第2閾値の大きさは、コントローラ4のメモリ等に事前に記憶されており、必要に応じて適宜読み出されるようになっている。
【0130】
ここで、上式(15)が満足されていない場合、コントローラ4は、ベッド10の移動方向が左右方向であると判定し、制御プロセスをステップS12に進める(ステップS11:NO)。ステップS12に進んだ場合の処理の詳細は、後述する。
【0131】
一方、上式(15)が満足されている場合、コントローラ4は、ベッド10の移動方向が前後方向であると判定し、制御プロセスをステップS13に進める(ステップS11:YES)。
【0132】
ステップS13において、コントローラ4は、6軸センサSW5の検出信号に基づいて、
図8に示したz軸まわりにベッド10が旋回しているか否かを判定する。詳しくは、このステップS13において、コントローラ4は、以下の関係式(16)が満足されているか否かを判定する。
【0133】
|aψ|≧T3 …(16)
【0134】
上式(16)において、aψ[1/s2]はヨー角の角加速度であり、T3[1/s2]は第3閾値である。第3閾値の大きさは、コントローラ4のメモリ等に事前に記憶されており、必要に応じて適宜読み出されるようになっている。
【0135】
ここで、上式(16)が満足されていない場合、コントローラ4は、ベッド10が非旋回中(旋回していない)と判定し、制御プロセスをステップS14に進める。
【0136】
ステップS14に進んだ場合とは、ベッド10が前進又は後退中であってかつ非旋回中であると判定された場合に相当する。この場合、コントローラ4は、これ以降の各ステップを行うことで、第1及び第2電流センサSW1,SW2によって得られた縦加速度ax及び横加速度ayに基づいて、第1制御としてのコンプライアンス制御と、第2制御としての速度増加制御とを双方とも実行する。
【0137】
一方、上式(16)が満足されている場合、コントローラ4は、ベッド10が旋回中(旋回している)と判定し、制御プロセスをステップS15に進める。
【0138】
ステップS15に進んだ場合とは、ベッド10が前進又は後退しながら旋回していると判定された場合(つまり、ベッド10がコーナリングしている場合)に相当する。この場合、コントローラ4は、コーナリングに最適化された制御であって、前後方向と左右方向との双方に手押移動をアシストする制御を実行する。
【0139】
以下、ステップS12及びステップS14で行われる処理と、ステップS15で行われる処理とについて順番に説明する。これらのステップに進んだ場合、コントローラ4は、前述のステップS11で判定された移動方向に基づいて、その移動方向に沿ったベッド10の移動をアシストするように、第1及び第2モータ22R,22Lを介して第1及び第2メカナムホイール21R,21Lを駆動することになる。その途中、本実施形態に係るコントローラ4は、第1制御としてのコンプライアンス制御を実行したり、第2制御としての速度増加制御を実行したりする。
【0140】
コンプライアンス制御とは、コントローラ4が、前記ステップS3で推定した加速度(つまり、縦加速度ax及び横加速度ayの少なくとも一方)に基づいて実行するものである。このコンプライアンス制御において、コントローラ4は、ベッド10の手押移動に追従させるように、前後方向又は左右方向における速度指令、つまり、縦速度vx及び横速度vyの指令値を設定する。
【0141】
式(9)-(12)に関して説明したように、縦速度vx及び横速度vyの指令値を設定することで、前記第1回転数rr及び第2回転数rlの指令値が一意に定まる。
【0142】
以下、縦速度vx及び横速度vyの指令値をそれぞれ縦速度指令Vx及び横速度指令Vyと呼称する。また、各モータ22R,22Lにおける第1回転数rr及び第2回転数rlの指令値を、それぞれ第1指令回転数Rr及び第2指令回転数Rlと呼称する。
【0143】
本実施形態のようにコンプライアンス制御によって縦速度指令Vx及び横速度指令Vyを設定することは、それぞれ、ベッド10の移動に追従させるように第1指令回転数Rr及び第2指令回転数Rlを設定することに等しい。
【0144】
一方、速度増加制御とは、コントローラ4が、前記ステップS3で推定した加速度と、コンプライアンス制御で設定された指令回転数と、に基づいて実行するものである。この速度増加制御において、コントローラ4は、コンプライアンス制御で参照された加速度の絶対値が所定値(後述の第4閾値T4)以上の場合に、そのコンプライアンス制御で設定した縦速度指令Vx及び横速度指令Vy(特に、各速度指令Vx,Vyの絶対値)を増加させる。
【0145】
本実施形態のように速度増加制御によって縦速度指令Vx及び横速度指令Vyを増加させることは、それぞれ、第1指令回転数Rr及び第2指令回転数Rl(特に、各指令回転数Rr,Rlの絶対値)を増加させることに等しい。
【0146】
まず、制御プロセスがステップS12又はステップS14へ進んだ場合について説明する。ここで、
図15のステップS31~S36は、それぞれ、
図10のステップS12又はS14で実行される処理を例示している。つまり、制御プロセスがステップS12又はS14に進むと、コントローラ4は、
図15のステップS31から順番に各ステップを実行する。
【0147】
例えば、ステップS12から
図15のフローに進んだ場合、つまり、「移動方向=左右方向」と判定された場合、コントローラ4は、横加速度a
yに基づいてコンプライアンス制御を実行するとともに、そのコンプライアンス制御を通じて得られた横速度指令V
yに基づいた速度増加制御を実行する。
【0148】
一方、ステップS14から
図15のフローに進んだ場合、つまり、「移動方向=前後方向」と判定された場合、コントローラ4は、縦加速度a
xに基づいてコンプライアンス制御を実行するとともに、そのコンプライアンス制御を通じて得られた縦速度指令V
xに基づいた速度増加制御を実行する。
【0149】
以下、ステップS14から
図15のフローに進んだ場合について詳細に説明する。
図15のフローにおいて、ステップS31がコンプライアンス制御に関係し、ステップS32~ステップS34が速度増加制御に関係している。
【0150】
まず、ステップS31において、コントローラ4は、
図11に例示した制御ブロックに縦加速度a
xを入力して縦速度v
xの指令値を演算する。入力となる縦加速度a
xは、第1及び第2電流センサSW1,SW2の検出信号に基づいて推定されたものであり、縦加速度a
xの推定値(実測値)に相当する。
【0151】
この制御ブロックにおいて、sはラプラス演算子であり、Mはベッド10及び搬送補助装置1の慣性を示している。また、Dは、搬送者100によるベッド10の支持位置(例えばヘッドボード11h)と、第1及び第2メカナムホイール21R,21Lとの間の減衰係数であり、Kは、前記支持位置と、第1及び第2メカナムホイール21R,21Lとの間のバネ乗数である。M、D及びKの値は、事前に設定されており、コントローラ4に記憶されている。
【0152】
ところで、仮に、搬送補助装置1、ベッド10及び搬送者100を剛体とみなした場合、外力の付与によって第1及び第2メカナムホイール21R,21Lが回転したときに生じる縦速度vxは、前後方向におけるベッド10及び搬送者100の移動速度と同期して変化するとともに、その大きさも互いに一致することになる。この場合、縦加速度axの実測値を時間積分することで、ベッド10の手押移動に追従するような縦速度指令Vxが得られることになる。
【0153】
しかし、実際のところ、ベッド10の支持位置と第1及び第2メカナムホイール21R,21Lとの間には、ベッド10のフレーム12、搬送補助装置1の取付具7等が介在している。フレーム12の撓み等に起因して、実際の縦速度vxは、ベッド10及び搬送者100の移動速度から遅れて変化したり、その移動速度との間に値のずれが生じたりすることになる。
【0154】
こうした遅れ、ずれ等の影響をモデル化したものが、
図11に例示した制御ブロックである。この制御ブロックは、力に対応した物理量(縦加速度a
x,横加速度a
y)を入力とし、速度指令(縦速度指令V
x,横速度指令V
y)を出力とするコンプライアンス制御を意味している。
【0155】
図11においては、まず、縦加速度a
xの実測値が、減算器P2を通過した後に第1ブロックB1に入力される。この第1ブロックにおいて、縦加速度a
xの実測値が時間積分される。第1ブロックB1の出力は、縦加速度a
xの大きさに対応した、縦速度指令V
xの修正分(速度指令値の修正量)ΔVを示している。コントローラ4は、現在の縦速度指令V
xにその修正分ΔVを加算したり、その修正分ΔVを積算したりすることで、縦速度指令V
xを設定する。
【0156】
また、ブロックB1からの出力は、第2ブロックB2においてD/Mが乗算された後、加算器P1を介して減算器P2に入力される。減算器P2に入力された乗算値は、縦加速度axの実測値から減算される。このフィードバックは、縦速度指令Vxに比例した減衰(特に、ベッド10の支持位置と第1及び第2メカナムホイール21R,21Lとの間に生じる減衰)を取り入れるためのものである。
【0157】
また、ブロックB1からの出力は、第3ブロックB3にも入力される。この第3ブロックB3において、前記修正分ΔVがさらに時間積分される。第3ブロックB3の出力は、第4ブロックB4においてK/Mが乗算された後、前記加算器P1を介して減算器P2に入力される。減算器P2に入力された乗算値は、第2ブロックB2を介した乗算値と同様に、縦加速度axの実測値から減算される。このフィードバックは、変位量に比例した復元力(特に、ベッド10の支持位置と第1及び第2メカナムホイール21R,21Lとの間の撓みに起因した復元力)を取り入れるためのものである。
【0158】
縦加速度axに2つのフィードバックを反映させることで、撓み、減衰等が考慮されたベッド10の加速度(特に、搬送者100の支持位置での加速度)が推定されることになる。その加速度を第1ブロックB1で時間積分したものが、ベッド10の移動に追従するような速度となる。
【0159】
また、加算器P1から減算器P2に至る途中で、フィードバックに伴う時間のずれを埋め合わせるような信号処理(例えば、遅延演算子を用いた処理)を行ってもよい。
【0160】
例えば、
図12の上図に示すように、搬送補助装置1とベッド10及び搬送者100とが等速で移動している場合、第1及び第2電流センサSW1,SW2で推定される加速度はゼロとなる。この場合、
図10の制御ブロックに入力される縦加速度a
xはゼロとなり、その制御ブロックから出力される修正分ΔVもゼロとなる。この場合、搬送補助装置1は加減速しない。
【0161】
一方、
図12の中央図に示すように、搬送補助装置1よりも搬送者100が速く移動している場合、第1及び第2電流センサSW1,SW2で推定される加速度は正となる。この場合、ベッド10には、これを押し込むような外力が付与されていることになる(矢印F1を参照)。この場合、
図10の制御ブロックに入力される縦加速度a
xは正となり、その制御ブロックから出力される修正分ΔVも正となる。その際、前記第4ブロックB4に係る復元力は、修正分ΔVを増加させる方向に作用する(矢印F3を参照)。これにより、搬送補助装置1は、ベッド10及び搬送者100と等速になるように、外力の付与から遅れて加速することになる。
【0162】
一方、
図12の下図に示すように、搬送補助装置1よりも搬送者100が遅れて移動している場合、第1及び第2電流センサSW1,SW2で推定される加速度は負となる。この場合、ベッド10には、これを引き込むような外力が付与されていることになる(矢印F2を参照)。この場合、
図10の制御ブロックに入力される縦加速度a
xは負となり、その制御ブロックから出力される修正分ΔVも負となる。その際、前記第4ブロックB4に係る復元力は、修正分ΔVを減少させる方向に作用する(矢印F4を参照)。これにより、搬送補助装置1は、ベッド10及び搬送者100と等速になるように、外力の付与から遅れて減速することになる。
【0163】
続くステップS32~ステップS34において、コントローラ4は、前述の速度増加制御を実行する。コントローラ4は、この速度増加制御を実行する場合、第1及び第2回転センサSW3,SW4によって検出された回転数が大きくなる程、速度指令値を大きく増加させる(
図13を参照)。
【0164】
具体的に、ステップS32において、コントローラ4は、縦速度vxが大きくなる程大きくなるように、速度増加量voffを設定する。縦速度vxの代わりに、縦回転数rxが大きくなる程大きくなるように、速度増加量voffを設定してもよい。
【0165】
また、ステップS12から
図15のフローに進んだ場合は、縦速度v
xの代わりに横速度v
yが判定対象となる。つまり、コントローラ4は、
図10のステップS11で判定された移動方向に基づいて、速度増加量v
offの設定を行うようになっている。
【0166】
続くステップS33において、コントローラ4は、以下の関係式(17)が満足されているか否かを判定する。ステップS33は、縦加速度axの絶対値が所定値以上であるか否かを判定するものである。この判定を通じて、移動方向に沿ってベッド10が押されているか否かを検出することができる(押し力を検出)。
【0167】
|ax|≧T4 …(17)
【0168】
上式(17)において、T4[m/s2]は第4閾値(所定値)である。所定値としての第4閾値T4の大きさは、コントローラ4のメモリ等に事前に記憶されており、必要に応じて適宜読み出されるようになっている。
【0169】
なお、ステップS12から
図15のフローに進んだ場合は、縦加速度a
xの代わりに横加速度a
yが比較対象となる。つまり、コントローラ4は、
図10のステップS11で判定された移動方向における加速度について、第4閾値T4以上であるか否かの判定を行うようになっている。
【0170】
ここで、上式(17)が満足されている場合(つまり、縦加速度axの絶対値が所定値以上の場合)、コントローラ4は、ベッド10が押されていると判定し、制御プロセスをステップS34に進める(ステップS33:YES)。
【0171】
ステップS34において、コントローラ4は、ステップS31で算出した速度指令(縦速度指令Vx)に速度増加量voffを加算する。コントローラ4は、そうして得られた加算値を、最終的な速度指令(アシスト速度)とする(ステップS36)。前後方向におけるアシスト速度は、前述の縦速度指令Vxである。左右方向におけるアシスト速度は、前述の横速度指令Vxである。
【0172】
なお、速度増加量voffを算出して速度指令に加算する代わりに、第1及び第2回転センサSW3,SW4によって検出された回転数が大きくなるほど大きくなるような増加倍率(>1)を算出し、その増加倍率を速度指令に乗算することで速度増加制御を行ってもよい。
【0173】
一方、上式(17)が満足されていない場合(つまり、縦加速度axの絶対値が所定値を下回った場合)、コントローラ4は、ベッド10が押されていないと判定し、制御プロセスをステップS35に進める(ステップS33:NO)。
【0174】
ステップS35において、コントローラ4は、第2制御後の速度指令を低下させる第3制御を実行する。
【0175】
具体的に、ステップS35において、コントローラ4は、速度増加量voffを、その時点の値からΔv2だけ減算した上で、制御プロセスをステップS34に進める。なお、速度増加量voffの減算量Δv2は、一定にしてもよい。減算量Δv2を一定に設定した場合、ベッド10が押されていない状態が繰り返されると、速度増加量voffは徐々に減少していくことになる。また、この減算に際し、速度増加量voffはゼロ未満にならないように構成されている。これにより、ベッド10の移動に追従させる程度のアシスト速度は確保される。
【0176】
例えば、n回目のループでステップS33からステップS34に進んだ場合、縦速度指令Vxは、縦速度vxに応じた速度増加量voffの分だけ増加することになる。その後、n+1回目のループでステップS33からステップS35に進んだ場合、速度増加量voffは、n回目のループ時の値から減算されることになる。その後、ステップS33からステップS35に進むような状況が繰り返されると、縦速度指令Vxは、ステップS31で算出された値に向かって低下することになる。
【0177】
図14は、コンプライアンス制御を実行し、速度増加制御を未実行とした場合におけるアシスト回転数(破線)と、コンプライアンス制御及び速度増加制御を双方とも実行とした場合におけるアシスト回転数(実線)とを比較した図である。
図14における丸印は、それぞれ、ベッド10が押されたと判定されたタイミング(ステップS33の判定がYESとなったタイミング)を示している。
【0178】
コンプライアンス制御のみを実行した場合、アシスト回転数は、ベッド10の移動から遅れて立ち上がった後、その移動に追従するような値で推移する。
【0179】
一方、コンプライアンス制御と速度増加制御を両方とも実行とした場合、ベッド10が押されたと判定される度に、アシスト回転数が急峻に立ち上がる(例えば、t=t1,t2,t3を参照)。一方、ベッド10が押されていないと判定された期間が続くと、立ち上がった後のアシスト回転数が、時間経過に伴って徐々に減少していくことになる(例えば、t1<t<t2,t2<t<t3を参照)。
【0180】
そして、ステップS36に係る処理が完了すると、制御プロセスは、
図10及び
図15のフローを終了し、
図9のステップS7に進む。
【0181】
なお、
図15に関する説明は、ステップS12から
図15のフローに進んだ場合についても同様である。その場合、前述の説明において、「縦」なる語を「横」なる語に置き換えるとともに、「前後」なる語を「左右」なる語に置き換えればよい。各種数式においても同様である。その際、第4閾値T4等の所定値は、前後方向と左右方向で同一としてもよいし、異ならせてもよい。
【0182】
一方、ステップS13からステップS15に進んだ場合、コントローラ4は、ベッド10のコーナリングをアシストすべく、コーナリング用に縦横両方向におけるアシスト回転数を設定する。
【0183】
ここで、
図16のステップS41~S44は、それぞれ、
図10のステップS15で実行される処理を例示している。つまり、制御プロセスがステップS15に進むと、コントローラ4は、
図15のステップS41から順番に各ステップを実行する。
【0184】
まずステップS41において、コントローラ4は、
図9のステップS3で推定した横加速度a
yを、0を上回る所定比率で減少させるように調整する。具体的に、コントローラ4は、縦加速度a
xについては前記ステップS3で推定した値を維持する一方、横加速度a
yについては下式(18)のように変換する。
【0185】
ay’=cy*ay …(18)
【0186】
上式(18)において、所定比率を示すcyは、ベッド10及び搬送補助装置1の寸法・重量・構成等に応じて事前に設定されており、コントローラ4に記憶されている。所定比率cyは、詳細には1未満(0<cy<1)、さらに詳細には0.5未満(0<cy<0.5)に設定される。
【0187】
この所定比率c
yは、ベッド10の旋回中心Otを、第1及び第2メカナムホイール21R,21Lの中央位置Pcからベッド10の前端側にシフトさせるように設定されている(
図17を参照)。
【0188】
なお、ここでいう中央位置Pcは、
図4に示すように、左右方向における第1及び第2メカナムホイール21R,21Lの中央位置であって、前後方向においいては、第1及び第2回転軸Oy1,Oy2と交わる位置としてもよい。
【0189】
続くステップS42において、コントローラ4は、前後方向について、ステップS3で推定した縦加速度axに基づいて、第1制御としてのコンプライアンス制御を実行する。
【0190】
特に、本実施形態に係るコントローラ4は、前後方向については、ステップS3で推定した縦加速度a
xに基づいて、コンプライアンス制御と、第2制御としての速度増加制御との双方を順番に実行する。前後方向におけるコンプライアンス制御及び速度増加制御の詳細は、
図15を参照して説明した通りである。ステップS42を実行することで、コントローラ4は、前述のように、前後方向における速度指令を設定する。
【0191】
つまり、前後方向については、ベッド10の前後移動に追従するような速度指令(ひいては、第1及び第2モータ22R,22Lの指令回転数)を算出の上、ベッド10が押されたことに同期して速度指令(指令回転数)を底上げするような制御が実行されることになる。
【0192】
続くステップS43において、コントローラ4は、左右方向(横方向)について、前記ステップS41によって調整後の横加速度ay’に基づいて、第1制御としてのコンプライアンス制御を実行する。
【0193】
特に、本実施形態に係るコントローラ4は、横方向については、調整後の横加速度a
y’に基づいてコンプライアンス制御を実行の上、第2制御としての速度増加制御を未実行とする。この場合、コントローラ4は、
図15においてステップS32~ステップS35以外の処理を実行し、左右方向における速度指令を設定する。
【0194】
つまり、左右方向については、ベッド10の横移動に若干追従するような速度指令(ひいては、第1及び第2モータ22R,22Lの指令回転数)を算出する制御こそ実行するものの、ベッド10が押されたことに同期して速度指令(指令回転数)を底上げするような制御については意図的に未実行とされる。
【0195】
続くステップS44において、コントローラ4は、ステップS42で設定した速度指令を、前後方向におけるアシスト速度とし、ステップS43で設定した指令回転数を、横方向におけるアシスト速度とする。
【0196】
図10のステップS12、ステップS14及びステップS15に係るフローが完了すると、制御プロセスは、
図9のステップS7に進む。このステップS7において、コントローラ4は、アシスト回転数として設定された縦速度指令V
x又は横速度指令V
yを、それぞれ、上式(5)及び(6)と同様に定めた下式(19)及び(20)を通じて第1指令回転数R
rと第2指令回転数R
lとに変換する。
【0197】
Rr=60*(Vx+Vy)/(2π・R) …(19)
Rl=60*(Vx-Vy)/(2π・R) …(20)
【0198】
上式(19)及び(20)における“R”は、前述のタイヤ半径である。本実施形態の場合、前後方向へのアシストに際してはVx≠0かつVy=0となり、左右方向へのアシストに際してはVx=0かつVy≠0となり、コーナリングのアシストに際してはVx≠0かつVy≠0となる。
【0199】
例えば、コントローラ4は、ベッド10の移動方向が前後方向であると判定した場合(ステップS14を経由した場合)、
図7の左上及び右上に例示したように、第1及び第2メカナムホイール21R、21Lを双方とも前転又は後転させるように、第1及び第2指令回転数R
r,R
lを設定するとともに、当該設定に際し、第1メカナムホイール21Rと第2メカナムホイール21Lとで指令回転数の絶対値を等しくする(R
r=R
l)。
【0200】
第1及び第2指令回転数Rr,Rlの絶対値を等しくすることで、各キャスタ14の向きに関わらず、前後方向に沿った移動を安定させることができる。
【0201】
また、コントローラ4は、ベッド10の移動方向が左右方向であると判定した場合(ステップS12を経由した場合)には、
図7の左下に例示したように、第1及び第2メカナムホイール21R,21Lのうちの一方を前転させるとともに、他方を後転させるように第1及び第2指令回転数R
r,R
lを設定するとともに、当該設定に際しても、第1メカナムホイール21Rと第2メカナムホイール21Lとで指令回転数の絶対値を等しくする(R
r=-R
l)。
【0202】
また、コントローラ4は、ベッド10がコーナリング中であると判定した場合(ステップS12を経由した場合)には、
図7の右下に例示したように、第1及び第2メカナムホイール21R,21Lのうちの少なくとも一方を回転させるように第1及び第2指令回転数R
r,R
lを設定する。その設定に際しては、
図17に例示した位置に旋回中心Otが位置するように、第1メカナムホイール21Rと第2メカナムホイール21Lとで異なる絶対値とする(|R
r|≠|R
l|)。
【0203】
その後、ステップS7から続くステップS8において、コントローラ4は安全制御処理を実行する。この処理の詳細は、
図18のステップS51及びステップS52に示す通りである。
【0204】
まず、ステップS51において、コントローラ4は、
図9のフローを通じて設定された各指令回転数R
r,R
lの絶対値が、所定の第5閾値T5以上か否かを判定する。ここで、第5閾値T5の大きさは、コントローラ4のメモリ等に事前に記憶されており、必要に応じて適宜読み出されるようになっている。
【0205】
ステップS51の判定がYESの場合、コントローラ4は、制御プロセスをステップS52に進める。このステップS52において、コントローラ4は、各指令回転数Rr,Rlを第5閾値T5に変更する。
【0206】
一方、ステップS51の判定がNOの場合、コントローラ4は、ステップS52をスキップしてリターンする。この場合、各指令回転数Rr,Rlの大きさは、第5閾値T5未満のまま維持される。
【0207】
このように、本実施形態に係るコントローラ4は、第2制御としての速度増加制御後に、第1及び第2指令回転数Rr,Rlが所定の閾値(第5閾値T5)未満の場合(ステップS51:NO)には、該第1及び第2指令回転数Rr,Rlの値を維持し、第1及び第2指令回転数Rr,Rlが第5閾値T5以上の場合(ステップS51:YES)には、第1及び第2指令回転数Rr,Rlを第5閾値T5に変更するように構成されている。
【0208】
そして、
図9のステップS8から続くステップS9において、コントローラ4は、移動方向に沿ったベッド10の移動をアシストするように、第1及び第2モータ22R,22Lを介して第1及び第2メカナムホイール21R,21Lをそれぞれ駆動する。その際、前述のステップS5、ステップS6及びステップS7を通じて決定された指令回転数R
r,R
lを実現するように、第1及び第2モータ22R,22Lがそれぞれ駆動される。
【0209】
これにより、前後方向又は左右方向への手押移動に際しては、その移動方向に沿ったアシストが実行される一方、前後方向に移動しながらの旋回つまり、ベッド10のコーナリングに際しては、前後方向と左右方向との双方に手押移動がアシストされるように、第1及び第2モータ22R,22Lを介して第1及び第2メカナムホイール21R,21Lが駆動される。
【0210】
これにより、前後方向のみにアシストしたときのような中央位置Pcまわりの旋回ではなく、横方向へとベッド10をスライドさせながらの旋回が実現される。例えば、
図17のような右折時には、ベッド10を前方に押し込む外力に加えて、該ベッド10を左方(旋回方向の逆方向)にスライドさせるような外力が作用するから、その外力をフィードバックしてアシストすることで、ベッド10を左方にスライド(いわばドリフト)させるようなコーナリングが実現される。
【0211】
これにより、
図17に示したように、旋回中心Otをベッド10の前端側にシフトさせたコーナリングが実現されて、同図に示すような軌道でベッド10を旋回させることができるようになる。
【0212】
仮に、横方向へのアシストを行わなかった場合、
図19の従来例に示すように、第1及び第2メカナムホイール21R,21Lの中央位置Pcを旋回中心Otとした軌道となる。そうした軌道は、コーナリング半径が小さいものとなり、通路の角等とベッド10とが干渉するおそれがあり不都合である。
【0213】
また、図示は省略するが、左折時には、ベッド10を前方に押し込む外力に加えて、該ベッド10を右方(旋回方向の逆方向)にスライドさせるような外力が作用するから、その外力をフィードバックしてアシストすることで、ベッド10を右方にスライドさせるようなコーナリングが実現される。この場合も、
図17に示したようなスムースな軌道を実現することが可能になる。
【0214】
以上説明したように、本実施形態によれば、コントローラ4は、前後方向に加えて、横方向についても手押移動をアシストする(
図16のステップS43及びステップS44を参照)。ベッド10のコーナリングに際しては、コーナリングの半径方向、すなわちベッドの横方向にも力が加わると考えられる。したがって、そうした横方向の力をアシストすることで、コーナリング時に、ベッド10を横方向にスライドさせることができる。これにより、コーナリング半径を大きくし、ベッド10の前端又は後端部と、通路の角部との干渉を抑制することができる。これにより、ベッド10のコーナリングを適切にアシストすることが可能になる。
【0215】
また、
図9のステップS2及びステップS3に例示したように、誘導電流を検出することで、その誘導電流が生じる起因となったトルク(第1及びメカナムホイール21R,21Lを回転させようとするトルク)、ひいては、そのトルクに対応した加速度を推定することができる。各メカナムホイール21R、21Lの加速度を推定することで、外力が作用した方向を推定することが可能になる。
【0216】
そして、前後方向については手押移動に追従させるようなアシストを実行する一方、横方向については、
図16のステップS41に例示したように、同方向における加速度を減少させた上、その加速度に基づいたコンプライアンス制御を行う。横方向における加速度を減少させることは、同方向に作用する外力を、実際に作用する外力よりも小さく見積もることに等しい。外力を小さく見積もることで、横方向については、手押移動に追従させるには及ばないようなアシストが実行される。その結果、横方向における過度のスライド(搬送者100が意図した以上のスライド)を抑制し、コーナリング半径を、適切な範囲内に収めることができる。これにより、ベッド10のコーナリングを適切にアシストする上で有利になる。
【0217】
また、
図17を用いて説明したように、ベッド10の旋回中心Otを前端側にシフトさせることで、ベッド10のコーナリングに際し、前端側よりも後端側を大きく旋回させるような動作を実現することができる。後端側を大きく旋回させることで、その後端側の部位と、通路の角部との干渉を抑制することができる。これにより、ベッド10のコーナリングを適切にアシストする上で有利になる。
【0218】
また、
図16のステップS42に例示したように、前後方向については速度増加制御を行うことで、単に手押移動に追従させるばかりでなく、指令回転数を増加させた分だけ搬送者100の負荷を軽減することができる。これにより、前後方向におけるベッド10の押し心地を向上し、適度な“アシスト感”を搬送者100に与えることができる。一方、横方向については、
図16のステップS43に例示したように、速度増加制御を意図的に未実行とする。これにより、横方向における過度のスライド(搬送者100が意図した以上のスライド)を抑制し、コーナリング半径を、適切な範囲内に収めることができる。これにより、ベッド10のコーナリングを適切にアシストする上で有利になる。
【0219】
また、
図3~
図5及び
図7に例示したように第1及び第2メカナムホイール21R、21Lを構成及び配置したことで、第1メカナムホイール21Rと第2メカナムホイール21Lとを反対方向に回転させたときに、ベッド10を旋回動作させるような推力を発揮させることができる。このように構成することは、ベッド10のコーナリングを適切にアシストする上で有効である。
【0220】
また、前後移動に際しては指令回転数の絶対値を等しくすることで、キャスタ14の向きにかかわらず、より安定した前後移動を実現することができる。一方、コーナリングに際しては意図的に絶対値を異ならせることで、所望の軌道に沿ったコーナリングを実現することができる。
【0221】
<他の実施形態>
前記実施形態では、ベッド10の前進又は後退を判定するための状態センサとして、第1及び第2電流センサSW1,SW2を用いるように構成されていたが、本開示は、そうした構成には限定されない。例えば、状態センサに、第1及び第2回転センサSW3,SW4を用いてもよいし、6軸センサSW5を用いてもよい。
【0222】
また、前記実施形態では、速度増加制御によって速度指令(並進速度の指令値)が増加されるように構成されていたが、そうした構成は必須ではない。
【0223】
例えば、ステップS32~S34において、速度指令に係る処理の代わりに指令回転数を増加させるような処理を実行してもよい。その場合、ステップS31とステップS32との間に、速度指令を指令回転数に変換するような処理が設けられることになる。
【符号の説明】
【0224】
1 搬送補助装置
4 コントローラ
10 ベッド(キャスタ付きベッド)
14 キャスタ
14F 前輪
14B 後輪
21R 第1メカナムホイール
211R 第1ホイール本体(ホイール本体)
212R 第1樽型ローラ(樽型ローラ)
21L 第2メカナムホイール
211L 第2ホイール本体(ホイール本体)
212L 第2樽型ローラ(樽型ローラ)
22R 第1モータ
22L 第2モータ
cy 所定比率
F 搬送面
Ot 旋回中心
Pc 中央位置
Oy1 第1回転軸(回転軸)
Oy2 第2回転軸(回転軸)
Or 第1傾斜軸(傾斜軸)
Ol 第2傾斜軸(傾斜軸)
SW1 第1電流センサ(状態センサ)
SW2 第2電流センサ(状態センサ)
SW5 6軸センサ(旋回センサ)