Reducing Program Size with the MPU-6050

mschindl:
I am using the library by I2CDev

This one? https://github.com/jrowberg/i2cdevlib/tree/master/Arduino/MPU6050

Would it have been so hard to post a link? When you're asking for help it's a good idea to make it as easy as possible for the people offering free assistance.