Safe and risk-aware trajectory planning under Gaussian Mixture Model environmental uncertainty