Added dumper for position, velocities and accelerations needed for CoDyCo demo