Simultaneous localization, mapping, and path planning for unmanned vehicle using optimal control. (January 2018)