It's just the Rviz "measure tool" but with visualizations for the X, Y, and Z component of the selected vector.
Improvements welcome.
If you have ROS Kinetic+ and Rviz, you should just be able to clone and build.
Like the default measurement tool, but with X, Y, and Z distances as well.
C++