順運動学と逆運動学

関節空間とタスク空間をつなぐ変換

ロボットアームは各関節の角度（回転関節）や伸縮量（直動関節）をアクチュエータで直接制御しますが、作業指示は「エンドエフェクタ（手先）をこの位置・姿勢へ動かせ」というタスク空間の言葉で与えられます。関節角度の組（関節空間）からタスク空間へ進む写像が順運動学（forward kinematics, FK）、逆にタスク空間から関節角度を求める写像が**逆運動学（inverse kinematics, IK）**です。軌道計画やビジュアルサーボなど上位アルゴリズムの多くはこの変換を土台にしており、PID・LQRのような一般的なフィードバック制御理論とは別の、幾何学固有の問題です。

順運動学: 同次変換行列の連鎖

各関節 i の位置・向きの変化は、回転行列 R と並進ベクトル p を1つにまとめた4×4の同次変換行列 T_i で表せます。n 自由度のロボットでは、根元（ベース座標系）から先端までの変換が各関節の変換の連鎖積になります。

T_base_to_ee = T_1 * T_2 * T_3 * ... * T_n

各 T_i は関節変数 θ_i（回転角）または d_i（伸縮量）のみに依存
→ 関節角度ベクトル q を決めれば T_base_to_ee は常に一意に計算できる

各 T_i を系統的に定義する標準手法が**DH法（Denavit-Hartenberg法）**で、隣接リンク間の位置関係をリンク長・ねじれ角・オフセット・関節角の4パラメータだけで表現し、任意の直列リンク機構を一意な手続きで行列化します。

function forward_kinematics(theta[1..n], dh_params[1..n]):
    T = identity(4)
    for i in 1..n:
        T = T * dh_transform(theta[i], dh_params[i])
    return T   // 位置pと姿勢Rを含む同次変換行列

逆運動学: 目標位置から関節角度へ

逆運動学は T_base_to_ee(q) = T_target を満たす q を求める問題で、一般に非線形連立方程式になり、解の個数も保証されません。

多くの6軸産業用アームは手首の3関節の回転軸が1点で交わる球面手首を持ち、これがあると根元側3関節（位置を決める）と手首側3関節（姿勢を決める）に問題を分離でき、三角関数の逆関数だけで閉じた式が書けます。この場合でも解は一般に複数あり（例: 2リンク平面アームの「肘上げ」「肘下げ」2解）、6軸では最大8通り程度の組み合わせが生じ得ます。関節数がタスク空間の自由度を超える冗長系（7軸など）では、解は離散個ではなく連続的な無限解（解の多様体）になり、余剰自由度を障害物回避や特異点回避に使えます。

数値解: ヤコビ行列による反復法

解析解が導けない一般のロボットでは、関節角速度と手先速度を結ぶヤコビ行列 J(q)（6×n行列、v = J(q) * q_dot）を使った反復法（ニュートン-ラフソン法系）が標準です。

function inverse_kinematics(T_target, q_init):
    q = q_init
    repeat until convergence:
        error = pose_difference(T_target, forward_kinematics(q))
        delta_q = pseudo_inverse(compute_jacobian(q)) * error
        q = q + delta_q
    return q

正方でない場合や特異点近傍では逆行列でなく擬似逆行列を使い、冗長系ではその零空間成分で副次目的を追加できます。

特異点: ヤコビ行列が正則でなくなる姿勢

ヤコビ行列の行列式や特異値がゼロに近づく関節配置を**特異点（singularity）と呼びます。代表例は、2リンクが伸びきる肘伸びきり特異点、球面手首の2回転軸が同一直線上に重なる手首特異点、手首中心がある軸の真上に来る肩特異点です。特異点近傍では擬似逆行列の要素が急増し、わずかな目標速度でも関節角速度指令が過大になり、実機では過大なトルク要求を招きます。この危険度はヤコビ行列の特異値から計算する可操作性（manipulability）**で定量化でき、特異点でゼロに落ちます。

まとめ

順運動学は各関節の同次変換行列を連鎖的に掛け合わせる一意な写像で、DH法で系統的にパラメータ化できます。逆運動学は球面手首を持つ6軸アームなど幾何条件が揃えば解析解（複数解を含む）が得られますが、一般にはヤコビ行列を用いた反復的な数値解に頼ります。特異点では関節角速度指令が発散し得るため、可操作性で危険度を評価しDLS法などで回避するのが実務の要点です。この枠組みは軌道計画やビジュアルサーボなど、ロボットアーム制御の多くのアルゴリズムが前提とする基盤になります。