Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking with a Holonomic AUV
summary
The gist
Small, holonomic Autonomous Underwater Vehicles (AUVs) enable close-range inspection of underwater structures from arbitrary viewpoints…
In short
This work introduces a Model Predictive Contouring Control (MPCC) for six-Degrees-of-Freedom holonomic Autonomous Underwater Vehicles (AUVs). It improves tracking accuracy by augmenting the standard dynamics model with residual dynamics learned via Gaussian Processes, allowing the controller to handle complex maneuvers while respecting physical constraints in real-time.
Key concepts
- Holonomic AUV
- A small underwater vehicle that can move freely in all six degrees of freedom (position and orientation) without needing specific propulsion configurations. This capability is crucial for close-range inspection tasks where arbitrary viewpoints are required.
- Gaussian Process (GP) Regression
- A machine learning technique used to learn the unknown 'residual dynamics'—the small errors in the vehicle's movement not captured by the main model. GPs provide both a prediction (mean) and a measure of uncertainty, helping the controller know when its predictions are unreliable.
- Model Predictive Contouring Control (MPCC)
- A control strategy that plans future movements along a desired geometric path while simultaneously optimizing for tracking errors. It treats the path progress as an additional decision variable, enabling precise trajectory following under complex constraints.
Terminology used across episodes
This episode discusses
- Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking with a Holonomic AUV · Paper Radio
- MPCC++: Model Predictive Contouring Control for Time-Optimal Flight with Safety Constraints
- Control of Marine Robots in the Era of Data-Driven Intelligence
The paper
Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking with a Holonomic AUV · Read on arXiv
David Dorner, Giancarlo Troni, Ignacio Torroba, Ivan Stenius
KTH Royal Institute of Technology · Monterey Bay Aquarium Research Institute
Transcript
Introduction to the show: ident: Robotics Radio. Generated commentary on the latest robotics and control papers.
Rosa: We're looking at the paper: "Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking with a Holonomic AUV".
Title and authors: Rosa: So we've talked about what the paper does and its performance gains. Now let's look at what they are actually talking about in this specific piece, "Gaussian Process-Augmented Model Predictive Contouring Control for six-DoF Trajectory Tracking with a Holonomic AUV <ref:2611.14373#pg1,Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking>."
Dev: Right, so the title itself tells us the core components: Gaussian Process, Model Predictive Contouring Control, six degrees of freedom, and holonomic AUV. That immediately tells you this isn't just a simple position controller; it’s a sophisticated setup designed for complex underwater motion.
Taro: I remember reading that they are using MPCC because it naturally handles the requirements of tracking under state and input constraints, but that reliance on an accurate dynamics model is the main hurdle underwater, so they’re going to augment that model with Gaussian Process regression.
Rosa: They’re augmenting the nominal model by learning residual dynamics from recorded state and input data, which they call y(t) equals B d dagger d of x t plus one minus f of x t u t.
Dev: That training signal is built from the recorded state and input data, specifically using z(t) equals x top t u top t transpose as the inputs for the regression. And that GP regression gives them a measure of uncertainty alongside their mean prediction.
Taro: So, the key improvement here is embedding this learned residual into the optimal control problem through a zero-order robust optimization scheme, which is what keeps it real-time capable at twenty-five hertz.
Rosa: That robust optimization part is crucial because it allows the controller to tighten constraints according to predicted uncertainty by evaluating that beta hat k equals beta mu hat k sigma hat k in a zero order robust optimization fashion.
Dev: So, we’re not just plugging in a single best guess from the GP; we’re using that uncertainty measure to actively shape how tight the constraints are enforced during the control calculation.
Taro: That means when things get uncertain, the controller gets more cautious about its moves, which is exactly what you need when dealing with unpredictable underwater currents or unknown system behaviors.
Rosa: So in short, they are using a probabilistic model to make their deterministic optimal control solver much smarter about the environment it's operating in.
Dev: And this probabilistic approach allows them to handle the six degrees of freedom—position and attitude for all three axes—which is something that simpler models often reduce down to just surge, sway, and yaw.
The paper's summary: Rosa: To summarize what we’ve covered so far, the core idea of this paper is taking a holonomic AUV, which means it can move in any direction using its six degrees of freedom, and applying Model Predictive Contouring Control to track a geometric reference path p theta.
Dev: Instead of tracking a simple time-parameterized reference where you just try to hit point A at time T, MPCC treats the progress along the path itself as an additional decision variable.
Taro: They define things like contouring error and lag error, which are essentially how far the vehicle is from the geometric reference path, and these errors are minimized in the cost function alongside tracking error.
Rosa: The optimization problem minimizes costs related to contouring error, lag error, and tracking error all at once. And leveraging that holonomic actuation means they can track an attitude reference independently of the direction of travel.
Dev: That’s a big deal because it decouples the heading control from the vertical motion control in a way that standard controllers might struggle with when you're trying to follow a curved path.
Taro: So, they are effectively solving a multi-variable optimization problem where you’ve got the geometry of the path and the vehicle's dynamics all interacting.
Rosa: And they use Gaussian Processes to handle the dynamics uncertainty that plagues underwater modeling, making this complex trajectory tracking feasible in a real-time setting.
Dev: The summary is basically: we use GP regression to improve our dynamic model, embed that improvement into an MPCC framework that respects constraints and uses robust optimization to handle the resulting uncertainty in real time.
The paper's improvements: Taro: Moving on to the specific improvements they suggest, one big takeaway is how they address the limitations of previous work where MPC often reduced models to just three degrees of freedom, like surge, sway, and yaw.
Rosa: They show that for inspection tasks, depth and roll control are equally important for getting a good result, so they propose tracking all six states instead of reducing the model order.
Dev: They’re proposing using Gaussian Process-Augmented Model Predictive Contouring Control for six-DoF Trajectory Tracking with a Holonomic AUV as the solution that moves beyond those three-DoF limitations <ref:2611.14373#pg1,Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking>.
Taro: And they show that adding that angular residual correction significantly improves attitude tracking on maneuvers like a lawnmower survey and inspection spirals compared to just using a standard proportional integral derivative controller.
Rosa: The improvement there is substantial: on the lawnmower pattern, it reduces the attitude root mean square error from zero point eight one degrees down to zero point five five degrees at an unchanged position error of zero point zero six meters.
Dev: That means they’re getting a significant performance boost without needing a huge increase in engineering effort, and they also found that adding the angular residual further reduces the attitude root mean square error to two point four degrees compared to a PID controller in their own in-water experiments.
Taro: Plus, on maneuvers like an inspection spiral in simulation, they showed that this approach reduces the attitude error of the nominal MPCC by eighty five percent at a lower control energy.
Rosa: The other key improvement is that it directly incorporates state and actuator constraints into the optimization problem, which is something standard PID controllers simply cannot do.
Conclusion: Dev: So to wrap up, this paper on "Gaussian Process-Augmented Model Predictive Contouring Control for six-DoF Trajectory Tracking with a Holonomic AUV" shows that augmenting the nominal model with Gaussian Process residual dynamics and embedding that via robust optimization into an MPCC framework is a viable path forward <ref:2611.14373#pg1,Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking>.
Rosa: The main implication is that we can achieve much better, more robust trajectory tracking for small underwater vehicles by using this data-driven approach to handle the inherent dynamics uncertainties in modeling.
Taro: For the world, this means for inspection tasks underwater, we have a system that can provide much closer and more precise tracking because it accounts for real-world dynamics uncertainty in a way that older methods couldn't.
Dev: And they’re not just getting better tracking numbers; they are showing that this method is robust enough to handle complex maneuvers while respecting the constraints directly, which is what makes it practical for deployment.
Rosa: So we’ve seen how the paper demonstrates that a sensible selection of learned residuals improves tracking performance, and compensating angular residuals halving the attitude error of a field-proven proportional integral derivative controller on a lawnmower survey and reducing the attitude error of the nominal MPCC by eighty five percent during an inspection spiral.
Dev: It’s a solid method, but they do point out that future work should focus on online learning during longer deployments and incorporating uncertainty into the propagation scheme of the GP-MPCC.
Taro: I agree, online learning is the next logical step because real-world environments are constantly changing, so we need to incorporate that adaptation over longer periods.
Rosa: Exactly, and incorporating that uncertainty into how the Gaussian Process propagates its predictions will make it even more reliable when deployed in those long deployments.
Dev: So that's our wrap-up on this paper, "Gaussian Process-Augmented Model Predictive Contouring Control for six-DoF Trajectory Tracking with a Holonomic AUV <ref:2611.14373#pg1,Gaussian Process-Augmented Model Predictive Contouring Control for 6-DoF Trajectory Tracking>."
More episodes
- 2608.13438-ContactGuard: Pre-Contact Execution Monitoring with Action-Conditioned Latent World Models
- 2610.34593-Future Prediction as Training-Only Video Supervision for Pretrained VLA Policies
- 2610.35385-EmbodiedLab: Beyond Manipulation, Benchmarking Embodied Agents That Act to Know
- 2610.36378-Data-Driven Hamiltonian for Neural Optimal Control
- 2610.37275-A Heuristic for Scheduling Autonomous Vehicles at Intersections
- 2610.37288-Dynamic Coordination of Autonomous Vehicles at Intersections
- 2610.37632-Real-Time Coordination of Autonomous Vehicles at Intersections
- 2611.13779-Softness is something you also need! Why compliance helps control: information metrics of a passive walker with compliant ankle
- 2611.13411-Residual-Corrected Physics-Informed Neural Network KKL Observers with Input-to-State Stability Guarantees
- 2611.14488-Is Your Robot's Memory Just a Clock? Temporal Shortcuts in Memory-Augmented VLA Policies