🤖 Surgical Robot Arm Lab: Motion Scaling, Tremor Filtering and Two-Link Kinematics

Educational model. Not medical advice.

Scenarios

Parameters

Readouts

Independent checks

The science

A teleoperated surgical manipulator sits between the surgeon's hand and the instrument tip. Two things make it more precise than a bare hand: motion scaling (the tip moves 1/s of the hand) and a tremor filter (a low-pass filter that removes the 8-12 Hz physiological tremor).

  • Tremor: the hand wobbles as A sin(2πft + φ) on each axis (here 90° apart, so it is a small circular wobble).
  • First-order low-pass filter with cutoff fc, discrete form y += a (x - y), a = 1 - e-2π fc dt. Its steady-state gain for a sine of frequency f is g = 1 / √(1 + (f/fc)2); its lag delays the commanded path by about 1/(2π fc).
  • Scaling: tip displacement = (filtered hand displacement) / s, so residual tremor at the tip has amplitude A g / s and RMS A g /(s√2) measured across the path.
  • Arm: planar two-link manipulator, inverse kinematics from the law of cosines: cos q2 = (x² + y² - L1² - L2²) / (2 L1 L2), q1 = atan2(y,x) - atan2(L2 sin q2, L1 + L2 cos q2). Targets outside the reach are clamped to the workspace edge.

Trade-off: a lower cutoff removes more tremor but adds lag, so fast intentional motion is traced late. Simplifications: the arm is a kinematic model (no joint dynamics, backlash, force feedback or remote-centre-of-motion constraint of real laparoscopic tools); the tremor amplitude and frequency are typical-order illustrative values, not measurements of any person; the circle is a generic training task.