Arudino and reg config

Added read sensors and config for MPU6500
Edited MPU file