[2306.07107] A novel trajectory optimization algorithm for continuous-time model predictive control