Added .csv output for rotation matrices. More output during simulation