Surgical Robot Remote Centre of Motion: Trocar Pivot, Motion Scaling and Tremor Filter

A robot arm holds an instrument through a trocar into a see-through abdomen: the shaft always passes through the port while the tip follows the scaled, filtered hand. Drag to orbit.

Switch to 2D
Controls

Presets

Parameters

Quality

Camera

Model checks

The science

Remote centre of motion. In laparoscopic surgery the instrument enters the body through a small port in the abdominal wall. The port is a fixed point the shaft must pass through, so the instrument can only pivot about it, slide in and out, and spin: a remote centre of motion (RCM). If the tip is wanted at q and the port is at P, the shaft direction is u = (q - P)/|q - P| and the wrist hub sits outside the body at H = P - u (Lsh - |q - P|). A three-joint arm (base yaw, shoulder, elbow, link lengths L1 = 40 cm, L2 = 38 cm) reaches H by planar two-link inverse kinematics, cosθ2 = (r² + y² - L1² - L2²)/(2L1L2). If the robot's assumed pivot is wrong by e (a calibration error), the shaft is pushed sideways at the port by e√(1 - ux²) and the wall loads it with about Kw times that displacement (Kw = 0.25 N/mm here, an illustrative value).

Motion scaling and tremor filtering. The surgeon's hand path (minimum-jerk movements between four targets) plus a physiological tremor A sin(2πft) at 6 to 12 Hz is divided by the scaling ratio and passed through a first-order low-pass filter with time constant τ. The filter attenuates a tremor at frequency f by 1/√(1 + (2πfτ)²), but it also delays the intended motion: a ramp of speed v trails by vτ and a step needs τ ln 50 to reach 98 %. The lower graph is this trade-off: tremor error falls and lag error rises with τ, so a best τ exists (the readout shows it).

Checks. The arm is rebuilt by forward kinematics from its own joint angles and the port-to-shaft distance is compared with the closed form; the filter's tremor gain is measured by lock-in detection at 0.1 ms steps; the ramp lag and the 98 % settling time are measured against vτ and τ ln 50; and the full pipeline's RMS tip error is compared with the closed-form sqrt(tremor² + lag²).

Simplifications. A single point-mass tip with an ideal inner position loop (no joint dynamics, backlash, cable stretch, haptics or camera delay); tremor is one sinusoid in a fixed direction; the filter is first order (real systems often use notch or adaptive band-limited filters); the abdominal wall is a linear spring and the shaft is rigid. This is an educational model of the principle, not a medical device description and not affiliated with any robot maker. Numbers are illustrative orders of magnitude.

Loading model...
Loading Blender model...
-
-
Made with 🟠 Blender · Three.js