Time-optimal trajectory planning for tractor-trailer vehicles via simultaneous dynamic optimization
On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming