Stochastic trajectory optimization for 6-DOF spacecraft autonomous rendezvous and docking with nonlinear chance constraints

Abstract

This paper addresses the problem of stochastic trajectory planning for 6-DOF spacecraft close proximity in the presence of external disturbances and initial state uncertainties. Nonlinear chance constraints on collision avoidance, docking corridor, sensor field-of-view, and control magnitude are considered in the corresponding optimal control problem. Nominal trajectory along with affine feedback controller that restricts the dispersion caused by disturbances are optimized simultaneously. The nonlinear stochastic dynamics are transformed into equality constraints on the first two statistical moments of the random states by linearization and discretization, and further, the non-convex covariance update equation is relaxed to a semidefinite cone constraint. The nonlinear path chance constraints are first approximated by affine chance formations, and then are convexified by introducing auxiliary variables instead of direct linearization of the covariance matrix. Combined with the tail bound of sub-exponential random variables, the constraints on control input are replaced with conservative deterministic inequalities. The sub-optimal solution to the original problem is obtained by iteratively solving a series of semidefinite cone programs. The effectiveness of the proposed framework is verified using numerical simulations.