blob: 85e1f7a9ab031fded8b5285f7c52a888aa1de47d [file] [log] [blame]
developer66e89bc2024-04-23 14:50:01 +08001From ccef6202191f2a17f84f021e6e2ade206b8c9cc1 Mon Sep 17 00:00:00 2001
2From: Evelyn Tsai <evelyn.tsai@mediatek.com>
3Date: Fri, 12 May 2023 05:24:19 +0800
4Subject: [PATCH 051/104] mtk: hostapd: Add muru user number debug command
5
6---
7 hostapd/ctrl_iface.c | 13 ++++++++++++-
8 src/ap/ap_drv_ops.c | 4 ++--
9 src/ap/ap_drv_ops.h | 2 +-
10 src/ap/hostapd.c | 3 ++-
11 src/common/mtk_vendor.h | 7 +++++++
12 src/drivers/driver.h | 4 ++--
13 src/drivers/driver_nl80211.c | 37 ++++++++++++++++++++++++++++--------
14 7 files changed, 55 insertions(+), 15 deletions(-)
15
16diff --git a/hostapd/ctrl_iface.c b/hostapd/ctrl_iface.c
17index 56722384b..88475b321 100644
18--- a/hostapd/ctrl_iface.c
19+++ b/hostapd/ctrl_iface.c
20@@ -3673,6 +3673,8 @@ hostapd_ctrl_iface_set_edcca(struct hostapd_data *hapd, char *cmd,
21 char *buf, size_t buflen)
22 {
23 char *pos, *config, *value;
24+ u8 mode;
25+
26 config = cmd;
27 pos = os_strchr(config, ' ');
28 if (pos == NULL)
29@@ -4065,6 +4067,8 @@ hostapd_ctrl_iface_set_mu(struct hostapd_data *hapd, char *cmd,
30 char *buf, size_t buflen)
31 {
32 char *pos, *config, *value;
33+ u8 mode;
34+
35 config = cmd;
36 pos = os_strchr(config, ' ');
37 if (pos == NULL)
38@@ -4082,13 +4086,20 @@ hostapd_ctrl_iface_set_mu(struct hostapd_data *hapd, char *cmd,
39 return -1;
40 }
41 hapd->iconf->mu_onoff = (u8) mu;
42+ mode = MU_CTRL_ONOFF;
43+ } else if (os_strcmp(config, "ul_user_cnt") == 0) {
44+ mode = MU_CTRL_UL_USER_CNT;
45+ wpa_printf(MSG_ERROR, "ul_user_cnt:%d\n", (u8)atoi(value));
46+ } else if (os_strcmp(config, "dl_user_cnt") == 0) {
47+ mode = MU_CTRL_DL_USER_CNT;
48+ wpa_printf(MSG_ERROR, "dl_user_cnt:%d\n", (u8)atoi(value));
49 } else {
50 wpa_printf(MSG_ERROR,
51 "Unsupported parameter %s for SET_MU", config);
52 return -1;
53 }
54
55- if(hostapd_drv_mu_ctrl(hapd) == 0) {
56+ if(hostapd_drv_mu_ctrl(hapd, mode, (u8)atoi(value)) == 0) {
57 return os_snprintf(buf, buflen, "OK\n");
58 } else {
59 return -1;
60diff --git a/src/ap/ap_drv_ops.c b/src/ap/ap_drv_ops.c
61index df652b12f..8878db380 100644
62--- a/src/ap/ap_drv_ops.c
63+++ b/src/ap/ap_drv_ops.c
64@@ -1270,11 +1270,11 @@ int hostapd_drv_get_edcca(struct hostapd_data *hapd, const u8 mode, u8 *value)
65 return hapd->driver->get_edcca(hapd->drv_priv, mode, value);
66 }
67
68-int hostapd_drv_mu_ctrl(struct hostapd_data *hapd)
69+int hostapd_drv_mu_ctrl(struct hostapd_data *hapd, u8 mode, u8 val)
70 {
71 if (!hapd->driver || !hapd->driver->mu_ctrl)
72 return 0;
73- return hapd->driver->mu_ctrl(hapd->drv_priv, hapd->iconf->mu_onoff);
74+ return hapd->driver->mu_ctrl(hapd->drv_priv, mode, val);
75 }
76
77 int hostapd_drv_mu_dump(struct hostapd_data *hapd, u8 *mu_onoff)
78diff --git a/src/ap/ap_drv_ops.h b/src/ap/ap_drv_ops.h
79index 4805a2e84..f77d07da0 100644
80--- a/src/ap/ap_drv_ops.h
81+++ b/src/ap/ap_drv_ops.h
82@@ -153,7 +153,7 @@ int hostapd_drv_configure_edcca_enable(struct hostapd_data *hapd);
83 int hostapd_drv_configure_edcca_threshold(struct hostapd_data *hapd,
84 const int *threshold);
85 int hostapd_drv_get_edcca(struct hostapd_data *hapd, const u8 mode, u8 *value);
86-int hostapd_drv_mu_ctrl(struct hostapd_data *hapd);
87+int hostapd_drv_mu_ctrl(struct hostapd_data *hapd, u8 mode, u8 val);
88 int hostapd_drv_mu_dump(struct hostapd_data *hapd, u8 *mu_onoff);
89 int hostapd_drv_three_wire_ctrl(struct hostapd_data *hapd);
90 int hostapd_drv_ibf_ctrl(struct hostapd_data *hapd);
91diff --git a/src/ap/hostapd.c b/src/ap/hostapd.c
92index a5b683676..5fd46d53d 100644
93--- a/src/ap/hostapd.c
94+++ b/src/ap/hostapd.c
95@@ -58,6 +58,7 @@
96 #include "wpa_auth_kay.h"
97 #include "hw_features.h"
98
99+#include "common/mtk_vendor.h"
100
101 static int hostapd_flush_old_stations(struct hostapd_data *hapd, u16 reason);
102 #ifdef CONFIG_WEP
103@@ -2699,7 +2700,7 @@ dfs_offload:
104 if (hostapd_drv_configure_edcca_threshold(hapd,
105 hapd->iconf->edcca_threshold) < 0)
106 goto fail;
107- if (hostapd_drv_mu_ctrl(hapd) < 0)
108+ if (hostapd_drv_mu_ctrl(hapd, MU_CTRL_ONOFF, hapd->iconf->mu_onoff) < 0)
109 goto fail;
110 if (hostapd_drv_three_wire_ctrl(hapd) < 0)
111 goto fail;
112diff --git a/src/common/mtk_vendor.h b/src/common/mtk_vendor.h
113index dd1ca2164..99371bf73 100644
114--- a/src/common/mtk_vendor.h
115+++ b/src/common/mtk_vendor.h
116@@ -199,6 +199,8 @@ enum mtk_vendor_attr_mu_ctrl {
117
118 MTK_VENDOR_ATTR_MU_CTRL_ONOFF,
119 MTK_VENDOR_ATTR_MU_CTRL_DUMP,
120+ MTK_VENDOR_ATTR_MU_CTRL_OFDMA_MODE,
121+ MTK_VENDOR_ATTR_MU_CTRL_OFDMA_VAL,
122
123 /* keep last */
124 NUM_MTK_VENDOR_ATTRS_MU_CTRL,
125@@ -272,4 +274,9 @@ struct amnt_resp_data {
126 struct amnt_data resp_data[0];
127 };
128
129+enum {
130+ MU_CTRL_ONOFF,
131+ MU_CTRL_DL_USER_CNT,
132+ MU_CTRL_UL_USER_CNT,
133+};
134 #endif /* MTK_VENDOR_H */
135diff --git a/src/drivers/driver.h b/src/drivers/driver.h
136index dd9c33201..3be4562e7 100644
137--- a/src/drivers/driver.h
138+++ b/src/drivers/driver.h
139@@ -5236,11 +5236,11 @@ struct wpa_driver_ops {
140 int (*get_edcca)(void *priv, const u8 mode, u8 *value);
141
142 /**
143- * mu_ctrl - ctrl on off for UL/DL MURU
144+ * mu_ctrl - ctrl for UL/DL MURU
145 * @priv: Private driver interface data
146 *
147 */
148- int (*mu_ctrl)(void *priv, u8 mu_onoff);
149+ int (*mu_ctrl)(void *priv, u8 mode, u8 val);
150 int (*mu_dump)(void *priv, u8 *mu_onoff);
151
152 /**
153diff --git a/src/drivers/driver_nl80211.c b/src/drivers/driver_nl80211.c
154index a2a6807f4..035a477e2 100644
155--- a/src/drivers/driver_nl80211.c
156+++ b/src/drivers/driver_nl80211.c
157@@ -13982,13 +13982,13 @@ fail:
158
159
160 #ifdef CONFIG_IEEE80211AX
161-static int nl80211_mu_onoff(void *priv, u8 mu_onoff)
162+static int nl80211_mu_ctrl(void *priv, u8 mode, u8 val)
163 {
164 struct i802_bss *bss = priv;
165 struct wpa_driver_nl80211_data *drv = bss->drv;
166 struct nl_msg *msg;
167 struct nlattr *data;
168- int ret;
169+ int ret = -ENOBUFS;
170
171 if (!drv->mtk_mu_vendor_cmd_avail) {
172 wpa_printf(MSG_INFO,
173@@ -13999,17 +13999,38 @@ static int nl80211_mu_onoff(void *priv, u8 mu_onoff)
174 if (!(msg = nl80211_drv_msg(drv, 0, NL80211_CMD_VENDOR)) ||
175 nla_put_u32(msg, NL80211_ATTR_VENDOR_ID, OUI_MTK) ||
176 nla_put_u32(msg, NL80211_ATTR_VENDOR_SUBCMD, MTK_NL80211_VENDOR_SUBCMD_MU_CTRL) ||
177- !(data = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA)) ||
178- nla_put_u8(msg, MTK_VENDOR_ATTR_MU_CTRL_ONOFF, mu_onoff)) {
179- nlmsg_free(msg);
180- return -ENOBUFS;
181+ !(data = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA)))
182+ goto fail;
183+
184+ switch (mode) {
185+ case MU_CTRL_ONOFF:
186+ if (nla_put_u8(msg, MTK_VENDOR_ATTR_MU_CTRL_ONOFF, val))
187+ goto fail;
188+ break;
189+ case MU_CTRL_UL_USER_CNT:
190+ case MU_CTRL_DL_USER_CNT:
191+ if (nla_put_u8(msg, MTK_VENDOR_ATTR_MU_CTRL_OFDMA_MODE, mode) ||
192+ nla_put_u8(msg, MTK_VENDOR_ATTR_MU_CTRL_OFDMA_VAL, val))
193+ goto fail;
194+ break;
195+ default:
196+ wpa_printf(MSG_ERROR, "nl80211: Wrong mu mode !");
197+ ret = -EINVAL;
198+ goto fail;
199 }
200+
201 nla_nest_end(msg, data);
202+
203 ret = send_and_recv_cmd(drv, msg);
204 if(ret){
205- wpa_printf(MSG_ERROR, "Failed to set mu_onoff. ret=%d (%s)", ret, strerror(-ret));
206+ wpa_printf(MSG_ERROR, "Failed to set mu_ctrl. ret=%d (%s)", ret, strerror(-ret));
207 }
208 return ret;
209+
210+fail:
211+ nl80211_nlmsg_clear(msg);
212+ nlmsg_free(msg);
213+ return ret;
214 }
215
216
217@@ -15178,7 +15199,7 @@ const struct wpa_driver_ops wpa_driver_nl80211_ops = {
218 .update_connect_params = nl80211_update_connection_params,
219 .send_external_auth_status = nl80211_send_external_auth_status,
220 .set_4addr_mode = nl80211_set_4addr_mode,
221- .mu_ctrl = nl80211_mu_onoff,
222+ .mu_ctrl = nl80211_mu_ctrl,
223 .mu_dump = nl80211_mu_dump,
224 #ifdef CONFIG_DPP
225 .dpp_listen = nl80211_dpp_listen,
226--
2272.39.2
228