Development Of A Model Predictive Controller For Motion Planning In A Dynamic Urban Search And Rescue Environment