mfd: convert PASIC3 to use MFD core
[linux-2.6.git] / drivers / mfd / mfd-core.c
1 /*
2  * drivers/mfd/mfd-core.c
3  *
4  * core MFD support
5  * Copyright (c) 2006 Ian Molton
6  * Copyright (c) 2007,2008 Dmitry Baryshkov
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  *
12  */
13
14 #include <linux/kernel.h>
15 #include <linux/platform_device.h>
16 #include <linux/mfd/core.h>
17
18 static int mfd_add_device(struct device *parent, int id,
19                           const struct mfd_cell *cell,
20                           struct resource *mem_base,
21                           int irq_base)
22 {
23         struct resource *res;
24         struct platform_device *pdev;
25         int ret = -ENOMEM;
26         int r;
27
28         pdev = platform_device_alloc(cell->name, id);
29         if (!pdev)
30                 goto fail_alloc;
31
32         res = kzalloc(sizeof(*res) * cell->num_resources, GFP_KERNEL);
33         if (!res)
34                 goto fail_device;
35
36         pdev->dev.parent = parent;
37         platform_set_drvdata(pdev, cell->driver_data);
38
39         ret = platform_device_add_data(pdev,
40                         cell->platform_data, cell->data_size);
41         if (ret)
42                 goto fail_res;
43
44         for (r = 0; r < cell->num_resources; r++) {
45                 res[r].name = cell->resources[r].name;
46                 res[r].flags = cell->resources[r].flags;
47
48                 /* Find out base to use */
49                 if (cell->resources[r].flags & IORESOURCE_MEM) {
50                         res[r].parent = mem_base;
51                         res[r].start = mem_base->start +
52                                 cell->resources[r].start;
53                         res[r].end = mem_base->start +
54                                 cell->resources[r].end;
55                 } else if (cell->resources[r].flags & IORESOURCE_IRQ) {
56                         res[r].start = irq_base +
57                                 cell->resources[r].start;
58                         res[r].end   = irq_base +
59                                 cell->resources[r].end;
60                 } else {
61                         res[r].parent = cell->resources[r].parent;
62                         res[r].start = cell->resources[r].start;
63                         res[r].end   = cell->resources[r].end;
64                 }
65         }
66
67         platform_device_add_resources(pdev, res, cell->num_resources);
68
69         ret = platform_device_add(pdev);
70         if (ret)
71                 goto fail_res;
72
73         kfree(res);
74
75         return 0;
76
77 /*      platform_device_del(pdev); */
78 fail_res:
79         kfree(res);
80 fail_device:
81         platform_device_put(pdev);
82 fail_alloc:
83         return ret;
84 }
85
86 int mfd_add_devices(struct device *parent, int id,
87                     const struct mfd_cell *cells, int n_devs,
88                     struct resource *mem_base,
89                     int irq_base)
90 {
91         int i;
92         int ret = 0;
93
94         for (i = 0; i < n_devs; i++) {
95                 ret = mfd_add_device(parent, id, cells + i, mem_base, irq_base);
96                 if (ret)
97                         break;
98         }
99
100         if (ret)
101                 mfd_remove_devices(parent);
102
103         return ret;
104 }
105 EXPORT_SYMBOL(mfd_add_devices);
106
107 static int mfd_remove_devices_fn(struct device *dev, void *unused)
108 {
109         platform_device_unregister(to_platform_device(dev));
110         return 0;
111 }
112
113 void mfd_remove_devices(struct device *parent)
114 {
115         device_for_each_child(parent, NULL, mfd_remove_devices_fn);
116 }
117 EXPORT_SYMBOL(mfd_remove_devices);
118
119 MODULE_LICENSE("GPL");
120 MODULE_AUTHOR("Ian Molton, Dmitry Baryshkov");