summaryrefslogtreecommitdiff
path: root/target/linux/cns3xxx/patches-3.3/440-i2c_retry.patch
blob: 707de82bab55ae43237d581cc4f3766121cd203e (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
--- a/drivers/i2c/busses/i2c-cns3xxx.c
+++ b/drivers/i2c/busses/i2c-cns3xxx.c
@@ -2,8 +2,9 @@
  * Cavium CNS3xxx I2C Host Controller
  *
  * Copyright 2010 Cavium Network
- * Copyright 2011 Gateworks Corporation
+ * Copyright 2012 Gateworks Corporation
  *		  Chris Lang <clang@gateworks.com>
+ *        Tim Harvey <tharvey@gateworks.com>
  *
  * This file is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License, Version 2, as
@@ -63,13 +64,15 @@
 #define STATE_ERROR		2
 
 struct cns3xxx_i2c {
-	void __iomem *base;
-	wait_queue_head_t wait;
-	struct i2c_adapter adap;
-	struct i2c_msg *msg;
-	int state;		/* see STATE_ */
-	int rd_wr_len;
-	u8 *buf;
+	struct device		*dev;
+	void __iomem		*base;		/* virtual */
+	wait_queue_head_t	wait;
+	struct i2c_adapter	adap;
+	struct i2c_msg		*msg;
+	u8			state;		/* see STATE_ */
+	u8			error;		/* see TWI_STATUS register */
+	int			rd_wr_len;
+	u8			*buf;
 };
 
 static u32 cns3xxx_i2c_func(struct i2c_adapter *adap)
@@ -150,14 +153,18 @@ cns3xxx_i2c_xfer_msg(struct i2c_adapter
 
 		// Start the Transfer
 		i2c->state = 0;		// Clear out the State
+		i2c->error = 0;
 		I2C_CONTROLLER_REG |= (1 << 6);
 
 		if (wait_event_timeout(i2c->wait, (i2c->state == STATE_ERROR) ||
 				(i2c->state == STATE_DONE), TWI_TIMEOUT)) {
 			if (i2c->state == STATE_ERROR) {
-				return -EIO;
+				dev_dbg(i2c->dev, "controller error: 0x%2x", i2c->error);
+				return -EAGAIN; // try again
 			}
 		} else {
+			dev_err(i2c->dev, "controller timed out "
+				"waiting for start condition to finish\n");
 			return -ETIMEDOUT;
 		}
 	}
@@ -238,6 +245,7 @@ static irqreturn_t cns3xxx_i2c_isr(int i
 
 	if (stat & I2C_BUS_ERROR_FLAG) {
 		i2c->state = STATE_ERROR;
+		i2c->error = (I2C_INTERRUPT_STATUS_REG & 0xff00)>>8;
 	} else {
 		if (i2c->msg->flags & I2C_M_RD) {
 			for (i = 0; i <= i2c->rd_wr_len; i++)
@@ -280,6 +288,7 @@ static int __devinit cns3xxx_i2c_probe(s
 		goto request_mem_failed;
 	}
 
+	i2c->dev = &pdev->dev;
 	i2c->base = ioremap(res->start, res->end - res->start + 1);
 	if (!i2c->base) {
 		dev_err(&pdev->dev, "Unable to map registers\n");