Merge pull request #83 from RaresAmbrus/hydro_devel

Metric map ptu sweep now preemptable
accepting preemption during initial pose