Precise trajectory optimization for articulated wheeled vehicles in cluttered environments. (February 2016)