i2c: designware: Get right data length

[linux-2.6-microblaze.git] / drivers / i2c / busses / i2c-designware-master.c

diff --git a/drivers/i2c/busses/i2c-designware-master.c b/drivers/i2c/busses/i2c-designware-master.c
index d6425ad..dd27b9d 100644 (file)
--- a/drivers/i2c/busses/i2c-designware-master.c
+++ b/drivers/i2c/busses/i2c-designware-master.c
@@ -432,7 +432,7 @@ i2c_dw_read(struct dw_i2c_dev *dev)
                        regmap_read(dev->map, DW_IC_DATA_CMD, &tmp);
                        /* Ensure length byte is a valid value */
                        if (flags & I2C_M_RECV_LEN &&
-                           tmp <= I2C_SMBUS_BLOCK_MAX && tmp > 0) {
+                           (tmp & DW_IC_DATA_CMD_DAT) <= I2C_SMBUS_BLOCK_MAX && tmp > 0) {
                                len = i2c_dw_recv_len(dev, tmp);
                        }
                        *buf++ = tmp;