(57)【要約】【課題】ロボットアームなどの被駆動部を高速で動作させることができるモーターの駆動方法、駆動装置およびロボットを提供する。【解決手段】モーターの駆動トルク計測データと回転数計測データと、を取得する駆動データ取得工程と、前記駆動トルク計測データと前記回転数計測データと、を前記モーターの回転数／トルク特性テーブルと比較する比較工程と、前記比較工程の比較結果において、前記駆動トルク計測データと前記回転数計測データとが、前記回転数／トルク特性テーブルの駆動可能領域境界にある場合、前記モーターの駆動電圧を昇圧させる昇電圧工程と、を備えるモーター駆動方法。【選択図】図１
2012257425.tif 000002
【特許請求の範囲】
【請求項１】
モーターの駆動トルク計測データと回転数計測データと、を取得する駆動データ取得工程と、
前記駆動トルク計測データと前記回転数計測データと、を前記モーターの回転数／トルク特性テーブルと比較する比較工程と、
前記比較工程の比較結果において、前記駆動トルク計測データと前記回転数計測データとが、前記回転数／トルク特性テーブルの駆動可能領域境界にある場合、前記モーターの駆動電圧を昇圧させる昇電圧工程と、を備える、
ことを特徴とするモーター駆動方法。
【請求項２】
前記昇電圧工程は、前記駆動トルク計測データと前記回転数計測データとが、前記駆動可能領域境界と前記駆動可能領域境界より内側に設定される閾値と、で形成される領域にある場合、前記モーターの駆動電圧を昇圧させる、
ことを特徴とする請求項１に記載のモーター駆動方法。
【請求項３】
モーターの駆動トルク計測データと回転数計測データと、を取得する駆動データ取得手段と、
前記駆動トルク計測データと前記回転数計測データと、を前記モーターの回転数／トルク特性テーブルと比較する比較手段と、
前記比較手段の比較結果から、前記駆動トルク計測データと前記回転数計測データとが、前記回転数／トルク特性テーブルの駆動可能領域境界にある場合、前記モーターの駆動電圧を昇圧させる昇電圧手段と、を備える、
ことを特徴とするモーター駆動装置。
【請求項４】
前記昇電圧手段は、前記駆動トルク計測データと前記回転数計測データとが、前記駆動可能領域境界と前記駆動可能領域境界より内側に設定される閾値と、で形成される領域にある場合、前記モーターの駆動電圧を昇圧させる、
ことを特徴とする請求項３に記載のモーター駆動装置。
【請求項５】
請求項３または４に記載のモーター駆動装置を備えるロボット。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、モーター駆動方法、モーター駆動装置およびロボットに関する。
【背景技術】
【０００２】
工業製品の製造現場へのロボットの導入は、単純作業の置き換えから、繰り返しの位置精度が求められる精密作業、重量物を扱う作業、など様々な領域に亘り拡大してきている。また、複数のロボットを生産ラインに配置し、流れ作業の無人化も急速に進んできている。生産ラインに複数のロボットを配置する場合、生産ラインの生産性を高めるためには、配置された複数のロボットの一台一台の生産性を高める必要がある。ロボットの生産性は、動作速度により左右されるが、中でも始動時から短い時間で所定の速度まで加速させるかが重要である。
【０００３】
特許文献１には、グリースなどの潤滑剤が低温時に粘度が上昇し、その粘度抵抗によって指令動作に対して、例えば動作時間の増大、軌跡精度の低下を招くため、その動作誤差を、初動時に検出されるトルクから予め設定されたモーターの加減速度および速度を調整し、モーターのトルクが飽和しないようにする加減速度決定器によって補正することが開示されている。
【０００４】
また、特許文献２には、単相整流コンバーター電源のモーターを制御する制御装置において、昇降圧チョッパと蓄電部とを備えて、直流電圧信号が閾値より下がった場合に蓄電部の電圧を昇圧してコンデンサー放電することで、直流電圧を閾値で維持させることが開示されている。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開平９−３１１７１３号公報
【特許文献２】特開２００９−１９５０１８号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
しかし、上述の特許文献１では、制御装置に備える加減速度決定器によって、モータートルクの飽和状態を回避させるため、基準トルク値を超える場合にはモーターの速度を下げるように制御される。従って、生産性の向上には繋がらないものであった。また、特許文献２では、通常動作において負荷変動が生じた場合の直流電圧の低下を蓄電部の電源で補い、変動の少ないモーターの動作を行わせるものであり、モーターの速度を上げることの開示は無い。
【０００７】
そこで、駆動可能領域を一時的に超えて駆動させ、ロボットアームなどの被駆動部を高速で動作させることができるモーターの駆動方法、駆動装置およびロボットを提供する。
【課題を解決するための手段】
【０００８】
本発明は、少なくとも上述の課題の一つを解決するように、下記の形態または適用例として実現され得る。
【０００９】
〔適用例１〕本適用例のモーター駆動方法は、モーターの駆動トルク計測データと回転数計測データと、を取得する駆動データ取得工程と、前記駆動トルク計測データと前記回転数計測データと、を前記モーターの回転数／トルク特性テーブルと比較する比較工程と、前記比較工程の比較結果において、前記駆動トルク計測データと前記回転数計測データとが、前記回転数／トルク特性テーブルの駆動可能領域境界にある場合、前記モーターの駆動電圧を昇圧させる昇電圧工程と、を備えることを特徴とする。
【００１０】
モーターのトルクと回転数との関係を示す特性、いわゆるＴＮ特性において、モーター始動から定速駆動に至るまでの加速駆動時には、負荷トルクの減少に伴って徐々に回転数が上昇し、所定のトルク値以下において定速回転する。この加速駆動時において、本適用例のモーター駆動方法によりモーターの駆動電圧を、定格駆動電圧を超える電圧に昇圧する工程を備えることにより、加速駆動時のモーター駆動トルクまたは回転数を定格特性値より高くし、モーター始動から定速駆動までの所要時間を短縮することができる。
【００１１】
〔適用例２〕上述の適用例において、前記昇電圧工程は、前記駆動トルク計測データと前記回転数計測データとが、前記駆動可能領域境界と前記駆動可能領域境界より内側に設定される閾値と、で形成される領域にある場合、前記モーターの駆動電圧を昇圧させることを特徴とする。
【００１２】
上述の適用例によれば、モーターの駆動電圧を昇圧する判定値を、駆動可能領域境界と駆動可能領域境界の内側に設定した閾値と、によって形成される領域に設定する。これにより、駆動電圧を昇圧するタイミングを早め、駆動電圧の昇圧の遅れを防止することができる。従って、モーター始動から定速駆動までの所要時間の短縮をより確実にすることができる。
【００１３】
〔適用例３〕本適用例のモーター駆動装置は、モーターの駆動トルク計測データと回転数計測データと、を取得する駆動データ取得手段と、前記駆動トルク計測データと前記回転数計測データと、を前記モーターの回転数／トルク特性テーブルと比較する比較手段と、前記比較手段の比較結果から、前記駆動トルク計測データと前記回転数計測データとが、前記回転数／トルク特性テーブルの駆動可能領域境界にある場合、前記モーターの駆動電圧を昇圧させる昇電圧手段と、を備えることを特徴とする。
【００１４】
モーターのトルクと回転数との関係を示す特性、いわゆるＴＮ特性において、モーター始動から定速駆動に至るまでの加速駆動時には、負荷トルクの減少に伴って徐々に回転数が上昇し、所定のトルク値以下において定速回転する。この加速駆動時において、本適用例のモーター駆動装置によりモーターの駆動電圧を、定格駆動電圧を超える電圧に昇圧する昇電圧手段を備えることにより、加速駆動時のモーター駆動トルクまたは回転数を定格特性値より高くし、モーター始動から定速駆動までの所要時間を短縮することができる。
【００１５】
〔適用例４〕上述の適用例において、前記昇電圧手段は、前記駆動トルク計測データと前記回転数計測データとが、前記駆動可能領域境界と前記駆動可能領域境界より内側に設定される閾値と、で形成される領域にある場合、前記モーターの駆動電圧を昇圧させることを特徴とする。
【００１６】
上述の適用例によれば、モーターの駆動電圧を昇圧する判定値を、駆動可能領域境界と駆動可能領域境界の内側に設定した閾値と、によって形成される領域に設定し、比較手段の比較結果により電源電圧を昇圧する昇電圧手段を備える装置である。これにより、駆動電圧を昇圧するタイミングを早め、駆動電圧の昇圧の遅れを防止することができる。従って、モーター始動から定速駆動までの所要時間の短縮をより確実にするモーター駆動装置を得ることができる。
【００１７】
〔適用例５〕上述の適用例のモーター駆動装置を備えるロボット。
【００１８】
本適用例のロボットによれば、駆動開始から定速駆動に至るまでの時間を短縮することができ、ロボットアームの目標移動時間を短縮することができる。従って、生産性の高いロボットを得ることができる。
【図面の簡単な説明】
【００１９】
【図１】実施形態に係るロボットの構成を示すブロック図。
【図２】実施形態に係るロボットの駆動方法を示すフローチャート。
【図３】実施形態に係るロボットに備えるモーターの駆動特性の概要を示すＴＮ特性線図。
【図４】実施形態に係るロボットに備えるモーターの比較判定方法を説明するＴＮ特性線図。
【図５】昇圧回路の一例を示す回路ブロック図。
【図６】その他の実施形態に係るロボットの駆動方法説明する、（ａ）はアームの軌道概念図、（ｂ）はトルク特性概念図、（ｃ）は駆動電圧の変化を示す概念図。
【図７】その他の実施形態に係るロボットの駆動方法説明する、（ａ）はアームの軌道概念図、（ｂ）は回転数特性概念図、（ｃ）は駆動電圧の変化を示す概念図。
【図８】昇圧回路のその他の例を示す回路ブロック図。
【発明を実施するための形態】
【００２０】
以下、図面を参照して、本発明に係る実施形態を説明する。
【００２１】
（実施形態）
図１は、本実施形態に係るロボットの構成を示す概念図である。図１に示すロボット１００は、基台１０に一方の側が回転可能に固定される第１アーム２１と、第１アーム２１の他方の側に相対的に一方の側が回転可能に固定される第２アーム２２と、第２アーム２２の他方の側に被作業物４０に対して作業を行うハンド部３０と、を備える。基台１０と第１アーム２１とは、モーター５１によって回転可能に固定され、第１アーム２１と第２アーム２２とは、モーター５２によって回転可能に固定されている。
【００２２】
またロボット１００は、ロボット１００の駆動を制御するモーター駆動装置としての駆動制御装置７０を備え、駆動制御装置７０は、例えばコンピューターなどの外部制御装置である外部駆動指示装置２００からの指示を駆動部７１に受け、アーム２１，２２およびハンド部３０を駆動する。また駆動制御装置７０には、ロボット１００の駆動情報により駆動部７１を介してロボット１００を制御する制御部７２を備えている。
【００２３】
基台１０に備えるモーター５１、および第１アーム２１に備えるモーター５２には、各モーターの出力トルクおよび回転数を検出する検出手段６１，６２を備えている。検出手段６１，６２において検出されたデータは駆動制御装置７０に備える制御部７２に取得され、取得された信号に基づいて制御部７２は、後述するモーター５１，５２の駆動電圧を一時的に昇圧する制御を実行する。制御部７２は、検出手段６１，６２からの検出データ信号を取得する駆動データ取得手段７２ａと、モーター５１，５２の回転数およびトルクの特性が記憶された回転数／トルク特性テーブル７２ｂと、駆動データ取得手段７２ａが取得した駆動データと回転数／トルク特性テーブル７２ｂから取得した駆動特性データとを比較する比較手段７２ｃと、比較手段７２ｃにおける比較結果に基づいてモーター駆動電圧を昇圧する昇電圧手段７２ｄと、を含んでいる。
【００２４】
図２は、ロボット１００のモーター５１，５２の駆動方法を示すフローチャートである。図２に基づいて、ロボット１００の駆動方法を説明する。
【００２５】
＜モータートルク／回転数計測工程＞
まず、外部駆動指示装置２００からの指示に基づくロボット１００の駆動の信号が駆動部７１より送出され、モーター５１，５２の駆動が開始する（Ｓ１）。モーター駆動開始（Ｓ１）の直後から、検出手段６１，６２によって、モーター５１，５２の回転数および出力トルクの計測を行う、モータートルク／回転数計測工程（Ｓ２）（以下、計測工程（Ｓ２）という）が実行される。
【００２６】
＜モーター回転数判定工程＞
計測工程（Ｓ２）において検出された回転数のデータを、モーター回転数判定工程（Ｓ３）において最大回転数であるか、を判定する。図３は、モーター５１，５２の回転数／トルク特性（ＴＮ特性）を模式的に示すグラフである。本実施形態に係るロボット１００に備えるモーター５１，５２は、図３に示すようなＴＮ特性を有し、このＴＮ特性線の内側領域ＵAが駆動可能領域、ＴＮ特性線が駆動可能領域境界として定義される。図３に示すＴＮ特性において、モーター回転数は変化点Ｐ１まで、すなわち負荷トルクがトルクＴP1まで、は最大回転数Ｒmaxまで駆動が可能となる。しかし、変化点Ｐ１から変化点Ｐ２である最大負荷トルクである最大出力トルクＴmaxまでは回転可能なモーター回転数は減少し、変化点Ｐ２において最大回転数はＲP2となってしまう。従って、本実施形態に係るロボット１００に備えるモーター５１，５２の性能を示すＴＮ特性図において、図３に示す変化点Ｐ１を、より高負荷トルク側、すなわちＴP1をよりＴmax側に近づけることで、Ｒmaxが維持できる負荷領域である０〜ＴP1を拡大させ、第１アーム２１、第２アーム２２をより短時間に目標位置まで移動させることを可能にするものである。
【００２７】
モーター回転数判定工程（Ｓ３）において、計測工程（Ｓ２）において検出された回転数が図３に示すＲmaxであるか、を判定する。判定結果が、モーター回転数がＲmaxである、すなわちＹＥＳである場合には、次の減速目標位置到達判別工程（Ｓ４）に移行する。判定結果が、モーター回転数がＲmaxではない、すなわちＮＯである場合には、比較工程としてのモータートルク／回転数比較工程（Ｓ１０）に移行する。
【００２８】
＜モータートルク／回転数比較工程＞
モータートルク／回転数比較工程（Ｓ１０）（以下、トルク回転数比較工程（Ｓ１０）という）では、図４に示すＴＮ特性図を用いて比較判定を実行する。図４に示すＴＮ特性図は、図３に示すＴＮ特性図より作成される。図４に示すように比較判定の基準となる閾値Ｌが設定される。閾値Ｌは、後述するモーター５１，５２の電源電圧を昇圧する判定値であり、線Ｐ１−Ｐ２を超える駆動性能を示す線Ｐ１´−Ｐ２´を含むＴＮ特性を与えるものである。
【００２９】
トルク回転数比較工程（Ｓ１０）では、図４に示すＴＮ特性図に基づいて、計測工程（Ｓ２）において取得された検出手段６１，６２からの回転数とトルクのデータが、領域Ｕ１，Ｕ２，Ｕ３のどの領域にあるかを比較する。領域Ｕ１とは、Ｒmax線を除く変化点Ｐ１までの領域である。領域Ｕ２は閾値Ｌと回転数０（座標線）とで形成される領域である。領域Ｕ３は、閾値Ｌと線Ｐ１−Ｐ２によって形成される領域である。領域Ｕ１では、定格電源の電圧によってモーター５１，５２に電源を供給することによって、最大回転数Ｒmaxに到達させることができる領域である。
【００３０】
領域Ｕ２では、モーター５１，５２の駆動可能領域ＵA（図３参照）に対して余裕のある領域であり、回転数を上昇させている状態にある。この領域Ｕ２では、定格電源の電圧によってモーター５１，５２に電源を供給することによって、回転数を上昇させる領域である。領域Ｕ３は、閾値Ｌを超えた領域となる。すなわち、更に回転数を上げるように駆動させて行くと、最大回転数Ｒmaxを下回る線Ｐ１−Ｐ２の領域に到達してしまう。そこで、モーター５１，５２のトルクおよび回転数の検出値が領域Ｕ３にあると判定された場合には、モーター５１，５２に定格電源電圧より高い昇圧された電源を、昇電圧手段７２ｄ（図１参照）によって生成し、モーター５１，５２に供給する工程に移行する。
【００３１】
すなわち、トルク回転数比較工程（Ｓ１０）において、特性テーブルとしての図４に示すＴＮ特性図における閾値Ｌとの比較を行い、領域Ｕ１，Ｕ２である場合、すなわち閾値Ｌ以下と判定された場合（ＹＥＳ）、定格電源電圧によるモーター駆動を継続させ、再度、計測工程（Ｓ２）から実行する。また、領域Ｕ３である場合、すなわち閾値Ｌを超えると判定された場合（ＮＯ）、定格電源電圧より高い電圧の電源を、昇電圧手段７２ｄ（図１参照）によって生成し、モーター５１，５２に供給する、昇電圧工程としてのモーター駆動電圧昇圧工程（Ｓ２０）に移行する。
【００３２】
＜モーター駆動電圧昇圧工程＞
モーター駆動電圧昇圧工程（Ｓ２０）（以下、駆動電圧昇圧工程（Ｓ２０）という）では、図１に示す昇電圧手段７２ｄにおいて、定格電源電圧、例えばＡＣ２００Ｖ、より高い電圧、によって生成される駆動電圧を生成し、駆動部７１に送出してモーター５１，５２に昇圧された電源を供給する。昇電圧手段７２ｄは、例えば図５の回路ブロックに示すような昇圧回路を備えている。図５に示す昇圧回路は昇電圧手段７２ｄに備える駆動電圧指令演算部７２ｅからの駆動電圧指令と駆動電圧に基づいて駆動電圧制御部７２ｆにおいてコイル電流指令を算出し、コイル電流指令とコイル電流に基づいてコイル電流制御部７２ｇにおいてＰＷＭ指令を算出し、算出されたＰＷＭ指令に基づいてＰＷＭ生成部７２ｈがスイッチＳＷ１およびＳＷ２を生成し放電を制御して駆動電圧を昇圧する。
【００３３】
このように駆動電源を昇圧させることにより、図４に示すＴＮ特性において、最大回転数Ｒmaxで駆動できる駆動トルクＴP1より大きなトルクＴP1´の負荷状態であっても最大回転数Ｒmaxを得ることが可能となり、第１アーム２１、第２アーム２２をより短時間に目標位置まで移動させることが可能になる。すなわち、定格電源電圧におけるモーター５１，５２の動作可能領域に対して、昇圧された電源を投入することにより、領域Ｕ４まで動作可能領域を一時的に拡大させることができる。
【００３４】
昇圧された電源によってモーター５１，５２の駆動可能範囲を超える領域Ｕ４で駆動され、再び計測工程（Ｓ２）によってモーター５１，５２の回転数が計測される。前述のモーター回転数判定工程（Ｓ３）において、判定結果が、モーター回転数がＲmaxである、すなわちＹＥＳである場合には、次の減速目標位置到達判別工程（Ｓ４）に移行する。
【００３５】
＜減速目標位置到達判別工程＞
減速目標位置到達判別工程（Ｓ４）（以下、減速位置判別工程（Ｓ４）という）では、外部駆動指示装置２００によって指示されたアーム２１，２２の移動目標位置に到達する前の移動速度の減速開始位置、すなわち減速目標位置を判定する。減速位置判別工程（Ｓ４）において、減速目標位置に到達した（ＹＥＳ）と判定された場合には、モーター減速工程（Ｓ５）に移行する。また、減速位置判別工程（Ｓ４）において、減速目標位置に到達していない（ＮＯ）と判定された場合には、モーター５１，５２は駆動を継続し計測工程（Ｓ２）からの工程を繰り返す。
【００３６】
＜モーター減速工程＞
モーター減速工程（Ｓ５）では、減速手段として電磁ブレーキもしくはモーター回生ブレーキなどを用いて、モーター５１，５２を減速し、目標位置到達判別工程（Ｓ６）へ移行する。
【００３７】
＜目標位置到達判別工程＞
目標位置到達判別工程（Ｓ６）では、モーター減速工程（Ｓ５）において、モーター５１，５２は減速され、所定の停止位置である目標位置にアーム２１，２２が到達したかを判別する。到達した（ＹＥＳ）と判定された場合には、モーター駆動停止（Ｓ７）に移行し、モーター５１，５２は停止、すなわちアーム２１，２２の移動が終了する。到達していない（ＮＯ）と判定された場合は、モーター減速工程（Ｓ５）を継続しながら、目標位置到達までモーター５１，５２は駆動される。
【００３８】
上述のモーター駆動方法で説明したように、モーターの定格駆動電源における駆動領域（図３に示すＴＮ特性図、参照）に対して、電源電圧を一時的に昇圧させ供給することによって、負荷（トルク）の大きい領域においてもモーターの回転数を最大まで駆動可能となる領域を形成することができる。これによって、特にアーム移動開始から定速移動になるまでの加速領域において生じる負荷増に対して、モーターの最大回転数が発揮できる領域を拡大し、より高速でアームを移動させることができる。従って、生産性の高いロボットを得ることができる。
【００３９】
（その他の実施形態）
上述の実施形態に係るロボット１００では、モーター５１，５２のトルクと回転数を計測した結果が、図４に示すＴＮ特性における領域Ｕ３にある場合に、モーター駆動電圧昇圧工程（Ｓ２０）を実行させた。しかし、これに限定されるものではなく、モーター５１，５２のトルクだけを計測し、トルク閾値との比較よってモーター駆動電圧昇圧工程（Ｓ２０）を実行する、あるいは、モーター５１，５２の回転数だけを計測し、回転数閾値との比較よってモーター駆動電圧昇圧工程（Ｓ２０）を実行することもできる。
【００４０】
図６は、モーター５１，５２のトルク計測値とトルク閾値との比較によってモーター駆動電圧昇圧工程（Ｓ２０）を実行する形態を説明する説明図である。図６（ａ）に示す軌道図ように、例えばモーター５１が駆動する第１アーム２１の軌道は、時間の経過と共に目標位置に到達する。その間、モーター始動から定速駆動するまでの加速区間から定速区間、そして駆動停止までの減速区間で構成される。加速区間では図６（ｂ）に示すトルク特性は定速区間の始まりにかけて高トルクを必要とする。しかし、定格電源電圧における最大トルクは図６（ｂ）に示すように必要とする最大トルクに対してトルクＴm分の低い値を示す。この差異分を図２に示すモーター駆動電圧昇圧工程（Ｓ２０）によって、駆動トルクの引き上げを行う。
【００４１】
図６（ｃ）に、駆動電圧の時間経過を示す。上述したように定格電源における最大トルクを超えるトルクを発生させるため、図６（ｂ）に示すように定格電源最大トルクを下回るトルク閾値を設定し、計測されるトルク値がこのトルク閾値を超えた場合に、図６（ｃ）に示す昇圧電源電圧を生成し、駆動電圧として供給する。これにより定格電源最大トルクよりＴm大きいトルクを得て、加速時間を短縮することができる。
【００４２】
図７は、モーター５１，５２の回転数計測値と回転数閾値との比較によってモーター駆動電圧昇圧工程（Ｓ２０）を実行する形態を説明する説明図である。図６（ａ）に示す軌道図と同様に、図７（ａ）に示す軌道図においても、例えばモーター５１が駆動する第１アーム２１の軌道は、時間の経過と共に加速区間、定速区間、減速区間を経て目標位置に到達する。図７（ｂ）に示すように、加速区間において、定格電源電圧によりモーター５１を駆動すると、回転数の上昇はグラフ線ＬRに沿って上昇し、定格電源最大回転数に至るまでに時間ｔmを必要とする。ここで、定格電源最大回転数より低い回転数閾値、例えば定格電源最大回転数の５０％を回転数閾値に設定し、この回転数閾値を超えた場合に、図７（ｃ）に示す昇圧電源電圧を生成し、駆動電圧として供給する。これにより定格電源最大回転数に到達する時間がｔmより前の時間ｔaとすることができ、加速時間を短縮することができる。
【００４３】
上述の実施形態に係るロボット１００は、昇電圧手段７２ｄの電源として図５に示すように外部交流電源を用いる形態としたが、モーター５１，５２の減速時の回生エネルギーを電力として蓄え、モーター駆動電圧昇圧工程（Ｓ２０）における昇圧電源として用いることもできる。図８は、回生電力による昇圧回路の一例を示す回路ブロックである。モーター５１，５２には、減速と減速エネルギーを電力に変換する図示しない回生ブレーキが備えられ、回生ブレーキから送出された電力を充放電用コンデンサーに蓄える。図８に示す昇圧回路では、昇電圧手段７２ｄ備える駆動電圧指令演算部７２ｅからの駆動電圧指令と駆動電圧に基づいて駆動電圧制御部７２ｆにおいてコイル電流指令を算出し、コイル電流指令とコイル電流に基づいてコイル電流制御部７２ｇにおいてＰＷＭ指令を算出し、算出されたＰＷＭ指令に基づいてＰＷＭ生成部７２ｈがスイッチＳＷ１およびＳＷ２を生成し放電を制御して駆動電圧を昇圧する。この際、充放電コンデンサーは直列に配置することで、耐電圧性を上げることができ、耐電圧性を上げて高い電圧で充電させることで、昇圧電源生成時に所望の高電圧を容易に得ることができ、高速のアーム移動を実現することができる。
【００４４】
上述の実施形態に係るロボット１００では、図２に示すモーター駆動電圧昇圧工程（Ｓ２０）が、計測工程（Ｓ２）におけるモーターのトルクおよび回転数の計測結果と、閾値と、の比較を行うトルク回転数比較工程（Ｓ１０）の比較結果に基づき実行される形態であるが、ロボット１００のアーム２１，２２の目標位置到達までの軌道が予め設定されている場合には、軌道に合わせた駆動電圧の昇圧の指示プロファイルを生成し、駆動電圧の制御を行うこともできる。これによって、リアルタイムにトルク、回転数のデータ取得、データの演算などを実行する必要が無く、簡単な構成の駆動制御装置とすることができ、低コスト、信頼性の向上、などが可能となる。
【００４５】
なお、上述に実施形態に係るロボット１００はアーム２１，２２を備える水平多関節ロボットを例示したが、これに限定されない。例えば、垂直多関節ロボットなどであっても良く、モーター駆動によるロボットのモーター駆動方法に適用できる。
【符号の説明】
【００４６】
１０…基台、２１，２２…アーム、３０…ハンド部、４０…被作業物、５１，５２…モーター、６１，６２…検出手段、７０…駆動制御装置、１００…ロボット、２００…外部駆動指示装置。
【図１】
2012257425.tif 000003
【図２】
2012257425.tif 000004
【図３】
2012257425.tif 000005
【図４】
2012257425.tif 000006
【図５】
2012257425.tif 000007
【図６】
2012257425.tif 000008
【図７】
2012257425.tif 000009
【図８】
2012257425.tif 000010