Got rid of redundant transactions
Revisited self-test
We need to stop MPU9250's driver from reseting the whole device!