|
@@ -18,6 +18,7 @@
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
#include <linux/init.h>
|
|
|
+#include <linux/err.h>
|
|
|
#include <linux/platform_device.h>
|
|
|
#include <mach/common.h>
|
|
|
|
|
@@ -35,3 +36,35 @@ int __init mxc_register_device(struct platform_device *pdev, void *data)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
+struct platform_device *__init imx_add_platform_device(const char *name, int id,
|
|
|
+ const struct resource *res, unsigned int num_resources,
|
|
|
+ const void *data, size_t size_data)
|
|
|
+{
|
|
|
+ int ret = -ENOMEM;
|
|
|
+ struct platform_device *pdev;
|
|
|
+
|
|
|
+ pdev = platform_device_alloc(name, id);
|
|
|
+ if (!pdev)
|
|
|
+ goto err;
|
|
|
+
|
|
|
+ if (res) {
|
|
|
+ ret = platform_device_add_resources(pdev, res, num_resources);
|
|
|
+ if (ret)
|
|
|
+ goto err;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (data) {
|
|
|
+ ret = platform_device_add_data(pdev, data, size_data);
|
|
|
+ if (ret)
|
|
|
+ goto err;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = platform_device_add(pdev);
|
|
|
+ if (ret) {
|
|
|
+err:
|
|
|
+ platform_device_put(pdev);
|
|
|
+ return ERR_PTR(ret);
|
|
|
+ }
|
|
|
+
|
|
|
+ return pdev;
|
|
|
+}
|