Commit | Line | Data |
---|---|---|
282b13d0 SH |
1 | /* |
2 | * Copyright 2008 Sascha Hauer, kernel@pengutronix.de | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License | |
6 | * as published by the Free Software Foundation; either version 2 | |
7 | * of the License, or (at your option) any later version. | |
8 | * This program is distributed in the hope that it will be useful, | |
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
11 | * GNU General Public License for more details. | |
12 | * | |
13 | * You should have received a copy of the GNU General Public License | |
14 | * along with this program; if not, write to the Free Software | |
15 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, | |
16 | * Boston, MA 02110-1301, USA. | |
17 | */ | |
18 | ||
19 | #include <linux/kernel.h> | |
20 | #include <linux/init.h> | |
253ff1fa | 21 | #include <linux/err.h> |
282b13d0 | 22 | #include <linux/platform_device.h> |
058b7a6f | 23 | #include <mach/common.h> |
282b13d0 SH |
24 | |
25 | int __init mxc_register_device(struct platform_device *pdev, void *data) | |
26 | { | |
27 | int ret; | |
28 | ||
29 | pdev->dev.platform_data = data; | |
30 | ||
31 | ret = platform_device_register(pdev); | |
32 | if (ret) | |
33 | pr_debug("Unable to register platform device '%s': %d\n", | |
34 | pdev->name, ret); | |
35 | ||
36 | return ret; | |
37 | } | |
38 | ||
253ff1fa UKK |
39 | struct platform_device *__init imx_add_platform_device(const char *name, int id, |
40 | const struct resource *res, unsigned int num_resources, | |
41 | const void *data, size_t size_data) | |
42 | { | |
43 | int ret = -ENOMEM; | |
44 | struct platform_device *pdev; | |
45 | ||
46 | pdev = platform_device_alloc(name, id); | |
47 | if (!pdev) | |
48 | goto err; | |
49 | ||
50 | if (res) { | |
51 | ret = platform_device_add_resources(pdev, res, num_resources); | |
52 | if (ret) | |
53 | goto err; | |
54 | } | |
55 | ||
56 | if (data) { | |
57 | ret = platform_device_add_data(pdev, data, size_data); | |
58 | if (ret) | |
59 | goto err; | |
60 | } | |
61 | ||
62 | ret = platform_device_add(pdev); | |
63 | if (ret) { | |
64 | err: | |
65 | platform_device_put(pdev); | |
66 | return ERR_PTR(ret); | |
67 | } | |
68 | ||
69 | return pdev; | |
70 | } |