Open Source Robotics

高品質なオープンソースロボティクスプロジェクト、ツール、ソフトウェアの厳選コレクション。

Gravity Compensation

  • 別名: gravity balancing, zero-gravity mode
  • カテゴリ: Control › Force & interaction control
  • タグ: manipulator-control, robot-dynamics, feedforward, physical-interaction, hand-guiding

ロボットに対する重力の影響を打ち消すこと。モデルで予測した重力トルクを関節指令に加えるか、カウンターウェイトやばねによって機械的に行う。

定義

重力補償(gravity compensation)とは、ロボットのリンクと、それが運ぶあらゆるペイロードを重力に抗して支えるのに必要な力やトルクを与え、制御装置の残りの部分が、あたかも重さのないように振る舞うシステムを相手にできるようにすることである。ソフトウェアでは、剛体ダイナミクス M(q)q̈ + C(q, q̇)q̇ + g(q) = τ の重力項を使う。制御装置は、現在のコンフィギュレーション q において重力が生む関節トルク g(q) を計算し、それを指令に加える。重力ベクトルはコンフィギュレーションと、各リンクの質量および重心位置だけで決まるので、URDF 形式のモデルから再帰 Newton-Euler 法などの手法で安価に計算できる。

重力補償は多くの制御装置の構成要素である。PD 制御に重力補償を加えた τ = Kp(q_d − q) − Kd q̇ + g(q) は古典的な目標値レギュレータであり、剛体マニピュレータに対するその安定性は 1981 年に Takegaki と Arimoto によって示された。インピーダンス制御装置や操作空間制御装置は重力項を含んでおり、指令した剛性がアームを支えるために費やされないようにしている。制御装置が g(q) だけを出力すると、アームはその場に浮いたように止まり、手で押して動かせる。多くのトルク制御アームや協働ロボットのアームは、この方法でハンドガイドとキネステティックティーチングを実現している。補償がないと、柔らかい制御装置はアーム自身の重さで垂れ下がり、硬い制御装置は大きな定常トルクを誤差項の中に隠してしまう。

機械的な重力補償は、同じ役割を受動的に果たす。カウンターウェイト、動作範囲全体でリンクと釣り合うよう配置したばね、平行リンク機構は、モータが保持しなければならないトルクを減らし、エネルギーを節約し、より小さなアクチュエータの使用を可能にし、電源が失われても機能し続ける。ソフトウェアによる補償の質はモデルの質で決まる。リンク質量の誤差、モデル化されていない工具やケーブル束、作業の途中で変わるペイロードは残差を残し、アームを上または下へドリフトさせる。関節摩擦は重力補償では取り除けない別の効果であり、高減速比で逆駆動できないギアボックスを備えたアームでは摩擦が大きく、重力補償をしても、関節トルクセンシングや手首の力センシングがなければ手でアームを動かせないことがある。

重要な理由

硬い位置制御を除けば、ほぼすべてのアーム制御装置に重力補償が必要であり、柔らかい制御、安全な物理的インタラクション、ハンドガイドを実用的なものにするのがこの段階である。その質は実機ですぐに表れる。よく同定されたモデルなら低ゲインでもアームを静止させられるが、質の悪いモデルはドリフトを生み、それは制御のバグと取り違えられやすい。

主な用途

  • 協働ロボットのアームにおけるハンドガイドとキネステティックティーチング
  • インピーダンス制御、アドミタンス制御、操作空間制御
  • 重さを感じさせてはならないハプティックデバイスやテレオペレーションのマスタアーム
  • 使用者の手足を支える外骨格や支援機器
  • 電源なしで姿勢を保持するばねバランス式およびカウンターウェイト式のアーム
  • 関節トルクの残差からのペイロード推定

実際の使われ方

キネステティックティーチング用にトルク制御の 7 関節アームを立ち上げるエンジニアは、メーカーの URDF から出発し、グリッパーと手首カメラを、実測した質量と重心をもつ追加の剛体として加える。制御装置が g(q) だけを出力する状態でアームをいくつかの姿勢に動かし、位置を保持するかを観察する。手首がゆっくり下方へドリフトするなら工具質量の過小評価を示し、姿勢によってドリフトの向きが変わるなら重心オフセットの誤りを示す。続いて短い同定走行でパラメータを改良する。多数の静止姿勢で関節トルクを記録し、重力トルクはこれらのパラメータに対して線形なので、質量と一次モーメントの項を最小二乗法で当てはめる。摩擦補償は別の項として加える。後にロボットが重い物体を持ち上げたときには、制御装置がペイロードモデルを更新し、操作者が手を離してもアームが落ちたり上がったりしないようにする。

よくある誤解

  • 重力補償によってアームは質量がなくなる — 打ち消すのは静的な重さだけであり、アームの慣性は依然として加速に抵抗するので、素早く動かすと重く感じる
  • 重力補償は摩擦も取り除く — 摩擦は別の効果であり、ギア付きのアームでは操作者が感じるものの大半を摩擦が占めることが多い
  • メーカーのモデルで常に十分である — 工具、ケーブル、ペイロードによって質量は変わり、補正されない誤差は低ゲインで目に見えるドリフトを引き起こす
  • 重力補償はそれ自体が一つの制御装置である — 多くの制御装置の内部で使われるフィードフォワード項であり、重力補償モードとは他のすべての項をゼロにした制御装置にすぎない

知っておくべき人

  • マニピュレータ制御のエンジニア
  • 協働ロボットのインテグレーター
  • ハプティクスおよび外骨格の設計者
  • 物理的ヒューマンロボットインタラクションの研究者

関連技術

  • 再帰 Newton-Euler 法(Recursive Newton-Euler Algorithm)
  • Pinocchio
  • 関節トルクセンサー(Joint Torque Sensors)
  • ばね式カウンターバランス機構(Spring Counterbalance Mechanisms)
  • 摩擦補償(Friction Compensation)
  • ペイロード同定(Payload Identification)

関連用語

  • Torque Control
  • Impedance Control
  • Kinesthetic Teaching
  • Physical Human-Robot Interaction
  • System Identification
  • Backdrivability

このウェブサイトにはJavaScriptが必要です。オープンソースロボティクスプロジェクトを閲覧するにはJavaScriptを有効にしてください。