// 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); }