Commit 9f8a3e7f authored by Richard Zhao's avatar Richard Zhao Committed by Wolfram Sang
Browse files

i2c: imx: convert to use managed functions 



- convert to use devm_request_and_ioremap, devm_kzalloc, devm_clk_get,
  devm_request_irq.
- clean up unused variables.

Signed-off-by: default avatarRichard Zhao <richard.zhao@freescale.com>
Reviewed-by: default avatarShubhrajyoti D <Shubhrajyoti@ti.com>
Signed-off-by: default avatarWolfram Sang <w.sang@pengutronix.de>
parent 9cbb6b2b

drivers/i2c/busses/i2c-imx.c

+18 −53
Original line number Diff line number Diff line
@@ -118,10 +118,8 @@ static u16 __initdata i2c_clk_div[50][2] = { 


struct imx_i2c_struct {

	struct i2c_adapter	adapter;

	struct resource		*res;

	struct clk		*clk;

	void __iomem		*base;

	int			irq;

	wait_queue_head_t	queue;

	unsigned long		i2csr;

	unsigned int 		disable_delay;
@@ -473,7 +471,6 @@ static int __init i2c_imx_probe(struct platform_device *pdev) 
	struct imxi2c_platform_data *pdata = pdev->dev.platform_data;

	struct pinctrl *pinctrl;

	void __iomem *base;

	resource_size_t res_size;

	int irq, bitrate;

	int ret;
@@ -490,25 +487,15 @@ static int __init i2c_imx_probe(struct platform_device *pdev) 
		return -ENOENT;

	}



	res_size = resource_size(res);



	if (!request_mem_region(res->start, res_size, DRIVER_NAME)) {

		dev_err(&pdev->dev, "request_mem_region failed\n");

	base = devm_request_and_ioremap(&pdev->dev, res);

	if (!base)

		return -EBUSY;

	}



	base = ioremap(res->start, res_size);

	if (!base) {

		dev_err(&pdev->dev, "ioremap failed\n");

		ret = -EIO;

		goto fail1;

	}



	i2c_imx = kzalloc(sizeof(struct imx_i2c_struct), GFP_KERNEL);

	i2c_imx = devm_kzalloc(&pdev->dev, sizeof(struct imx_i2c_struct),

				GFP_KERNEL);

	if (!i2c_imx) {

		dev_err(&pdev->dev, "can't allocate interface\n");

		ret = -ENOMEM;

		goto fail2;

		return -ENOMEM;

	}



	/* Setup i2c_imx driver structure */
@@ -518,29 +505,27 @@ static int __init i2c_imx_probe(struct platform_device *pdev) 
	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;



	pinctrl = devm_pinctrl_get_select_default(&pdev->dev);

	if (IS_ERR(pinctrl)) {

		ret = PTR_ERR(pinctrl);

		goto fail3;

		dev_err(&pdev->dev, "can't get/select pinctrl\n");

		return PTR_ERR(pinctrl);

	}



	/* Get I2C clock */

	i2c_imx->clk = clk_get(&pdev->dev, "i2c_clk");

	i2c_imx->clk = devm_clk_get(&pdev->dev, "i2c_clk");

	if (IS_ERR(i2c_imx->clk)) {

		ret = PTR_ERR(i2c_imx->clk);

		dev_err(&pdev->dev, "can't get I2C clock\n");

		goto fail3;

		return PTR_ERR(i2c_imx->clk);

	}



	/* Request IRQ */

	ret = request_irq(i2c_imx->irq, i2c_imx_isr, 0, pdev->name, i2c_imx);

	ret = devm_request_irq(&pdev->dev, irq, i2c_imx_isr, 0,

				pdev->name, i2c_imx);

	if (ret) {

		dev_err(&pdev->dev, "can't claim irq %d\n", i2c_imx->irq);

		goto fail4;

		dev_err(&pdev->dev, "can't claim irq %d\n", irq);

		return ret;

	}



	/* Init queue */
@@ -565,7 +550,7 @@ static int __init i2c_imx_probe(struct platform_device *pdev) 
	ret = i2c_add_numbered_adapter(&i2c_imx->adapter);

	if (ret < 0) {

		dev_err(&pdev->dev, "registration failed\n");

		goto fail5;

		return ret;

	}



	of_i2c_register_devices(&i2c_imx->adapter);
@@ -573,28 +558,16 @@ static int __init i2c_imx_probe(struct platform_device *pdev) 
	/* Set up platform driver data */

	platform_set_drvdata(pdev, i2c_imx);



	dev_dbg(&i2c_imx->adapter.dev, "claimed irq %d\n", i2c_imx->irq);

	dev_dbg(&i2c_imx->adapter.dev, "claimed irq %d\n", irq);

	dev_dbg(&i2c_imx->adapter.dev, "device resources from 0x%x to 0x%x\n",

		i2c_imx->res->start, i2c_imx->res->end);

		res->start, res->end);

	dev_dbg(&i2c_imx->adapter.dev, "allocated %d bytes at 0x%x\n",

		res_size, i2c_imx->res->start);

		resource_size(res), res->start);

	dev_dbg(&i2c_imx->adapter.dev, "adapter name: \"%s\"\n",

		i2c_imx->adapter.name);

	dev_dbg(&i2c_imx->adapter.dev, "IMX I2C adapter registered\n");



	return 0;   /* Return OK */



fail5:

	free_irq(i2c_imx->irq, i2c_imx);

fail4:

	clk_put(i2c_imx->clk);

fail3:

	kfree(i2c_imx);

fail2:

	iounmap(base);

fail1:

	release_mem_region(res->start, resource_size(res));

	return ret; /* Return error number */

}



static int __exit i2c_imx_remove(struct platform_device *pdev)
@@ -606,20 +579,12 @@ static int __exit i2c_imx_remove(struct platform_device *pdev) 
	i2c_del_adapter(&i2c_imx->adapter);

	platform_set_drvdata(pdev, NULL);



	/* free interrupt */

	free_irq(i2c_imx->irq, i2c_imx);



	/* setup chip registers to defaults */

	writeb(0, i2c_imx->base + IMX_I2C_IADR);

	writeb(0, i2c_imx->base + IMX_I2C_IFDR);

	writeb(0, i2c_imx->base + IMX_I2C_I2CR);

	writeb(0, i2c_imx->base + IMX_I2C_I2SR);



	clk_put(i2c_imx->clk);



	iounmap(i2c_imx->base);

	release_mem_region(i2c_imx->res->start, resource_size(i2c_imx->res));

	kfree(i2c_imx);

	return 0;

}

CRA Git | Maintained and supported by SUSTech CRA and CCSE