非线性规划

复现经典论文 Direct Trajectory Optimization Using Nonlinear Programming and Collocation：实现三次 Hermite 状态插值、控制线性插值、中心点配点缺陷，并用 brachistochrone 解析解验证数值收敛。