Twi в SAM7s128, он же I2C Опции

[Nikitoc]

Всем доброго времени суток! Я понимаю, что тема избитая, но перечитав с дюжину веток на этом и других форумах, я решения так и не нашел. Надеюсь на понимание уважаемых форумчан. Собственно не могу добиться хотя бы изменения состояния на линиях TWD и TWCK у at91sam7128. Привожу кусок кода который использую для инициализации интерфейса:

/* Function of definition I2C */
void I2C_INIT () {
pPIO -> PIO_PDR = pPIO -> PIO_PDR | 0x18; // disable PA3 PA4 I/O for using by I2C
pPIO -> PIO_PPUDR = 0xFFFFFFE7; // Отключаю pull-up резисторы везде кроме 3 и 4 линий
pPIO -> PIO_ASR = pPIO -> PIO_ASR | 0x18; // наверное необязательно, но указываю что линии 3 и 4 - это периферия А
pPIO -> PIO_MDER = pPIO -> PIO_MDER | 0x18; // линии 3 и 4 с открытым стоком
pP_M_C -> PMC_PCER = pP_M_C -> PMC_PCER | 0x200; // clock enable I2C
AT91C_BASE_TWI -> TWI_CR = AT91C_TWI_SWRST; // программный сброс
AT91C_BASE_TWI -> TWI_CWGR = 0x8383; // частота ~200kHz
AT91C_BASE_TWI -> TWI_MMR = AT91C_TWI_IADRSZ_1_BYTE | ((unsigned int) 0x42 << 16); // adress and size of internal adress
}
/********************************************************/

записи:

/********************************************************/
void I2C_WR (int intadress) {
int status;
AT91C_BASE_TWI -> TWI_IADR = intadress;
AT91C_BASE_TWI -> TWI_MMR &= 0xFFFFEFFF;
AT91C_BASE_TWI -> TWI_CR = AT91C_TWI_START | AT91C_TWI_MSEN | AT91C_TWI_STOP;


//* Set Data register for start transmission
AT91C_BASE_TWI -> TWI_THR = 0xAA; // !!!!!!!!! Здесь ничего не происходит!!!! Содержимое регистра THR и TXDATA не изменяются

status = AT91C_BASE_TWI -> TWI_THR; //..чтение этого регистра дает 0x00 !!!!
//* Wait end transmission
status = AT91C_BASE_TWI -> TWI_SR;
while (!(status & AT91C_TWI_TXCOMP)) {
status = AT91C_BASE_TWI -> TWI_SR;
}
}
///////////////////////////////////////////////////////////////////////////////
Если честно перепробовал кучу вариантов реализации, с учетом рекомендаций Atmel (на их сайте), уже голова кругом. Подскажите, где я делаю что-то неправильно?

[Nikitoc]

Всем огромное спасибо за участие и дельные советы. Помучившись чуток я написал свой софтверный I2C специально под удивительную видеокамеру ov7670 (там создатели назвали I2C интерфейс странным словом SCCB ) Конечно, лучше всегда иметь под рукой универсальную библиотеку TWI, но так оказалось быстрее. Тему, думаю, можно считать закрытой. Еще раз всем спасибо.
2 Sergey_K: обязательно попробую Ваш вариант инициализации.