関節チェーンの逆運動学

2次元の固定根元を持つ直列回転関節について、関節制限を守る目標位置・姿勢の角度候補を求める。

根元は(0,0)に固定し、2次元の回転関節のみを対象とします。角度制限を守って探索しますが、未収束の場合は候補角として表示します。

項目を入力・選択してから「計算する」を押してください。

選択内容に応じて、残りの入力項目を案内します。

計算する内容

リンク長と目標X/Yには同じ単位を使ってください。数値の単位変換は行いません。

リンクと関節角の制限必須
行リンク長角度下限(°)角度上限(°)操作
1
2

計算結果

値を入力して計算してください。

お気に入り一覧

計算方法・適用範囲・出典

計算方法

順運動学:先端 (x,y) = Σᵢ Lᵢ(cos Aᵢ, sin Aᵢ)、Aᵢ = Σⱼ₌₁ⁱ θⱼ。θⱼは親リンクからの相対角。CCDは先端から根元へ関節を順次回し、関節→先端と関節→目標の符号付き角差を用いて、制限内で位置誤差を減らします。DLSはJの位置行を (−(y−yⱼ), x−xⱼ)、姿勢指定時の角度行を w(w=リンク長合計/リンク数)とし、Δθ=Jᵀ(JJᵀ+λ²I)⁻¹e を解きます(λ=0.08w)。更新は最大25°/回、線探索・角度クランプ付き。複数の初期角から最大180反復ずつ試し、位置許容差はリンク長合計×10⁻⁶、姿勢は0.05°です。角度誤差は±180°に折り返します。

関節角候補、各リンク終点、先端位置・向き、位置誤差、姿勢誤差、収束状態。

計算例(架空の数値)

長さ1、1の2リンクで角度制限を両方−180°〜180°、目標(X,Y)=(1,1)とすると、位置解は相対角(0°,90°)または(90°,−90°)。姿勢指定で先端角90°なら(0°,90°)が一致し、位置誤差0・角度誤差0です。

適用対象と限界

根元が(0,0)で固定された平面上の直列回転関節、1〜8リンク。リンク長と座標の単位を揃えること。3D/球関節/分岐構造/衝突回避/障害物/速度・トルク/関節間連動は対象外。角度制限付きIKは非凸で、局所探索による未収束が無解を意味するものではない。

採用した方式

  • CCD(Welman 1993 §4.2.1):対象範囲 2D回転関節の先端位置/適用地域 地域制限なし
  • DLS(Buss 2009 §5 式(11)を2Dへ適用):対象範囲 2D回転関節の先端位置・向き/適用地域 地域制限なし

方法と出典

方法:Welman (1993) §4.2.1(CCD);Buss (2009) §5 Eq. (11)(DLS);2D角度制限クランプ・有界反復 v1。データ記録日:2026-11-14。