Optimization based path planning for a two-body articulated vehicle | IEEE Conference Publication | IEEE Xplore