Bent SCARA with different rotary-drive motion accents illustrates unequal joint speeds during tool travel.

What you need

Use a validated Jacobian in an offline numerical script. Avoid matrix inversion close to a singularity.

Joint-speed magnitudes for a 20 mm/s Y motion. Joint 1: 0.2 rad/s; Joint 2: 0.2 rad/s.
Joint-speed magnitudes for a 20 mm/s Y motion. Original Academy diagram using illustrative values; not a measured hardware result.
Read the diagram as a data table
Values used in the illustration
Condition or componentrad/s
Joint 10.2
Joint 20.2

The calculation

q̇ = J⁻¹ × v

This direct inverse applies only to a nonsingular square Jacobian. Joint rates are rad/s when lengths and velocities use meters.

Worked example

Illustrative numbers. Replace them with your measured inputs.

At the right-angle pose with J=[[-0.1,-0.1],[0.1,0]], a desired velocity (0,0.02) m/s requires q̇₁=0.2 rad/s and q̇₂=-0.2 rad/s. Both joints move even though the target velocity is purely vertical in the drawing.

Try it step by step

  1. Evaluate the Jacobian at the current pose using the same conventions as the forward model.
  2. Solve the linear system and compare each requested joint rate with the configured machine limit.
  3. Scale the task velocity or replan where the solution exceeds limits, while preserving direction only when appropriate to the task.
  4. Check acceleration and continuity between samples; individually valid rates can still form an infeasible trajectory.

How to check the result

Multiplying the resulting rates by J should recover the requested velocity within numerical tolerance away from singularities.

Common mistake to avoid

Never use this local linear relation as a complete collision-aware motion planner. Large time steps invalidate the small-motion approximation.

Reference reading

Primary references for the underlying models, APIs or application context. The worked numbers and plots above are educational calculations, not results reported by these sources.

Read our methods, limitations and safety notes.