fn init_mpu6050(
    i2c: I2cProxy<'static, AtomicCheckMutex<I2c1>>,
    delay: &mut Delay
) -> Result<Mpu6050<I2cProxy<'static, AtomicCheckMutex<I2c1>>>, Mpu6050Error<Error>>