1 // SPDX-License-Identifier: ISC
2 /* Copyright (C) 2020 MediaTek Inc.
3 *
4 * Author: Lorenzo Bianconi <lorenzo@kernel.org>
5 * Sean Wang <sean.wang@mediatek.com>
6 */
7
8 #include <linux/kernel.h>
9 #include <linux/module.h>
10 #include <linux/usb.h>
11
12 #include "mt7615.h"
13 #include "mac.h"
14 #include "mcu.h"
15 #include "regs.h"
16
17 const u32 mt7663_usb_sdio_reg_map[] = {
18 [MT_TOP_CFG_BASE] = 0x80020000,
19 [MT_HW_BASE] = 0x80000000,
20 [MT_DMA_SHDL_BASE] = 0x5000a000,
21 [MT_HIF_BASE] = 0x50000000,
22 [MT_CSR_BASE] = 0x40000000,
23 [MT_EFUSE_ADDR_BASE] = 0x78011000,
24 [MT_TOP_MISC_BASE] = 0x81020000,
25 [MT_PLE_BASE] = 0x82060000,
26 [MT_PSE_BASE] = 0x82068000,
27 [MT_PP_BASE] = 0x8206c000,
28 [MT_WTBL_BASE_ADDR] = 0x820e0000,
29 [MT_CFG_BASE] = 0x820f0000,
30 [MT_AGG_BASE] = 0x820f2000,
31 [MT_ARB_BASE] = 0x820f3000,
32 [MT_TMAC_BASE] = 0x820f4000,
33 [MT_RMAC_BASE] = 0x820f5000,
34 [MT_DMA_BASE] = 0x820f7000,
35 [MT_PF_BASE] = 0x820f8000,
36 [MT_WTBL_BASE_ON] = 0x820f9000,
37 [MT_WTBL_BASE_OFF] = 0x820f9800,
38 [MT_LPON_BASE] = 0x820fb000,
39 [MT_MIB_BASE] = 0x820fd000,
40 };
41 EXPORT_SYMBOL_GPL(mt7663_usb_sdio_reg_map);
42
43 static void
mt7663_usb_sdio_write_txwi(struct mt7615_dev * dev,struct mt76_wcid * wcid,enum mt76_txq_id qid,struct ieee80211_sta * sta,struct sk_buff * skb)44 mt7663_usb_sdio_write_txwi(struct mt7615_dev *dev, struct mt76_wcid *wcid,
45 enum mt76_txq_id qid, struct ieee80211_sta *sta,
46 struct sk_buff *skb)
47 {
48 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
49 struct ieee80211_key_conf *key = info->control.hw_key;
50 __le32 *txwi;
51 int pid;
52
53 if (!wcid)
54 wcid = &dev->mt76.global_wcid;
55
56 pid = mt76_tx_status_skb_add(&dev->mt76, wcid, skb);
57
58 txwi = (__le32 *)(skb->data - MT_USB_TXD_SIZE);
59 memset(txwi, 0, MT_USB_TXD_SIZE);
60 mt7615_mac_write_txwi(dev, txwi, skb, wcid, sta, pid, key, false);
61 skb_push(skb, MT_USB_TXD_SIZE);
62 }
63
64 static int
mt7663_usb_sdio_set_rates(struct mt7615_dev * dev,struct mt7615_wtbl_desc * wd)65 mt7663_usb_sdio_set_rates(struct mt7615_dev *dev,
66 struct mt7615_wtbl_desc *wd)
67 {
68 struct mt7615_rate_desc *rate = &wd->rate;
69 struct mt7615_sta *sta = wd->sta;
70 u32 w5, w27, addr, val;
71
72 lockdep_assert_held(&dev->mt76.mutex);
73
74 if (!sta)
75 return -EINVAL;
76
77 if (!mt76_poll(dev, MT_WTBL_UPDATE, MT_WTBL_UPDATE_BUSY, 0, 5000))
78 return -ETIMEDOUT;
79
80 addr = mt7615_mac_wtbl_addr(dev, sta->wcid.idx);
81
82 w27 = mt76_rr(dev, addr + 27 * 4);
83 w27 &= ~MT_WTBL_W27_CC_BW_SEL;
84 w27 |= FIELD_PREP(MT_WTBL_W27_CC_BW_SEL, rate->bw);
85
86 w5 = mt76_rr(dev, addr + 5 * 4);
87 w5 &= ~(MT_WTBL_W5_BW_CAP | MT_WTBL_W5_CHANGE_BW_RATE |
88 MT_WTBL_W5_MPDU_OK_COUNT |
89 MT_WTBL_W5_MPDU_FAIL_COUNT |
90 MT_WTBL_W5_RATE_IDX);
91 w5 |= FIELD_PREP(MT_WTBL_W5_BW_CAP, rate->bw) |
92 FIELD_PREP(MT_WTBL_W5_CHANGE_BW_RATE,
93 rate->bw_idx ? rate->bw_idx - 1 : 7);
94
95 mt76_wr(dev, MT_WTBL_RIUCR0, w5);
96
97 mt76_wr(dev, MT_WTBL_RIUCR1,
98 FIELD_PREP(MT_WTBL_RIUCR1_RATE0, rate->probe_val) |
99 FIELD_PREP(MT_WTBL_RIUCR1_RATE1, rate->val[0]) |
100 FIELD_PREP(MT_WTBL_RIUCR1_RATE2_LO, rate->val[1]));
101
102 mt76_wr(dev, MT_WTBL_RIUCR2,
103 FIELD_PREP(MT_WTBL_RIUCR2_RATE2_HI, rate->val[1] >> 8) |
104 FIELD_PREP(MT_WTBL_RIUCR2_RATE3, rate->val[1]) |
105 FIELD_PREP(MT_WTBL_RIUCR2_RATE4, rate->val[2]) |
106 FIELD_PREP(MT_WTBL_RIUCR2_RATE5_LO, rate->val[2]));
107
108 mt76_wr(dev, MT_WTBL_RIUCR3,
109 FIELD_PREP(MT_WTBL_RIUCR3_RATE5_HI, rate->val[2] >> 4) |
110 FIELD_PREP(MT_WTBL_RIUCR3_RATE6, rate->val[3]) |
111 FIELD_PREP(MT_WTBL_RIUCR3_RATE7, rate->val[3]));
112
113 mt76_wr(dev, MT_WTBL_UPDATE,
114 FIELD_PREP(MT_WTBL_UPDATE_WLAN_IDX, sta->wcid.idx) |
115 MT_WTBL_UPDATE_RATE_UPDATE |
116 MT_WTBL_UPDATE_TX_COUNT_CLEAR);
117
118 mt76_wr(dev, addr + 27 * 4, w27);
119
120 sta->rate_probe = sta->rateset[rate->rateset].probe_rate.idx != -1;
121
122 mt76_set(dev, MT_LPON_T0CR, MT_LPON_T0CR_MODE); /* TSF read */
123 val = mt76_rr(dev, MT_LPON_UTTR0);
124 sta->rate_set_tsf = (val & ~BIT(0)) | rate->rateset;
125
126 if (!(sta->wcid.tx_info & MT_WCID_TX_INFO_SET))
127 mt76_poll(dev, MT_WTBL_UPDATE, MT_WTBL_UPDATE_BUSY, 0, 5000);
128
129 sta->rate_count = 2 * MT7615_RATE_RETRY * sta->n_rates;
130 sta->wcid.tx_info |= MT_WCID_TX_INFO_SET;
131
132 return 0;
133 }
134
135 static int
mt7663_usb_sdio_set_key(struct mt7615_dev * dev,struct mt7615_wtbl_desc * wd)136 mt7663_usb_sdio_set_key(struct mt7615_dev *dev,
137 struct mt7615_wtbl_desc *wd)
138 {
139 struct mt7615_key_desc *key = &wd->key;
140 struct mt7615_sta *sta = wd->sta;
141 enum mt7615_cipher_type cipher;
142 struct mt76_wcid *wcid;
143 int err;
144
145 lockdep_assert_held(&dev->mt76.mutex);
146
147 if (!sta) {
148 err = -EINVAL;
149 goto out;
150 }
151
152 cipher = mt7615_mac_get_cipher(key->cipher);
153 if (cipher == MT_CIPHER_NONE) {
154 err = -EOPNOTSUPP;
155 goto out;
156 }
157
158 wcid = &wd->sta->wcid;
159
160 mt7615_mac_wtbl_update_cipher(dev, wcid, cipher, key->cmd);
161 err = mt7615_mac_wtbl_update_key(dev, wcid, key->key, key->keylen,
162 cipher, key->cmd);
163 if (err < 0)
164 goto out;
165
166 err = mt7615_mac_wtbl_update_pk(dev, wcid, cipher, key->keyidx,
167 key->cmd);
168 if (err < 0)
169 goto out;
170
171 if (key->cmd == SET_KEY)
172 wcid->cipher |= BIT(cipher);
173 else
174 wcid->cipher &= ~BIT(cipher);
175 out:
176 kfree(key->key);
177
178 return err;
179 }
180
mt7663_usb_sdio_wtbl_work(struct work_struct * work)181 void mt7663_usb_sdio_wtbl_work(struct work_struct *work)
182 {
183 struct mt7615_wtbl_desc *wd, *wd_next;
184 struct list_head wd_list;
185 struct mt7615_dev *dev;
186
187 dev = (struct mt7615_dev *)container_of(work, struct mt7615_dev,
188 wtbl_work);
189
190 INIT_LIST_HEAD(&wd_list);
191 spin_lock_bh(&dev->mt76.lock);
192 list_splice_init(&dev->wd_head, &wd_list);
193 spin_unlock_bh(&dev->mt76.lock);
194
195 list_for_each_entry_safe(wd, wd_next, &wd_list, node) {
196 list_del(&wd->node);
197
198 mt7615_mutex_acquire(dev);
199
200 switch (wd->type) {
201 case MT7615_WTBL_RATE_DESC:
202 mt7663_usb_sdio_set_rates(dev, wd);
203 break;
204 case MT7615_WTBL_KEY_DESC:
205 mt7663_usb_sdio_set_key(dev, wd);
206 break;
207 }
208
209 mt7615_mutex_release(dev);
210
211 kfree(wd);
212 }
213 }
214 EXPORT_SYMBOL_GPL(mt7663_usb_sdio_wtbl_work);
215
mt7663_usb_sdio_tx_status_data(struct mt76_dev * mdev,u8 * update)216 bool mt7663_usb_sdio_tx_status_data(struct mt76_dev *mdev, u8 *update)
217 {
218 struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
219
220 mt7615_mutex_acquire(dev);
221 mt7615_mac_sta_poll(dev);
222 mt7615_mutex_release(dev);
223
224 return 0;
225 }
226 EXPORT_SYMBOL_GPL(mt7663_usb_sdio_tx_status_data);
227
mt7663_usb_sdio_tx_complete_skb(struct mt76_dev * mdev,struct mt76_queue_entry * e)228 void mt7663_usb_sdio_tx_complete_skb(struct mt76_dev *mdev,
229 struct mt76_queue_entry *e)
230 {
231 unsigned int headroom = MT_USB_TXD_SIZE;
232
233 if (mt76_is_usb(mdev))
234 headroom += MT_USB_HDR_SIZE;
235 skb_pull(e->skb, headroom);
236
237 mt76_tx_complete_skb(mdev, e->wcid, e->skb);
238 }
239 EXPORT_SYMBOL_GPL(mt7663_usb_sdio_tx_complete_skb);
240
mt7663_usb_sdio_tx_prepare_skb(struct mt76_dev * mdev,void * txwi_ptr,enum mt76_txq_id qid,struct mt76_wcid * wcid,struct ieee80211_sta * sta,struct mt76_tx_info * tx_info)241 int mt7663_usb_sdio_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr,
242 enum mt76_txq_id qid, struct mt76_wcid *wcid,
243 struct ieee80211_sta *sta,
244 struct mt76_tx_info *tx_info)
245 {
246 struct mt7615_sta *msta = container_of(wcid, struct mt7615_sta, wcid);
247 struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
248 struct sk_buff *skb = tx_info->skb;
249 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
250 int pad;
251
252 if ((info->flags & IEEE80211_TX_CTL_RATE_CTRL_PROBE) &&
253 !msta->rate_probe) {
254 /* request to configure sampling rate */
255 spin_lock_bh(&dev->mt76.lock);
256 mt7615_mac_set_rates(&dev->phy, msta, &info->control.rates[0],
257 msta->rates);
258 spin_unlock_bh(&dev->mt76.lock);
259 }
260
261 mt7663_usb_sdio_write_txwi(dev, wcid, qid, sta, skb);
262 if (mt76_is_usb(mdev)) {
263 u32 len = skb->len;
264
265 put_unaligned_le32(len, skb_push(skb, sizeof(len)));
266 pad = round_up(skb->len, 4) + 4 - skb->len;
267 } else {
268 pad = round_up(skb->len, 4) - skb->len;
269 }
270
271 return mt76_skb_adjust_pad(skb, pad);
272 }
273 EXPORT_SYMBOL_GPL(mt7663_usb_sdio_tx_prepare_skb);
274
mt7663u_dma_sched_init(struct mt7615_dev * dev)275 static int mt7663u_dma_sched_init(struct mt7615_dev *dev)
276 {
277 int i;
278
279 mt76_rmw(dev, MT_DMA_SHDL(MT_DMASHDL_PKT_MAX_SIZE),
280 MT_DMASHDL_PKT_MAX_SIZE_PLE | MT_DMASHDL_PKT_MAX_SIZE_PSE,
281 FIELD_PREP(MT_DMASHDL_PKT_MAX_SIZE_PLE, 1) |
282 FIELD_PREP(MT_DMASHDL_PKT_MAX_SIZE_PSE, 8));
283
284 /* disable refill group 5 - group 15 and raise group 2
285 * and 3 as high priority.
286 */
287 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_REFILL), 0xffe00006);
288 mt76_clear(dev, MT_DMA_SHDL(MT_DMASHDL_PAGE), BIT(16));
289
290 for (i = 0; i < 5; i++)
291 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_GROUP_QUOTA(i)),
292 FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MIN, 0x3) |
293 FIELD_PREP(MT_DMASHDL_GROUP_QUOTA_MAX, 0x1ff));
294
295 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_Q_MAP(0)), 0x42104210);
296 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_Q_MAP(1)), 0x42104210);
297
298 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_Q_MAP(2)), 0x4444);
299
300 /* group pririority from high to low:
301 * 15 (cmd groups) > 4 > 3 > 2 > 1 > 0.
302 */
303 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_SCHED_SET0), 0x6501234f);
304 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_SCHED_SET1), 0xedcba987);
305 mt76_wr(dev, MT_DMA_SHDL(MT_DMASHDL_OPTIONAL), 0x7004801c);
306
307 mt76_wr(dev, MT_UDMA_WLCFG_1,
308 FIELD_PREP(MT_WL_TX_TMOUT_LMT, 80000) |
309 FIELD_PREP(MT_WL_RX_AGG_PKT_LMT, 1));
310
311 /* setup UDMA Rx Flush */
312 mt76_clear(dev, MT_UDMA_WLCFG_0, MT_WL_RX_FLUSH);
313 /* hif reset */
314 mt76_set(dev, MT_HIF_RST, MT_HIF_LOGIC_RST_N);
315
316 mt76_set(dev, MT_UDMA_WLCFG_0,
317 MT_WL_RX_AGG_EN | MT_WL_RX_EN | MT_WL_TX_EN |
318 MT_WL_RX_MPSZ_PAD0 | MT_TICK_1US_EN |
319 MT_WL_TX_TMOUT_FUNC_EN);
320 mt76_rmw(dev, MT_UDMA_WLCFG_0, MT_WL_RX_AGG_LMT | MT_WL_RX_AGG_TO,
321 FIELD_PREP(MT_WL_RX_AGG_LMT, 32) |
322 FIELD_PREP(MT_WL_RX_AGG_TO, 100));
323
324 return 0;
325 }
326
mt7663_usb_sdio_init_hardware(struct mt7615_dev * dev)327 static int mt7663_usb_sdio_init_hardware(struct mt7615_dev *dev)
328 {
329 int ret, idx;
330
331 ret = mt7615_eeprom_init(dev, MT_EFUSE_BASE);
332 if (ret < 0)
333 return ret;
334
335 if (mt76_is_usb(&dev->mt76)) {
336 ret = mt7663u_dma_sched_init(dev);
337 if (ret)
338 return ret;
339 }
340
341 set_bit(MT76_STATE_INITIALIZED, &dev->mphy.state);
342
343 /* Beacon and mgmt frames should occupy wcid 0 */
344 idx = mt76_wcid_alloc(dev->mt76.wcid_mask, MT7615_WTBL_STA - 1);
345 if (idx)
346 return -ENOSPC;
347
348 dev->mt76.global_wcid.idx = idx;
349 dev->mt76.global_wcid.hw_key_idx = -1;
350 rcu_assign_pointer(dev->mt76.wcid[idx], &dev->mt76.global_wcid);
351
352 return 0;
353 }
354
mt7663_usb_sdio_register_device(struct mt7615_dev * dev)355 int mt7663_usb_sdio_register_device(struct mt7615_dev *dev)
356 {
357 struct ieee80211_hw *hw = mt76_hw(dev);
358 int err;
359
360 INIT_WORK(&dev->wtbl_work, mt7663_usb_sdio_wtbl_work);
361 INIT_LIST_HEAD(&dev->wd_head);
362 mt7615_init_device(dev);
363
364 err = mt7663_usb_sdio_init_hardware(dev);
365 if (err)
366 return err;
367
368 hw->extra_tx_headroom += MT_USB_TXD_SIZE;
369 if (mt76_is_usb(&dev->mt76)) {
370 hw->extra_tx_headroom += MT_USB_HDR_SIZE;
371 /* check hw sg support in order to enable AMSDU */
372 if (dev->mt76.usb.sg_en)
373 hw->max_tx_fragments = MT_HW_TXP_MAX_BUF_NUM;
374 else
375 hw->max_tx_fragments = 1;
376 }
377
378 err = mt76_register_device(&dev->mt76, true, mt7615_rates,
379 ARRAY_SIZE(mt7615_rates));
380 if (err < 0)
381 return err;
382
383 if (!dev->mt76.usb.sg_en) {
384 struct ieee80211_sta_vht_cap *vht_cap;
385
386 /* decrease max A-MSDU size if SG is not supported */
387 vht_cap = &dev->mphy.sband_5g.sband.vht_cap;
388 vht_cap->cap &= ~IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454;
389 }
390
391 ieee80211_queue_work(hw, &dev->mcu_work);
392 mt7615_init_txpower(dev, &dev->mphy.sband_2g.sband);
393 mt7615_init_txpower(dev, &dev->mphy.sband_5g.sband);
394
395 return mt7615_init_debugfs(dev);
396 }
397 EXPORT_SYMBOL_GPL(mt7663_usb_sdio_register_device);
398
399 MODULE_AUTHOR("Lorenzo Bianconi <lorenzo@kernel.org>");
400 MODULE_AUTHOR("Sean Wang <sean.wang@mediatek.com>");
401 MODULE_LICENSE("Dual BSD/GPL");
402
