High scientific value areas on celestial bodies such as the Moon and Mars are often located in hazardous terrains. To achieve safe landing exploration, a novel planning method is proposed, which can ensure that the planned trajectory maintains a user-specified distance from obstacles, thus reducing potential collision risk induced by factors such as the body size and model uncertainties. Firstly, the basic model of the trajectory optimization problem and its convexification version is given. The obstacles are modeled as polynomial functions, based on which the “if-then” obstacle avoidance logic explicitly considering the safe distance, is described as a sum of squares constraint. This constraint formulation applies to any obstacle described by a finite number of polynomials, independent of the specific expression of the polynomials (reflecting the shape of the obstacle). Subsequently, the convexification process for the obstacle avoidance constraint is given. Finally, the sequential sum of squares programming problem for the obstacle avoidance trajectory is established, which boils down to a series of semidefinite programming problems. Simulation results show that the closest distance between the planned trajectory and obstacles strictly satisfies the specified distance constraint, and the trajectory could avoid non-convex obstacles. With the promising convergence properties of underlying convex optimization algorithms, advanced autonomous obstacle avoidance guidance schemes are expected to be formed based on the proposed trajectory planning method.
Read full abstract