PositionEastimator: bug fixed