Disturbance-aware Motion Planning for Over-actuated Underwater Vehicles Exploiting Actuation Redundancy for High-fidelity 3D Reconstruction

TL;DR: An eight-thruster underwater robot has more actuators than degrees of freedom, so infinitely many thrust combinations produce the same motion. This paper picks among them the one that blows the least water at the thing being photographed. A cheap analytical wake model (actuator-disk theory plus a \cos^4\theta directional falloff) makes "predicted turbulence at the target" a differentiable cost, and an SQP allocator running at 10 Hz searches the thruster null space to minimize it. In tank experiments the result is a 67% reduction in particle velocity at the target and 3D reconstruction RMSE dropping from 4.3 mm to 1.9 mm — with no loss of positioning accuracy and 31% less energy. The transferable idea is bigger than ROVs: control redundancy is a free resource you can spend on sensing quality, not just on motion.

The problem: your thrusters are fighting your camera

Every close-range underwater inspection task — coral monitoring, pipeline crack detection, archaeology — runs into the same physical trap. To hold position near the target, the robot fires thrusters. The thruster wakes resuspend sediment and churn the water column, suspended particles scatter light, and the images the robot came to collect are ruined at the sensor input. No amount of downstream image enhancement can recover information that was destroyed by occlusion and blur before the photons hit the lens. The authors call this actuation-to-perception coupling, and it's a genuinely awkward one: the harder you try to stabilize (high-gain station-keeping, aggressive corrections), the more turbulence you create, and the worse your data gets.

The standard mitigations are all unsatisfying. Hardware fixes (low-wash propellers, relocated thrusters) are fixed at design time. Operational fixes (go slower, wait for sediment to settle) multiply mission duration — the paper cites 3× or more. Post-processing (Sea-thru-style restoration, neural enhancement) can't undo occlusion. And note the structural reason conventional control can't help: a standard six-thruster vehicle has exactly six control inputs for six degrees of freedom. The mapping from desired motion to thrust is unique. There is no freedom left to spend on anything else — motion and disturbance are rigidly coupled.

The key idea: spend your null space on the water, not just the robot

An eight-thruster vehicle has two more actuators than degrees of freedom. Writing the thrust allocation problem as B\mathbf{u} = \boldsymbol{\tau}, where \mathbf{u} \in \mathbb{R}^8 is the vector of thruster forces, \boldsymbol{\tau} \in \mathbb{R}^6 is the desired net force/torque on the body, and B is the geometry-dependent allocation matrix, the solution set is a 2-dimensional affine subspace: any \mathbf{u}^* + \mathbf{u}_{\text{null}} with \mathbf{u}_{\text{null}} \in \ker(B) produces identical vehicle motion.

This is exactly the redundancy-resolution story from manipulator kinematics — a 7-DOF arm can hold its end-effector fixed while moving its elbow to avoid an obstacle. The paper's contribution is what it puts in the null space objective: not the usual energy or actuator-saturation terms, but a physical model of what the thruster wakes do to the water at the imaging target. Elbow-around-the-obstacle becomes wake-around-the-coral.

The mechanism: a wake proxy cheap enough to sit inside a control loop

To optimize over wakes, you need a wake model that evaluates in microseconds, not the hours a CFD solver takes. The paper's proxy models each thruster as an actuator disk — the classic momentum-theory idealization of a propeller as an infinitely thin disk imparting momentum to the fluid. The induced velocity at a point \mathbf{x} from thruster i is:

Three ingredients: an axial jet velocity from momentum theory (T_i is thrust, \rho water density, A_{\text{prop}} the propeller disk area), an inverse-square decay with distance r_i from the thruster, and a directional attenuation g(\theta_i) = \cos^4(\theta_i) for angles within 45° of the thrust axis \mathbf{n}_i, zero outside. The \cos^4 comes from a nice two-step argument: momentum theory gives velocity decaying as \cos^2\theta off-axis, and hydrodynamic force on a target scales with dynamic pressure — velocity squared — hence \cos^4. The 45° hard cutoff matches submerged-jet studies: beyond it, induced velocity falls under 10% of the axial peak.

The aggregate disturbance cost sums all eight wakes (linear superposition), squares the norm, and integrates over the target region, discretized to N = 150–300 sample points weighted by proximity to delicate features (w_j = \exp(-d_j/\sigma), \sigma = 5 cm). Total overhead: under 1 ms per iteration.

Is the proxy any good? They validated it against Particle Image Velocimetry — laser-illuminated tracer particles tracked at high frame rate to measure actual flow fields. R^2 = 0.99 near the wake axis (|\theta| < 15°, r < 0.3 m), degrading to R^2 \approx 0.82–0.84 across the full primary wake region where turbulent mixing kicks in. Crucially, the authors are honest about what the model needs to be good at: not absolute flow prediction, but relative ordering of candidate allocations. The known biases (superposition overestimates when wakes partially cancel; overestimation at r > 0.4 m) are conservative — the optimizer errs toward gentler solutions.

The optimizer itself is a fairly standard receding-horizon SQP: 2-second horizon, 20 steps, disturbance cost plus effort plus a soft tracking term (w_{\text{track}} = 5.0 mediates the intent-vs-gentleness tradeoff), thrust bounds and rate limits, collision log-barrier, warm-started OSQP inside. Average solve: 45 ± 12 ms on a desktop i7, comfortably inside the 10 Hz loop. The disturbance cost is non-convex, but warm-starting from the previous cycle keeps solutions consistent — disturbance cost varied by <5% across random restarts.

