add disturbance code
fixed disturbance
add rotation disturbance.
Merge pull request #6 from fabianhu/sim-create-disturbances

Sim create disturbances