44 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright (C) 2011 Pengutronix4 * 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 device13 * @pdata: the platform data used for the new device14 * @id: platform ID15 *16 * Makes a copy of pdata and pdata->leds and registers a new leds-gpio device17 * with the result. This allows to have pdata and pdata-leds in .init.rodata18 * and so saves some bytes compared to a static struct platform_device with19 * static platform data.20 *21 * Returns the registered device or an error pointer.22 */23struct 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