提交 a23a1757 编写于 作者: P Philipp Zabel 提交者: Samuel Ortiz

mfd: convert DS1WM to use MFD core

This patch converts the DS1WM driver into an MFD cell. It also
calculates the bus_shift parameter from the memory resource size.
Signed-off-by: NPhilipp Zabel <philipp.zabel@gmail.com>
Signed-off-by: NSamuel Ortiz <sameo@openedhand.com>
上级 32064503
...@@ -19,7 +19,8 @@ ...@@ -19,7 +19,8 @@
#include <linux/clk.h> #include <linux/clk.h>
#include <linux/err.h> #include <linux/err.h>
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/ds1wm.h> #include <linux/mfd/core.h>
#include <linux/mfd/ds1wm.h>
#include <asm/io.h> #include <asm/io.h>
...@@ -89,7 +90,7 @@ struct ds1wm_data { ...@@ -89,7 +90,7 @@ struct ds1wm_data {
void __iomem *map; void __iomem *map;
int bus_shift; /* # of shifts to calc register offsets */ int bus_shift; /* # of shifts to calc register offsets */
struct platform_device *pdev; struct platform_device *pdev;
struct ds1wm_platform_data *pdata; struct mfd_cell *cell;
int irq; int irq;
int active_high; int active_high;
struct clk *clk; struct clk *clk;
...@@ -217,8 +218,8 @@ static void ds1wm_up(struct ds1wm_data *ds1wm_data) ...@@ -217,8 +218,8 @@ static void ds1wm_up(struct ds1wm_data *ds1wm_data)
{ {
int gclk, divisor; int gclk, divisor;
if (ds1wm_data->pdata->enable) if (ds1wm_data->cell->enable)
ds1wm_data->pdata->enable(ds1wm_data->pdev); ds1wm_data->cell->enable(ds1wm_data->pdev);
gclk = clk_get_rate(ds1wm_data->clk); gclk = clk_get_rate(ds1wm_data->clk);
clk_enable(ds1wm_data->clk); clk_enable(ds1wm_data->clk);
...@@ -244,8 +245,8 @@ static void ds1wm_down(struct ds1wm_data *ds1wm_data) ...@@ -244,8 +245,8 @@ static void ds1wm_down(struct ds1wm_data *ds1wm_data)
ds1wm_write_register(ds1wm_data, DS1WM_INT_EN, ds1wm_write_register(ds1wm_data, DS1WM_INT_EN,
ds1wm_data->active_high ? DS1WM_INTEN_IAS : 0); ds1wm_data->active_high ? DS1WM_INTEN_IAS : 0);
if (ds1wm_data->pdata->disable) if (ds1wm_data->cell->disable)
ds1wm_data->pdata->disable(ds1wm_data->pdev); ds1wm_data->cell->disable(ds1wm_data->pdev);
clk_disable(ds1wm_data->clk); clk_disable(ds1wm_data->clk);
} }
...@@ -330,13 +331,18 @@ static struct w1_bus_master ds1wm_master = { ...@@ -330,13 +331,18 @@ static struct w1_bus_master ds1wm_master = {
static int ds1wm_probe(struct platform_device *pdev) static int ds1wm_probe(struct platform_device *pdev)
{ {
struct ds1wm_data *ds1wm_data; struct ds1wm_data *ds1wm_data;
struct ds1wm_platform_data *plat; struct ds1wm_driver_data *plat;
struct resource *res; struct resource *res;
struct mfd_cell *cell;
int ret; int ret;
if (!pdev) if (!pdev)
return -ENODEV; return -ENODEV;
cell = pdev->dev.platform_data;
if (!cell)
return -ENODEV;
ds1wm_data = kzalloc(sizeof(*ds1wm_data), GFP_KERNEL); ds1wm_data = kzalloc(sizeof(*ds1wm_data), GFP_KERNEL);
if (!ds1wm_data) if (!ds1wm_data)
return -ENOMEM; return -ENOMEM;
...@@ -348,15 +354,18 @@ static int ds1wm_probe(struct platform_device *pdev) ...@@ -348,15 +354,18 @@ static int ds1wm_probe(struct platform_device *pdev)
ret = -ENXIO; ret = -ENXIO;
goto err0; goto err0;
} }
ds1wm_data->map = ioremap(res->start, res->end - res->start + 1); ds1wm_data->map = ioremap(res->start, resource_size(res));
if (!ds1wm_data->map) { if (!ds1wm_data->map) {
ret = -ENOMEM; ret = -ENOMEM;
goto err0; goto err0;
} }
plat = pdev->dev.platform_data; plat = cell->driver_data;
ds1wm_data->bus_shift = plat->bus_shift;
/* calculate bus shift from mem resource */
ds1wm_data->bus_shift = resource_size(res) >> 3;
ds1wm_data->pdev = pdev; ds1wm_data->pdev = pdev;
ds1wm_data->pdata = plat; ds1wm_data->cell = cell;
res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
if (!res) { if (!res) {
......
/* platform data for the DS1WM driver */
struct ds1wm_platform_data {
int bus_shift; /* number of shifts needed to calculate the
* offset between DS1WM registers;
* e.g. on h5xxx and h2200 this is 2
* (registers aligned to 4-byte boundaries),
* while on hx4700 this is 1 */
int active_high;
void (*enable)(struct platform_device *pdev);
void (*disable)(struct platform_device *pdev);
};
/* MFD cell driver data for the DS1WM driver */
struct ds1wm_driver_data {
int active_high;
};
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册