https://9lib.net/document/y8grxkn0-trajectory-control-quadrotor-using-control-allocation-approach.html