calculates cage CoMs on each step
cleanup
changed output file name
changed output file name
writes file incrementally
fixed conflict