Resolves failing IMU unit test. 

```Matlab
<matlab_test>strcmp(test_name,'systems/plants/test/testRigidBodyInertialMeasurementUnit')</matlab_test>
```


Twan added some specific rng seeds to show the remaining part of the bug.