linux/drivers/net/wireless/realtek/rtw89/led.c

// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
/* Copyright(c) 2026 Realtek Corporation
 */

#include "core.h"
#include "debug.h"
#include "led.h"
#include "reg.h"

static const struct rtw89_led_gpio_entry rtw89_common_led_gpios[] = {{
	.pin = 8,
	.pinmux = {.addr = R_AX_GPIO8_15_FUNC_SEL, .mask = GENMASK(3, 0), .data = 0xf},
	.mode = {.addr = R_AX_GPIO_EXT_CTRL + 2, .data = BIT(0) | BIT(8)},
	.out = {.addr = R_AX_GPIO_EXT_CTRL + 1, .data = BIT(0)},
}};

static const struct rtw89_led_desc rtw89_common_led_desc = {
	.gpios = rtw89_common_led_gpios,
	.n_gpio = ARRAY_SIZE(rtw89_common_led_gpios),
};

void rtw89_led_gpio_config(struct rtw89_dev *rtwdev,
			   const struct rtw89_led_gpio_entry *e)
{
	rtw89_write32_mask(rtwdev, e->pinmux.addr, e->pinmux.mask, e->pinmux.data);
	rtw89_write16_clr(rtwdev, e->mode.addr, e->mode.data);
}

void rtw89_led_gpio_set(struct rtw89_dev *rtwdev,
			const struct rtw89_led_gpio_entry *e,
			enum led_brightness brightness)
{
	if (brightness == LED_OFF) {
		rtw89_write16_clr(rtwdev, e->mode.addr, e->mode.data);
	} else {
		rtw89_write16_set(rtwdev, e->mode.addr, e->mode.data);
		rtw89_write8_clr(rtwdev, e->out.addr, e->out.data);
	}
}

static int rtw89_led_set(struct led_classdev *led, enum led_brightness brightness)
{
	struct rtw89_led *rtw_led = container_of(led, struct rtw89_led, led);
	struct rtw89_dev *rtwdev = container_of(rtw_led, struct rtw89_dev, led);
	const struct rtw89_led_desc *desc = rtw_led->desc;
	const struct rtw89_led_gpio_entry *e = &desc->gpios[0];

	if (rtw_led->brightness_cache[0] == brightness) {
		rtw89_debug(rtwdev, RTW89_DBG_LED, "led_set: pin=%u skip (no change)\n",
			    e->pin);
		return 0;
	}

	wiphy_lock(rtwdev->hw->wiphy);

	rtw89_debug(rtwdev, RTW89_DBG_LED, "led_set: pin=%u brightness=%u\n",
		    e->pin, brightness);
	rtw89_led_gpio_set(rtwdev, e, brightness);
	rtw_led->brightness_cache[0] = brightness;

	wiphy_unlock(rtwdev->hw->wiphy);

	return 0;
}

static int rtw89_led_sc_init(struct rtw89_dev *rtwdev, const struct rtw89_led_desc *desc)
{
	struct rtw89_led *rtw_led = &rtwdev->led;
	int ret;

	snprintf(rtw_led->name, sizeof(rtw_led->name), "rtw89-%s",
		 wiphy_name(rtwdev->hw->wiphy));
	rtw_led->led.name = rtw_led->name;
	rtw_led->led.brightness_set_blocking = rtw89_led_set;
	rtw_led->led.max_brightness = LED_ON;
	rtw_led->led.default_trigger = ieee80211_get_assoc_led_name(rtwdev->hw);

	ret = led_classdev_register(rtwdev->dev, &rtw_led->led);
	if (ret) {
		rtw89_warn(rtwdev, "failed to register LED, ret=%d\n", ret);
		return ret;
	}

	rtw89_led_gpio_config(rtwdev, &desc->gpios[0]);

	return 0;
}

static void rtw89_led_sc_deinit(struct rtw89_dev *rtwdev)
{
	struct rtw89_led *rtw_led = &rtwdev->led;

	led_classdev_unregister(&rtw_led->led);
}

void rtw89_led_init(struct rtw89_dev *rtwdev)
{
	const struct rtw89_led_desc *desc = &rtw89_common_led_desc;
	struct rtw89_led *rtw_led = &rtwdev->led;
	const struct rtw89_board_variant *board = rtwdev->board;
	int ret;
	int i;

	/* single-GPIO monochrome LED is the only supported layout */
	BUILD_BUG_ON(ARRAY_SIZE(rtw89_common_led_gpios) != 1);

	if (board)
		desc = board->led_desc;
	if (!desc->n_gpio || desc->n_gpio > RTW89_LED_MAX_NUM)
		return;

	rtw_led->desc = desc;
	for (i = 0; i < ARRAY_SIZE(rtw_led->brightness_cache); i++)
		rtw_led->brightness_cache[i] = LED_OFF;

	if (desc->n_gpio == 1)
		ret = rtw89_led_sc_init(rtwdev, desc);
	else
		ret = rtw89_led_mc_init(rtwdev, desc);

	if (ret)
		return;

	rtw_led->registered = true;
}

void rtw89_led_deinit(struct rtw89_dev *rtwdev)
{
	struct rtw89_led *rtw_led = &rtwdev->led;
	const struct rtw89_led_desc *desc = rtw_led->desc;

	if (!rtw_led->registered)
		return;

	if (desc->n_gpio == 1)
		rtw89_led_sc_deinit(rtwdev);
	else
		rtw89_led_mc_deinit(rtwdev);
}