diff options
Diffstat (limited to 'drivers/i2c/busses/i2c-designware-hs.c')
-rw-r--r-- | drivers/i2c/busses/i2c-designware-hs.c | 36 |
1 files changed, 36 insertions, 0 deletions
diff --git a/drivers/i2c/busses/i2c-designware-hs.c b/drivers/i2c/busses/i2c-designware-hs.c index d986a12f5bb..9b8a3b6faa3 100644 --- a/drivers/i2c/busses/i2c-designware-hs.c +++ b/drivers/i2c/busses/i2c-designware-hs.c @@ -24,8 +24,16 @@ #include <linux/io.h> #include <linux/slab.h> #include <linux/pinctrl/consumer.h> +#include <linux/of_address.h> #include "i2c-designware-core.h" +static void __iomem *pctrl; + +struct hs_i2c_priv_data { + u32 delay_off; + u32 delay_bit; +}; + static struct i2c_algorithm hs_i2c_dw_algo = { .master_xfer = i2c_dw_xfer, .functionality = i2c_dw_func, @@ -41,12 +49,22 @@ static int hs_dw_i2c_probe(struct platform_device *pdev) struct i2c_adapter *adap; struct resource *iores; struct pinctrl *pinctrl; + struct device_node *node; + u32 data[2]; + struct hs_i2c_priv_data *priv; int r; d = devm_kzalloc(&pdev->dev, sizeof(struct dw_i2c_dev), GFP_KERNEL); if (!d) return -ENOMEM; + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); + if (!priv) { + dev_err(&pdev->dev, "mem alloc failed for private data\n"); + return -ENOMEM; + } + d->priv = priv; + /* NOTE: driver uses the static register mapping */ iores = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!iores) @@ -56,6 +74,20 @@ static int hs_dw_i2c_probe(struct platform_device *pdev) if (!d->base) return -EADDRNOTAVAIL; + if (!pctrl) { + node = of_find_compatible_node(NULL, NULL, + "hisilicon,pctrl"); + if (node) + pctrl = of_iomap(node, 0); + } + of_property_read_u32_array(pdev->dev.of_node, "delay-reg", &data[0], 2); + priv->delay_off = data[0]; + priv->delay_bit = data[1]; + + if (pctrl) + writel(BIT((priv->delay_bit) << 16) | BIT(priv->delay_bit), + pctrl + priv->delay_off); + d->irq = platform_get_irq(pdev, 0); if (d->irq < 0) { dev_err(&pdev->dev, "no irq resource?\n"); @@ -132,6 +164,10 @@ err: static int hs_dw_i2c_remove(struct platform_device *pdev) { struct dw_i2c_dev *d = platform_get_drvdata(pdev); + struct hs_i2c_priv_data *priv = d->priv; + + if (pctrl) + writel(BIT((priv->delay_bit) << 16), pctrl + priv->delay_off); platform_set_drvdata(pdev, NULL); i2c_del_adapter(&d->adapter); |