関節チェーンの逆運動学
バグ・不具合を報告
2次元の固定根元を持つ直列回転関節について、関節制限を守る目標位置・姿勢の角度候補を求める。
根元は(0,0)に固定し、2次元の回転関節のみを対象とします。角度制限を守って探索しますが、未収束の場合は候補角として表示します。
項目を入力・選択してから「計算する」を押してください。
選択内容に応じて、残りの入力項目を案内します。
計算結果
—
- 収束判定
- —
- 計算後の先端X
- —
- 計算後の先端Y
- —
- 計算後の先端角
- —°
- 先端角の誤差
- —
- 採用した候補の反復数
- —
- 位置誤差の収束しきい値
- —
値を入力して計算してください。
この計算機は使いやすかったですか?
回答はサイト改善のために保存します。入力値・計算結果は送りません。
ありがとうございます。よかったら、上の共有ボタンからこの計算機を紹介しませんか?
計算方法・適用範囲・出典
計算方法
順運動学:先端 (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。