Fast numerical solution of optimal control problems for switched systems: An application to path planning | IEEE Conference Publication | IEEE Xplore