twi: Update, 95% functional master code