1 // SPDX-License-Identifier: BSD-3-Clause-Clear
2 /* Copyright (C) 2020 MediaTek Inc. */
3
4 #include <linux/fs.h>
5 #include <linux/firmware.h>
6 #include "mt7921.h"
7 #include "regd.h"
8 #include "mcu.h"
9 #include "../mt76_connac2_mac.h"
10 #include "../mt792x_trace.h"
11
12 #define MT_STA_BFER BIT(0)
13 #define MT_STA_BFEE BIT(1)
14
mt7921_mcu_parse_response(struct mt76_dev * mdev,int cmd,struct sk_buff * skb,int seq)15 int mt7921_mcu_parse_response(struct mt76_dev *mdev, int cmd,
16 struct sk_buff *skb, int seq)
17 {
18 int mcu_cmd = FIELD_GET(__MCU_CMD_FIELD_ID, cmd);
19 struct mt76_connac2_mcu_rxd *rxd;
20 int ret = 0;
21
22 if (!skb) {
23 dev_err(mdev->dev, "Message %08x (seq %d) timeout\n",
24 cmd, seq);
25 mt792x_reset(mdev);
26
27 return -ETIMEDOUT;
28 }
29
30 rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
31 if (seq != rxd->seq)
32 return -EAGAIN;
33
34 if (cmd == MCU_CMD(PATCH_SEM_CONTROL) ||
35 cmd == MCU_CMD(PATCH_FINISH_REQ)) {
36 skb_pull(skb, sizeof(*rxd) - 4);
37 ret = *skb->data;
38 } else if (cmd == MCU_EXT_CMD(THERMAL_CTRL)) {
39 skb_pull(skb, sizeof(*rxd) + 4);
40 ret = le32_to_cpu(*(__le32 *)skb->data);
41 } else if (cmd == MCU_UNI_CMD(DEV_INFO_UPDATE) ||
42 cmd == MCU_UNI_CMD(BSS_INFO_UPDATE) ||
43 cmd == MCU_UNI_CMD(STA_REC_UPDATE) ||
44 cmd == MCU_UNI_CMD(HIF_CTRL) ||
45 cmd == MCU_UNI_CMD(OFFLOAD) ||
46 cmd == MCU_UNI_CMD(SUSPEND)) {
47 struct mt76_connac_mcu_uni_event *event;
48
49 skb_pull(skb, sizeof(*rxd));
50 event = (struct mt76_connac_mcu_uni_event *)skb->data;
51 ret = le32_to_cpu(event->status);
52 /* skip invalid event */
53 if (mcu_cmd != event->cid)
54 ret = -EAGAIN;
55 } else if (cmd == MCU_CE_QUERY(REG_READ)) {
56 struct mt76_connac_mcu_reg_event *event;
57
58 skb_pull(skb, sizeof(*rxd));
59 event = (struct mt76_connac_mcu_reg_event *)skb->data;
60 ret = (int)le32_to_cpu(event->val);
61 } else if (cmd == MCU_EXT_CMD(WF_RF_PIN_CTRL)) {
62 struct mt7921_wf_rf_pin_ctrl_event *event;
63
64 skb_pull(skb, sizeof(*rxd));
65 event = (struct mt7921_wf_rf_pin_ctrl_event *)skb->data;
66 ret = (int)event->result;
67 } else {
68 skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
69 }
70
71 return ret;
72 }
73 EXPORT_SYMBOL_GPL(mt7921_mcu_parse_response);
74
mt7921_mcu_read_eeprom(struct mt792x_dev * dev,u32 offset,u8 * val)75 static int mt7921_mcu_read_eeprom(struct mt792x_dev *dev, u32 offset, u8 *val)
76 {
77 struct mt7921_mcu_eeprom_info *res, req = {
78 .addr = cpu_to_le32(round_down(offset,
79 MT7921_EEPROM_BLOCK_SIZE)),
80 };
81 struct sk_buff *skb;
82 int ret;
83
84 ret = mt76_mcu_send_and_get_msg(&dev->mt76, MCU_EXT_QUERY(EFUSE_ACCESS),
85 &req, sizeof(req), true, &skb);
86 if (ret)
87 return ret;
88
89 res = (struct mt7921_mcu_eeprom_info *)skb->data;
90 *val = res->data[offset % MT7921_EEPROM_BLOCK_SIZE];
91 dev_kfree_skb(skb);
92
93 return 0;
94 }
95
96 #ifdef CONFIG_PM
97
98 static int
mt7921_mcu_set_ipv6_ns_filter(struct mt76_dev * dev,struct ieee80211_vif * vif,bool suspend)99 mt7921_mcu_set_ipv6_ns_filter(struct mt76_dev *dev,
100 struct ieee80211_vif *vif, bool suspend)
101 {
102 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
103 struct {
104 struct {
105 u8 bss_idx;
106 u8 pad[3];
107 } __packed hdr;
108 struct mt76_connac_arpns_tlv arpns;
109 } req = {
110 .hdr = {
111 .bss_idx = mvif->bss_conf.mt76.idx,
112 },
113 .arpns = {
114 .tag = cpu_to_le16(UNI_OFFLOAD_OFFLOAD_ND),
115 .len = cpu_to_le16(sizeof(struct mt76_connac_arpns_tlv)),
116 .mode = suspend,
117 },
118 };
119
120 return mt76_mcu_send_msg(dev, MCU_UNI_CMD_OFFLOAD, &req, sizeof(req),
121 true);
122 }
123
mt7921_mcu_set_suspend_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)124 void mt7921_mcu_set_suspend_iter(void *priv, u8 *mac, struct ieee80211_vif *vif)
125 {
126 if (IS_ENABLED(CONFIG_IPV6)) {
127 struct mt76_phy *phy = priv;
128
129 mt7921_mcu_set_ipv6_ns_filter(phy->dev, vif,
130 !test_bit(MT76_STATE_RUNNING,
131 &phy->state));
132 }
133
134 mt76_connac_mcu_set_suspend_iter(priv, mac, vif);
135 }
136
137 #endif /* CONFIG_PM */
138
139 static void
mt7921_mcu_uni_roc_event(struct mt792x_dev * dev,struct sk_buff * skb)140 mt7921_mcu_uni_roc_event(struct mt792x_dev *dev, struct sk_buff *skb)
141 {
142 struct mt7921_roc_grant_tlv *grant;
143 struct mt76_connac2_mcu_rxd *rxd;
144 int duration;
145
146 rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
147 grant = (struct mt7921_roc_grant_tlv *)(rxd->tlv + 4);
148
149 /* should never happen */
150 WARN_ON_ONCE((le16_to_cpu(grant->tag) != UNI_EVENT_ROC_GRANT));
151
152 if (grant->reqtype == MT7921_ROC_REQ_ROC)
153 ieee80211_ready_on_channel(dev->mt76.phy.hw);
154
155 dev->phy.roc_grant = true;
156 wake_up(&dev->phy.roc_wait);
157 duration = le32_to_cpu(grant->max_interval);
158 mod_timer(&dev->phy.roc_timer,
159 jiffies + msecs_to_jiffies(duration));
160 }
161
162 static void
mt7921_mcu_scan_event(struct mt792x_dev * dev,struct sk_buff * skb)163 mt7921_mcu_scan_event(struct mt792x_dev *dev, struct sk_buff *skb)
164 {
165 struct mt76_phy *mphy = &dev->mt76.phy;
166 struct mt792x_phy *phy = mphy->priv;
167
168 spin_lock_bh(&dev->mt76.lock);
169 __skb_queue_tail(&phy->scan_event_list, skb);
170 spin_unlock_bh(&dev->mt76.lock);
171
172 ieee80211_queue_delayed_work(mphy->hw, &phy->scan_work,
173 MT792x_HW_SCAN_TIMEOUT);
174 }
175
176 static void
mt7921_mcu_connection_loss_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)177 mt7921_mcu_connection_loss_iter(void *priv, u8 *mac,
178 struct ieee80211_vif *vif)
179 {
180 struct mt76_vif_link *mvif = (struct mt76_vif_link *)vif->drv_priv;
181 struct mt76_connac_beacon_loss_event *event = priv;
182
183 if (mvif->idx != event->bss_idx)
184 return;
185
186 if (!(vif->driver_flags & IEEE80211_VIF_BEACON_FILTER) ||
187 vif->type != NL80211_IFTYPE_STATION)
188 return;
189
190 ieee80211_connection_loss(vif);
191 }
192
193 static void
mt7921_mcu_connection_loss_event(struct mt792x_dev * dev,struct sk_buff * skb)194 mt7921_mcu_connection_loss_event(struct mt792x_dev *dev, struct sk_buff *skb)
195 {
196 struct mt76_connac_beacon_loss_event *event;
197 struct mt76_phy *mphy = &dev->mt76.phy;
198
199 skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
200 event = (struct mt76_connac_beacon_loss_event *)skb->data;
201
202 ieee80211_iterate_active_interfaces_atomic(mphy->hw,
203 IEEE80211_IFACE_ITER_RESUME_ALL,
204 mt7921_mcu_connection_loss_iter, event);
205 }
206
207 static void
mt7921_mcu_debug_msg_event(struct mt792x_dev * dev,struct sk_buff * skb)208 mt7921_mcu_debug_msg_event(struct mt792x_dev *dev, struct sk_buff *skb)
209 {
210 struct mt7921_debug_msg {
211 __le16 id;
212 u8 type;
213 u8 flag;
214 __le32 value;
215 __le16 len;
216 u8 content[512];
217 } __packed * msg;
218
219 skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
220 msg = (struct mt7921_debug_msg *)skb->data;
221
222 if (msg->type == 3) { /* fw log */
223 u16 len = min_t(u16, le16_to_cpu(msg->len), 512);
224 int i;
225
226 for (i = 0 ; i < len; i++) {
227 if (!msg->content[i])
228 msg->content[i] = ' ';
229 }
230 wiphy_info(mt76_hw(dev)->wiphy, "%.*s", len, msg->content);
231 }
232 }
233
234 static void
mt7921_mcu_low_power_event(struct mt792x_dev * dev,struct sk_buff * skb)235 mt7921_mcu_low_power_event(struct mt792x_dev *dev, struct sk_buff *skb)
236 {
237 struct mt7921_mcu_lp_event {
238 u8 state;
239 u8 reserved[3];
240 } __packed * event;
241
242 skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
243 event = (struct mt7921_mcu_lp_event *)skb->data;
244
245 trace_lp_event(dev, event->state);
246 }
247
248 static void
mt7921_mcu_tx_done_event(struct mt792x_dev * dev,struct sk_buff * skb)249 mt7921_mcu_tx_done_event(struct mt792x_dev *dev, struct sk_buff *skb)
250 {
251 struct mt7921_mcu_tx_done_event *event;
252
253 skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
254 event = (struct mt7921_mcu_tx_done_event *)skb->data;
255
256 mt7921_mac_add_txs(dev, event->txs);
257 }
258
259 static void
mt7921_mcu_rssi_monitor_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)260 mt7921_mcu_rssi_monitor_iter(void *priv, u8 *mac,
261 struct ieee80211_vif *vif)
262 {
263 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
264 struct mt76_connac_rssi_notify_event *event = priv;
265 enum nl80211_cqm_rssi_threshold_event nl_event;
266 s32 rssi = le32_to_cpu(event->rssi[mvif->bss_conf.mt76.idx]);
267
268 if (!rssi)
269 return;
270
271 if (!(vif->driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI))
272 return;
273
274 if (rssi > vif->bss_conf.cqm_rssi_thold)
275 nl_event = NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH;
276 else
277 nl_event = NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW;
278
279 ieee80211_cqm_rssi_notify(vif, nl_event, rssi, GFP_KERNEL);
280 }
281
282 static void
mt7921_mcu_rssi_monitor_event(struct mt792x_dev * dev,struct sk_buff * skb)283 mt7921_mcu_rssi_monitor_event(struct mt792x_dev *dev, struct sk_buff *skb)
284 {
285 struct mt76_connac_rssi_notify_event *event;
286
287 skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
288 event = (struct mt76_connac_rssi_notify_event *)skb->data;
289
290 ieee80211_iterate_active_interfaces_atomic(mt76_hw(dev),
291 IEEE80211_IFACE_ITER_RESUME_ALL,
292 mt7921_mcu_rssi_monitor_iter, event);
293 }
294
295 static void
mt7921_mcu_rx_unsolicited_event(struct mt792x_dev * dev,struct sk_buff * skb)296 mt7921_mcu_rx_unsolicited_event(struct mt792x_dev *dev, struct sk_buff *skb)
297 {
298 struct mt76_connac2_mcu_rxd *rxd;
299
300 rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
301 switch (rxd->eid) {
302 case MCU_EVENT_BSS_BEACON_LOSS:
303 mt7921_mcu_connection_loss_event(dev, skb);
304 break;
305 case MCU_EVENT_SCHED_SCAN_DONE:
306 case MCU_EVENT_SCAN_DONE:
307 mt7921_mcu_scan_event(dev, skb);
308 return;
309 case MCU_EVENT_DBG_MSG:
310 mt7921_mcu_debug_msg_event(dev, skb);
311 break;
312 case MCU_EVENT_COREDUMP:
313 dev->fw_assert = true;
314 mt76_connac_mcu_coredump_event(&dev->mt76, skb,
315 &dev->coredump);
316 return;
317 case MCU_EVENT_LP_INFO:
318 mt7921_mcu_low_power_event(dev, skb);
319 break;
320 case MCU_EVENT_TX_DONE:
321 mt7921_mcu_tx_done_event(dev, skb);
322 break;
323 case MCU_EVENT_RSSI_NOTIFY:
324 mt7921_mcu_rssi_monitor_event(dev, skb);
325 break;
326 default:
327 break;
328 }
329 dev_kfree_skb(skb);
330 }
331
332 static void
mt7921_mcu_uni_rx_unsolicited_event(struct mt792x_dev * dev,struct sk_buff * skb)333 mt7921_mcu_uni_rx_unsolicited_event(struct mt792x_dev *dev,
334 struct sk_buff *skb)
335 {
336 struct mt76_connac2_mcu_rxd *rxd;
337
338 rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
339
340 switch (rxd->eid) {
341 case MCU_UNI_EVENT_ROC:
342 mt7921_mcu_uni_roc_event(dev, skb);
343 break;
344 default:
345 break;
346 }
347 dev_kfree_skb(skb);
348 }
349
mt7921_mcu_rx_event(struct mt792x_dev * dev,struct sk_buff * skb)350 void mt7921_mcu_rx_event(struct mt792x_dev *dev, struct sk_buff *skb)
351 {
352 struct mt76_connac2_mcu_rxd *rxd;
353
354 if (skb_linearize(skb)) {
355 dev_kfree_skb(skb);
356 return;
357 }
358
359 rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
360
361 if (rxd->option & MCU_UNI_CMD_UNSOLICITED_EVENT) {
362 mt7921_mcu_uni_rx_unsolicited_event(dev, skb);
363 return;
364 }
365
366 if (rxd->eid == 0x6) {
367 mt76_mcu_rx_event(&dev->mt76, skb);
368 return;
369 }
370
371 if (rxd->ext_eid == MCU_EXT_EVENT_RATE_REPORT ||
372 rxd->eid == MCU_EVENT_BSS_BEACON_LOSS ||
373 rxd->eid == MCU_EVENT_SCHED_SCAN_DONE ||
374 rxd->eid == MCU_EVENT_RSSI_NOTIFY ||
375 rxd->eid == MCU_EVENT_SCAN_DONE ||
376 rxd->eid == MCU_EVENT_TX_DONE ||
377 rxd->eid == MCU_EVENT_DBG_MSG ||
378 rxd->eid == MCU_EVENT_COREDUMP ||
379 rxd->eid == MCU_EVENT_LP_INFO ||
380 !rxd->seq)
381 mt7921_mcu_rx_unsolicited_event(dev, skb);
382 else
383 mt76_mcu_rx_event(&dev->mt76, skb);
384 }
385
386 /** starec & wtbl **/
mt7921_mcu_uni_tx_ba(struct mt792x_dev * dev,struct ieee80211_ampdu_params * params,bool enable)387 int mt7921_mcu_uni_tx_ba(struct mt792x_dev *dev,
388 struct ieee80211_ampdu_params *params,
389 bool enable)
390 {
391 struct mt792x_sta *msta = (struct mt792x_sta *)params->sta->drv_priv;
392
393 if (enable && !params->amsdu)
394 msta->deflink.wcid.amsdu = false;
395
396 return mt76_connac_mcu_sta_ba(&dev->mt76, &msta->vif->bss_conf.mt76, params,
397 MCU_UNI_CMD(STA_REC_UPDATE),
398 enable, true);
399 }
400
mt7921_mcu_uni_rx_ba(struct mt792x_dev * dev,struct ieee80211_ampdu_params * params,bool enable)401 int mt7921_mcu_uni_rx_ba(struct mt792x_dev *dev,
402 struct ieee80211_ampdu_params *params,
403 bool enable)
404 {
405 struct mt792x_sta *msta = (struct mt792x_sta *)params->sta->drv_priv;
406
407 return mt76_connac_mcu_sta_ba(&dev->mt76, &msta->vif->bss_conf.mt76, params,
408 MCU_UNI_CMD(STA_REC_UPDATE),
409 enable, false);
410 }
411
mt7921_load_clc(struct mt792x_dev * dev,const char * fw_name)412 static int mt7921_load_clc(struct mt792x_dev *dev, const char *fw_name)
413 {
414 const struct mt76_connac2_fw_trailer *hdr;
415 const struct mt76_connac2_fw_region *region;
416 const struct mt7921_clc *clc;
417 struct mt76_dev *mdev = &dev->mt76;
418 struct mt792x_phy *phy = &dev->phy;
419 const struct firmware *fw;
420 size_t clc_len, fw_data_len, len, offset = 0;
421 int ret, i;
422 u8 *clc_base = NULL, hw_encap = 0;
423
424 dev->phy.clc_chan_conf = 0xff;
425 dev->regd_user = false;
426 if (!mt7921_regd_clc_supported(dev))
427 return 0;
428
429 if (mt76_is_mmio(&dev->mt76)) {
430 ret = mt7921_mcu_read_eeprom(dev, MT_EE_HW_TYPE, &hw_encap);
431 if (ret)
432 return ret;
433 hw_encap = u8_get_bits(hw_encap, MT_EE_HW_TYPE_ENCAP);
434 }
435
436 ret = request_firmware(&fw, fw_name, mdev->dev);
437 if (ret)
438 return ret;
439
440 if (!fw || !fw->data || fw->size < sizeof(*hdr)) {
441 dev_err(mdev->dev, "Invalid firmware\n");
442 ret = -EINVAL;
443 goto out;
444 }
445
446 hdr = (const void *)(fw->data + fw->size - sizeof(*hdr));
447 if (hdr->n_region > (fw->size - sizeof(*hdr)) / sizeof(*region)) {
448 dev_err(mdev->dev, "Invalid firmware region table\n");
449 ret = -EINVAL;
450 goto out;
451 }
452 fw_data_len = fw->size - sizeof(*hdr) -
453 hdr->n_region * sizeof(*region);
454
455 for (i = 0; i < hdr->n_region; i++) {
456 region = (const void *)((const u8 *)hdr -
457 (hdr->n_region - i) * sizeof(*region));
458 len = le32_to_cpu(region->len);
459
460 /* check if we have valid buffer size */
461 if (len > fw_data_len - offset) {
462 dev_err(mdev->dev, "Invalid firmware region\n");
463 ret = -EINVAL;
464 goto out;
465 }
466
467 if ((region->feature_set & FW_FEATURE_NON_DL) &&
468 region->type == FW_TYPE_CLC) {
469 clc_base = (u8 *)(fw->data + offset);
470 break;
471 }
472 offset += len;
473 }
474
475 if (!clc_base)
476 goto out;
477
478 for (offset = 0; offset < len; offset += clc_len) {
479 if (len - offset < sizeof(*clc)) {
480 dev_err(mdev->dev, "Invalid CLC record\n");
481 ret = -EINVAL;
482 goto out;
483 }
484
485 clc = (const struct mt7921_clc *)(clc_base + offset);
486 clc_len = le32_to_cpu(clc->len);
487 if (clc_len < sizeof(*clc) || clc_len > len - offset) {
488 dev_err(mdev->dev, "Invalid CLC record\n");
489 ret = -EINVAL;
490 goto out;
491 }
492
493 /* Newer firmware may add records this driver does not use yet */
494 if (clc->idx >= ARRAY_SIZE(phy->clc))
495 continue;
496
497 /* do not init buf again if chip reset triggered */
498 if (phy->clc[clc->idx])
499 continue;
500
501 /* header content sanity */
502 if (clc->idx == MT7921_CLC_POWER &&
503 u8_get_bits(clc->type, MT_EE_HW_TYPE_ENCAP) != hw_encap)
504 continue;
505
506 phy->clc[clc->idx] = devm_kmemdup(mdev->dev, clc,
507 clc_len,
508 GFP_KERNEL);
509
510 if (!phy->clc[clc->idx]) {
511 ret = -ENOMEM;
512 goto out;
513 }
514 }
515
516 ret = mt7921_regd_init(phy);
517 out:
518 release_firmware(fw);
519
520 return ret;
521 }
522
mt7921_mcu_parse_tx_resource(struct mt76_dev * dev,struct sk_buff * skb)523 static void mt7921_mcu_parse_tx_resource(struct mt76_dev *dev,
524 struct sk_buff *skb)
525 {
526 struct mt76_sdio *sdio = &dev->sdio;
527 struct mt7921_tx_resource {
528 __le32 version;
529 __le32 pse_data_quota;
530 __le32 pse_mcu_quota;
531 __le32 ple_data_quota;
532 __le32 ple_mcu_quota;
533 __le16 pse_page_size;
534 __le16 ple_page_size;
535 u8 pp_padding;
536 u8 pad[3];
537 } __packed * tx_res;
538
539 tx_res = (struct mt7921_tx_resource *)skb->data;
540 sdio->sched.pse_data_quota = le32_to_cpu(tx_res->pse_data_quota);
541 sdio->pse_mcu_quota_max = le32_to_cpu(tx_res->pse_mcu_quota);
542 /* The mcu quota usage of this function itself must be taken into consideration */
543 sdio->sched.pse_mcu_quota =
544 sdio->sched.pse_mcu_quota ? sdio->pse_mcu_quota_max : sdio->pse_mcu_quota_max - 1;
545 sdio->sched.ple_data_quota = le32_to_cpu(tx_res->ple_data_quota);
546 sdio->sched.pse_page_size = le16_to_cpu(tx_res->pse_page_size);
547 sdio->sched.deficit = tx_res->pp_padding;
548 }
549
mt7921_mcu_parse_phy_cap(struct mt76_dev * dev,struct sk_buff * skb)550 static void mt7921_mcu_parse_phy_cap(struct mt76_dev *dev,
551 struct sk_buff *skb)
552 {
553 struct mt7921_phy_cap {
554 u8 ht;
555 u8 vht;
556 u8 _5g;
557 u8 max_bw;
558 u8 nss;
559 u8 dbdc;
560 u8 tx_ldpc;
561 u8 rx_ldpc;
562 u8 tx_stbc;
563 u8 rx_stbc;
564 u8 hw_path;
565 u8 he;
566 } __packed * cap;
567
568 enum {
569 WF0_24G,
570 WF0_5G
571 };
572
573 cap = (struct mt7921_phy_cap *)skb->data;
574
575 dev->phy.antenna_mask = BIT(cap->nss) - 1;
576 dev->phy.chainmask = dev->phy.antenna_mask;
577 dev->phy.cap.has_2ghz = cap->hw_path & BIT(WF0_24G);
578 dev->phy.cap.has_5ghz = cap->hw_path & BIT(WF0_5G);
579 }
580
mt7921_mcu_get_nic_capability(struct mt792x_phy * mphy)581 static int mt7921_mcu_get_nic_capability(struct mt792x_phy *mphy)
582 {
583 struct mt76_connac_cap_hdr {
584 __le16 n_element;
585 u8 rsv[2];
586 } __packed * hdr;
587 struct sk_buff *skb;
588 struct mt76_phy *phy = mphy->mt76;
589 int ret, i;
590
591 ret = mt76_mcu_send_and_get_msg(phy->dev, MCU_CE_CMD(GET_NIC_CAPAB),
592 NULL, 0, true, &skb);
593 if (ret)
594 return ret;
595
596 hdr = (struct mt76_connac_cap_hdr *)skb->data;
597 if (skb->len < sizeof(*hdr)) {
598 ret = -EINVAL;
599 goto out;
600 }
601
602 skb_pull(skb, sizeof(*hdr));
603
604 for (i = 0; i < le16_to_cpu(hdr->n_element); i++) {
605 struct tlv_hdr {
606 __le32 type;
607 __le32 len;
608 } __packed * tlv = (struct tlv_hdr *)skb->data;
609 int len;
610
611 if (skb->len < sizeof(*tlv))
612 break;
613
614 skb_pull(skb, sizeof(*tlv));
615
616 len = le32_to_cpu(tlv->len);
617 if (skb->len < len)
618 break;
619
620 switch (le32_to_cpu(tlv->type)) {
621 case MT_NIC_CAP_6G:
622 phy->cap.has_6ghz = skb->data[0];
623 break;
624 case MT_NIC_CAP_MAC_ADDR:
625 memcpy(phy->macaddr, (void *)skb->data, ETH_ALEN);
626 break;
627 case MT_NIC_CAP_PHY:
628 mt7921_mcu_parse_phy_cap(phy->dev, skb);
629 break;
630 case MT_NIC_CAP_TX_RESOURCE:
631 if (mt76_is_sdio(phy->dev))
632 mt7921_mcu_parse_tx_resource(phy->dev,
633 skb);
634 break;
635 case MT_NIC_CAP_CHIP_CAP:
636 memcpy(&mphy->chip_cap, (void *)skb->data, sizeof(u64));
637 break;
638 default:
639 break;
640 }
641 skb_pull(skb, len);
642 }
643 out:
644 dev_kfree_skb(skb);
645
646 return ret;
647 }
648
mt7921_mcu_fw_log_2_host(struct mt792x_dev * dev,u8 ctrl)649 int mt7921_mcu_fw_log_2_host(struct mt792x_dev *dev, u8 ctrl)
650 {
651 struct {
652 u8 ctrl_val;
653 u8 pad[3];
654 } data = {
655 .ctrl_val = ctrl
656 };
657
658 return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(FWLOG_2_HOST),
659 &data, sizeof(data), false);
660 }
661
mt7921_run_firmware(struct mt792x_dev * dev)662 int mt7921_run_firmware(struct mt792x_dev *dev)
663 {
664 int err;
665
666 err = mt792x_load_firmware(dev);
667 if (err)
668 return err;
669
670 err = mt7921_mcu_get_nic_capability(&dev->phy);
671 if (err)
672 return err;
673
674 err = mt7921_load_clc(dev, mt792x_ram_name(dev));
675 if (err)
676 return err;
677 set_bit(MT76_STATE_MCU_RUNNING, &dev->mphy.state);
678
679 return mt7921_mcu_fw_log_2_host(dev, 1);
680 }
681 EXPORT_SYMBOL_GPL(mt7921_run_firmware);
682
mt7921_mcu_radio_led_ctrl(struct mt792x_dev * dev,u8 value)683 int mt7921_mcu_radio_led_ctrl(struct mt792x_dev *dev, u8 value)
684 {
685 struct {
686 u8 ctrlid;
687 u8 rsv[3];
688 } __packed req = {
689 .ctrlid = value,
690 };
691
692 return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(ID_RADIO_ON_OFF_CTRL),
693 &req, sizeof(req), false);
694 }
695 EXPORT_SYMBOL_GPL(mt7921_mcu_radio_led_ctrl);
696
mt7921_mcu_set_tx(struct mt792x_dev * dev,struct ieee80211_vif * vif)697 int mt7921_mcu_set_tx(struct mt792x_dev *dev, struct ieee80211_vif *vif)
698 {
699 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
700 struct edca {
701 __le16 cw_min;
702 __le16 cw_max;
703 __le16 txop;
704 __le16 aifs;
705 u8 guardtime;
706 u8 acm;
707 } __packed;
708 struct mt7921_mcu_tx {
709 struct edca edca[IEEE80211_NUM_ACS];
710 u8 bss_idx;
711 u8 qos;
712 u8 wmm_idx;
713 u8 pad;
714 } __packed req = {
715 .bss_idx = mvif->bss_conf.mt76.idx,
716 .qos = vif->bss_conf.qos,
717 .wmm_idx = mvif->bss_conf.mt76.wmm_idx,
718 };
719 struct mu_edca {
720 u8 cw_min;
721 u8 cw_max;
722 u8 aifsn;
723 u8 acm;
724 u8 timer;
725 u8 padding[3];
726 };
727 struct mt7921_mcu_mu_tx {
728 u8 ver;
729 u8 pad0;
730 __le16 len;
731 u8 bss_idx;
732 u8 qos;
733 u8 wmm_idx;
734 u8 pad1;
735 struct mu_edca edca[IEEE80211_NUM_ACS];
736 u8 pad3[32];
737 } __packed req_mu = {
738 .bss_idx = mvif->bss_conf.mt76.idx,
739 .qos = vif->bss_conf.qos,
740 .wmm_idx = mvif->bss_conf.mt76.wmm_idx,
741 };
742 static const int to_aci[] = { 1, 0, 2, 3 };
743 int ac, ret;
744
745 for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
746 struct ieee80211_tx_queue_params *q = &mvif->bss_conf.queue_params[ac];
747 struct edca *e = &req.edca[to_aci[ac]];
748
749 e->aifs = cpu_to_le16(q->aifs);
750 e->txop = cpu_to_le16(q->txop);
751
752 if (q->cw_min)
753 e->cw_min = cpu_to_le16(q->cw_min);
754 else
755 e->cw_min = cpu_to_le16(5);
756
757 if (q->cw_max)
758 e->cw_max = cpu_to_le16(q->cw_max);
759 else
760 e->cw_max = cpu_to_le16(10);
761 }
762
763 ret = mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_EDCA_PARMS), &req,
764 sizeof(req), false);
765 if (ret)
766 return ret;
767
768 if (!vif->bss_conf.he_support)
769 return 0;
770
771 for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
772 struct ieee80211_he_mu_edca_param_ac_rec *q;
773 struct mu_edca *e;
774
775 if (!mvif->bss_conf.queue_params[ac].mu_edca)
776 break;
777
778 q = &mvif->bss_conf.queue_params[ac].mu_edca_param_rec;
779 e = &(req_mu.edca[to_aci[ac]]);
780
781 e->cw_min = q->ecw_min_max & 0xf;
782 e->cw_max = (q->ecw_min_max & 0xf0) >> 4;
783 e->aifsn = q->aifsn;
784 e->timer = q->mu_edca_timer;
785 }
786
787 return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_MU_EDCA_PARMS),
788 &req_mu, sizeof(req_mu), false);
789 }
790
mt7921_mcu_set_roc(struct mt792x_phy * phy,struct mt792x_vif * vif,struct ieee80211_channel * chan,int duration,enum mt7921_roc_req type,u8 token_id)791 int mt7921_mcu_set_roc(struct mt792x_phy *phy, struct mt792x_vif *vif,
792 struct ieee80211_channel *chan, int duration,
793 enum mt7921_roc_req type, u8 token_id)
794 {
795 int center_ch = ieee80211_frequency_to_channel(chan->center_freq);
796 struct mt792x_dev *dev = phy->dev;
797 struct {
798 struct {
799 u8 rsv[4];
800 } __packed hdr;
801 struct roc_acquire_tlv {
802 __le16 tag;
803 __le16 len;
804 u8 bss_idx;
805 u8 tokenid;
806 u8 control_channel;
807 u8 sco;
808 u8 band;
809 u8 bw;
810 u8 center_chan;
811 u8 center_chan2;
812 u8 bw_from_ap;
813 u8 center_chan_from_ap;
814 u8 center_chan2_from_ap;
815 u8 reqtype;
816 __le32 maxinterval;
817 u8 dbdcband;
818 u8 rsv[3];
819 } __packed roc;
820 } __packed req = {
821 .roc = {
822 .tag = cpu_to_le16(UNI_ROC_ACQUIRE),
823 .len = cpu_to_le16(sizeof(struct roc_acquire_tlv)),
824 .tokenid = token_id,
825 .reqtype = type,
826 .maxinterval = cpu_to_le32(duration),
827 .bss_idx = vif->bss_conf.mt76.idx,
828 .control_channel = chan->hw_value,
829 .bw = CMD_CBW_20MHZ,
830 .bw_from_ap = CMD_CBW_20MHZ,
831 .center_chan = center_ch,
832 .center_chan_from_ap = center_ch,
833 .dbdcband = 0xff, /* auto */
834 },
835 };
836
837 if (chan->hw_value < center_ch)
838 req.roc.sco = 1; /* SCA */
839 else if (chan->hw_value > center_ch)
840 req.roc.sco = 3; /* SCB */
841
842 switch (chan->band) {
843 case NL80211_BAND_6GHZ:
844 req.roc.band = 3;
845 break;
846 case NL80211_BAND_5GHZ:
847 req.roc.band = 2;
848 break;
849 default:
850 req.roc.band = 1;
851 break;
852 }
853
854 return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(ROC),
855 &req, sizeof(req), false);
856 }
857
mt7921_mcu_abort_roc(struct mt792x_phy * phy,struct mt792x_vif * vif,u8 token_id)858 int mt7921_mcu_abort_roc(struct mt792x_phy *phy, struct mt792x_vif *vif,
859 u8 token_id)
860 {
861 struct mt792x_dev *dev = phy->dev;
862 struct {
863 struct {
864 u8 rsv[4];
865 } __packed hdr;
866 struct roc_abort_tlv {
867 __le16 tag;
868 __le16 len;
869 u8 bss_idx;
870 u8 tokenid;
871 u8 dbdcband;
872 u8 rsv[5];
873 } __packed abort;
874 } __packed req = {
875 .abort = {
876 .tag = cpu_to_le16(UNI_ROC_ABORT),
877 .len = cpu_to_le16(sizeof(struct roc_abort_tlv)),
878 .tokenid = token_id,
879 .bss_idx = vif->bss_conf.mt76.idx,
880 .dbdcband = 0xff, /* auto*/
881 },
882 };
883
884 return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(ROC),
885 &req, sizeof(req), false);
886 }
887
mt7921_mcu_set_chan_info(struct mt792x_phy * phy,int cmd)888 int mt7921_mcu_set_chan_info(struct mt792x_phy *phy, int cmd)
889 {
890 struct mt792x_dev *dev = phy->dev;
891 struct cfg80211_chan_def *chandef = &phy->mt76->chandef;
892 int freq1 = chandef->center_freq1;
893 struct {
894 u8 control_ch;
895 u8 center_ch;
896 u8 bw;
897 u8 tx_streams_num;
898 u8 rx_streams; /* mask or num */
899 u8 switch_reason;
900 u8 band_idx;
901 u8 center_ch2; /* for 80+80 only */
902 __le16 cac_case;
903 u8 channel_band;
904 u8 rsv0;
905 __le32 outband_freq;
906 u8 txpower_drop;
907 u8 ap_bw;
908 u8 ap_center_ch;
909 u8 rsv1[57];
910 } __packed req = {
911 .control_ch = chandef->chan->hw_value,
912 .center_ch = ieee80211_frequency_to_channel(freq1),
913 .bw = mt76_connac_chan_bw(chandef),
914 .tx_streams_num = hweight8(phy->mt76->antenna_mask),
915 .rx_streams = phy->mt76->antenna_mask,
916 .band_idx = phy != &dev->phy,
917 };
918
919 if (chandef->chan->band == NL80211_BAND_6GHZ)
920 req.channel_band = 2;
921 else
922 req.channel_band = chandef->chan->band;
923
924 if (cmd == MCU_EXT_CMD(SET_RX_PATH) ||
925 dev->mt76.hw->conf.flags & IEEE80211_CONF_MONITOR)
926 req.switch_reason = CH_SWITCH_NORMAL;
927 else if (phy->mt76->offchannel)
928 req.switch_reason = CH_SWITCH_SCAN_BYPASS_DPD;
929 else if (!cfg80211_reg_can_beacon(dev->mt76.hw->wiphy, chandef,
930 NL80211_IFTYPE_AP))
931 req.switch_reason = CH_SWITCH_DFS;
932 else
933 req.switch_reason = CH_SWITCH_NORMAL;
934
935 if (cmd == MCU_EXT_CMD(CHANNEL_SWITCH))
936 req.rx_streams = hweight8(req.rx_streams);
937
938 if (chandef->width == NL80211_CHAN_WIDTH_80P80) {
939 int freq2 = chandef->center_freq2;
940
941 req.center_ch2 = ieee80211_frequency_to_channel(freq2);
942 }
943
944 return mt76_mcu_send_msg(&dev->mt76, cmd, &req, sizeof(req), true);
945 }
946
mt7921_mcu_set_eeprom(struct mt792x_dev * dev)947 int mt7921_mcu_set_eeprom(struct mt792x_dev *dev)
948 {
949 struct req_hdr {
950 u8 buffer_mode;
951 u8 format;
952 __le16 len;
953 } __packed req = {
954 .buffer_mode = EE_MODE_EFUSE,
955 .format = EE_FORMAT_WHOLE,
956 };
957
958 return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(EFUSE_BUFFER_MODE),
959 &req, sizeof(req), true);
960 }
961 EXPORT_SYMBOL_GPL(mt7921_mcu_set_eeprom);
962
mt7921_mcu_uni_bss_ps(struct mt792x_dev * dev,struct ieee80211_vif * vif)963 int mt7921_mcu_uni_bss_ps(struct mt792x_dev *dev, struct ieee80211_vif *vif)
964 {
965 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
966 struct {
967 struct {
968 u8 bss_idx;
969 u8 pad[3];
970 } __packed hdr;
971 struct ps_tlv {
972 __le16 tag;
973 __le16 len;
974 u8 ps_state; /* 0: device awake
975 * 1: static power save
976 * 2: dynamic power saving
977 * 3: enter TWT power saving
978 * 4: leave TWT power saving
979 */
980 u8 pad[3];
981 } __packed ps;
982 } __packed ps_req = {
983 .hdr = {
984 .bss_idx = mvif->bss_conf.mt76.idx,
985 },
986 .ps = {
987 .tag = cpu_to_le16(UNI_BSS_INFO_PS),
988 .len = cpu_to_le16(sizeof(struct ps_tlv)),
989 .ps_state = vif->cfg.ps ? 2 : 0,
990 },
991 };
992
993 if (vif->type != NL80211_IFTYPE_STATION)
994 return -EOPNOTSUPP;
995
996 return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(BSS_INFO_UPDATE),
997 &ps_req, sizeof(ps_req), true);
998 }
999
1000 static int
mt7921_mcu_uni_bss_bcnft(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)1001 mt7921_mcu_uni_bss_bcnft(struct mt792x_dev *dev, struct ieee80211_vif *vif,
1002 bool enable)
1003 {
1004 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1005 struct {
1006 struct {
1007 u8 bss_idx;
1008 u8 pad[3];
1009 } __packed hdr;
1010 struct bcnft_tlv {
1011 __le16 tag;
1012 __le16 len;
1013 __le16 bcn_interval;
1014 u8 dtim_period;
1015 u8 pad;
1016 } __packed bcnft;
1017 } __packed bcnft_req = {
1018 .hdr = {
1019 .bss_idx = mvif->bss_conf.mt76.idx,
1020 },
1021 .bcnft = {
1022 .tag = cpu_to_le16(UNI_BSS_INFO_BCNFT),
1023 .len = cpu_to_le16(sizeof(struct bcnft_tlv)),
1024 .bcn_interval = cpu_to_le16(vif->bss_conf.beacon_int),
1025 .dtim_period = vif->bss_conf.dtim_period,
1026 },
1027 };
1028
1029 if (vif->type != NL80211_IFTYPE_STATION)
1030 return 0;
1031
1032 return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(BSS_INFO_UPDATE),
1033 &bcnft_req, sizeof(bcnft_req), true);
1034 }
1035
1036 int
mt7921_mcu_set_bss_pm(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)1037 mt7921_mcu_set_bss_pm(struct mt792x_dev *dev, struct ieee80211_vif *vif,
1038 bool enable)
1039 {
1040 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1041 struct {
1042 u8 bss_idx;
1043 u8 dtim_period;
1044 __le16 aid;
1045 __le16 bcn_interval;
1046 __le16 atim_window;
1047 u8 uapsd;
1048 u8 bmc_delivered_ac;
1049 u8 bmc_triggered_ac;
1050 u8 pad;
1051 } req = {
1052 .bss_idx = mvif->bss_conf.mt76.idx,
1053 .aid = cpu_to_le16(vif->cfg.aid),
1054 .dtim_period = vif->bss_conf.dtim_period,
1055 .bcn_interval = cpu_to_le16(vif->bss_conf.beacon_int),
1056 };
1057 struct {
1058 u8 bss_idx;
1059 u8 pad[3];
1060 } req_hdr = {
1061 .bss_idx = mvif->bss_conf.mt76.idx,
1062 };
1063 int err;
1064
1065 err = mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_BSS_ABORT),
1066 &req_hdr, sizeof(req_hdr), false);
1067 if (err < 0 || !enable)
1068 return err;
1069
1070 return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_BSS_CONNECTED),
1071 &req, sizeof(req), false);
1072 }
1073
mt7921_mcu_sta_update(struct mt792x_dev * dev,struct ieee80211_sta * sta,struct ieee80211_vif * vif,bool enable,enum mt76_sta_info_state state)1074 int mt7921_mcu_sta_update(struct mt792x_dev *dev, struct ieee80211_sta *sta,
1075 struct ieee80211_vif *vif, bool enable,
1076 enum mt76_sta_info_state state)
1077 {
1078 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1079 int rssi = -ewma_rssi_read(&mvif->bss_conf.rssi);
1080 struct mt76_sta_cmd_info info = {
1081 .sta = sta,
1082 .vif = vif,
1083 .enable = enable,
1084 .cmd = MCU_UNI_CMD(STA_REC_UPDATE),
1085 .state = state,
1086 .offload_fw = true,
1087 .rcpi = to_rcpi(rssi),
1088 };
1089 struct mt792x_sta *msta;
1090
1091 msta = sta ? (struct mt792x_sta *)sta->drv_priv : NULL;
1092 info.wcid = msta ? &msta->deflink.wcid : &mvif->sta.deflink.wcid;
1093 info.newly = msta ? state != MT76_STA_INFO_STATE_ASSOC : true;
1094
1095 return mt76_connac_mcu_sta_cmd(&dev->mphy, &info);
1096 }
1097
mt7921_mcu_set_beacon_filter(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)1098 int mt7921_mcu_set_beacon_filter(struct mt792x_dev *dev,
1099 struct ieee80211_vif *vif,
1100 bool enable)
1101 {
1102 #define MT7921_FIF_BIT_CLR BIT(1)
1103 #define MT7921_FIF_BIT_SET BIT(0)
1104 int err;
1105
1106 if (enable) {
1107 err = mt7921_mcu_uni_bss_bcnft(dev, vif, true);
1108 if (err)
1109 return err;
1110
1111 err = mt7921_mcu_set_rxfilter(dev, 0,
1112 MT7921_FIF_BIT_SET,
1113 MT_WF_RFCR_DROP_OTHER_BEACON);
1114 if (err)
1115 return err;
1116
1117 return 0;
1118 }
1119
1120 err = mt7921_mcu_set_bss_pm(dev, vif, false);
1121 if (err)
1122 return err;
1123
1124 err = mt7921_mcu_set_rxfilter(dev, 0,
1125 MT7921_FIF_BIT_CLR,
1126 MT_WF_RFCR_DROP_OTHER_BEACON);
1127 if (err)
1128 return err;
1129
1130 return 0;
1131 }
1132
mt7921_get_txpwr_info(struct mt792x_dev * dev,struct mt7921_txpwr * txpwr)1133 int mt7921_get_txpwr_info(struct mt792x_dev *dev, struct mt7921_txpwr *txpwr)
1134 {
1135 struct mt7921_txpwr_event *event;
1136 struct mt7921_txpwr_req req = {
1137 .dbdc_idx = 0,
1138 };
1139 struct sk_buff *skb;
1140 int ret;
1141
1142 ret = mt76_mcu_send_and_get_msg(&dev->mt76, MCU_CE_CMD(GET_TXPWR),
1143 &req, sizeof(req), true, &skb);
1144 if (ret)
1145 return ret;
1146
1147 event = (struct mt7921_txpwr_event *)skb->data;
1148 WARN_ON(skb->len != le16_to_cpu(event->len));
1149 memcpy(txpwr, &event->txpwr, sizeof(event->txpwr));
1150
1151 dev_kfree_skb(skb);
1152
1153 return 0;
1154 }
1155
mt7921_mcu_set_sniffer(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)1156 int mt7921_mcu_set_sniffer(struct mt792x_dev *dev, struct ieee80211_vif *vif,
1157 bool enable)
1158 {
1159 struct mt76_vif_link *mvif = (struct mt76_vif_link *)vif->drv_priv;
1160 struct {
1161 struct {
1162 u8 band_idx;
1163 u8 pad[3];
1164 } __packed hdr;
1165 struct sniffer_enable_tlv {
1166 __le16 tag;
1167 __le16 len;
1168 u8 enable;
1169 u8 pad[3];
1170 } __packed enable;
1171 } req = {
1172 .hdr = {
1173 .band_idx = mvif->band_idx,
1174 },
1175 .enable = {
1176 .tag = cpu_to_le16(0),
1177 .len = cpu_to_le16(sizeof(struct sniffer_enable_tlv)),
1178 .enable = enable,
1179 },
1180 };
1181
1182 return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(SNIFFER), &req, sizeof(req),
1183 true);
1184 }
1185
mt7921_mcu_config_sniffer(struct mt792x_vif * vif,struct ieee80211_chanctx_conf * ctx)1186 int mt7921_mcu_config_sniffer(struct mt792x_vif *vif,
1187 struct ieee80211_chanctx_conf *ctx)
1188 {
1189 struct cfg80211_chan_def *chandef = &ctx->def;
1190 int freq1 = chandef->center_freq1, freq2 = chandef->center_freq2;
1191 static const u8 ch_band[] = {
1192 [NL80211_BAND_2GHZ] = 1,
1193 [NL80211_BAND_5GHZ] = 2,
1194 [NL80211_BAND_6GHZ] = 3,
1195 };
1196 static const u8 ch_width[] = {
1197 [NL80211_CHAN_WIDTH_20_NOHT] = 0,
1198 [NL80211_CHAN_WIDTH_20] = 0,
1199 [NL80211_CHAN_WIDTH_40] = 0,
1200 [NL80211_CHAN_WIDTH_80] = 1,
1201 [NL80211_CHAN_WIDTH_160] = 2,
1202 [NL80211_CHAN_WIDTH_80P80] = 3,
1203 [NL80211_CHAN_WIDTH_5] = 4,
1204 [NL80211_CHAN_WIDTH_10] = 5,
1205 [NL80211_CHAN_WIDTH_320] = 6,
1206 };
1207 struct {
1208 struct {
1209 u8 band_idx;
1210 u8 pad[3];
1211 } __packed hdr;
1212 struct config_tlv {
1213 __le16 tag;
1214 __le16 len;
1215 u16 aid;
1216 u8 ch_band;
1217 u8 bw;
1218 u8 control_ch;
1219 u8 sco;
1220 u8 center_ch;
1221 u8 center_ch2;
1222 u8 drop_err;
1223 u8 pad[3];
1224 } __packed tlv;
1225 } __packed req = {
1226 .hdr = {
1227 .band_idx = vif->bss_conf.mt76.band_idx,
1228 },
1229 .tlv = {
1230 .tag = cpu_to_le16(1),
1231 .len = cpu_to_le16(sizeof(req.tlv)),
1232 .control_ch = chandef->chan->hw_value,
1233 .center_ch = ieee80211_frequency_to_channel(freq1),
1234 .drop_err = 1,
1235 },
1236 };
1237 if (chandef->chan->band < ARRAY_SIZE(ch_band))
1238 req.tlv.ch_band = ch_band[chandef->chan->band];
1239 if (chandef->width < ARRAY_SIZE(ch_width))
1240 req.tlv.bw = ch_width[chandef->width];
1241
1242 if (freq2)
1243 req.tlv.center_ch2 = ieee80211_frequency_to_channel(freq2);
1244
1245 if (req.tlv.control_ch < req.tlv.center_ch)
1246 req.tlv.sco = 1; /* SCA */
1247 else if (req.tlv.control_ch > req.tlv.center_ch)
1248 req.tlv.sco = 3; /* SCB */
1249
1250 return mt76_mcu_send_msg(vif->phy->mt76->dev, MCU_UNI_CMD(SNIFFER),
1251 &req, sizeof(req), true);
1252 }
1253
1254 int
mt7921_mcu_uni_add_beacon_offload(struct mt792x_dev * dev,struct ieee80211_hw * hw,struct ieee80211_vif * vif,bool enable)1255 mt7921_mcu_uni_add_beacon_offload(struct mt792x_dev *dev,
1256 struct ieee80211_hw *hw,
1257 struct ieee80211_vif *vif,
1258 bool enable)
1259 {
1260 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1261 struct mt76_wcid *wcid = &dev->mt76.global_wcid;
1262 struct ieee80211_mutable_offsets offs;
1263 struct {
1264 struct req_hdr {
1265 u8 bss_idx;
1266 u8 pad[3];
1267 } __packed hdr;
1268 struct bcn_content_tlv {
1269 __le16 tag;
1270 __le16 len;
1271 __le16 tim_ie_pos;
1272 __le16 csa_ie_pos;
1273 __le16 bcc_ie_pos;
1274 /* 0: disable beacon offload
1275 * 1: enable beacon offload
1276 * 2: update probe respond offload
1277 */
1278 u8 enable;
1279 /* 0: legacy format (TXD + payload)
1280 * 1: only cap field IE
1281 */
1282 u8 type;
1283 __le16 pkt_len;
1284 u8 pkt[512];
1285 } __packed beacon_tlv;
1286 } req = {
1287 .hdr = {
1288 .bss_idx = mvif->bss_conf.mt76.idx,
1289 },
1290 .beacon_tlv = {
1291 .tag = cpu_to_le16(UNI_BSS_INFO_BCN_CONTENT),
1292 .len = cpu_to_le16(sizeof(struct bcn_content_tlv)),
1293 .enable = enable,
1294 },
1295 };
1296 struct sk_buff *skb;
1297
1298 /* support enable/update process only
1299 * disable flow would be handled in bss stop handler automatically
1300 */
1301 if (!enable)
1302 return -EOPNOTSUPP;
1303
1304 skb = ieee80211_beacon_get_template(mt76_hw(dev), vif, &offs, 0);
1305 if (!skb)
1306 return -EINVAL;
1307
1308 if (skb->len > 512 - MT_TXD_SIZE) {
1309 dev_err(dev->mt76.dev, "beacon size limit exceed\n");
1310 dev_kfree_skb(skb);
1311 return -EINVAL;
1312 }
1313
1314 mt76_connac2_mac_write_txwi(&dev->mt76, (__le32 *)(req.beacon_tlv.pkt),
1315 skb, wcid, NULL, 0, 0, BSS_CHANGED_BEACON);
1316 memcpy(req.beacon_tlv.pkt + MT_TXD_SIZE, skb->data, skb->len);
1317 req.beacon_tlv.pkt_len = cpu_to_le16(MT_TXD_SIZE + skb->len);
1318 req.beacon_tlv.tim_ie_pos = cpu_to_le16(MT_TXD_SIZE + offs.tim_offset);
1319
1320 if (offs.cntdwn_counter_offs[0]) {
1321 u16 csa_offs;
1322
1323 csa_offs = MT_TXD_SIZE + offs.cntdwn_counter_offs[0] - 4;
1324 req.beacon_tlv.csa_ie_pos = cpu_to_le16(csa_offs);
1325 }
1326 dev_kfree_skb(skb);
1327
1328 return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(BSS_INFO_UPDATE),
1329 &req, sizeof(req), true);
1330 }
1331
1332 static
__mt7921_mcu_set_clc(struct mt792x_dev * dev,u8 * alpha2,enum environment_cap env_cap,struct mt7921_clc * clc,u8 idx)1333 int __mt7921_mcu_set_clc(struct mt792x_dev *dev, u8 *alpha2,
1334 enum environment_cap env_cap,
1335 struct mt7921_clc *clc,
1336 u8 idx)
1337 {
1338 #define CLC_CAP_EVT_EN BIT(0)
1339 #define CLC_CAP_DTS_EN BIT(1)
1340 struct sk_buff *skb, *ret_skb = NULL;
1341 struct {
1342 u8 ver;
1343 u8 pad0;
1344 __le16 len;
1345 u8 idx;
1346 u8 env;
1347 u8 acpi_conf;
1348 u8 cap;
1349 u8 alpha2[2];
1350 u8 type[2];
1351 u8 env_6g;
1352 u8 mtcl_conf;
1353 u8 rsvd[62];
1354 } __packed req = {
1355 .ver = 1,
1356 .idx = idx,
1357 .env = env_cap,
1358 .env_6g = dev->phy.power_type,
1359 .acpi_conf = mt792x_acpi_get_flags(&dev->phy),
1360 .mtcl_conf = mt792x_acpi_get_mtcl_conf(&dev->phy, alpha2),
1361 };
1362 int ret, valid_cnt = 0;
1363 u32 buf_len = 0;
1364 u8 *pos;
1365
1366 if (!clc)
1367 return 0;
1368
1369 if (dev->phy.chip_cap & MT792x_CHIP_CAP_CLC_EVT_EN)
1370 req.cap |= CLC_CAP_EVT_EN;
1371 if (mt76_find_power_limits_node(&dev->mt76))
1372 req.cap |= CLC_CAP_DTS_EN;
1373
1374 buf_len = le32_to_cpu(clc->len) - sizeof(*clc);
1375 pos = clc->data;
1376 while (buf_len > 16) {
1377 struct mt7921_clc_rule *rule = (struct mt7921_clc_rule *)pos;
1378 u16 len = le16_to_cpu(rule->len);
1379 u16 offset = len + sizeof(*rule);
1380
1381 if (buf_len < offset)
1382 break;
1383
1384 pos += offset;
1385 buf_len -= offset;
1386 if (rule->alpha2[0] != alpha2[0] ||
1387 rule->alpha2[1] != alpha2[1])
1388 continue;
1389
1390 memcpy(req.alpha2, rule->alpha2, 2);
1391 memcpy(req.type, rule->type, 2);
1392
1393 req.len = cpu_to_le16(sizeof(req) + len);
1394 skb = __mt76_mcu_msg_alloc(&dev->mt76, &req,
1395 le16_to_cpu(req.len),
1396 sizeof(req), GFP_KERNEL);
1397 if (!skb)
1398 return -ENOMEM;
1399 skb_put_data(skb, rule->data, len);
1400
1401 ret = mt76_mcu_skb_send_and_get_msg(&dev->mt76, skb,
1402 MCU_CE_CMD(SET_CLC),
1403 !!(req.cap & CLC_CAP_EVT_EN),
1404 &ret_skb);
1405 if (ret < 0)
1406 return ret;
1407
1408 if (ret_skb) {
1409 struct mt7921_clc_info_tlv *info;
1410
1411 info = (struct mt7921_clc_info_tlv *)(ret_skb->data + 4);
1412 dev->phy.clc_chan_conf = info->chan_conf;
1413 dev_kfree_skb(ret_skb);
1414 }
1415
1416 valid_cnt++;
1417 }
1418
1419 if (!valid_cnt)
1420 return -ENOENT;
1421
1422 return 0;
1423 }
1424
mt7921_mcu_set_clc(struct mt792x_dev * dev,u8 * alpha2,enum environment_cap env_cap)1425 int mt7921_mcu_set_clc(struct mt792x_dev *dev, u8 *alpha2,
1426 enum environment_cap env_cap)
1427 {
1428 struct mt792x_phy *phy = (struct mt792x_phy *)&dev->phy;
1429 int i, ret;
1430
1431 /* submit all clc config */
1432 for (i = 0; i < ARRAY_SIZE(phy->clc); i++) {
1433 if (i == MT792x_CLC_REGD)
1434 continue;
1435
1436 ret = __mt7921_mcu_set_clc(dev, alpha2, env_cap,
1437 phy->clc[i], i);
1438
1439 /* If no country found, set "00" as default */
1440 if (ret == -ENOENT)
1441 ret = __mt7921_mcu_set_clc(dev, "00",
1442 ENVIRON_INDOOR,
1443 phy->clc[i], i);
1444 if (ret < 0)
1445 return ret;
1446 }
1447 return 0;
1448 }
1449
mt7921_mcu_get_temperature(struct mt792x_phy * phy)1450 int mt7921_mcu_get_temperature(struct mt792x_phy *phy)
1451 {
1452 struct mt792x_dev *dev = phy->dev;
1453 struct {
1454 u8 ctrl_id;
1455 u8 action;
1456 u8 band_idx;
1457 u8 rsv[5];
1458 } req = {
1459 .ctrl_id = THERMAL_SENSOR_TEMP_QUERY,
1460 .band_idx = phy->mt76->band_idx,
1461 };
1462
1463 return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(THERMAL_CTRL), &req,
1464 sizeof(req), true);
1465 }
1466
mt7921_mcu_wf_rf_pin_ctrl(struct mt792x_phy * phy,u8 action)1467 int mt7921_mcu_wf_rf_pin_ctrl(struct mt792x_phy *phy, u8 action)
1468 {
1469 struct mt792x_dev *dev = phy->dev;
1470 struct {
1471 u8 action;
1472 u8 value;
1473 } req = {
1474 .action = action,
1475 .value = 0,
1476 };
1477
1478 return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(WF_RF_PIN_CTRL), &req,
1479 sizeof(req), action ? true : false);
1480 }
1481
mt7921_mcu_set_rxfilter(struct mt792x_dev * dev,u32 fif,u8 bit_op,u32 bit_map)1482 int mt7921_mcu_set_rxfilter(struct mt792x_dev *dev, u32 fif,
1483 u8 bit_op, u32 bit_map)
1484 {
1485 struct {
1486 u8 rsv[4];
1487 u8 mode;
1488 u8 rsv2[3];
1489 __le32 fif;
1490 __le32 bit_map; /* bit_* for bitmap update */
1491 u8 bit_op;
1492 u8 pad[51];
1493 } __packed data = {
1494 .mode = fif ? 1 : 2,
1495 .fif = cpu_to_le32(fif),
1496 .bit_map = cpu_to_le32(bit_map),
1497 .bit_op = bit_op,
1498 };
1499
1500 return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_RX_FILTER),
1501 &data, sizeof(data), false);
1502 }
1503
mt7921_mcu_set_rssimonitor(struct mt792x_dev * dev,struct ieee80211_vif * vif)1504 int mt7921_mcu_set_rssimonitor(struct mt792x_dev *dev, struct ieee80211_vif *vif)
1505 {
1506 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1507 struct {
1508 u8 enable;
1509 s8 cqm_rssi_high;
1510 s8 cqm_rssi_low;
1511 u8 bss_idx;
1512 u16 duration;
1513 u8 rsv2[2];
1514 } __packed data = {
1515 .enable = vif->cfg.assoc,
1516 .cqm_rssi_high = vif->bss_conf.cqm_rssi_thold + vif->bss_conf.cqm_rssi_hyst,
1517 .cqm_rssi_low = vif->bss_conf.cqm_rssi_thold - vif->bss_conf.cqm_rssi_hyst,
1518 .bss_idx = mvif->bss_conf.mt76.idx,
1519 };
1520
1521 return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(RSSI_MONITOR),
1522 &data, sizeof(data), false);
1523 }
1524