Problem z obsługą TWI(I2C)...

[mariuqs]

Drodzy koledzy...
Chciałbym się was poradzić.
Mam problem z obsługa modu TWI(I2C) w mikrokontrolerze Atmega16

Oto program:

ldi R16, (1<<TWPS0)
out TWSR, r16

ldi R16, 8
out TWBR, r16 ;czestotliwosc SCL



I2C_zapis1:

ldi r16, (1<<TWEN) | (1<<TWSTA) | (1<<TWINT)
out TWCR, r16

I2C_zapis1_start:
in r16, TWCR
sbrs R16, TWINT
rjmp I2C_zapis1_start

lds r16, (55<<1)+0
out TWDR, r16

ldi r16, (1<<TWEN) | (0<<TWSTA) | (1<<TWINT)
out TWCR, r16

I2C_zapis1_adres:
in r16, TWCR
sbrs R16, TWINT
rjmp I2C_zapis1_adres


out TWDR, 0xff ;przykladowe slowo do zapisu na magistrale

ldi r16, (1<<TWEN) | (1<<TWINT)
out TWCR, r16

I2C_zapis1_slowo:
in r16, TWCR
sbrs R16, TWINT
rjmp I2C_zapis1_slowo


ldi r16, (1<<TWEN) | (1<<TWSTO) | (1<<TWINT)
out TWCR, r16

I2C_zapis1_stop:
in r16, TWCR
sbrs R16, TWINT
rjmp I2C_zapis1_stop


;;;Prosze o pomoc i wskazanie bledow...
;;;Z gory dziekuje z pomoc