Hydra Topology Running unit tests: catkin build hydra_topology --catkin-make-args tests && rosrun hydra_topology utest_hydra_topology
