Blame view

drivers/leds/leds-gpio-register.c 1.33 KB
81f7e3824   Eric Lee   Initial Release, ...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
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;
  }