Started implementing interfaces for yarp of Cartesian tasks