fix i2c, main loop queue issues