Rewrote MPU6050 library to support init/refresh format