Added ros hydro navigation source
Implemented replanning without sudden stops