Writing the output trajectory to file
Merge branch 'master' into LieAlgebraTest

* master:
  Writing the output trajectory to file