A Safety Planning and Control Architecture Applied to a Quadrotor Autopilot
Wenyu Zhang, Jindou Jia, Sicheng Zhou, Kexin Guo, Xiang Yu, Youmin Zhang
Abstract
This letter presents a safety trajectory planning and tracking architecture for a quadrotor autopilot. Motor saturation constraints are explicitly considered in obstacle avoidance mission. Two challenging cases are covered: agile flight with a short task time and stable flight with actuator degradation. By explicitly considering the real physical constraints, the proposed method can make better use of the quadrotor maneuverability. Specifically, from control aspect, a sliding mode observer (SMO) based safety controller is implemented on the autopilot. Subsequently, the actuator saturation problem is analyzed and modeled as axis-coupled constraints. The B-spline curve is used to deal with the constraints due to its convex hull property. As a result, the planning problem can be transformed into a quadratically constrained quadratic programming (QCQP) problem with the proposed minimum energy cost function. Experiments show that the resulting trajectories can yield improvements in tracking accuracy in comparison of conventional planning method.