Safety is crucial for quadrotor flight, especially when the system suffers one rotor loss and disturbance. To enable quadrotors to survive in these worst cases, this paper proposes a Simultaneous Planning And Execution (SPAE) system strategy. First, the Euler angles under different equilibrium states are solved to ensure the feasibility of the control input when the quadrotors encounters rotor loss and disturbance. Based on the admissible Euler angle solutions, an emergency control strategy is proposed to realize desired angles by recalculating the desired trajectory and the disturbance observer. Meanwhile, this control strategy sacrifices the yaw angle control to handle further underactuation of the system caused by complete rotor failure. In addition to rotor losses, unsafe flight caused by actuator saturation is considered in the SPAE strategy where the planning and execution are simultaneous. As a decision maker, the planning considers the current disturbances and constraints of actuators, then generates a feasible trajectory for controller execution. As an executor of the decision, the controller feedback estimated disturbance information to the trajectory planning, which can help trajectory planning make admissible decisions consistent with the current situation. As a result, the actuator saturation caused by the underestimation of disturbance can be avoided under a feasible regenerated trajectory. Extensive simulations and experiments prove the validity of the proposed SPAE strategy.
Read full abstract