drivers/leds/leds-gpio-register.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2011 Pengutronix
   4  * Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>
   5  */
   6 #include <linux/err.h>
   7 #include <linux/leds.h>
   8 #include <linux/platform_device.h>
   9 #include <linux/slab.h>
  10
  11 /**
  12  * gpio_led_register_device - register a gpio-led device
  13  * @id: platform ID
  14  * @pdata: the platform data used for the new device
  15  *
  16  * Makes a copy of pdata and pdata->leds and registers a new leds-gpio device
  17  * with the result. This allows to have pdata and pdata-leds in .init.rodata
  18  * and so saves some bytes compared to a static struct platform_device with
  19  * static platform data.
  20  *
  21  * Returns the registered device or an error pointer.
  22  */
  23 struct platform_device *__init gpio_led_register_device(
  24                 int id, const struct gpio_led_platform_data *pdata)
  25 {
  26         struct platform_device *ret;
  27         struct gpio_led_platform_data _pdata = *pdata;
  28
  29         if (!pdata->num_leds)
  30                 return ERR_PTR(-EINVAL);
  31
  32         _pdata.leds = kmemdup(pdata->leds,
  33                         pdata->num_leds * sizeof(*pdata->leds), GFP_KERNEL);
  34         if (!_pdata.leds)
  35                 return ERR_PTR(-ENOMEM);
  36
  37         ret = platform_device_register_resndata(NULL, "leds-gpio", id,
  38                         NULL, 0, &_pdata, sizeof(_pdata));
  39         if (IS_ERR(ret))
  40                 kfree(_pdata.leds);
  41
  42         return ret;
  43 }