X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fdrv%2Flm75.c;h=5d24e0ae520224b348727e016982d0d1b7a2e64d;hb=8d34c3b835bcdf6f01d3c15631abc62a713608fd;hp=db8f8a9420c04755668c35bb07eb988cb604e556;hpb=3d4ba0662613c7dcbaaaba7a26f84fe9b848d808;p=bertos.git

diff --git a/bertos/drv/lm75.c b/bertos/drv/lm75.c
index db8f8a94..5d24e0ae 100644
--- a/bertos/drv/lm75.c
+++ b/bertos/drv/lm75.c
@@ -62,10 +62,20 @@ deg_t lm75_read(uint8_t sens_addr)
 	int16_t degree;
 	int16_t deci_degree;
 
-	i2c_start_w(SELECT_ADDRESS(sens_addr));
-	i2c_put(LM75_PAD_BYTE);
-	i2c_start_r(SELECT_ADDRESS(sens_addr));
-	i2c_recv(data, sizeof(data));
+	if( !(i2c_start_w(SELECT_ADDRESS(sens_addr))
+		&& i2c_put(LM75_PAD_BYTE)
+		&& i2c_start_r(SELECT_ADDRESS(sens_addr))) )
+	{
+		i2c_stop();
+		return EOF;
+	}
+
+	if ( !i2c_recv(data, sizeof(data)) )
+	{
+		i2c_stop();
+		return EOF;
+	}
+	i2c_stop();
 
 	degree = (int16_t)data[0];
 	deci_degree = (int16_t)(((data[1] >> 7) & 1 ) * 5);