NEW: added testprogram for MPU-6050