ZJU-FAST-Lab / GCOPTER C++ 1.3K 218 A General-Purpose Trajectory Optimizer for Multicopters quadrotor trajectory-optimization motion-planning navigation