Removed filter from yaw.
Lesson learned: Don't filter circular coordinate systems.