2 * drivers/mfd/mfd-core.c
5 * Copyright (c) 2006 Ian Molton
6 * Copyright (c) 2007,2008 Dmitry Baryshkov
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.
14 #include <linux/kernel.h>
15 #include <linux/platform_device.h>
16 #include <linux/acpi.h>
17 #include <linux/mfd/core.h>
18 #include <linux/pm_runtime.h>
19 #include <linux/slab.h>
21 static int mfd_add_device(struct device
*parent
, int id
,
22 const struct mfd_cell
*cell
,
23 struct resource
*mem_base
,
27 struct platform_device
*pdev
;
31 pdev
= platform_device_alloc(cell
->name
, id
+ cell
->id
);
35 res
= kzalloc(sizeof(*res
) * cell
->num_resources
, GFP_KERNEL
);
39 pdev
->dev
.parent
= parent
;
41 ret
= platform_device_add_data(pdev
, cell
, sizeof(*cell
));
45 for (r
= 0; r
< cell
->num_resources
; r
++) {
46 res
[r
].name
= cell
->resources
[r
].name
;
47 res
[r
].flags
= cell
->resources
[r
].flags
;
49 /* Find out base to use */
50 if ((cell
->resources
[r
].flags
& IORESOURCE_MEM
) && mem_base
) {
51 res
[r
].parent
= mem_base
;
52 res
[r
].start
= mem_base
->start
+
53 cell
->resources
[r
].start
;
54 res
[r
].end
= mem_base
->start
+
55 cell
->resources
[r
].end
;
56 } else if (cell
->resources
[r
].flags
& IORESOURCE_IRQ
) {
57 res
[r
].start
= irq_base
+
58 cell
->resources
[r
].start
;
59 res
[r
].end
= irq_base
+
60 cell
->resources
[r
].end
;
62 res
[r
].parent
= cell
->resources
[r
].parent
;
63 res
[r
].start
= cell
->resources
[r
].start
;
64 res
[r
].end
= cell
->resources
[r
].end
;
67 if (!cell
->ignore_resource_conflicts
) {
68 ret
= acpi_check_resource_conflict(res
);
74 ret
= platform_device_add_resources(pdev
, res
, cell
->num_resources
);
78 ret
= platform_device_add(pdev
);
82 if (cell
->pm_runtime_no_callbacks
)
83 pm_runtime_no_callbacks(&pdev
->dev
);
89 /* platform_device_del(pdev); */
93 platform_device_put(pdev
);
98 int mfd_add_devices(struct device
*parent
, int id
,
99 const struct mfd_cell
*cells
, int n_devs
,
100 struct resource
*mem_base
,
106 for (i
= 0; i
< n_devs
; i
++) {
107 ret
= mfd_add_device(parent
, id
, cells
+ i
, mem_base
, irq_base
);
113 mfd_remove_devices(parent
);
117 EXPORT_SYMBOL(mfd_add_devices
);
119 static int mfd_remove_devices_fn(struct device
*dev
, void *unused
)
121 platform_device_unregister(to_platform_device(dev
));
125 void mfd_remove_devices(struct device
*parent
)
127 device_for_each_child(parent
, NULL
, mfd_remove_devices_fn
);
129 EXPORT_SYMBOL(mfd_remove_devices
);
131 MODULE_LICENSE("GPL");
132 MODULE_AUTHOR("Ian Molton, Dmitry Baryshkov");