発明の詳細な説明【技術分野】 【0001】 本発明は、消費電力が上限の閾値を超えない軌道を生成するロボットアームの軌道生成装置等に関する。 続きを表示(約 2,100 文字)【背景技術】 【0002】 ロボットアームの軌道生成の技術としては、各種の拘束条件下でエンドエフェクタを所望の位置及び姿勢に到達させるための最適軌道を生成する方法などが知られている(例えば、特許文献1参照)。また、エンドエフェクタの所望の位置及び姿勢への移動を、決められた時間内に最小のエネルギーで実現するための軌道を生成する方法についても知られている(例えば、非特許文献1~3参照)。 【先行技術文献】 【特許文献】 【0003】 特開平7-200030号公報 【非特許文献】 【0004】 A. Mohammed, B. Schmidt, L. Wang, and L. Gao, "Minimizing energy consumption for robot arm movement", Procedia CIRP, Vol.25, pp.400-405 (2014) J. Gregory, A. Olivares, and E. Staffetti, "Energy-optimal trajectory planning for robot manipulators with holonomic constraints", Syst. Control. Lett. 61(2), pp.279-291 (2012) Y. Wang, K. Ueda, and S. A. Bortoff "A Hamiltonian approach to compute an energy efficient trajectory for a servomotor system", Automatica, Vol.49, pp.3550-3561 (2013) 【発明の概要】 【発明が解決しようとする課題】 【0005】 ロボットアームにおいて、供給可能な電力の上限が設定されていることがある。例えば、ロボットアームの各関節において、非接触電力伝送によって電力を基端側から先端側に伝送している場合には、そのような供給電力に上限が存在することがある。このような場合には、例えば、あらかじめ決められた時間内に最小エネルギーでエンドエフェクタを所望の位置及び姿勢に移動させることができる軌道が生成されたとしても、その軌道に応じてロボットアームを動作させた際に、ロボットアームの消費電力が上限の閾値を超えてしまい、途中で動作できなくなる可能性もある。 【0006】 本発明は、上記課題を解決するためになされたものであり、ロボットアームの消費電力が上限の閾値を超えないようにするための軌道を生成することができるロボットアームの軌道生成装置等を提供することを目的とする。 【課題を解決するための手段】 【0007】 上記目的を達成するため、本発明の一態様によるロボットアームの軌道生成装置は、モータによって駆動される関節によって連結された複数のアームを有するロボットアームのエンドエフェクタの経路を示す経路情報が記憶される経路記憶部と、経路情報に対応する軌道であって、ロボットアームの総消費電力量が最小となるように最適化された軌道である第1の軌道を生成する生成部と、第1の軌道において、ロボットアームの消費電力が、上限の閾値を超える時間範囲を特定する特定部と、時間範囲に対応する第1の軌道の部分を、消費電力が上限の閾値を超えない第2の軌道に修正する修正部と、を備えたものである。 【0008】 このような構成により、エンドエフェクタが移動する際に、消費電力が上限の閾値を超えないようにすることができる軌道を生成することができる。また、そのような軌道を、最小の総消費電力量の軌道である第1の軌道を修正して生成することにより、生成後の軌道も総消費電力量がより少ないものとなる。 【0009】 また、本発明の一態様によるロボットアームの軌道生成装置では、修正部は、さらに、時間範囲の終点から第1の軌道の終点までに対応する第1の軌道の部分を、第2の軌道の終点から、第1の軌道の終点までの第3の軌道に修正してもよい。 このような構成により、修正後の軌道の終点と、修正前の第1の軌道の終点とを一致させることができる。 【0010】 また、本発明の一態様によるロボットアームの軌道生成装置では、修正部は、時間範囲に対応する第1の軌道の部分におけるロボットアームの各関節の角速度をα倍することによって第2の軌道を生成し、αは、第2の軌道において、ロボットアームの消費電力が上限の閾値を超えないようにするための1未満の最大の正の実数であってもよい。 このような構成により、第1の軌道を修正する際に、第1の軌道におけるエンドエフェクタの経路が変更されないようにすることができる。 (【0011】以降は省略されています)
特許ウォッチbot のツイートを見る
この特許をJ-PlatPatで参照する