Multimodal modeling and uncertainty quantification for robot planning and decision making