The evidence

The headline experiment: three artificial coral models (branching, brain, plate; 12–18 cm) scanned via hemispherical layered orbits, reconstructed with COLMAP + Instant-NGP, evaluated against Artec Space Spider ground truth (0.05 mm nominal). Four methods, 20 trials each per model.

The physical mechanism is validated directly, not just through reconstruction quality: PIV-tracked tracer particles at the target surface show mean velocity of 0.06 ± 0.02 m/s under the disturbance-aware controller versus 0.18 ± 0.05 m/s for the disturbance-unaware baseline — the 67% reduction (p < 0.001, n = 20). An additional 200-trial run under varied initial conditions gives the 98.5% success figure (197/200).

The ablation is the most informative table for judging whether the idea — rather than just careful engineering — is doing the work:

Two ablation results matter. Disabling two thrusters — removing the null space while keeping everything else — doubles the RMSE (3.8 mm), directly confirming that redundancy, not just the disturbance-aware cost, is essential. And replacing the \cos^4 directional model with a linear proxy still degrades RMSE to 3.2 mm, so the wake model's fidelity is contributing, not just the general "don't blast the target" penalty.

There's also a satisfying station-keeping result the authors call gentle stability. Holding pose 0.20 m above a coral under a 0.3 m/s current for 180 s, their controller matches a high-gain DP/PID baseline on position accuracy (2.1 ± 0.6 mm vs. 2.3 ± 0.8 mm, statistically indistinguishable) while cutting target-surface particle velocity 67%, energy 31% (11.2 vs. 16.2 kJ), and attitude RMS 45%. This quietly undermines a common assumption in station-keeping: that tighter tracking requires more aggressive actuation. Here the aggressive baseline buys nothing in accuracy and pays for it in turbulence, energy, and platform jitter. High-gain error correction is, in this regime, mostly self-inflicted noise.

What to be skeptical about

Lab conditions are far from the field. A 6 × 5 × 1.5 m clear freshwater tank, controlled LED lighting, steady pump-generated current, artificial coral under 20 cm, and — importantly — a known target pose for defining the disturbance region. In deployment you'd need online target detection/segmentation feeding \mathcal{R}_{\text{target}} at control-compatible latency. The authors partially address realism with a CaCO₃ sediment proxy test (62% relative disturbance reduction, similar to clear water, but ~40% worse absolute RMSE), and they conservatively project 3–5 mm RMSE for field conditions — roughly where their smooth-planner baseline already sits in the tank.

Some baselines are soft. Manual teleoperation at 0/60 success tells you 6-DOF joystick ROV piloting is hard, not much about the method. The honest comparison is against the smooth planner (2.8 mm, 85% success): the disturbance-aware system's real margin is 2.8 → 1.9 mm and 85% → 98% success. Meaningful, but less dramatic than the abstract's headline 55% (vs. disturbance-unaware) or the 78% figure quoted in some figure captions (vs. manual). Also, quality metrics exclude failed reconstructions, which flatters methods with higher failure rates.

Platform specificity. The wake proxy's constants (\cos^4, 45° cutoff, inverse-square decay) were validated for this thruster (M060, ducted) at 0.1–0.5 m range. The structure should transfer to other thrusters with recalibration, and the framework generalizes to any over-actuated platform, but the two-dimensional null space of an eight-thruster vehicle is not huge — how much disturbance reduction is achievable depends on thruster geometry relative to typical target directions. The vectored 4-horizontal/4-vertical layout here seems well suited; other layouts might have less useful null spaces.

Superposition and quasi-steady flow. Wakes interact nonlinearly and take time to develop; the model treats them as instantaneous, independent, linear jets. The conservative-bias argument is reasonable for a relative-ordering objective, but strongly interacting wakes near a complex vehicle body could scramble the ordering in ways the tank tests (single-vehicle, open geometry) wouldn't reveal.

Why this is worth remembering

The specific system is a nicely executed tank demonstration, not a field-ready capability. But the framing — actuation redundancy as a sensing resource — is the kind of principle that travels. Any over-actuated system whose actuators perturb the medium its sensors observe faces the same coupling: drones whose downwash disturbs the surfaces they're inspecting or the dust they're imaging through, manipulators whose vibrations blur their eye-in-hand cameras, surgical robots displacing tissue they're visualizing. The recipe is general: (1) build a control-oriented proxy for how actuation degrades sensing, cheap enough for the loop and accurate enough for relative ranking; (2) put it in the null-space objective; (3) verify with a physical measurement of the disturbance channel, not just the downstream task metric. Step 3 is what makes this paper convincing where a reconstruction-only evaluation would be circumstantial — the PIV measurements close the causal chain from allocation to flow to image quality to geometry.

The "gentle stability" result is the piece I'd flag for anyone in control: matching a high-gain controller's accuracy at 31% less energy and a third of the induced turbulence suggests that a lot of conventional station-keeping effort is spent fighting disturbances the controller itself creates.

Where to spend your reading time: Section III-B (the wake proxy and its PIV validation) is the core technical contribution and the part you'd need to reimplement the idea elsewhere; Table V's ablation and Section IV-C's gentle-stability experiment are the evidence that the principle, not just the tuning, is doing the work.