Софтовый I2C. Проблема Опции

[Blew_zc]

Возникла трабла с реализацией софтового I2C на чипе LPC2919 старой ревизии, что не поддерживает аппаратный I2C.
Девайс - магнитный компас HMC5843.
Кое-что получилось - точнее получить ID устройства, и оно корректное.
А вот чтение регистров осей выдает 255. При этом аппаратный TWI, заюзанный в Атмеле, выдает корректные значения.
Может я что проглядел при чтении спецификации? Кому не влом, посмотрите код...

http://www.everfall.com/paste/id.php?xpg3ml1jrw2h

Или киньте в меня уже готовым, 100% рабочим. Потому как то что я видел в сети что-то мне не внушает доверия...