3D Robot Manipulator: Pick and Place, Inverse Kinematics, Torque Limits and Grip Friction

An articulated arm in a Blender-built work cell moves crates between two pallets: inverse kinematics, joint torques against the motor rating, a speed-limited path and a friction gripper.

Switch to 2D

Presets

Playback

Parameters

Camera

Layers

Quality

Model check

The science

What is modelled

A four-axis articulated arm stands on a pedestal: a base joint that turns about the vertical axis (yaw) and three pitch joints in the arm plane (shoulder, elbow, wrist). The wrist keeps the gripper at a chosen angle to the vertical, so the arm needs only three numbers to place the tool tip: the yaw, and the two joints of a planar two-link chain that carries the wrist point. The page plans straight-line tool moves between the pallets, solves the joint angles every frame, adds up the gravity torque each motor must hold and checks whether the gripper can keep hold of the crate.

Equations

  • Inverse kinematics: yaw ψ = atan2(y, x). The wrist point is the tool tip minus the tool length along the tool direction, W = (r − LT cosθ3, z − LT sinθ3 − zs). The law of cosines gives cos q2 = (|W|² − L1² − L2²)/(2 L1 L2), then q1 = atan2(Wz, Wr) − atan2(L2 sin q2, L1 + L2 cos q2) and q3 = θ3 − q1 − q2. The sign of q2 chooses elbow up or elbow down. If |cos q2| > 1 the point cannot be reached.
  • Jacobian of the tool position (r, z) with respect to (q1, q2, q3) and, for the wrist point, det J = L1 L2 sin q2: it is zero when the elbow is straight (arm fully stretched) or folded back, a singularity where the tool cannot move along the arm.
  • Static gravity torques from the potential energy of the links and the payload, U = g Σ mi hi, τj = ∂U/∂qj. For the outstretched arm the shoulder torque is the sum of weight times lever arm.
  • Trapezoidal speed profile on each straight move of length d: accelerate at a up to v, cruise, brake; T = d/v + v/a (or 2√(d/a) if v is never reached).
  • Friction grip with two pads: the crate is held while 2 μ F ≥ m (g + a), with a the tool acceleration in the worst direction.

Checks run in the page

  • Inverse followed by forward kinematics for thousands of random targets, plus the trapezoid profile integrated against the move length.
  • The analytic Jacobian against finite differences and det J against L1 L2 sin q2.
  • Gravity torques against numerical derivatives of the potential energy, and the outstretched arm summed by hand.

Honest simplifications

The torques are quasi-static: only gravity is counted, not the inertia of the links during acceleration, joint friction, gearbox losses or the spring balancer that real arms use at the shoulder, so a real arm needs more motor reserve than the numbers show. The link masses, centre-of-mass positions and the nominal torque ratings (350, 180 and 45 N m) are round values for a medium arm. Joint motion is not limited in speed or acceleration separately from the tool path, there is no collision check with the pallets or the fence, and the gripper force check treats the worst-case acceleration as acting against the grip. A trip of the drive after half a second of overload stands for the protection of a real controller.

What to try

  • Choose the 20 kg preset: the shoulder torque passes the reduced rating and the drive trips. Lower the crate mass to see how the largest allowed crate changes with the pose.
  • Use the slippery pads preset and watch the crate slip when the acceleration is high; raise the pad friction or the gripper force.
  • Switch to manual mode and drive the tool to a point near the edge of the green working-range dots; watch det J fall toward zero near the stretched arm.
  • Tilt the tool or choose the elbow-down configuration and see the reachable region in the third graph change.
Loading model...
Loading Blender model...
Joint angles
Torque as a share of the motor rating
Working range slice and tool path
Made with 🟠 Blender · Three.js