firmware: Get I2C and SHT21 working

Signed-off-by: Maxim Osipov <maxim.osipov@gmail.com>