X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/rsbs2/blobdiff_plain/87f4338b452dea4fdebba3eac573bec999642eb9..4f3bb1187e9576afbc90f99d904633ca02d023e2:/bmc/i2c.c

diff --git a/bmc/i2c.c b/bmc/i2c.c
index f0816f0..d7bb951 100644
--- a/bmc/i2c.c
+++ b/bmc/i2c.c
@@ -78,10 +78,9 @@ out2:
 	TWCR = ((1<<TWINT) | (1<<TWEN) | (1<<TWSTO));
 	while(TWCR & (1<<TWSTO)) {}
 
-	TWCR = (1<<TWINT) | (1<<TWEN);
 out:	
-	TWCR = old_TWCR;
 	SREG = old_SREG;
+	TWCR = old_TWCR | (1<<TWINT);
 }
 
 ISR (TWI_vect, ISR_BLOCK)