diff options
Diffstat (limited to 'drivers/i2c/busses/i2c-imx.c')
| -rw-r--r-- | drivers/i2c/busses/i2c-imx.c | 75 | 
1 files changed, 20 insertions, 55 deletions
diff --git a/drivers/i2c/busses/i2c-imx.c b/drivers/i2c/busses/i2c-imx.c index 370031ac820..0722f869465 100644 --- a/drivers/i2c/busses/i2c-imx.c +++ b/drivers/i2c/busses/i2c-imx.c @@ -117,10 +117,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; @@ -472,9 +470,8 @@ 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; +	int irq, ret; +	u32 bitrate;  	dev_dbg(&pdev->dev, "<%s>\n", __func__); @@ -489,25 +486,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 */ @@ -517,29 +504,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, NULL);  	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 */ @@ -564,7 +549,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); @@ -572,28 +557,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); -	dev_dbg(&i2c_imx->adapter.dev, "allocated %d bytes at 0x%x \n", -		res_size, i2c_imx->res->start); +		res->start, res->end); +	dev_dbg(&i2c_imx->adapter.dev, "allocated %d bytes at 0x%x\n", +		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) @@ -605,20 +578,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;  }  |