A Multimodal Stochastic Planning Approach for Navigation and Multi-Robot Coordination