Presets
Playback
Cell
Speed, payload and servo precision of the pick-and-place cycle.
Arm design
Link lengths and masses decide reach and torque demand.
Layers
Model checks
The science
The arm
A 3-axis articulated arm: base yaw, then shoulder and elbow rotating in one vertical plane. Link lengths l1 and l2 give the tip position r = l1 cos q1 + l2 cos(q1 + q2), z = h0 + l1 sin q1 + l2 sin(q1 + q2). Inverse kinematics is closed form: cos q2 = (r^2 + (z - h0)^2 - l1^2 - l2^2) / (2 l1 l2), elbow up.
Motion
Each move between work points (home, above the part, the part, lift, tray ...) is a minimum-jerk joint move s(tau) = 10 tau^3 - 15 tau^4 + 6 tau^5. Its duration follows from the speed limit (peak speed 1.875 D/T) and the acceleration limit (peak acceleration 5.77 D/T^2) of the slowest joint; both limits grow with the speed setting.
Dynamics and torque limits
The shoulder and elbow obey the standard manipulator equation tau = M(q) q'' + C(q, q') q' + g(q), with the payload added as a point mass at the tool. The planner computes the torques along the whole cycle and, if 90 % of the rated torque would be exceeded, stretches all moves in time until it is not. That is why a heavier payload lengthens the cycle (graph 4). The work-energy theorem is used as a check: the integral of torque times joint speed equals the change of kinetic plus potential energy.
Simplifications
Uniform-rod links, no joint friction or gear inertia, no coupling of the base yaw into the shoulder and elbow equations (yaw only has a point-mass inertia), stiff rigid links, instantaneous grasp and release at rest. The tip-error readout is an illustrative function of the precision setting, payload and speed, not a measured repeatability.
What to try
- Raise the payload to 90 kg at 100 % speed: the planner slows the cycle to stay within the shoulder rating (watch the torque graph touch the dashed line).
- Reduce gravity to 1.6 m/s2: holding torques drop and the same payload runs at full speed.
- Lengthen the upper arm: reach grows but the shoulder torque grows with it.
- Compare Turbo cell with Heavy part in the cycle-time versus payload graph.