Попередня та зворотна кінематика для роботних рук

Forward vs Inverse Kinematics

Forward kinematics takes joint angles θ₁…θₙ as input and produces the end-effector's position directly — always a unique, fast trigonometric computation, O(n) for n joints.

Inverse kinematics takes a desired end-effector position and solves for the joint angles that reach it — the output may have zero, one, or infinitely many solutions, and it's generally non-linear and iterative.

2-link arm forward kinematics:
x = L₁cos θ₁ + L₂cos(θ₁+θ₂)
y = L₁sin θ₁ + L₂sin(θ₁+θ₂)

2-link inverse (law of cosines, closed-form):
cos θ₂ = (x²+y²−L₁²−L₂²) / (2L₁L₂)   → "elbow up" / "elbow down"
θ₁ = atan2(y,x) − atan2(L₂sinθ₂, L₁+L₂cosθ₂)

3D: Denavit-Hartenberg parameters

In 3D, each joint is described by four DH parameters — link length a, link twist α, link offset d, and joint angle θ — combined into a 4×4 transformation matrix Tᵢ. The total forward kinematics is the product T₀ₙ = T₁·T₂·…·Tₙ, whose final column gives the end-effector position and whose upper-left 3×3 block gives its orientation. A 6-DOF industrial arm (KUKA, UR5) chains six of these matrices together; 6R robots with the right geometry admit analytical IK solutions with up to 16 possible configurations.

Jacobian, CCD and FABRIK

For chains with no closed-form solution, the Jacobian J relates small joint changes to small end-effector movements: δx = J·δθ, solved iteratively via δθ = J⁺·δx using the pseudoinverse, damped least squares (adds λ²I to avoid blow-ups near singularities), or the cheaper transpose method δθ = Jᵀ·δx. Cyclic Coordinate Descent (CCD) rotates one joint at a time, from tip to root, moving the end-effector maximally toward the target each step — simple and fast, but prone to unnatural poses.

FABRIK works directly on joint positions with alternating forward and backward passes, typically converging in 3-10 iterations, often under a millisecond, with no matrix inversion at all — which is why it dominates games and procedural animation.

Redundancy and real-world constraints

When a chain has more degrees of freedom than the task requires — 7 joints for a 6D target — the system is redundant: infinitely many solutions exist, and the null space of J can be used to satisfy secondary objectives like obstacle avoidance or staying away from joint limits while still reaching the target.

Real IK always layers on joint constraints (a human elbow bends 0°-145°, not 360°), collision avoidance, and singularity handling — production solvers like Unity's Animation Rigging and Unreal's IK Rig combine FABRIK with constraint projection and blending. Surgical robots like da Vinci use tightly constrained IK to map surgeon hand movements to small-scale instrument motions through narrow ports.

Frequently asked questions

Спробуйте наживо

Усе, що вище, працює прямо у вашому браузері — відкрийте the simulation і змінюйте параметри під час роботи. Нічого не встановлюється, нічого не завантажується на сервер, уся модель живе в одній вкладці.