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
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
|
// 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);
}
|
