Robust Motion Planning With Accuracy Optimization Based on Learned Sensitivity Metrics

Simon Wasiela, Marco Cognetti, Paolo Robuffo Giordano, Juan Cortés, Thierry SiméonIEEE RA-L 2024 · DOI

In real-world robotics, mathematical models are rarely perfect. Whether it's a quadrotor carrying an unknown payload or a manipulator with slightly offset inertial parameters, these uncertainties can lead to catastrophic failures if not properly accounted for during motion planning. Standard planners often rely on "nominal" paths that assume perfect model knowledge, which can result in collisions or task failure when the robot deviates from its intended trajectory.

This research, published in IEEE Robotics and Automation Letters, introduces RA-SAMP (Robust and Accurate Sensitivity-Aware Motion Planner), a framework that bridges the gap between safety and precision in the face of parametric uncertainty.

The Challenge of Uncertainty Tubes

A common approach to robust planning involves calculating "uncertainty tubes"—mathematical bounds that encompass all possible trajectories a robot might take given its model errors. However, traditional methods for computing these tubes are computationally expensive, requiring the solution of numerous coupled differential equations for every candidate path. This bottleneck often makes real-time robust planning unfeasible.

Visualization of an uncertainty tube for a quadrotor navigating through a narrow window. The tube represents the spatial bounds of potential trajectories under model uncertainty.

Methodology: The RA-SAMP Framework

The authors propose a two-stage framework that leverages deep learning to accelerate the planning process and optimization techniques to enhance task accuracy.

1. Learned Sensitivity Metrics

The core innovation lies in replacing slow numerical integration with a Gated Recurrent Unit (GRU) neural network. Because the uncertainty at any point in a trajectory depends on its history, the GRU's hidden state serves as a natural proxy for the accumulated sensitivity. This allows the network to predict uncertainty tube radii and required control inputs almost instantaneously.

The GRU-based architecture used to estimate sensitivity metrics. The recurrent structure allows the model to maintain a "memory" of trajectory history, significantly speeding up robustness checks.

2. Robust Planning (R-SAMP)

The GRU is integrated into a sampling-based planner (such as RRT*). By using the fast neural network estimates, the planner can ensure that the entire uncertainty tube—rather than just a single nominal line—is collision-free throughout the environment.

3. Accuracy Optimization (A-Optim)

Beyond mere safety, RA-SAMP optimizes for task-specific precision. Once a robust path is identified, the framework performs a local optimization that simultaneously adjusts the trajectory shape and the controller gains. This "shrinks" the uncertainty tube at critical waypoints, ensuring the robot is exactly where it needs to be for high-precision maneuvers, such as catching a ring mid-flight.

Key Results and Insights

The RA-SAMP framework was evaluated using a 3D quadrotor model with uncertainties in mass, center of mass, and moments of inertia.

  • Computational Efficiency: The GRU-based approach achieved a speedup of approximately 3x for standard RRT and over an order of magnitude for RRT*, where dense rewiring necessitates thousands of robustness checks.
  • Enhanced Robustness: In simulation tests involving narrow window navigation, the robust planner achieved a 100% success rate, compared to just 56.5% for a standard, non-robust RRT*.
  • Task Precision: In a challenging "ring catching" experiment, where a drone must pass a perch through a 2cm radius ring, the accuracy-optimized framework succeeded 90% of the time, a significant improvement over the 30% success rate of the non-optimized version.

Conclusion and Future Directions

RA-SAMP demonstrates that combining classical sensitivity analysis with modern recurrent neural networks can make robust motion planning both fast and effective. By optimizing controller gains alongside the path, the system achieves a level of precision previously difficult to reach under model uncertainty.

Future work aims to extend this approach to account for state estimation uncertainty (sensor noise) and external disturbances like wind. Additionally, the authors plan to explore learning optimal controller gains directly within the neural network architecture to further streamline the optimization process.

Summary updated

BibTeX
@article{wasiela2024robust,
  author = {Simon Wasiela and Marco Cognetti and Paolo Robuffo Giordano and Juan Cortés and Thierry Siméon},
  title = {{Robust Motion Planning With Accuracy Optimization Based on Learned Sensitivity Metrics}},
  journal = {IEEE RA-L},
  year = {2024},
  doi = {10.1109/lra.2024.3468149},
}
Figure