using the modes
broke out kalman filter into library, some cleanup and reconnecting in
the RocketMega code, still not ready for use