По pseudo TWI пример очень хилый. Так только начало. Как заправить драйвер, а дальше ничего. Ну отправли я команду, а как принять ответ? Ведь в TWI нужно продолжать клок, чтобы получить ответ. А откуда драйвер знает какой длины ответ? И т.д. и т.п. Срисовать надо для начала.