162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (C) 2011 Pengutronix
462306a36Sopenharmony_ci * Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>
562306a36Sopenharmony_ci */
662306a36Sopenharmony_ci#include <linux/err.h>
762306a36Sopenharmony_ci#include <linux/leds.h>
862306a36Sopenharmony_ci#include <linux/platform_device.h>
962306a36Sopenharmony_ci#include <linux/slab.h>
1062306a36Sopenharmony_ci
1162306a36Sopenharmony_ci/**
1262306a36Sopenharmony_ci * gpio_led_register_device - register a gpio-led device
1362306a36Sopenharmony_ci * @pdata: the platform data used for the new device
1462306a36Sopenharmony_ci * @id: platform ID
1562306a36Sopenharmony_ci *
1662306a36Sopenharmony_ci * Makes a copy of pdata and pdata->leds and registers a new leds-gpio device
1762306a36Sopenharmony_ci * with the result. This allows to have pdata and pdata-leds in .init.rodata
1862306a36Sopenharmony_ci * and so saves some bytes compared to a static struct platform_device with
1962306a36Sopenharmony_ci * static platform data.
2062306a36Sopenharmony_ci *
2162306a36Sopenharmony_ci * Returns the registered device or an error pointer.
2262306a36Sopenharmony_ci */
2362306a36Sopenharmony_cistruct platform_device *__init gpio_led_register_device(
2462306a36Sopenharmony_ci		int id, const struct gpio_led_platform_data *pdata)
2562306a36Sopenharmony_ci{
2662306a36Sopenharmony_ci	struct platform_device *ret;
2762306a36Sopenharmony_ci	struct gpio_led_platform_data _pdata = *pdata;
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci	if (!pdata->num_leds)
3062306a36Sopenharmony_ci		return ERR_PTR(-EINVAL);
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci	_pdata.leds = kmemdup(pdata->leds,
3362306a36Sopenharmony_ci			pdata->num_leds * sizeof(*pdata->leds), GFP_KERNEL);
3462306a36Sopenharmony_ci	if (!_pdata.leds)
3562306a36Sopenharmony_ci		return ERR_PTR(-ENOMEM);
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_ci	ret = platform_device_register_resndata(NULL, "leds-gpio", id,
3862306a36Sopenharmony_ci			NULL, 0, &_pdata, sizeof(_pdata));
3962306a36Sopenharmony_ci	if (IS_ERR(ret))
4062306a36Sopenharmony_ci		kfree(_pdata.leds);
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci	return ret;
4362306a36Sopenharmony_ci}
44