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  * @pdata: the platform data used for the new device
14  * @id: platform ID
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 }
44