PositionEstimator: accelerometer bias estimation, some refactoring