Okay, in the meantime, I ended up creating a subscriber for the tof_pc and I managed to extract the x,y and z points. Im assuming that the z point that I extracted from the voxl_mpa_to_ros is the same as the one used in voxl-inspect-points, so that z axis is also reported in meters correct?
Thanks for you help so far.