Move Pauls EKF into a class and instantiate only when / if needed. 

Checking for low memory conditions as we should. I'm piping this right now through HIL to ensure it behaves - this fix is pretty critical to free RAM on FMUv1.