Presets
Playback
Control
Joint angles
Inverse target
Circle path
Camera
Layers
Quality
Model check
The science
What is modelled
A three-joint industrial arm: a base that turns about the vertical axis (q1), a shoulder (q2) and an elbow (q3) that bend in the arm's vertical plane. The gripper is fixed to the forearm, so the arm controls only the position of the gripper tip, not its orientation. The 3D work cell (arm, cage, table, cargo box) is modelled in Blender; the joints of that model are driven by the formulas below.
Equations
- Forward kinematics:
r = L1 cos q2 + L2 cos(q2+q3),y = H + L1 sin q2 + L2 sin(q2+q3),x = r cos q1,z = −r sin q1. L1 = 1.40 m, L2 = 1.10 m forearm plus 0.28 m gripper, shoulder height H = 0.35 m. - Inverse kinematics (closed form):
q1 = atan2(−z, x),cos q3 = (r² + h² − L1² − L2²)/(2 L1 L2)with h = y − H,q2 = atan2(h, r) − atan2(L2 sin q3, L1 + L2 cos q3). The two signs of q3 are the elbow-up and elbow-down solutions; a target farther than L1+L2 has none. - Jacobian J = ∂p/∂q (3 x 3). Joint rates for a wanted tip velocity:
dq/dt = J−1 v. Its determinant is|det J| = r L1 L2 |sin q3|: zero when the elbow is straight or folded (q3 = 0 or 180°) or when the tip is on the vertical axis (r = 0). - Pick and place: waypoints are joined either by straight lines in space (inverse kinematics every frame) or by equal-fraction changes of the joint angles (curved tip path).
Checks run in the page
- Inverse then forward kinematics over 500 random poses returns the same point.
- The gripper tip node of the Blender model, after the joint rotations, matches the formula.
- The Jacobian matches finite differences and the closed form of its determinant.
Honest simplifications
- Only geometry is modelled: no masses, motor torques, gravity, joint speed limits or collisions with the table or cage. Joint limits are checked and flagged. The cargo is attached to the gripper while it is closed on it. Link dimensions are illustrative, not those of a particular robot.
What to try
- Compare the two pick-and-place presets: straight lines versus joint-space motion draw different tip paths.
- Choose "Near full stretch" and watch |det J| and the joint rates grow: small tip motions need large joint speeds near a singularity.
- Switch the same target between elbow up and elbow down.
- Pull the target beyond 2.78 m: the arm stretches and the marker turns red.
Loading model...
Loading Blender model...