ATxMega128 i TWI - problemy... cd

[SP2GNB]

Witam,

Naprawdę myślałem, że sobie poradzę z przesiadką ze zwykłej Atmegi, ale nie wyszło...Chcę pisać i czytać 24c256 na początku na pierwszej stronie. Program zwisa podczas czytania na zakomentowanych liniach:

Kod:

int8_t TWI_read_data(uint8_t readAddr)
{
//    while ((TWIC_MASTER_STATUS & TWI_MASTER_BUSSTATE_gm) != TWI_MASTER_BUSSTATE_IDLE_gc)
        {
        }
    uint8_t adres = MEM_SLAVE_ADDRESS + 1;
    TWIC_MASTER_ADDR = adres;
    
    while(!(TWIC_MASTER_STATUS & TWI_MASTER_WIF_bm));

    TWIC_MASTER_DATA = 0x00;

    TWIC_MASTER_ADDR = readAddr;
//    while(!(TWIC_MASTER_STATUS & TWI_MASTER_RIF_bm));

    return TWIC_MASTER_DATA;
}

Nie wiem co jest źle, nie wiem jak to powinno wyglądać - pomóżcie...pse...