Commit | Line | Data |
---|---|---|
d2912cb1 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
4440673a UKK |
2 | /* |
3 | * Copyright (C) 2011 Pengutronix | |
4 | * Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de> | |
4440673a UKK |
5 | */ |
6 | #include <linux/err.h> | |
4cc72346 | 7 | #include <linux/leds.h> |
4440673a UKK |
8 | #include <linux/platform_device.h> |
9 | #include <linux/slab.h> | |
4440673a UKK |
10 | |
11 | /** | |
12 | * gpio_led_register_device - register a gpio-led device | |
13 | * @pdata: the platform data used for the new device | |
c5a87a4a | 14 | * @id: platform ID |
4440673a UKK |
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 | ||
a823e761 XL |
29 | if (!pdata->num_leds) |
30 | return ERR_PTR(-EINVAL); | |
31 | ||
4440673a UKK |
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 | } |