Code rewite to separate pure MPU6050 library from main()