Jak rozwiązać problem z nieskończoną pętlą I2C na ATMega?

void i2c_init(void)
{
  TWSR = 0;                         //brak preskalera
  TWBR = ((F_CPU/SCL_CLOCK)-16)/2;
}

unsigned char i2c_start(unsigned char address)
{
    uint8_t   twst;
	//START
	TWCR = (1<<TWINT) | (1<<TWSTA) | (1<<TWEN);
	// czekaj na zakonczenie transmisji
	while(!(TWCR & (1<<TWINT)));  <----TUTAJ WCHODZI W PĘTLĘ

	twst = TW_STATUS & 0xF8;
	//wystapil blad, zwroc 1
	if ( (twst != TW_START) && (twst != TW_REP_START)) {return 1;}
	// wyslij adres urzadzenia
	TWDR = address;
	TWCR = (1<<TWINT) | (1<<TWEN);

	while(!(TWCR & (1<<TWINT)));

	twst = TW_STATUS & 0xF8;

	if ( (twst != TW_MT_SLA_ACK) && (twst != TW_MR_SLA_ACK) ){return 1;}

	return 0;
}

sei();
TWAR=address;
TWCR = (1<<TWEN) | (1<<TWEA) | (1<<TWIE);

char rec='0';

SIGNAL(SIG_2WIRE_SERIAL)
{
 rec=TWDR;
 TWCR = (1<<TWINT);
}

i2c_START:
ldi R16, 0b10100100		//(1<<TWINT)|(1<<TWSTA)|(1<<TWEN) 
sts TWCR,R16            ; envoi condition de start sur le bus

ldi R16,0b10000100		// zeruje komendę start
sts TWCR,R16

rcall i2c_WAIT
ret

i2c_WAIT:                  ; Attente extinction de twint (twint a 1 voir doc)
lds R16,TWCR              ; et si ack ou nack 
sbrs R16,TWINT           ;
rjmp i2c_WAIT
ret

• Bit 5 – TWSTA: TWI START Condition Bit
The application writes the TWSTA bit to one when it desires to become a master on the
Two-wire Serial Bus. The TWI hardware checks if the bus is available, and generates a
START condition on the bus if it is free. However, if the bus is not free, the TWI waits
until a STOP condition is detected, and then generates a new START condition to claim the bus Master status. TWSTA must be cleared by software when the START condition
has been transmitted.

int main(void)
{
 sei();
 TWSR = 0;
 TWBR = ((F_CPU/SCL_CLOCK)-16)/2;
 while(1)
 {
  TWCR = 0b10100100; //(1<<TWSTA) | (1<<TWEN) | (1<<TWINT);
  TWCR = 0b10000100;
  while( !(TWCR & (1<<TWINT)) );
  TWDR=address & 0xFE;
  TWCR = (1<<TWINT) | (1<<TWEN);
  while( !(TWCR & (1<<TWINT)) );
  TWDR='X';
  TWCR = (1<<TWINT) | (1<<TWEN);
  while( !(TWCR & (1<<TWINT)) );
  TWCR = (1<<TWSTO) | (1<<TWEN) | (1<<TWINT);
 }
}

char rec='0';

SIGNAL(SIG_2WIRE_SERIAL)
{
  status=TWSR & 0xF8;

  switch(status)
  {
	case TW_SR_SLA_ACK:	  	 	
	case TW_SR_ARB_LOST_SLA_ACK:		
	case TW_SR_GCALL_ACK:				
	case TW_SR_ARB_LOST_GCALL_ACK:				
 	
		TWCR = (1<<TWINT) | (1<<TWEA)| (1<<TWIE) | (1<<TWEN);   	
		break;
	case TW_SR_DATA_ACK:		  		
	case TW_SR_GCALL_DATA_ACK:			
      	rec = TWDR;	 
	USART_Transmit(rec); 
	TWCR = (1<<TWINT) | (1<<TWEA)| (1<<TWIE) | (1<<TWEN);
		break;
	case TW_SR_DATA_NACK:	   		
	case TW_SR_GCALL_DATA_NACK:			
	TWCR = (1<<TWINT) | (1<<TWIE) | (1<<TWEN);
		break;
	case TW_SR_STOP:		
	TWCR = (1<<TWINT) | (1<<TWEA) | (1<<TWIE) | (1<<TWEN);
		break;
  }
}

int main(void)
{
 sei();
 TWAR=4;
 TWCR=(1<<TWEA) | (1<<TWEN) | (1<<TWIE);
 while(1)
 {
 }
}