arch/arm/plat-mxc/devices.c

   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>
  21 #include <linux/err.h>
  22 #include <linux/platform_device.h>
  23 #include <mach/common.h>
  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
  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 }