https://123dok.net/document/z1d4k3ez-an-intermediary-quaternion-based-control-for-trajectory-following-using-a-quadrotor.html