Got convergence working with MPU initialization
Added visual indicators for calibration mode
Added custom initial offsets for MPU calibration