diff options
Diffstat (limited to 'kernel/drivers/leds/leds-gpio-register.c')
| -rw-r--r-- | kernel/drivers/leds/leds-gpio-register.c | 45 |
1 files changed, 45 insertions, 0 deletions
diff --git a/kernel/drivers/leds/leds-gpio-register.c b/kernel/drivers/leds/leds-gpio-register.c new file mode 100644 index 000000000..75717ba68 --- /dev/null +++ b/kernel/drivers/leds/leds-gpio-register.c @@ -0,0 +1,45 @@ +/* + * Copyright (C) 2011 Pengutronix + * Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de> + * + * This program is free software; you can redistribute it and/or modify it under + * the terms of the GNU General Public License version 2 as published by the + * Free Software Foundation. + */ +#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 + * + * 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; +} |