Simultaneous dynamic optimization: A trajectory planning method for nonholonomic car-like robots. (September 2015)