Modified HW I2C support (sensor port 5)