Madgwick AHRS: Fix 64bit compatibility for invSqrt