Developing Combinatorial Optimization And Data-Driven Methods For Multi-Modal Motion Planning