44 lines
1.2 KiB
C
44 lines
1.2 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright (C) 2011 Pengutronix
|
|
* Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>
|
|
*/
|
|
#include <linux/err.h>
|
|
#include <linux/leds.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/slab.h>
|
|
|
|
/**
|
|
* gpio_led_register_device - register a gpio-led device
|
|
* @pdata: the platform data used for the new device
|
|
* @id: platform ID
|
|
*
|
|
* Makes a copy of pdata and pdata->leds and registers a new leds-gpio device
|
|
* with the result. This allows to have pdata and pdata-leds in .init.rodata
|
|
* and so saves some bytes compared to a static struct platform_device with
|
|
* static platform data.
|
|
*
|
|
* Returns the registered device or an error pointer.
|
|
*/
|
|
struct platform_device *__init gpio_led_register_device(
|
|
int id, const struct gpio_led_platform_data *pdata)
|
|
{
|
|
struct platform_device *ret;
|
|
struct gpio_led_platform_data _pdata = *pdata;
|
|
|
|
if (!pdata->num_leds)
|
|
return ERR_PTR(-EINVAL);
|
|
|
|
_pdata.leds = kmemdup(pdata->leds,
|
|
pdata->num_leds * sizeof(*pdata->leds), GFP_KERNEL);
|
|
if (!_pdata.leds)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
ret = platform_device_register_resndata(NULL, "leds-gpio", id,
|
|
NULL, 0, &_pdata, sizeof(_pdata));
|
|
if (IS_ERR(ret))
|
|
kfree(_pdata.leds);
|
|
|
|
return ret;
|
|
}
|