- finally fixed simulation bounds issues in tests, fixed a PathStateBelief covariance projection bug