Adding mutex and condition to mpu9250 thread

Created by: mcdeoliveira

James, it's becoming harder to track your changes. Please consider merging the additional mutex and condition to your repository. Thank you,

Mauricio