逆ヤコビアンとIK可視化

ヤコビアンベースIK(速度ベースIK)のデモです。3Dビュー内をクリックすると、その位置を目標点としてインバースキネマティクスが作動します。

IK制御

目標座標 (クリックで設定)

(---, ---)

関節角度 (θ)

計算結果 (dθ = J⁻¹(θ) v)

関節速度
[dθ1, dθ2]

0.00
0.00
=

逆ヤコビアン J⁻¹(θ)

0.00
0.00
0.00
0.00
×

手先速度
[vx, vy]

0.00
0.00

ヤコビアン J(θ) と 特異点指標

ヤコビアン J(θ)

0.00
0.00
0.00
0.00

行列式 det(J)

0.00

※このデモでは |det(J)| が5000未満で「特異点に近い」、100未満で「特異点」と判定されます。

関節速度の履歴プロット