i2c-mpc: Don't disable I2C module on stop condition
Disabling module on stop doesn't work on some CPUs (ie. mpc8241, as reported by Guennadi Liakhovetski), so remove that. Disable I2C module on errors/interrupts to prevent it from locking up on mpc5200b. Signed-off-by: Domen Puncer <domen.puncer@telargo.com> Acked-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de> Signed-off-by: Jean Delvare <khali@linux-fr.org>
This commit is contained in:
parent
432ca994bf
commit
5af0e07f87
1 changed files with 6 additions and 3 deletions
|
@ -105,6 +105,7 @@ static int i2c_wait(struct mpc_i2c *i2c, unsigned timeout, int writing)
|
|||
schedule();
|
||||
if (time_after(jiffies, orig_jiffies + timeout)) {
|
||||
pr_debug("I2C: timeout\n");
|
||||
writeccr(i2c, 0);
|
||||
result = -EIO;
|
||||
break;
|
||||
}
|
||||
|
@ -116,10 +117,12 @@ static int i2c_wait(struct mpc_i2c *i2c, unsigned timeout, int writing)
|
|||
result = wait_event_interruptible_timeout(i2c->queue,
|
||||
(i2c->interrupt & CSR_MIF), timeout * HZ);
|
||||
|
||||
if (unlikely(result < 0))
|
||||
if (unlikely(result < 0)) {
|
||||
pr_debug("I2C: wait interrupted\n");
|
||||
else if (unlikely(!(i2c->interrupt & CSR_MIF))) {
|
||||
writeccr(i2c, 0);
|
||||
} else if (unlikely(!(i2c->interrupt & CSR_MIF))) {
|
||||
pr_debug("I2C: wait timeout\n");
|
||||
writeccr(i2c, 0);
|
||||
result = -ETIMEDOUT;
|
||||
}
|
||||
|
||||
|
@ -172,7 +175,6 @@ static void mpc_i2c_start(struct mpc_i2c *i2c)
|
|||
static void mpc_i2c_stop(struct mpc_i2c *i2c)
|
||||
{
|
||||
writeccr(i2c, CCR_MEN);
|
||||
writeccr(i2c, 0);
|
||||
}
|
||||
|
||||
static int mpc_write(struct mpc_i2c *i2c, int target,
|
||||
|
@ -261,6 +263,7 @@ static int mpc_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num)
|
|||
while (readb(i2c->base + MPC_I2C_SR) & CSR_MBB) {
|
||||
if (signal_pending(current)) {
|
||||
pr_debug("I2C: Interrupted\n");
|
||||
writeccr(i2c, 0);
|
||||
return -EINTR;
|
||||
}
|
||||
if (time_after(jiffies, orig_jiffies + HZ)) {
|
||||
|
|
Loading…
Reference in a new issue