An optimal trajectory planning algorithm for autonomous trucks: Architecture, algorithm, and experiment. (8th April 2020)