[Firmware] added I2C and MPU-6050 drivers
-Added a driver for the I2C bus, accessible on the digital extension connector. -Added a driver for the MPU-6050, an IMU on the I2C bus.