Six-axis robot arm: kinematics, singularities, gravity

Move the tool or the joints; watch the Jacobian lose rank near singular poses and the motors load up.

Switch to 2D

Presets

Playback

Control mode

Joint angles

Tool target

Load and speed

Camera

Layers

Quality

Model check

The science

Forward kinematics

The arm is a chain of six revolute joints. Each joint turns about an axis a_i fixed in the previous link, so the orientation after joint i is R_i = R_(i-1) Rot(a_i, q_i) and the position of the next joint is p_i = p_(i-1) + R_(i-1) o_i, where o_i is the fixed offset between joints. The tool point is the end of this chain. Joints 2 and 3 pitch the upper arm (0.55 m) and forearm (0.50 m) in a vertical plane; joints 4, 5 and 6 form a spherical wrist whose three axes meet at one point, which is what makes the inverse problem solvable in closed form.

Inverse kinematics

Subtract the tool length along the tool axis to get the wrist centre w = p_tool - d6 R_t e_x. Joint 1 is atan2(w_y, w_x). With horizontal distance r, height z above the shoulder and d^2 = r^2 + z^2, the law of cosines gives cos q3 = (d^2 - a2^2 - a3^2) / (2 a2 a3). The two signs of q3 are the two elbow branches (elbow up and elbow down) that reach the same point. Then q2 = atan2(z, r) - atan2(a3 sin q3, a2 + a3 cos q3). The remaining rotation R_3^T R_t = Rx(q4) Ry(-q5) Rx(q6) is decomposed into three angles, again with two solutions; the page keeps the one closest to the current wrist. If |cos q3| > 1 the target is outside the workspace and the arm stretches toward it.

Jacobian and manipulability

Column i of the geometric Jacobian is [ z_i x (p_tool - p_i) ; z_i ]: joint i turns about world axis z_i and moves the tool at that lever arm. Joint speeds and tool twist are related by v = J q', so the speeds needed for a wanted tool motion are q' = J^-1 v. The determinant of this Jacobian has a closed form for this arm, |det J| = r a2 a3 |sin q3| |sin q5|, and it vanishes in three families of singular poses: the elbow stretched or folded (sin q3 = 0), the wrist axes aligned (sin q5 = 0), and the wrist centre on the base axis (r = 0). Near them one tool direction costs unbounded joint speed; the velocity ellipsoid, whose semi-axes are the singular values of the position block of J, collapses to a flat disc or a needle. The condition number (largest over smallest singular value) says how lopsided it is. The graphs sweep the tool along a straight line and show the joint speeds that the inverse Jacobian demands against the motor limit.

Gravity torque

A motor holding the pose still must supply the slope of the potential energy U = sum m_k g z_k, so tau_i = dU/dq_i = sum_k m_k g (z_i x (p_k - p_i))_z over every mass carried beyond joint i. For the shoulder this is simply total weight times the horizontal lever arm of each mass. The torque is linear in the payload, so the largest payload for a pose is found by solving for the mass at which the first motor reaches its limit. The masses (7 kg upper arm, 3 kg elbow motor, 4 kg forearm, and so on) and the torque limits are rounded values typical of a mid-size industrial arm, not data for a particular product.

What is simplified

The page treats the links as point masses at their centres, ignores friction, inertia and Coriolis forces (the joints follow the target with a simple speed limit), uses the same torque limits at any speed, and does not check collisions with the floor or with itself. The Jacobian mixes metres and radians in its angular rows, so the full determinant is a relative indicator rather than a physical unit; the translational singular values are in metres per radian.

Loading model...
Loading Blender model...
Manipulability and smallest singular value along a straight tool line
Holding torque against shoulder angle, with motor limits
Where the wrist centre moves easily (side view of the workspace)
Joint speeds needed to move the tool along the line
Made with 🟠 Blender · Three.js