|
@@ -48,6 +48,9 @@
|
|
|
#include <linux/platform_device.h>
|
|
|
#include <linux/clk.h>
|
|
|
#include <linux/slab.h>
|
|
|
+#include <linux/of.h>
|
|
|
+#include <linux/of_device.h>
|
|
|
+#include <linux/of_i2c.h>
|
|
|
|
|
|
#include <mach/irqs.h>
|
|
|
#include <mach/hardware.h>
|
|
@@ -125,6 +128,11 @@ struct imx_i2c_struct {
|
|
|
unsigned int ifdr; /* IMX_I2C_IFDR */
|
|
|
};
|
|
|
|
|
|
+static const struct of_device_id i2c_imx_dt_ids[] = {
|
|
|
+ { .compatible = "fsl,imx1-i2c", },
|
|
|
+ { /* sentinel */ }
|
|
|
+};
|
|
|
+
|
|
|
/** Functions for IMX I2C adapter driver ***************************************
|
|
|
*******************************************************************************/
|
|
|
|
|
@@ -469,7 +477,7 @@ static int __init i2c_imx_probe(struct platform_device *pdev)
|
|
|
struct imxi2c_platform_data *pdata = pdev->dev.platform_data;
|
|
|
void __iomem *base;
|
|
|
resource_size_t res_size;
|
|
|
- int irq;
|
|
|
+ int irq, bitrate;
|
|
|
int ret;
|
|
|
|
|
|
dev_dbg(&pdev->dev, "<%s>\n", __func__);
|
|
@@ -512,6 +520,7 @@ static int __init i2c_imx_probe(struct platform_device *pdev)
|
|
|
i2c_imx->adapter.algo = &i2c_imx_algo;
|
|
|
i2c_imx->adapter.dev.parent = &pdev->dev;
|
|
|
i2c_imx->adapter.nr = pdev->id;
|
|
|
+ i2c_imx->adapter.dev.of_node = pdev->dev.of_node;
|
|
|
i2c_imx->irq = irq;
|
|
|
i2c_imx->base = base;
|
|
|
i2c_imx->res = res;
|
|
@@ -538,10 +547,12 @@ static int __init i2c_imx_probe(struct platform_device *pdev)
|
|
|
i2c_set_adapdata(&i2c_imx->adapter, i2c_imx);
|
|
|
|
|
|
/* Set up clock divider */
|
|
|
- if (pdata && pdata->bitrate)
|
|
|
- i2c_imx_set_clk(i2c_imx, pdata->bitrate);
|
|
|
- else
|
|
|
- i2c_imx_set_clk(i2c_imx, IMX_I2C_BIT_RATE);
|
|
|
+ bitrate = IMX_I2C_BIT_RATE;
|
|
|
+ ret = of_property_read_u32(pdev->dev.of_node,
|
|
|
+ "clock-frequency", &bitrate);
|
|
|
+ if (ret < 0 && pdata && pdata->bitrate)
|
|
|
+ bitrate = pdata->bitrate;
|
|
|
+ i2c_imx_set_clk(i2c_imx, bitrate);
|
|
|
|
|
|
/* Set up chip registers to defaults */
|
|
|
writeb(0, i2c_imx->base + IMX_I2C_I2CR);
|
|
@@ -554,6 +565,8 @@ static int __init i2c_imx_probe(struct platform_device *pdev)
|
|
|
goto fail5;
|
|
|
}
|
|
|
|
|
|
+ of_i2c_register_devices(&i2c_imx->adapter);
|
|
|
+
|
|
|
/* Set up platform driver data */
|
|
|
platform_set_drvdata(pdev, i2c_imx);
|
|
|
|
|
@@ -584,7 +597,6 @@ fail1:
|
|
|
static int __exit i2c_imx_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
struct imx_i2c_struct *i2c_imx = platform_get_drvdata(pdev);
|
|
|
- struct imxi2c_platform_data *pdata = pdev->dev.platform_data;
|
|
|
|
|
|
/* remove adapter */
|
|
|
dev_dbg(&i2c_imx->adapter.dev, "adapter removed\n");
|
|
@@ -613,6 +625,7 @@ static struct platform_driver i2c_imx_driver = {
|
|
|
.driver = {
|
|
|
.name = DRIVER_NAME,
|
|
|
.owner = THIS_MODULE,
|
|
|
+ .of_match_table = i2c_imx_dt_ids,
|
|
|
}
|
|
|
};
|
|
|
|