SE3 controller geometric uav Geometric Control of a Quadrotor UAV on SE(3) geometric controller github