Overhaul

This fixes the balltrack module issue of overcomputing, we now only have two kalman filters and choose the appropriate one based on the filtered velocity. seems fairly responsive.