Added HW I2C support (sensor port 5)