Update inv_mpu.c

Fix bug in invenses library