Gazebo Plugin to get any 6D frame of a robot link and write it to a yarp-port, used with iCub. - View it on GitHub