increased PF update rate and set initial covariance angle to pi^2