Working version of mocap_optitrack package for indigo - View it on GitHub