AP_HAL_PX4 I2CDriver - Reverting the I2CDriver code will create a driver in PX4Firmware