ロボット特異点

序論

ロボット運動学において、特異点とは、ロボットが特定の空間位置や姿勢において、逆運動学が解なし、多解、または極めて高い感度を示す状況を指します。この時、ロボット末端エフェクタ(TCP)の位置と姿勢を各関節の回転角に一意で安定した対応付けができなくなり、制御精度の低下や制御不能を引き起こします。

ほとんどの6軸多関節ロボットでは、機械的リミットやソフトリミットの制限により、作業空間内で逆運動学の解なし状況が発生します。これは座標ベースの計画運動をロボット各関節軸の回転角度に明確に逆変換できない状況です。ロボット作業空間内でこれらの逆運動学解なし点が「特異点」と呼ばれます。ロボット特異点は大まかに以下の3つのタイプに分類できます。

ショルダー特異点

ショルダー特異点は、ロボット手首の中心とJ1軸関節が同一直線上にある時に発生します。ロボット「ショルダー」—すなわち第1関節軸(J1)と手首中心を結ぶ線が共線になると、ロボット構造の水平方向の自由度が失われます。この時、J1と第4関節軸(J4)の結合が発生し、両者が末端姿勢を維持するために「瞬間的に」大幅な回転を完了する必要があり、関節軸1と4が瞬時に180度回転しようとします。この状況は、人間の肩と前腕が完全に一直線上に伸展した時、腕の特定の回転動作が非常に困難になることに似ています。

shoulder singularity

エルボー特異点

ロボット手首の中心と関節軸2および3が同一平面上にある時、エルボー特異点が発生します。ロボット「エルボー」—すなわち第2関節軸(J2)と第3関節軸(J3)および手首中心点が共面かつ完全に伸展した時、ロボットは「腕を限界まで伸ばした」状態に類似し、エルボーが特定の空間位置でロックされます。この時、エルボーの回転自由度が消失し、末端運動の特定方向が制御不能となり、逆運動学解の一意性が失われます。この状況は、人間の腕が完全に伸びた時、エルボーがもはや曲がることができず、一部の動作が制限されることに似ています。

elbow singularity

リスト特異点

ロボットの2つの手首軸(関節軸4と6)が同一直線上にある時、リスト特異点が発生します。ロボット手首の第4関節軸(J4)と第6関節軸(J6)が共線になると、手首部分の回転自由度に結合が発生し、ロボット末端姿勢の制御が困難になります。この時、TCPの微小な移動がJ4とJ6の激しい回転を引き起こす可能性があり、これらの関節は瞬時に180度回転しようとする場合があります。この状況は、人間の手首が限界まで完全に捻転した時、特定の回転は腕全体の移動によってのみ完了できることに似ています。

wrist singularity

特異点の特殊性

ショルダー特異点とエルボー特異点については、ロボットの作業範囲を制限するだけで容易に回避できます。しかし、リスト特異点はロボット作業領域のほぼすべての位置で発生する可能性があります。ロボットがこれらのリスト特異点またはその近傍を通過する時、ロボット手首軸のJ4軸とJ6軸は短時間内に大きな回転量の運動を行い、ロボットに極度に奇妙な運動姿勢を生じさせます。この時に手首軸の運行速度を制限すると、工具中心点(TCP)の速度が遅くなり、同時にロボットが示教された運行軌跡から逸脱することになります。

特異点のリスクと影響

ロボットが特異点近傍で運動する時、以下のようなリスク状況が発生します:

  • 運動異常:特異点近傍では、関節運動に急激な変化が現れ、ロボットに「痙攣」や「非人間的」動作が発生し、作業安全性と精度に影響します。

  • 軌跡逸脱:TCPの実際の運動軌跡が予設定経路から逸脱し、溶接、搬送などの高精度タスクの実行品質に影響します。

  • 制御失効:重篤な場合、関節速度が無限大に近づく可能性があり、サーボシステムの警報、関節損傷、さらには安全事故を引き起こします。

  • 逆運動学解なし/多解:経路計画の失敗や実行異常を引き起こします。

エンジニアリング対応措置

  • 軌跡計画最適化:プログラミングやシミュレーション段階で、軌跡計画により特異点領域を事前に回避します。

  • 運動範囲制限:ショルダー、エルボーなど特異点が出現しやすい関節に物理的またはソフトウェア制限を設定します。

  • リアルタイム検出と警報機能:ロボット制御システムに特異点検出アルゴリズムを統合し、リアルタイム監視と警報を行います。

  • 特異点特性分析:ロボット構造パラメータとタスク要求を分析することで、機械アーム設計を最適化または工程フローを調整します。

  • アルゴリズム堅牢性設計:逆運動学と制御アルゴリズムを改良し、特異点に対する耐故障性を向上させます。

発生する特異形態状況

elbow singularity example1

エルボー特異点

elbow singularity example2

エルボー特異点

elbow singularity example3

エルボー特異点

wrist singularity example

リスト特異点