leds: lt3593: merge functions and clean up code
In preparation to DT probe functionality, merge create_lt3593_led() into its only call-site. The DT based setup code will be quite different, so this internal helper function is of no help. This also changes the way the driver works by only handling one entry inside 'struct gpio_led_platform_data'. If multiple devices of the same type are found in a design, there should be a platform device for each of them. The only mainline user of this driver is not affected by this change. Last, use devm_led_classdev_register() instead of led_classdev_register(), so the driver's remove callback can go away. Signed-off-by: Daniel Mack <daniel@zonque.org> Signed-off-by: Jacek Anaszewski <jacek.anaszewski@gmail.com>
This commit is contained in:
parent
f041f96abc
commit
d8be286739
1 changed files with 34 additions and 67 deletions
|
@ -71,104 +71,71 @@ static int lt3593_led_set(struct led_classdev *led_cdev,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int create_lt3593_led(const struct gpio_led *template,
|
||||
struct lt3593_led_data *led_dat, struct device *parent)
|
||||
static struct lt3593_led_data *lt3593_led_probe_pdata(struct device *dev)
|
||||
{
|
||||
struct gpio_led_platform_data *pdata = dev_get_platdata(dev);
|
||||
const struct gpio_led *template = &pdata->leds[0];
|
||||
struct lt3593_led_data *led_data;
|
||||
int ret, state;
|
||||
|
||||
/* skip leds on GPIOs that aren't available */
|
||||
if (pdata->num_leds != 1)
|
||||
return ERR_PTR(-EINVAL);
|
||||
|
||||
led_data = devm_kzalloc(dev, sizeof(*led_data), GFP_KERNEL);
|
||||
if (!led_data)
|
||||
return ERR_PTR(-ENOMEM);
|
||||
|
||||
if (!gpio_is_valid(template->gpio)) {
|
||||
dev_info(parent, "%s: skipping unavailable LT3593 LED at gpio %d (%s)\n",
|
||||
KBUILD_MODNAME, template->gpio, template->name);
|
||||
return 0;
|
||||
dev_info(dev, "skipping unavailable LT3593 LED at gpio "
|
||||
"%d (%s)\n", template->gpio, template->name);
|
||||
return ERR_PTR(-EINVAL);
|
||||
}
|
||||
|
||||
led_dat->cdev.name = template->name;
|
||||
led_dat->cdev.default_trigger = template->default_trigger;
|
||||
led_dat->gpio = template->gpio;
|
||||
|
||||
led_dat->cdev.brightness_set_blocking = lt3593_led_set;
|
||||
led_data->cdev.name = template->name;
|
||||
led_data->cdev.default_trigger = template->default_trigger;
|
||||
led_data->gpio = template->gpio;
|
||||
led_data->cdev.brightness_set_blocking = lt3593_led_set;
|
||||
|
||||
state = (template->default_state == LEDS_GPIO_DEFSTATE_ON);
|
||||
led_dat->cdev.brightness = state ? LED_FULL : LED_OFF;
|
||||
led_data->cdev.brightness = state ? LED_FULL : LED_OFF;
|
||||
|
||||
if (!template->retain_state_suspended)
|
||||
led_dat->cdev.flags |= LED_CORE_SUSPENDRESUME;
|
||||
led_data->cdev.flags |= LED_CORE_SUSPENDRESUME;
|
||||
|
||||
ret = devm_gpio_request_one(parent, template->gpio, state ?
|
||||
ret = devm_gpio_request_one(dev, template->gpio, state ?
|
||||
GPIOF_OUT_INIT_HIGH : GPIOF_OUT_INIT_LOW,
|
||||
template->name);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
return ERR_PTR(ret);
|
||||
|
||||
ret = led_classdev_register(parent, &led_dat->cdev);
|
||||
ret = devm_led_classdev_register(dev, &led_data->cdev);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
return ERR_PTR(ret);
|
||||
|
||||
dev_info(parent, "%s: registered LT3593 LED '%s' at GPIO %d\n",
|
||||
KBUILD_MODNAME, template->name, template->gpio);
|
||||
dev_info(dev, "registered LT3593 LED '%s' at GPIO %d\n",
|
||||
template->name, template->gpio);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void delete_lt3593_led(struct lt3593_led_data *led)
|
||||
{
|
||||
if (!gpio_is_valid(led->gpio))
|
||||
return;
|
||||
|
||||
led_classdev_unregister(&led->cdev);
|
||||
return led_data;
|
||||
}
|
||||
|
||||
static int lt3593_led_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct gpio_led_platform_data *pdata = dev_get_platdata(&pdev->dev);
|
||||
struct lt3593_led_data *leds_data;
|
||||
int i, ret = 0;
|
||||
struct device *dev = &pdev->dev;
|
||||
struct lt3593_led_data *led_data;
|
||||
|
||||
if (!pdata)
|
||||
return -EBUSY;
|
||||
|
||||
leds_data = devm_kcalloc(&pdev->dev,
|
||||
pdata->num_leds, sizeof(struct lt3593_led_data),
|
||||
GFP_KERNEL);
|
||||
if (!leds_data)
|
||||
return -ENOMEM;
|
||||
|
||||
for (i = 0; i < pdata->num_leds; i++) {
|
||||
ret = create_lt3593_led(&pdata->leds[i], &leds_data[i],
|
||||
&pdev->dev);
|
||||
if (ret < 0)
|
||||
goto err;
|
||||
if (dev_get_platdata(dev)) {
|
||||
led_data = lt3593_led_probe_pdata(dev);
|
||||
if (IS_ERR(led_data))
|
||||
return PTR_ERR(led_data);
|
||||
}
|
||||
|
||||
platform_set_drvdata(pdev, leds_data);
|
||||
|
||||
return 0;
|
||||
|
||||
err:
|
||||
for (i = i - 1; i >= 0; i--)
|
||||
delete_lt3593_led(&leds_data[i]);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int lt3593_led_remove(struct platform_device *pdev)
|
||||
{
|
||||
int i;
|
||||
struct gpio_led_platform_data *pdata = dev_get_platdata(&pdev->dev);
|
||||
struct lt3593_led_data *leds_data;
|
||||
|
||||
leds_data = platform_get_drvdata(pdev);
|
||||
|
||||
for (i = 0; i < pdata->num_leds; i++)
|
||||
delete_lt3593_led(&leds_data[i]);
|
||||
platform_set_drvdata(pdev, led_data);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver lt3593_led_driver = {
|
||||
.probe = lt3593_led_probe,
|
||||
.remove = lt3593_led_remove,
|
||||
.driver = {
|
||||
.name = "leds-lt3593",
|
||||
},
|
||||
|
|
Loading…
Reference in a new issue