In your example, you set the ` T orientationNoise = 0.025;`, but the OrientationMeasurement's covariance is onsistent with $N\left(0,0.05^2\right)$