diff options
-rw-r--r-- | drivers/i2c/busses/i2c-designware.c | 10 |
1 files changed, 7 insertions, 3 deletions
diff --git a/drivers/i2c/busses/i2c-designware.c b/drivers/i2c/busses/i2c-designware.c index e8e2212d576e..c3702a8647cb 100644 --- a/drivers/i2c/busses/i2c-designware.c +++ b/drivers/i2c/busses/i2c-designware.c | |||
@@ -360,8 +360,7 @@ i2c_dw_xfer_msg(struct dw_i2c_dev *dev) | |||
360 | { | 360 | { |
361 | struct i2c_msg *msgs = dev->msgs; | 361 | struct i2c_msg *msgs = dev->msgs; |
362 | u32 intr_mask; | 362 | u32 intr_mask; |
363 | int tx_limit = dev->tx_fifo_depth - readl(dev->base + DW_IC_TXFLR); | 363 | int tx_limit, rx_limit; |
364 | int rx_limit = dev->rx_fifo_depth - readl(dev->base + DW_IC_RXFLR); | ||
365 | u32 addr = msgs[dev->msg_write_idx].addr; | 364 | u32 addr = msgs[dev->msg_write_idx].addr; |
366 | u32 buf_len = dev->tx_buf_len; | 365 | u32 buf_len = dev->tx_buf_len; |
367 | u8 *buf = dev->tx_buf;; | 366 | u8 *buf = dev->tx_buf;; |
@@ -389,6 +388,9 @@ i2c_dw_xfer_msg(struct dw_i2c_dev *dev) | |||
389 | buf_len = msgs[dev->msg_write_idx].len; | 388 | buf_len = msgs[dev->msg_write_idx].len; |
390 | } | 389 | } |
391 | 390 | ||
391 | tx_limit = dev->tx_fifo_depth - readl(dev->base + DW_IC_TXFLR); | ||
392 | rx_limit = dev->rx_fifo_depth - readl(dev->base + DW_IC_RXFLR); | ||
393 | |||
392 | while (buf_len > 0 && tx_limit > 0 && rx_limit > 0) { | 394 | while (buf_len > 0 && tx_limit > 0 && rx_limit > 0) { |
393 | if (msgs[dev->msg_write_idx].flags & I2C_M_RD) { | 395 | if (msgs[dev->msg_write_idx].flags & I2C_M_RD) { |
394 | writel(0x100, dev->base + DW_IC_DATA_CMD); | 396 | writel(0x100, dev->base + DW_IC_DATA_CMD); |
@@ -418,7 +420,7 @@ i2c_dw_read(struct dw_i2c_dev *dev) | |||
418 | { | 420 | { |
419 | struct i2c_msg *msgs = dev->msgs; | 421 | struct i2c_msg *msgs = dev->msgs; |
420 | u32 addr = msgs[dev->msg_read_idx].addr; | 422 | u32 addr = msgs[dev->msg_read_idx].addr; |
421 | int rx_valid = readl(dev->base + DW_IC_RXFLR); | 423 | int rx_valid; |
422 | 424 | ||
423 | for (; dev->msg_read_idx < dev->msgs_num; dev->msg_read_idx++) { | 425 | for (; dev->msg_read_idx < dev->msgs_num; dev->msg_read_idx++) { |
424 | u32 len; | 426 | u32 len; |
@@ -439,6 +441,8 @@ i2c_dw_read(struct dw_i2c_dev *dev) | |||
439 | buf = dev->rx_buf; | 441 | buf = dev->rx_buf; |
440 | } | 442 | } |
441 | 443 | ||
444 | rx_valid = readl(dev->base + DW_IC_RXFLR); | ||
445 | |||
442 | for (; len > 0 && rx_valid > 0; len--, rx_valid--) | 446 | for (; len > 0 && rx_valid > 0; len--, rx_valid--) |
443 | *buf++ = readl(dev->base + DW_IC_DATA_CMD); | 447 | *buf++ = readl(dev->base + DW_IC_DATA_CMD); |
444 | 448 | ||