Velocity of CP is saved to simdata. Disturbances in tests can be applied at different iterations.