Added fast inverse square root and also improved MPU-9150 startup