A Multiresolution Approach for Statistical Mobility Prediction of Unmanned Ground Vehicles

1. A Multiresolution Approach for Statistical Mobility Prediction of Unmanned Ground Vehicles 44th Annual Technical Meeting of the Society of Engineering Science

2. Objective • Unmanned Ground Systems often operate with some degree of uncertainty. • Poorly known parameters • variation in suspension stiffness and damping characteristics • Uncertain inputs • Rough terrain, soil properties in vehicle-terrain interaction. • For realistic predictions of the system behavior and performance dynamic models must account for these uncertainties. • Given the uncertain nature of the terrain and the parameters of the vehicle, predict the ability of the vehicle to negotiate a terrain while satisfying certain performance metrics. • Main Challenge: propagation of high dimensional uncertainty through a nonlinear dynamic system.

3. Uncertainty Propagation: Continuous System

4. Not preferred for highly nonlinear systems and long time durations of propagation • All the above methods provide an approximate description of the uncertainty propagation problem The Fokker-Planck equation (FPE) provides the exact description of the uncertainty propagation problem under white-noise excitation White-noise excitation Uncertainty Propagation: Continuous System • Approximate methods for uncertainty propagation: • Monte Carlo:Computationally heavy esp. in high dimensions • Gaussian Closure, Higher order closures • Statistical linearization, Stochastic averaging

5. (1) (2) (Fokker-Planck operator) (Drift Vector) (Diffusion Matrix) Uncertainty Propagation: Continuous System • System dynamics: • The following linear PDE, called the Fokker-Planck equation describes the time evolution of for the system given by (1):

6. Probability Density Function Approximation • Let us assume that underlying pdf can be approximated by a finite sum of Gaussian pdfs. • Question is how to find unknown parameters of this Gaussian Sum Mixture?

7. Uncertainty Propagation: Continuous System EKF Now, update the weights of Gaussian Sum Mixture such that FPK equation error is minimized.

8. Solving Fokker-Planck Equation Fokker Planck Equation Error: Minimize: Subject to Necessary Conditions:

9. Solving Fokker-Planck Equation Let us assume: We have designed a mean to update the weights of Gaussian Mixture Model to capture non-Gaussian behavior.

10. Uncertainty Propagation: Black-Box Model For most of practical applications, it is difficult to describe the system by a set of ODE.

11. Stochastic GLO-MAP • Basic Idea: express the output as a function of input random variables. • Specially designed weight functions gives us the freedom to choose independent local approximations. • Local models Yi can be chosen judiciously to reduce computational burden. • Gaussian Hermite Polynomials. • Uniform  Legendre Polynomials.

12. Stochastic GLO-MAP Arbitrary Local Approximations There is a choice of weighting function that will guarantee piecewise global continuity while leaving freedom to fit local data by any desired local functions.

13. Stochastic GLO-MAP

14. Half-Car Suspension Model Y L2 L1 c6 c3 k3 k6 m2 y y6 y3 m1 c5 Uneven Terrain k5 c2 y5 k2 y2 y1(x), y4(x) y4 y1 X

15. Validating Key Ideas

16. Validating Key Ideas

17. Monte Carlo Simulations • Input Parameters • Terrain Constants, Mass(M), Inertia(I) • Stiffness(k) and Damping(c) Constants • Performance Metrics • Maximum bounce of the wheels • Maximum attitude angle • RMS value of the wheel vertical velocities

18. Monte Carlo Simulations True State Histogram with 10000 Monte Carlo Simulations

19. Monte Carlo Simulations Estimated State Histogram (from model using 3000 Monte Carlo)

20. Monte Carlo Simulations Estimated State Histogram (from model using 5000 Monte Carlo)

21. Conclusions • A robust uncertainty propagation method has been developed for UGV mobility prediction. • Can qualitatively capture the dynamics for multiple attractor states. • Allows an accurate treatment of nonlinear dynamics and of non-Gaussian probability densities. • Does not rely on the assumption that uncertainties are small. • more efficient than sequential Monte-Carlo methods. • Finally, the simulation results presented in this paper merely illustrate usefulness of the uncertainty propagation algorithm. • further testing would be required to reach any conclusions about the efficacy of the mobility prediction algorithm.