Minor fixes to urdf
Rolled back some navigation changes and update some parameters for hydro
URDF fixed and working completely, navigation somewhat tuned