Save csv joint trajectory in TEO format