i2c: omap: make reset a seperate function
Implement reset as a separate function. This will enable us to make sure that we don't do the calculation again on every transfer. Also at probe the reset is not added as the hwmod is doing that for us. Reviewed-by: Felipe Balbi <balbi@ti.com> Signed-off-by: Shubhrajyoti D <shubhrajyoti@ti.com> Signed-off-by: Wolfram Sang <w.sang@pengutronix.de>
This commit is contained in:
parent
95dd303266
commit
d6c842ad56
1 changed files with 24 additions and 15 deletions
|
@ -302,15 +302,9 @@ static void __omap_i2c_init(struct omap_i2c_dev *dev)
|
|||
omap_i2c_write_reg(dev, OMAP_I2C_IE_REG, dev->iestate);
|
||||
}
|
||||
|
||||
static int omap_i2c_init(struct omap_i2c_dev *dev)
|
||||
static int omap_i2c_reset(struct omap_i2c_dev *dev)
|
||||
{
|
||||
u16 psc = 0, scll = 0, sclh = 0;
|
||||
u16 fsscll = 0, fssclh = 0, hsscll = 0, hssclh = 0;
|
||||
unsigned long fclk_rate = 12000000;
|
||||
unsigned long timeout;
|
||||
unsigned long internal_clk = 0;
|
||||
struct clk *fclk;
|
||||
|
||||
if (dev->rev >= OMAP_I2C_OMAP1_REV_2) {
|
||||
/* Disable I2C controller before soft reset */
|
||||
omap_i2c_write_reg(dev, OMAP_I2C_CON_REG,
|
||||
|
@ -348,14 +342,27 @@ static int omap_i2c_init(struct omap_i2c_dev *dev)
|
|||
|
||||
omap_i2c_write_reg(dev, OMAP_I2C_SYSC_REG,
|
||||
dev->syscstate);
|
||||
/*
|
||||
* Enabling all wakup sources to stop I2C freezing on
|
||||
* WFI instruction.
|
||||
* REVISIT: Some wkup sources might not be needed.
|
||||
*/
|
||||
dev->westate = OMAP_I2C_WE_ALL;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int omap_i2c_init(struct omap_i2c_dev *dev)
|
||||
{
|
||||
u16 psc = 0, scll = 0, sclh = 0;
|
||||
u16 fsscll = 0, fssclh = 0, hsscll = 0, hssclh = 0;
|
||||
unsigned long fclk_rate = 12000000;
|
||||
unsigned long internal_clk = 0;
|
||||
struct clk *fclk;
|
||||
|
||||
if (dev->rev >= OMAP_I2C_REV_ON_3430_3530) {
|
||||
/*
|
||||
* Enabling all wakup sources to stop I2C freezing on
|
||||
* WFI instruction.
|
||||
* REVISIT: Some wkup sources might not be needed.
|
||||
*/
|
||||
dev->westate = OMAP_I2C_WE_ALL;
|
||||
}
|
||||
|
||||
if (dev->flags & OMAP_I2C_FLAG_ALWAYS_ARMXOR_CLK) {
|
||||
/*
|
||||
|
@ -599,7 +606,8 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
|
|||
OMAP_I2C_TIMEOUT);
|
||||
if (timeout == 0) {
|
||||
dev_err(dev->dev, "controller timed out\n");
|
||||
omap_i2c_init(dev);
|
||||
omap_i2c_reset(dev);
|
||||
__omap_i2c_init(dev);
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
|
@ -609,7 +617,8 @@ static int omap_i2c_xfer_msg(struct i2c_adapter *adap,
|
|||
/* We have an error */
|
||||
if (dev->cmd_err & (OMAP_I2C_STAT_AL | OMAP_I2C_STAT_ROVR |
|
||||
OMAP_I2C_STAT_XUDF)) {
|
||||
omap_i2c_init(dev);
|
||||
omap_i2c_reset(dev);
|
||||
__omap_i2c_init(dev);
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in a new issue