[yarp] Rewrite yarp datastream to use class oriented datastream

Fix #276