Added magnetometer to KalmanGyro classes ; rewrote #ifdef's to allow usage of multiple IMU configs