Added gyro, accelerometer and heading services using I2C