MPU-6050 driver working, 

RTI @ 1 kHz, various changes and improvements.