https://gitee.com/lanqx/Efficient-Trajectory-Optimization-for-Robot-Motion-Planning--Examples.git