https://9lib.org/document/qmj851wq-onboard-trajectory-generation-vehicles-adaptive-multivariate-pseudospectral-interpolation.html