パラメータ設定
リンク長
目標位置
関節制限
θ₁: ±150°, θ₂: ±170°, θ₃: ±170°
逆運動学解
3R:十字は目標位置、緑の関節は位置を計算する点です。橙のL₃は参考表示で、位置計算に含みません。投影図のため奥行きが重なります。
スライダーを動かすと手動操作に切替わります
理論・主要公式
第2関節角の余弦値から両解を求める:
$$c_2 = \frac{x^2+y^2-L_1^2-L_2^2}{2L_1 L_2}, \quad s_2 = \pm\sqrt{1-c_2^2}$$
$$\theta_2 = \text{atan2}(s_2, c_2)$$
$$\theta_1 = \text{atan2}(y,x) - \text{atan2}(L_2 s_2,\ L_1+L_2 c_2)$$
到達可能条件:$|L_1-L_2| \le \sqrt{x^2+y^2} \le L_1+L_2$。3R 空間モードは減衰付きガウス・ニュートン法 $\Delta\theta=(J^TJ+\lambda I)^{-1}J^T(\mathbf{x}^*-\mathbf{x})$(λ=0.01、24 回反復)で θ₁〜θ₃ を求め、L₃ は参考描画のみで先端位置の計算には含めていません。
ロボットアーム逆運動学とは
🙋
逆運動学って何ですか?「目標の位置」から「関節の角度」を求めるって聞いたけど、順運動学とどう違うんですか?
🎓
大まかに言うと、順運動学は「関節をこれだけ曲げたら、手先はどこに行く?」を計算するもの。逆運動学はその逆で、「手先をここに持っていきたい!そのためには各関節を何度曲げればいい?」を解くんだ。例えば、このシミュレーターで「目標X」と「目標Y」の値を変えると、アームの姿勢が大きく変わるよね。あれが逆運動学で計算された角度で動いているんだ。
🙋
え、同じ目標位置なのに、アームの形が2通りあるときがあります!「エルボーアップ」と「エルボーダウン」って表示されます。どうして解が2つ出るんですか?
🎓
良いところに気が付いたね。2リンクのアームの場合、手先を同じ位置に持っていく方法は、肘を上に向けるか下に向けるかの2通りが一般的にあるんだ。数式的には、$s_2 = \pm\sqrt{1-c_2^2}$ のプラスかマイナスかの選択に対応している。実務では、周りの機械にぶつからない方や、関節の可動範囲内にある方を選ぶんだよ。このツールでは2つの姿勢(エルボーアップ/ダウン)が同時に色分け表示されるので、見比べてみて。
🙋
「特異点」って表示が出ることがあります。アームがピンと伸びきった状態で、動かそうとすると急に暴れるみたいな…あれは何が起きているんですか?
🎓
あれはまさに「特異点」、ロボット制御で最も注意すべき状態の一つだ。アームが完全に伸びたり折り畳まれたりすると、手先をある方向(アームの長手方向)に動かそうとすると、関節速度が理論上無限大に発散してしまうんだ。シミュレーターで「リンク1長さ」と「リンク2長さ」を同じくらいの値にして、目標点をX方向にぎりぎりまで遠ざけてみて(スライダーを動かすと自動追従が止まる)。アームが一直線になって「特異点」と表示されるはずだ。現場ではこの姿勢を避ける経路を計画するのが鉄則だよ。
よくある質問
2Rモデルでは余弦定理からθ₂の正弦に正負の枝が生じます。本ツールでは正をエルボーダウン(青)、負をエルボーアップ(緑)と呼び、条件を満たす枝を描きます。特異位置では2枝が重なり、関節制限によって一方または両方が除外されることがあります。障害物の衝突判定は行いません。
2Rではヤコビアンの行列式がゼロになる伸展・折り畳み姿勢が特異点です。手先の一部の方向へは瞬間的に動けず、近傍では所定の手先速度に大きな関節速度が必要になる場合があります。すべての関節速度が無限大になるわけではありません。
目標が最大・最小リーチの範囲外なら解はありません。関節制限OFFでは最も近い幾何学上の姿勢を灰色で示し、目標までの距離を表示します。関節制限ONで解がない場合は制限内の最近姿勢を計算しないため、姿勢・誤差を「—」と表示します。
本ツールの 3R 空間モードは、基部回転 θ₁・肩 θ₂・肘 θ₃ の 3 関節で 3 次元の目標 (x,y,z) に先端を合わせます。解析解ではなく、減衰付きガウス・ニュートン法(ヤコビアン擬似逆行列、λ=0.01、ステップ係数 0.5)を最大 24 回反復して θ₁〜θ₃ を求め、先端誤差が 10 mm 未満なら「到達可能」、それ以上なら「収束失敗」と表示します。第 3 リンク L₃ は描画のみで、先端位置の計算には含めていません。
ヤコビアンJは関節角速度と手先速度を結びます(dx/dt = J·dθ/dt)。このツールの2Rは余弦定理による解析解、3Rは減衰項付きの反復法を使います。冗長性は関節数と対象とする位置・姿勢の次元の関係で決まり、関節が3個以上なら常に冗長というわけではありません。
関節制限OFFの2Rでは、到達域は半径|L₁−L₂|からL₁+L₂までの領域です。等しい長さなら内側半径は0になり、異なる長さでは原点付近に届かない円形領域ができます。L₁とL₂を変更して図を比較してください。関節制限ONでは到達域がさらに制限されます。
同じ手先位置や姿勢に複数の関節配置があると、動作中に解が切り替わり、急な関節の動きが生じる場合があります。実機では関節制限、衝突、経路の連続性を考慮します。本ツールは2Rの有効な枝を同時に表示しますが、経路計画や衝突判定は行いません。
本ツールは入力した目標位置に対する運動学の解を示し、慣性、摩擦、モータのトルクや制御系を計算しません。そのため実機の追従時間は求まりません。目標位置はスライダーまたは数値欄で変更できます。
実世界での応用
産業用ロボット(溶接・搬送):自動車工場の溶接ロボットは、車体の決められた位置に正確にトーチを運ぶ必要があります。逆運動学計算により、各関節の目標角度を高速に算出し、滑らかな経路を実現しています。特異点を避ける経路計画は安全稼働に必須です。
外科手術支援ロボット:内視鏡手術で、医師の操作に従って鉗子の先端を患部に正確に位置決めします。患者の体内という限られた空間で障害物(他の臓器)を回避するため、複数の逆運動学解から最適な姿勢(エルボーアップ/ダウン)を選択します。
アニメーション・CG制作:キャラクターの手や足を自然な動きで特定の位置に持っていくために逆運動学が多用されます。関節の可動範囲制限を設定することで、人間らしい無理のない動きを自動生成できます。
多関節構造のCAE解析:ロボットアームや建設機械の構造解析(FEM)を行う際、実際に取りうる負荷のかかる姿勢を初期状態として設定する必要があります。逆運動学計算で得られた関節角度を用いて、解析モデルの初期姿勢を現実に即した形で定義します。
よくある誤解と注意点
まず、「リンク長は長ければ長いほど良い」という誤解があります。確かに長いと到達範囲は広がりますが、特異点(アームが一直線になる姿勢)に陥りやすくなり、制御が不安定になります。例えば、L₁=L₂=300 mm のアームで目標点 (595, 0) を狙うと、ぎりぎり届きますが完全な特異点に近づき、小さな位置指令で関節が急激に動く「暴れ」をシミュレートできます。実務では、ワークのサイズに合わせて必要最小限のアーム長を選び、余裕を持った可動域を設計します。
次に、「解が求まればそれでOK」という考え方。数式上は角度が算出されても、それがロボットの物理的な可動範囲を超えていることが多々あります。例えば、θ₂の可動範囲が-120°〜120°の関節で、計算結果が150°になった場合、それは「到達不能」と判断しなければなりません。このツールで解を切り替えても両方の姿勢が関節限界に引っかかるなら、それはその位置が実質的に到達不能であることを意味します。
最後に、「3自由度なら2次元のどこでも自由に届く」という過信。本ツールの 3R は基部回転を加えた空間アームで、3 つの関節で先端の 3 次元位置を合わせるため、手先の姿勢(ツールの向き)は制御できません。一方、平面内で関節を 3 つにすると位置 2 成分に対して関節が 1 つ余り、逆運動学の解は無限に存在します(冗長性)。本ツールの反復解は初期値から収束した 1 つの解を表示するだけで、実機では「最も関節負荷が少ない解」や「最も動きが滑らかな解」を無限の中から選ぶ、高度な最適化問題に発展します。
具体的な計算例
2R平面モードで目標を手動にし、既定値(L₁=200mm、L₂=150mm、目標(x,y)=(200mm, 150mm))にすると、到達距離は√(200²+150²)=250mmで、到達可能範囲 |L₁−L₂|=50mm 〜 L₁+L₂=350mm の内側にあります。解析解はエルボーダウン解 θ₁=0.0°・θ₂=90.0°(およびエルボーアップ解)を返し、ヤコビ行列式 det(J)=30000、特異点距離 |det(J)|/(L₁L₂)=1.0 で特異点から十分離れています。目標位置が(360mm, 0mm)の場合、L₁+L₂=350mm を超過するため「不到達」と判定され、先端誤差に不足分 10 mm が表示されます。なお3R空間モードの反復解は現状リンクL₃を順運動学に組み込んでおらず、L₃は到達計算に影響しません(参考表示)。