Use hypot() instead of sqrt(x*x, y*y), it's cleaner

https://github.com/ros-planning/navigation/pull/183 should be merged first