|
@@ -1,5 +1,5 @@
|
|
|
/*
|
|
|
- * Copyright (C) 2009 ST-Ericsson
|
|
|
+ * Copyright (C) 2009 ST-Ericsson SA
|
|
|
* Copyright (C) 2009 STMicroelectronics
|
|
|
*
|
|
|
* I2C master mode controller driver, used in Nomadik 8815
|
|
@@ -103,6 +103,9 @@
|
|
|
/* maximum threshold value */
|
|
|
#define MAX_I2C_FIFO_THRESHOLD 15
|
|
|
|
|
|
+/* per-transfer delay, required for the hardware to stabilize */
|
|
|
+#define I2C_DELAY 150
|
|
|
+
|
|
|
enum i2c_status {
|
|
|
I2C_NOP,
|
|
|
I2C_ON_GOING,
|
|
@@ -118,7 +121,7 @@ enum i2c_operation {
|
|
|
};
|
|
|
|
|
|
/* controller response timeout in ms */
|
|
|
-#define I2C_TIMEOUT_MS 500
|
|
|
+#define I2C_TIMEOUT_MS 2000
|
|
|
|
|
|
/**
|
|
|
* struct i2c_nmk_client - client specific data
|
|
@@ -250,6 +253,8 @@ static int init_hw(struct nmk_i2c_dev *dev)
|
|
|
{
|
|
|
int stat;
|
|
|
|
|
|
+ clk_enable(dev->clk);
|
|
|
+
|
|
|
stat = flush_i2c_fifo(dev);
|
|
|
if (stat)
|
|
|
return stat;
|
|
@@ -263,6 +268,9 @@ static int init_hw(struct nmk_i2c_dev *dev)
|
|
|
|
|
|
dev->cli.operation = I2C_NO_OPERATION;
|
|
|
|
|
|
+ clk_disable(dev->clk);
|
|
|
+
|
|
|
+ udelay(I2C_DELAY);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -431,7 +439,6 @@ static int read_i2c(struct nmk_i2c_dev *dev)
|
|
|
(void) init_hw(dev);
|
|
|
status = -ETIMEDOUT;
|
|
|
}
|
|
|
-
|
|
|
return status;
|
|
|
}
|
|
|
|
|
@@ -502,9 +509,9 @@ static int write_i2c(struct nmk_i2c_dev *dev)
|
|
|
|
|
|
/**
|
|
|
* nmk_i2c_xfer() - I2C transfer function used by kernel framework
|
|
|
- * @i2c_adap - Adapter pointer to the controller
|
|
|
- * @msgs[] - Pointer to data to be written.
|
|
|
- * @num_msgs - Number of messages to be executed
|
|
|
+ * @i2c_adap: Adapter pointer to the controller
|
|
|
+ * @msgs: Pointer to data to be written.
|
|
|
+ * @num_msgs: Number of messages to be executed
|
|
|
*
|
|
|
* This is the function called by the generic kernel i2c_transfer()
|
|
|
* or i2c_smbus...() API calls. Note that this code is protected by the
|
|
@@ -559,6 +566,8 @@ static int nmk_i2c_xfer(struct i2c_adapter *i2c_adap,
|
|
|
if (status)
|
|
|
return status;
|
|
|
|
|
|
+ clk_enable(dev->clk);
|
|
|
+
|
|
|
/* setup the i2c controller */
|
|
|
setup_i2c_controller(dev);
|
|
|
|
|
@@ -591,10 +600,13 @@ static int nmk_i2c_xfer(struct i2c_adapter *i2c_adap,
|
|
|
dev_err(&dev->pdev->dev, "%s\n",
|
|
|
cause >= ARRAY_SIZE(abort_causes)
|
|
|
? "unknown reason" : abort_causes[cause]);
|
|
|
+ clk_disable(dev->clk);
|
|
|
return status;
|
|
|
}
|
|
|
- mdelay(1);
|
|
|
+ udelay(I2C_DELAY);
|
|
|
}
|
|
|
+ clk_disable(dev->clk);
|
|
|
+
|
|
|
/* return the no. messages processed */
|
|
|
if (status)
|
|
|
return status;
|
|
@@ -605,6 +617,7 @@ static int nmk_i2c_xfer(struct i2c_adapter *i2c_adap,
|
|
|
/**
|
|
|
* disable_interrupts() - disable the interrupts
|
|
|
* @dev: private data of controller
|
|
|
+ * @irq: interrupt number
|
|
|
*/
|
|
|
static int disable_interrupts(struct nmk_i2c_dev *dev, u32 irq)
|
|
|
{
|
|
@@ -794,10 +807,7 @@ static irqreturn_t i2c_irq_handler(int irq, void *arg)
|
|
|
|
|
|
static unsigned int nmk_i2c_functionality(struct i2c_adapter *adap)
|
|
|
{
|
|
|
- return I2C_FUNC_I2C
|
|
|
- | I2C_FUNC_SMBUS_BYTE_DATA
|
|
|
- | I2C_FUNC_SMBUS_WORD_DATA
|
|
|
- | I2C_FUNC_SMBUS_I2C_BLOCK;
|
|
|
+ return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
|
|
|
}
|
|
|
|
|
|
static const struct i2c_algorithm nmk_i2c_algo = {
|
|
@@ -857,8 +867,6 @@ static int __devinit nmk_i2c_probe(struct platform_device *pdev)
|
|
|
goto err_no_clk;
|
|
|
}
|
|
|
|
|
|
- clk_enable(dev->clk);
|
|
|
-
|
|
|
adap = &dev->adap;
|
|
|
adap->dev.parent = &pdev->dev;
|
|
|
adap->owner = THIS_MODULE;
|
|
@@ -895,7 +903,6 @@ static int __devinit nmk_i2c_probe(struct platform_device *pdev)
|
|
|
return 0;
|
|
|
|
|
|
err_init_hw:
|
|
|
- clk_disable(dev->clk);
|
|
|
err_add_adap:
|
|
|
clk_put(dev->clk);
|
|
|
err_no_clk:
|
|
@@ -928,7 +935,6 @@ static int __devexit nmk_i2c_remove(struct platform_device *pdev)
|
|
|
iounmap(dev->virtbase);
|
|
|
if (res)
|
|
|
release_mem_region(res->start, resource_size(res));
|
|
|
- clk_disable(dev->clk);
|
|
|
clk_put(dev->clk);
|
|
|
platform_set_drvdata(pdev, NULL);
|
|
|
kfree(dev);
|