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(error: -EINVAL); |
31 | |
32 | _pdata.leds = kmemdup(p: pdata->leds, |
33 | size: pdata->num_leds * sizeof(*pdata->leds), GFP_KERNEL); |
34 | if (!_pdata.leds) |
35 | return ERR_PTR(error: -ENOMEM); |
36 | |
37 | ret = platform_device_register_resndata(NULL, name: "leds-gpio", id, |
38 | NULL, num: 0, data: &_pdata, size: sizeof(_pdata)); |
39 | if (IS_ERR(ptr: ret)) |
40 | kfree(objp: _pdata.leds); |
41 | |
42 | return ret; |
43 | } |
44 |