Automatically reconfigure MPU6050 when data is null
Improved servo library configuration flexibility