Add node to print location.
Merge branch 'hydro-devel' of github.com:robotica-minor1/hector_quadrotor into hydro-devel