math: Add pre-filter and a simple understandable 3-DoF fusion filter.