BackCompleted
Completed2025Author

Recalibration-Free Stereo PTU

Calibration and state estimation for a moving stereo pair

A stereo pan-tilt unit whose extrinsics stay trustworthy as it moves, so the rig does not need to be recalibrated by hand every time it is used.

Problem

A stereo rig on a pan-tilt mount loses its calibration the moment it moves. Servo backlash and drift accumulate, the extrinsics stop describing the actual geometry, and depth quietly degrades until someone recalibrates by hand.

Treating this as a state estimation problem rather than a maintenance chore is the point of the project.

What I built

The rig, and the estimator that keeps it honest.

  • Stereo pair on a pan-tilt mount with MPU9250 IMU reference
  • Laser anchor (VL53L0X) providing an absolute correction
  • Six-state EKF with explicit backlash estimation and drift correction
  • SGBM block matching fused with MiDaS monocular depth priors
  • CAD, plus synthetic and real evaluation
  • Reprojection analysis and ablation analysis

Keeping the extrinsics honest

The rig loses calibration the moment it moves. Rather than recalibrating by hand, the errors that cause the drift are estimated as part of the state.

  1. Command a pan/tilt move

  2. Servo backlash and drift accumulate

    The extrinsics stop describing the actual geometry.

  3. Six-state EKF

    Backlash estimated explicitly rather than assumed away; IMU (MPU9250) provides the inertial reference.

  4. Laser anchor correction

    A VL53L0X range to a known anchor gives an absolute correction, not just a relative one.

  5. Depth from stereo

    SGBM block matching fused with MiDaS monocular priors.

  6. Reprojection error stays bounded — no manual recalibration

The rig

PartRole
Stereo pair on a pan-tilt mountThe sensor whose extrinsics are the problem
MPU9250 IMUInertial reference for the filter
VL53L0X laser anchorAbsolute correction against a known point
Jetson Orin NanoRuns estimation and depth
Six-state EKFBacklash estimation and drift correction

Experiments

Synthetic and real evaluation

Question
Does modelling backlash and drift keep the extrinsics valid without manual recalibration?
Method
Synthetic and real evaluation with reprojection error analysis, plus ablations isolating the contribution of each estimator component.
Result
Ablation analysis separates what the backlash estimation, drift correction and laser anchor each contribute.

Limitations and failure modes

  • Evaluated on one rig; the backlash model is fitted to this mount's characteristics.

Gallery

The rig — stereo pair on the pan-tilt mount, as modelled
The rig — stereo pair on the pan-tilt mount, as modelled
Ablation: mean reprojection error with each estimator component removed
Ablation: mean reprojection error with each estimator component removed
Reprojection error over time as backlash and drift accumulate
Reprojection error over time as backlash and drift accumulate

Attribution

Built by me
Hardware, CAD, estimator and evaluation.
Based on external research
SGBM and MiDaS are upstream methods.

Related

  • OpenDroneKit

    Offline drone inspection — mission planning, flight, geospatial reconstruction and defect intelligence

  • SMR300

    Autonomy stack for a 300 kg industrial AMR