firmware: Add I2C scheduler

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