https://9lib.org/document/ky6vnogq-pseudospectral-optimal-train-control.html