Adapt MPU6050 lib from Arduino to Chipkit