Fixed bearing observation not being wrapped to pi