1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * (c) Copyright 2002-2010, Ralink Technology, Inc.
4 * Copyright (C) 2014 Felix Fietkau <nbd@openwrt.org>
5 * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl>
6 */
7
8 #include "mt7601u.h"
9 #include "mcu.h"
10 #include "eeprom.h"
11 #include "trace.h"
12 #include "initvals_phy.h"
13
14 #include <linux/etherdevice.h>
15
16 static void mt7601u_agc_reset(struct mt7601u_dev *dev);
17
18 static int
mt7601u_rf_wr(struct mt7601u_dev * dev,u8 bank,u8 offset,u8 value)19 mt7601u_rf_wr(struct mt7601u_dev *dev, u8 bank, u8 offset, u8 value)
20 {
21 int ret = 0;
22
23 if (WARN_ON(!test_bit(MT7601U_STATE_WLAN_RUNNING, &dev->state)) ||
24 WARN_ON(offset > 63))
25 return -EINVAL;
26 if (test_bit(MT7601U_STATE_REMOVED, &dev->state))
27 return 0;
28
29 mutex_lock(&dev->reg_atomic_mutex);
30
31 if (!mt76_poll(dev, MT_RF_CSR_CFG, MT_RF_CSR_CFG_KICK, 0, 100)) {
32 ret = -ETIMEDOUT;
33 goto out;
34 }
35
36 mt7601u_wr(dev, MT_RF_CSR_CFG,
37 FIELD_PREP(MT_RF_CSR_CFG_DATA, value) |
38 FIELD_PREP(MT_RF_CSR_CFG_REG_BANK, bank) |
39 FIELD_PREP(MT_RF_CSR_CFG_REG_ID, offset) |
40 MT_RF_CSR_CFG_WR |
41 MT_RF_CSR_CFG_KICK);
42 trace_rf_write(dev, bank, offset, value);
43 out:
44 mutex_unlock(&dev->reg_atomic_mutex);
45
46 if (ret < 0)
47 dev_err(dev->dev, "Error: RF write %02hhx:%02hhx failed:%d!!\n",
48 bank, offset, ret);
49
50 return ret;
51 }
52
53 static int
mt7601u_rf_rr(struct mt7601u_dev * dev,u8 bank,u8 offset)54 mt7601u_rf_rr(struct mt7601u_dev *dev, u8 bank, u8 offset)
55 {
56 int ret = -ETIMEDOUT;
57 u32 val;
58
59 if (WARN_ON(!test_bit(MT7601U_STATE_WLAN_RUNNING, &dev->state)) ||
60 WARN_ON(offset > 63))
61 return -EINVAL;
62 if (test_bit(MT7601U_STATE_REMOVED, &dev->state))
63 return 0xff;
64
65 mutex_lock(&dev->reg_atomic_mutex);
66
67 if (!mt76_poll(dev, MT_RF_CSR_CFG, MT_RF_CSR_CFG_KICK, 0, 100))
68 goto out;
69
70 mt7601u_wr(dev, MT_RF_CSR_CFG,
71 FIELD_PREP(MT_RF_CSR_CFG_REG_BANK, bank) |
72 FIELD_PREP(MT_RF_CSR_CFG_REG_ID, offset) |
73 MT_RF_CSR_CFG_KICK);
74
75 if (!mt76_poll(dev, MT_RF_CSR_CFG, MT_RF_CSR_CFG_KICK, 0, 100))
76 goto out;
77
78 val = mt7601u_rr(dev, MT_RF_CSR_CFG);
79 if (FIELD_GET(MT_RF_CSR_CFG_REG_ID, val) == offset &&
80 FIELD_GET(MT_RF_CSR_CFG_REG_BANK, val) == bank) {
81 ret = FIELD_GET(MT_RF_CSR_CFG_DATA, val);
82 trace_rf_read(dev, bank, offset, ret);
83 }
84 out:
85 mutex_unlock(&dev->reg_atomic_mutex);
86
87 if (ret < 0)
88 dev_err(dev->dev, "Error: RF read %02hhx:%02hhx failed:%d!!\n",
89 bank, offset, ret);
90
91 return ret;
92 }
93
94 static int
mt7601u_rf_rmw(struct mt7601u_dev * dev,u8 bank,u8 offset,u8 mask,u8 val)95 mt7601u_rf_rmw(struct mt7601u_dev *dev, u8 bank, u8 offset, u8 mask, u8 val)
96 {
97 int ret;
98
99 ret = mt7601u_rf_rr(dev, bank, offset);
100 if (ret < 0)
101 return ret;
102 val |= ret & ~mask;
103 ret = mt7601u_rf_wr(dev, bank, offset, val);
104 if (ret)
105 return ret;
106
107 return val;
108 }
109
110 static int
mt7601u_rf_set(struct mt7601u_dev * dev,u8 bank,u8 offset,u8 val)111 mt7601u_rf_set(struct mt7601u_dev *dev, u8 bank, u8 offset, u8 val)
112 {
113 return mt7601u_rf_rmw(dev, bank, offset, 0, val);
114 }
115
116 static int
mt7601u_rf_clear(struct mt7601u_dev * dev,u8 bank,u8 offset,u8 mask)117 mt7601u_rf_clear(struct mt7601u_dev *dev, u8 bank, u8 offset, u8 mask)
118 {
119 return mt7601u_rf_rmw(dev, bank, offset, mask, 0);
120 }
121
mt7601u_bbp_wr(struct mt7601u_dev * dev,u8 offset,u8 val)122 static void mt7601u_bbp_wr(struct mt7601u_dev *dev, u8 offset, u8 val)
123 {
124 if (WARN_ON(!test_bit(MT7601U_STATE_WLAN_RUNNING, &dev->state)) ||
125 test_bit(MT7601U_STATE_REMOVED, &dev->state))
126 return;
127
128 mutex_lock(&dev->reg_atomic_mutex);
129
130 if (!mt76_poll(dev, MT_BBP_CSR_CFG, MT_BBP_CSR_CFG_BUSY, 0, 1000)) {
131 dev_err(dev->dev, "Error: BBP write %02hhx failed!!\n", offset);
132 goto out;
133 }
134
135 mt7601u_wr(dev, MT_BBP_CSR_CFG,
136 FIELD_PREP(MT_BBP_CSR_CFG_VAL, val) |
137 FIELD_PREP(MT_BBP_CSR_CFG_REG_NUM, offset) |
138 MT_BBP_CSR_CFG_RW_MODE | MT_BBP_CSR_CFG_BUSY);
139 trace_bbp_write(dev, offset, val);
140 out:
141 mutex_unlock(&dev->reg_atomic_mutex);
142 }
143
mt7601u_bbp_rr(struct mt7601u_dev * dev,u8 offset)144 static int mt7601u_bbp_rr(struct mt7601u_dev *dev, u8 offset)
145 {
146 u32 val;
147 int ret = -ETIMEDOUT;
148
149 if (WARN_ON(!test_bit(MT7601U_STATE_WLAN_RUNNING, &dev->state)))
150 return -EINVAL;
151 if (test_bit(MT7601U_STATE_REMOVED, &dev->state))
152 return 0xff;
153
154 mutex_lock(&dev->reg_atomic_mutex);
155
156 if (!mt76_poll(dev, MT_BBP_CSR_CFG, MT_BBP_CSR_CFG_BUSY, 0, 1000))
157 goto out;
158
159 mt7601u_wr(dev, MT_BBP_CSR_CFG,
160 FIELD_PREP(MT_BBP_CSR_CFG_REG_NUM, offset) |
161 MT_BBP_CSR_CFG_RW_MODE | MT_BBP_CSR_CFG_BUSY |
162 MT_BBP_CSR_CFG_READ);
163
164 if (!mt76_poll(dev, MT_BBP_CSR_CFG, MT_BBP_CSR_CFG_BUSY, 0, 1000))
165 goto out;
166
167 val = mt7601u_rr(dev, MT_BBP_CSR_CFG);
168 if (FIELD_GET(MT_BBP_CSR_CFG_REG_NUM, val) == offset) {
169 ret = FIELD_GET(MT_BBP_CSR_CFG_VAL, val);
170 trace_bbp_read(dev, offset, ret);
171 }
172 out:
173 mutex_unlock(&dev->reg_atomic_mutex);
174
175 if (ret < 0)
176 dev_err(dev->dev, "Error: BBP read %02hhx failed:%d!!\n",
177 offset, ret);
178
179 return ret;
180 }
181
mt7601u_bbp_rmw(struct mt7601u_dev * dev,u8 offset,u8 mask,u8 val)182 static int mt7601u_bbp_rmw(struct mt7601u_dev *dev, u8 offset, u8 mask, u8 val)
183 {
184 int ret;
185
186 ret = mt7601u_bbp_rr(dev, offset);
187 if (ret < 0)
188 return ret;
189 val |= ret & ~mask;
190 mt7601u_bbp_wr(dev, offset, val);
191
192 return val;
193 }
194
mt7601u_bbp_rmc(struct mt7601u_dev * dev,u8 offset,u8 mask,u8 val)195 static u8 mt7601u_bbp_rmc(struct mt7601u_dev *dev, u8 offset, u8 mask, u8 val)
196 {
197 int ret;
198
199 ret = mt7601u_bbp_rr(dev, offset);
200 if (ret < 0)
201 return ret;
202 val |= ret & ~mask;
203 if (ret != val)
204 mt7601u_bbp_wr(dev, offset, val);
205
206 return val;
207 }
208
mt7601u_wait_bbp_ready(struct mt7601u_dev * dev)209 int mt7601u_wait_bbp_ready(struct mt7601u_dev *dev)
210 {
211 int i = 20;
212 u8 val;
213
214 do {
215 val = mt7601u_bbp_rr(dev, MT_BBP_REG_VERSION);
216 if (val && val != 0xff)
217 break;
218 } while (--i);
219
220 if (!i) {
221 dev_err(dev->dev, "Error: BBP is not ready\n");
222 return -EIO;
223 }
224
225 return 0;
226 }
227
mt7601u_bbp_set_ctrlch(struct mt7601u_dev * dev,bool below)228 u32 mt7601u_bbp_set_ctrlch(struct mt7601u_dev *dev, bool below)
229 {
230 return mt7601u_bbp_rmc(dev, 3, 0x20, below ? 0x20 : 0);
231 }
232
mt7601u_phy_get_rssi(struct mt7601u_dev * dev,struct mt7601u_rxwi * rxwi,u16 rate)233 int mt7601u_phy_get_rssi(struct mt7601u_dev *dev,
234 struct mt7601u_rxwi *rxwi, u16 rate)
235 {
236 static const s8 lna[2][2][3] = {
237 /* main LNA */ {
238 /* bw20 */ { -2, 15, 33 },
239 /* bw40 */ { 0, 16, 34 }
240 },
241 /* aux LNA */ {
242 /* bw20 */ { -2, 15, 33 },
243 /* bw40 */ { -2, 16, 34 }
244 }
245 };
246 int bw = FIELD_GET(MT_RXWI_RATE_BW, rate);
247 int aux_lna = FIELD_GET(MT_RXWI_ANT_AUX_LNA, rxwi->ant);
248 int lna_id = FIELD_GET(MT_RXWI_GAIN_RSSI_LNA_ID, rxwi->gain);
249 int val;
250
251 if (lna_id) /* LNA id can be 0, 2, 3. */
252 lna_id--;
253
254 val = 8;
255 val -= lna[aux_lna][bw][lna_id];
256 val -= FIELD_GET(MT_RXWI_GAIN_RSSI_VAL, rxwi->gain);
257 val -= dev->ee->lna_gain;
258 val -= dev->ee->rssi_offset[0];
259
260 return val;
261 }
262
mt7601u_vco_cal(struct mt7601u_dev * dev)263 static void mt7601u_vco_cal(struct mt7601u_dev *dev)
264 {
265 mt7601u_rf_wr(dev, 0, 4, 0x0a);
266 mt7601u_rf_wr(dev, 0, 5, 0x20);
267 mt7601u_rf_set(dev, 0, 4, BIT(7));
268 msleep(2);
269 }
270
mt7601u_set_bw_filter(struct mt7601u_dev * dev,bool cal)271 static int mt7601u_set_bw_filter(struct mt7601u_dev *dev, bool cal)
272 {
273 u32 filter = 0;
274 int ret;
275
276 if (!cal)
277 filter |= 0x10000;
278 if (dev->bw != MT_BW_20)
279 filter |= 0x00100;
280
281 /* TX */
282 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_BW, filter | 1);
283 if (ret)
284 return ret;
285 /* RX */
286 return mt7601u_mcu_calibrate(dev, MCU_CAL_BW, filter);
287 }
288
mt7601u_load_bbp_temp_table_bw(struct mt7601u_dev * dev)289 static int mt7601u_load_bbp_temp_table_bw(struct mt7601u_dev *dev)
290 {
291 const struct reg_table *t;
292
293 if (WARN_ON(dev->temp_mode > MT_TEMP_MODE_LOW))
294 return -EINVAL;
295
296 t = &bbp_mode_table[dev->temp_mode][dev->bw];
297
298 return mt7601u_write_reg_pairs(dev, MT_MCU_MEMMAP_BBP, t->regs, t->n);
299 }
300
mt7601u_bbp_temp(struct mt7601u_dev * dev,int mode,const char * name)301 static int mt7601u_bbp_temp(struct mt7601u_dev *dev, int mode, const char *name)
302 {
303 const struct reg_table *t;
304 int ret;
305
306 if (dev->temp_mode == mode)
307 return 0;
308
309 dev->temp_mode = mode;
310 trace_temp_mode(dev, mode);
311
312 t = bbp_mode_table[dev->temp_mode];
313 ret = mt7601u_write_reg_pairs(dev, MT_MCU_MEMMAP_BBP,
314 t[2].regs, t[2].n);
315 if (ret)
316 return ret;
317
318 return mt7601u_write_reg_pairs(dev, MT_MCU_MEMMAP_BBP,
319 t[dev->bw].regs, t[dev->bw].n);
320 }
321
mt7601u_apply_ch14_fixup(struct mt7601u_dev * dev,int hw_chan)322 static void mt7601u_apply_ch14_fixup(struct mt7601u_dev *dev, int hw_chan)
323 {
324 struct mt7601u_rate_power *t = &dev->ee->power_rate_table;
325
326 if (hw_chan != 14 || dev->bw != MT_BW_20) {
327 mt7601u_bbp_rmw(dev, 4, 0x20, 0);
328 mt7601u_bbp_wr(dev, 178, 0xff);
329
330 t->cck[0].bw20 = dev->ee->real_cck_bw20[0];
331 t->cck[1].bw20 = dev->ee->real_cck_bw20[1];
332 } else { /* Apply CH14 OBW fixup */
333 mt7601u_bbp_wr(dev, 4, 0x60);
334 mt7601u_bbp_wr(dev, 178, 0);
335
336 /* Note: vendor code is buggy here for negative values */
337 t->cck[0].bw20 = dev->ee->real_cck_bw20[0] - 2;
338 t->cck[1].bw20 = dev->ee->real_cck_bw20[1] - 2;
339 }
340 }
341
__mt7601u_phy_set_channel(struct mt7601u_dev * dev,struct cfg80211_chan_def * chandef)342 static int __mt7601u_phy_set_channel(struct mt7601u_dev *dev,
343 struct cfg80211_chan_def *chandef)
344 {
345 #define FREQ_PLAN_REGS 4
346 static const u8 freq_plan[14][FREQ_PLAN_REGS] = {
347 { 0x99, 0x99, 0x09, 0x50 },
348 { 0x46, 0x44, 0x0a, 0x50 },
349 { 0xec, 0xee, 0x0a, 0x50 },
350 { 0x99, 0x99, 0x0b, 0x50 },
351 { 0x46, 0x44, 0x08, 0x51 },
352 { 0xec, 0xee, 0x08, 0x51 },
353 { 0x99, 0x99, 0x09, 0x51 },
354 { 0x46, 0x44, 0x0a, 0x51 },
355 { 0xec, 0xee, 0x0a, 0x51 },
356 { 0x99, 0x99, 0x0b, 0x51 },
357 { 0x46, 0x44, 0x08, 0x52 },
358 { 0xec, 0xee, 0x08, 0x52 },
359 { 0x99, 0x99, 0x09, 0x52 },
360 { 0x33, 0x33, 0x0b, 0x52 },
361 };
362 struct mt76_reg_pair channel_freq_plan[FREQ_PLAN_REGS] = {
363 { 17, 0 }, { 18, 0 }, { 19, 0 }, { 20, 0 },
364 };
365 struct mt76_reg_pair bbp_settings[3] = {
366 { 62, 0x37 - dev->ee->lna_gain },
367 { 63, 0x37 - dev->ee->lna_gain },
368 { 64, 0x37 - dev->ee->lna_gain },
369 };
370
371 struct ieee80211_channel *chan = chandef->chan;
372 enum nl80211_channel_type chan_type =
373 cfg80211_get_chandef_type(chandef);
374 struct mt7601u_rate_power *t = &dev->ee->power_rate_table;
375 int chan_idx;
376 bool chan_ext_below;
377 u8 bw;
378 int i, ret;
379
380 bw = MT_BW_20;
381 chan_ext_below = (chan_type == NL80211_CHAN_HT40MINUS);
382 chan_idx = chan->hw_value - 1;
383
384 if (chandef->width == NL80211_CHAN_WIDTH_40) {
385 bw = MT_BW_40;
386
387 if (chan_idx > 1 && chan_type == NL80211_CHAN_HT40MINUS)
388 chan_idx -= 2;
389 else if (chan_idx < 12 && chan_type == NL80211_CHAN_HT40PLUS)
390 chan_idx += 2;
391 else
392 dev_err(dev->dev, "Error: invalid 40MHz channel!!\n");
393 }
394
395 if (bw != dev->bw || chan_ext_below != dev->chan_ext_below) {
396 dev_dbg(dev->dev, "Info: switching HT mode bw:%d below:%d\n",
397 bw, chan_ext_below);
398
399 mt7601u_bbp_set_bw(dev, bw);
400
401 mt7601u_bbp_set_ctrlch(dev, chan_ext_below);
402 mt7601u_mac_set_ctrlch(dev, chan_ext_below);
403 dev->chan_ext_below = chan_ext_below;
404 }
405
406 for (i = 0; i < FREQ_PLAN_REGS; i++)
407 channel_freq_plan[i].value = freq_plan[chan_idx][i];
408
409 ret = mt7601u_write_reg_pairs(dev, MT_MCU_MEMMAP_RF,
410 channel_freq_plan, FREQ_PLAN_REGS);
411 if (ret)
412 return ret;
413
414 mt7601u_rmw(dev, MT_TX_ALC_CFG_0, 0x3f3f,
415 dev->ee->chan_pwr[chan_idx] & 0x3f);
416
417 ret = mt7601u_write_reg_pairs(dev, MT_MCU_MEMMAP_BBP,
418 bbp_settings, ARRAY_SIZE(bbp_settings));
419 if (ret)
420 return ret;
421
422 mt7601u_vco_cal(dev);
423 mt7601u_bbp_set_bw(dev, bw);
424 ret = mt7601u_set_bw_filter(dev, false);
425 if (ret)
426 return ret;
427
428 mt7601u_apply_ch14_fixup(dev, chan->hw_value);
429 mt7601u_wr(dev, MT_TX_PWR_CFG_0, int_to_s6(t->ofdm[1].bw20) << 24 |
430 int_to_s6(t->ofdm[0].bw20) << 16 |
431 int_to_s6(t->cck[1].bw20) << 8 |
432 int_to_s6(t->cck[0].bw20));
433
434 if (test_bit(MT7601U_STATE_SCANNING, &dev->state))
435 mt7601u_agc_reset(dev);
436
437 dev->chandef = *chandef;
438
439 return 0;
440 }
441
mt7601u_phy_set_channel(struct mt7601u_dev * dev,struct cfg80211_chan_def * chandef)442 int mt7601u_phy_set_channel(struct mt7601u_dev *dev,
443 struct cfg80211_chan_def *chandef)
444 {
445 int ret;
446
447 cancel_delayed_work_sync(&dev->cal_work);
448 cancel_delayed_work_sync(&dev->freq_cal.work);
449
450 mutex_lock(&dev->hw_atomic_mutex);
451 ret = __mt7601u_phy_set_channel(dev, chandef);
452 mutex_unlock(&dev->hw_atomic_mutex);
453 if (ret)
454 return ret;
455
456 if (test_bit(MT7601U_STATE_SCANNING, &dev->state))
457 return 0;
458
459 ieee80211_queue_delayed_work(dev->hw, &dev->cal_work,
460 MT_CALIBRATE_INTERVAL);
461 if (dev->freq_cal.enabled)
462 ieee80211_queue_delayed_work(dev->hw, &dev->freq_cal.work,
463 MT_FREQ_CAL_INIT_DELAY);
464 return 0;
465 }
466
467 #define BBP_R47_FLAG GENMASK(2, 0)
468 #define BBP_R47_F_TSSI 0
469 #define BBP_R47_F_PKT_T 1
470 #define BBP_R47_F_TX_RATE 2
471 #define BBP_R47_F_TEMP 4
472 /**
473 * mt7601u_bbp_r47_get - read value through BBP R47/R49 pair
474 * @dev: pointer to adapter structure
475 * @reg: value of BBP R47 before the operation
476 * @flag: one of the BBP_R47_F_* flags
477 *
478 * Convenience helper for reading values through BBP R47/R49 pair.
479 * Takes old value of BBP R47 as @reg, because callers usually have it
480 * cached already.
481 *
482 * Return: value of BBP R49.
483 */
mt7601u_bbp_r47_get(struct mt7601u_dev * dev,u8 reg,u8 flag)484 static u8 mt7601u_bbp_r47_get(struct mt7601u_dev *dev, u8 reg, u8 flag)
485 {
486 flag |= reg & ~BBP_R47_FLAG;
487 mt7601u_bbp_wr(dev, 47, flag);
488 usleep_range(500, 700);
489 return mt7601u_bbp_rr(dev, 49);
490 }
491
mt7601u_read_bootup_temp(struct mt7601u_dev * dev)492 static s8 mt7601u_read_bootup_temp(struct mt7601u_dev *dev)
493 {
494 u8 bbp_val, temp;
495 u32 rf_bp, rf_set;
496 int i;
497
498 rf_set = mt7601u_rr(dev, MT_RF_SETTING_0);
499 rf_bp = mt7601u_rr(dev, MT_RF_BYPASS_0);
500
501 mt7601u_wr(dev, MT_RF_BYPASS_0, 0);
502 mt7601u_wr(dev, MT_RF_SETTING_0, 0x00000010);
503 mt7601u_wr(dev, MT_RF_BYPASS_0, 0x00000010);
504
505 bbp_val = mt7601u_bbp_rmw(dev, 47, 0, 0x10);
506
507 mt7601u_bbp_wr(dev, 22, 0x40);
508
509 for (i = 100; i && (bbp_val & 0x10); i--)
510 bbp_val = mt7601u_bbp_rr(dev, 47);
511
512 temp = mt7601u_bbp_r47_get(dev, bbp_val, BBP_R47_F_TEMP);
513
514 mt7601u_bbp_wr(dev, 22, 0);
515
516 bbp_val = mt7601u_bbp_rr(dev, 21);
517 bbp_val |= 0x02;
518 mt7601u_bbp_wr(dev, 21, bbp_val);
519 bbp_val &= ~0x02;
520 mt7601u_bbp_wr(dev, 21, bbp_val);
521
522 mt7601u_wr(dev, MT_RF_BYPASS_0, 0);
523 mt7601u_wr(dev, MT_RF_SETTING_0, rf_set);
524 mt7601u_wr(dev, MT_RF_BYPASS_0, rf_bp);
525
526 trace_read_temp(dev, temp);
527 return temp;
528 }
529
mt7601u_read_temp(struct mt7601u_dev * dev)530 static s8 mt7601u_read_temp(struct mt7601u_dev *dev)
531 {
532 int i;
533 u8 val;
534 s8 temp;
535
536 val = mt7601u_bbp_rmw(dev, 47, 0x7f, 0x10);
537
538 /* Note: this rarely succeeds, temp can change even if it fails. */
539 for (i = 100; i && (val & 0x10); i--)
540 val = mt7601u_bbp_rr(dev, 47);
541
542 temp = mt7601u_bbp_r47_get(dev, val, BBP_R47_F_TEMP);
543
544 trace_read_temp(dev, temp);
545 return temp;
546 }
547
mt7601u_rxdc_cal(struct mt7601u_dev * dev)548 static void mt7601u_rxdc_cal(struct mt7601u_dev *dev)
549 {
550 static const struct mt76_reg_pair intro[] = {
551 { 158, 0x8d }, { 159, 0xfc },
552 { 158, 0x8c }, { 159, 0x4c },
553 }, outro[] = {
554 { 158, 0x8d }, { 159, 0xe0 },
555 };
556 u32 mac_ctrl;
557 int i, ret;
558
559 mac_ctrl = mt7601u_rr(dev, MT_MAC_SYS_CTRL);
560 mt7601u_wr(dev, MT_MAC_SYS_CTRL, MT_MAC_SYS_CTRL_ENABLE_RX);
561
562 ret = mt7601u_write_reg_pairs(dev, MT_MCU_MEMMAP_BBP,
563 intro, ARRAY_SIZE(intro));
564 if (ret)
565 dev_err(dev->dev, "%s intro failed:%d\n", __func__, ret);
566
567 for (i = 20; i; i--) {
568 usleep_range(300, 500);
569
570 mt7601u_bbp_wr(dev, 158, 0x8c);
571 if (mt7601u_bbp_rr(dev, 159) == 0x0c)
572 break;
573 }
574 if (!i)
575 dev_err(dev->dev, "%s timed out\n", __func__);
576
577 mt7601u_wr(dev, MT_MAC_SYS_CTRL, 0);
578
579 ret = mt7601u_write_reg_pairs(dev, MT_MCU_MEMMAP_BBP,
580 outro, ARRAY_SIZE(outro));
581 if (ret)
582 dev_err(dev->dev, "%s outro failed:%d\n", __func__, ret);
583
584 mt7601u_wr(dev, MT_MAC_SYS_CTRL, mac_ctrl);
585 }
586
mt7601u_phy_recalibrate_after_assoc(struct mt7601u_dev * dev)587 void mt7601u_phy_recalibrate_after_assoc(struct mt7601u_dev *dev)
588 {
589 mt7601u_mcu_calibrate(dev, MCU_CAL_DPD, dev->curr_temp);
590
591 mt7601u_rxdc_cal(dev);
592 }
593
594 /* Note: function copied from vendor driver */
lin2dBd(u16 linear)595 static s16 lin2dBd(u16 linear)
596 {
597 short exp = 0;
598 unsigned int mantisa;
599 int app, dBd;
600
601 if (WARN_ON(!linear))
602 return -10000;
603
604 mantisa = linear;
605
606 exp = fls(mantisa) - 16;
607 if (exp > 0)
608 mantisa >>= exp;
609 else
610 mantisa <<= abs(exp);
611
612 if (mantisa <= 0xb800)
613 app = (mantisa + (mantisa >> 3) + (mantisa >> 4) - 0x9600);
614 else
615 app = (mantisa - (mantisa >> 3) - (mantisa >> 6) - 0x5a00);
616 if (app < 0)
617 app = 0;
618
619 dBd = ((15 + exp) << 15) + app;
620 dBd = (dBd << 2) + (dBd << 1) + (dBd >> 6) + (dBd >> 7);
621 dBd = (dBd >> 10);
622
623 return dBd;
624 }
625
626 static void
mt7601u_set_initial_tssi(struct mt7601u_dev * dev,s16 tssi_db,s16 tssi_hvga_db)627 mt7601u_set_initial_tssi(struct mt7601u_dev *dev, s16 tssi_db, s16 tssi_hvga_db)
628 {
629 struct tssi_data *d = &dev->ee->tssi_data;
630 int init_offset;
631
632 init_offset = -((tssi_db * d->slope + d->offset[1]) / 4096) + 10;
633
634 mt76_rmw(dev, MT_TX_ALC_CFG_1, MT_TX_ALC_CFG_1_TEMP_COMP,
635 int_to_s6(init_offset) & MT_TX_ALC_CFG_1_TEMP_COMP);
636 }
637
mt7601u_tssi_dc_gain_cal(struct mt7601u_dev * dev)638 static void mt7601u_tssi_dc_gain_cal(struct mt7601u_dev *dev)
639 {
640 u8 rf_vga, rf_mixer, bbp_r47;
641 int i, j;
642 s8 res[4];
643 s16 tssi_init_db, tssi_init_hvga_db;
644
645 mt7601u_wr(dev, MT_RF_SETTING_0, 0x00000030);
646 mt7601u_wr(dev, MT_RF_BYPASS_0, 0x000c0030);
647 mt7601u_wr(dev, MT_MAC_SYS_CTRL, 0);
648
649 mt7601u_bbp_wr(dev, 58, 0);
650 mt7601u_bbp_wr(dev, 241, 0x2);
651 mt7601u_bbp_wr(dev, 23, 0x8);
652 bbp_r47 = mt7601u_bbp_rr(dev, 47);
653
654 /* Set VGA gain */
655 rf_vga = mt7601u_rf_rr(dev, 5, 3);
656 mt7601u_rf_wr(dev, 5, 3, 8);
657
658 /* Mixer disable */
659 rf_mixer = mt7601u_rf_rr(dev, 4, 39);
660 mt7601u_rf_wr(dev, 4, 39, 0);
661
662 for (i = 0; i < 4; i++) {
663 mt7601u_rf_wr(dev, 4, 39, (i & 1) ? rf_mixer : 0);
664
665 mt7601u_bbp_wr(dev, 23, (i < 2) ? 0x08 : 0x02);
666 mt7601u_rf_wr(dev, 5, 3, (i < 2) ? 0x08 : 0x11);
667
668 /* BBP TSSI initial and soft reset */
669 mt7601u_bbp_wr(dev, 22, 0);
670 mt7601u_bbp_wr(dev, 244, 0);
671
672 mt7601u_bbp_wr(dev, 21, 1);
673 udelay(1);
674 mt7601u_bbp_wr(dev, 21, 0);
675
676 /* TSSI measurement */
677 mt7601u_bbp_wr(dev, 47, 0x50);
678 mt7601u_bbp_wr(dev, (i & 1) ? 244 : 22, (i & 1) ? 0x31 : 0x40);
679
680 for (j = 20; j; j--)
681 if (!(mt7601u_bbp_rr(dev, 47) & 0x10))
682 break;
683 if (!j)
684 dev_err(dev->dev, "%s timed out\n", __func__);
685
686 /* TSSI read */
687 mt7601u_bbp_wr(dev, 47, 0x40);
688 res[i] = mt7601u_bbp_rr(dev, 49);
689 }
690
691 tssi_init_db = lin2dBd((short)res[1] - res[0]);
692 tssi_init_hvga_db = lin2dBd(((short)res[3] - res[2]) * 4);
693 dev->tssi_init = res[0];
694 dev->tssi_init_hvga = res[2];
695 dev->tssi_init_hvga_offset_db = tssi_init_hvga_db - tssi_init_db;
696
697 dev_dbg(dev->dev,
698 "TSSI_init:%hhx db:%hx hvga:%hhx hvga_db:%hx off_db:%hx\n",
699 dev->tssi_init, tssi_init_db, dev->tssi_init_hvga,
700 tssi_init_hvga_db, dev->tssi_init_hvga_offset_db);
701
702 mt7601u_bbp_wr(dev, 22, 0);
703 mt7601u_bbp_wr(dev, 244, 0);
704
705 mt7601u_bbp_wr(dev, 21, 1);
706 udelay(1);
707 mt7601u_bbp_wr(dev, 21, 0);
708
709 mt7601u_wr(dev, MT_RF_BYPASS_0, 0);
710 mt7601u_wr(dev, MT_RF_SETTING_0, 0);
711
712 mt7601u_rf_wr(dev, 5, 3, rf_vga);
713 mt7601u_rf_wr(dev, 4, 39, rf_mixer);
714 mt7601u_bbp_wr(dev, 47, bbp_r47);
715
716 mt7601u_set_initial_tssi(dev, tssi_init_db, tssi_init_hvga_db);
717 }
718
mt7601u_temp_comp(struct mt7601u_dev * dev,bool on)719 static int mt7601u_temp_comp(struct mt7601u_dev *dev, bool on)
720 {
721 int ret, temp, hi_temp = 400, lo_temp = -200;
722
723 temp = (dev->raw_temp - dev->ee->ref_temp) * MT_EE_TEMPERATURE_SLOPE;
724 dev->curr_temp = temp;
725
726 /* DPD Calibration */
727 if (temp - dev->dpd_temp > 450 || temp - dev->dpd_temp < -450) {
728 dev->dpd_temp = temp;
729
730 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_DPD, dev->dpd_temp);
731 if (ret)
732 return ret;
733
734 mt7601u_vco_cal(dev);
735
736 dev_dbg(dev->dev, "Recalibrate DPD\n");
737 }
738
739 /* PLL Lock Protect */
740 if (temp < -50 && !dev->pll_lock_protect) { /* < 20C */
741 dev->pll_lock_protect = true;
742
743 mt7601u_rf_wr(dev, 4, 4, 6);
744 mt7601u_rf_clear(dev, 4, 10, 0x30);
745
746 dev_dbg(dev->dev, "PLL lock protect on - too cold\n");
747 } else if (temp > 50 && dev->pll_lock_protect) { /* > 30C */
748 dev->pll_lock_protect = false;
749
750 mt7601u_rf_wr(dev, 4, 4, 0);
751 mt7601u_rf_rmw(dev, 4, 10, 0x30, 0x10);
752
753 dev_dbg(dev->dev, "PLL lock protect off\n");
754 }
755
756 if (on) {
757 hi_temp -= 50;
758 lo_temp -= 50;
759 }
760
761 /* BBP CR for H, L, N temperature */
762 if (temp > hi_temp)
763 return mt7601u_bbp_temp(dev, MT_TEMP_MODE_HIGH, "high");
764 else if (temp > lo_temp)
765 return mt7601u_bbp_temp(dev, MT_TEMP_MODE_NORMAL, "normal");
766 else
767 return mt7601u_bbp_temp(dev, MT_TEMP_MODE_LOW, "low");
768 }
769
770 /* Note: this is used only with TSSI, we can just use trgt_pwr from eeprom. */
mt7601u_current_tx_power(struct mt7601u_dev * dev)771 static int mt7601u_current_tx_power(struct mt7601u_dev *dev)
772 {
773 return dev->ee->chan_pwr[dev->chandef.chan->hw_value - 1];
774 }
775
mt7601u_use_hvga(struct mt7601u_dev * dev)776 static bool mt7601u_use_hvga(struct mt7601u_dev *dev)
777 {
778 return !(mt7601u_current_tx_power(dev) > 20);
779 }
780
781 static s16
mt7601u_phy_rf_pa_mode_val(struct mt7601u_dev * dev,int phy_mode,int tx_rate)782 mt7601u_phy_rf_pa_mode_val(struct mt7601u_dev *dev, int phy_mode, int tx_rate)
783 {
784 static const s16 decode_tb[] = { 0, 8847, -5734, -5734 };
785 u32 reg;
786
787 switch (phy_mode) {
788 case MT_PHY_TYPE_OFDM:
789 tx_rate += 4;
790 fallthrough;
791 case MT_PHY_TYPE_CCK:
792 reg = dev->rf_pa_mode[0];
793 break;
794 default:
795 reg = dev->rf_pa_mode[1];
796 break;
797 }
798
799 return decode_tb[(reg >> (tx_rate * 2)) & 0x3];
800 }
801
802 static struct mt7601u_tssi_params
mt7601u_tssi_params_get(struct mt7601u_dev * dev)803 mt7601u_tssi_params_get(struct mt7601u_dev *dev)
804 {
805 static const u8 ofdm_pkt2rate[8] = { 6, 4, 2, 0, 7, 5, 3, 1 };
806 static const int static_power[4] = { 0, -49152, -98304, 49152 };
807 struct mt7601u_tssi_params p;
808 u8 bbp_r47, pkt_type, tx_rate;
809 struct power_per_rate *rate_table;
810
811 bbp_r47 = mt7601u_bbp_rr(dev, 47);
812
813 p.tssi0 = mt7601u_bbp_r47_get(dev, bbp_r47, BBP_R47_F_TSSI);
814 dev->raw_temp = mt7601u_bbp_r47_get(dev, bbp_r47, BBP_R47_F_TEMP);
815 pkt_type = mt7601u_bbp_r47_get(dev, bbp_r47, BBP_R47_F_PKT_T);
816
817 p.trgt_power = mt7601u_current_tx_power(dev);
818
819 switch (pkt_type & 0x03) {
820 case MT_PHY_TYPE_CCK:
821 tx_rate = (pkt_type >> 4) & 0x03;
822 rate_table = dev->ee->power_rate_table.cck;
823 break;
824
825 case MT_PHY_TYPE_OFDM:
826 tx_rate = ofdm_pkt2rate[(pkt_type >> 4) & 0x07];
827 rate_table = dev->ee->power_rate_table.ofdm;
828 break;
829
830 default:
831 tx_rate = mt7601u_bbp_r47_get(dev, bbp_r47, BBP_R47_F_TX_RATE);
832 tx_rate &= 0x7f;
833 rate_table = dev->ee->power_rate_table.ht;
834 break;
835 }
836
837 if (dev->bw == MT_BW_20)
838 p.trgt_power += rate_table[tx_rate / 2].bw20;
839 else
840 p.trgt_power += rate_table[tx_rate / 2].bw40;
841
842 p.trgt_power <<= 12;
843
844 dev_dbg(dev->dev, "tx_rate:%02hhx pwr:%08x\n", tx_rate, p.trgt_power);
845
846 p.trgt_power += mt7601u_phy_rf_pa_mode_val(dev, pkt_type & 0x03,
847 tx_rate);
848
849 /* Channel 14, cck, bw20 */
850 if ((pkt_type & 0x03) == MT_PHY_TYPE_CCK) {
851 if (mt7601u_bbp_rr(dev, 4) & 0x20)
852 p.trgt_power += mt7601u_bbp_rr(dev, 178) ? 18022 : 9830;
853 else
854 p.trgt_power += mt7601u_bbp_rr(dev, 178) ? 819 : 24576;
855 }
856
857 p.trgt_power += static_power[mt7601u_bbp_rr(dev, 1) & 0x03];
858
859 p.trgt_power += dev->ee->tssi_data.tx0_delta_offset;
860
861 dev_dbg(dev->dev,
862 "tssi:%02hhx t_power:%08x temp:%02hhx pkt_type:%02hhx\n",
863 p.tssi0, p.trgt_power, dev->raw_temp, pkt_type);
864
865 return p;
866 }
867
mt7601u_tssi_read_ready(struct mt7601u_dev * dev)868 static bool mt7601u_tssi_read_ready(struct mt7601u_dev *dev)
869 {
870 return !(mt7601u_bbp_rr(dev, 47) & 0x10);
871 }
872
mt7601u_tssi_cal(struct mt7601u_dev * dev)873 static int mt7601u_tssi_cal(struct mt7601u_dev *dev)
874 {
875 struct mt7601u_tssi_params params;
876 int curr_pwr, diff_pwr;
877 char tssi_offset;
878 s8 tssi_init;
879 s16 tssi_m_dc, tssi_db;
880 bool hvga;
881 u32 val;
882
883 if (!dev->ee->tssi_enabled)
884 return 0;
885
886 hvga = mt7601u_use_hvga(dev);
887 if (!dev->tssi_read_trig)
888 return mt7601u_mcu_tssi_read_kick(dev, hvga);
889
890 if (!mt7601u_tssi_read_ready(dev))
891 return 0;
892
893 params = mt7601u_tssi_params_get(dev);
894
895 tssi_init = (hvga ? dev->tssi_init_hvga : dev->tssi_init);
896 tssi_m_dc = params.tssi0 - tssi_init;
897 tssi_db = lin2dBd(tssi_m_dc);
898 dev_dbg(dev->dev, "tssi dc:%04hx db:%04hx hvga:%d\n",
899 tssi_m_dc, tssi_db, hvga);
900
901 if (dev->chandef.chan->hw_value < 5)
902 tssi_offset = dev->ee->tssi_data.offset[0];
903 else if (dev->chandef.chan->hw_value < 9)
904 tssi_offset = dev->ee->tssi_data.offset[1];
905 else
906 tssi_offset = dev->ee->tssi_data.offset[2];
907
908 if (hvga)
909 tssi_db -= dev->tssi_init_hvga_offset_db;
910
911 curr_pwr = tssi_db * dev->ee->tssi_data.slope + (tssi_offset << 9);
912 diff_pwr = params.trgt_power - curr_pwr;
913 dev_dbg(dev->dev, "Power curr:%08x diff:%08x\n", curr_pwr, diff_pwr);
914
915 if (params.tssi0 > 126 && diff_pwr > 0) {
916 dev_err(dev->dev, "Error: TSSI upper saturation\n");
917 diff_pwr = 0;
918 }
919 if (params.tssi0 - tssi_init < 1 && diff_pwr < 0) {
920 dev_err(dev->dev, "Error: TSSI lower saturation\n");
921 diff_pwr = 0;
922 }
923
924 if ((dev->prev_pwr_diff ^ diff_pwr) < 0 && abs(diff_pwr) < 4096 &&
925 (abs(diff_pwr) > abs(dev->prev_pwr_diff) ||
926 (diff_pwr > 0 && diff_pwr == -dev->prev_pwr_diff)))
927 diff_pwr = 0;
928 else
929 dev->prev_pwr_diff = diff_pwr;
930
931 diff_pwr += (diff_pwr > 0) ? 2048 : -2048;
932 diff_pwr /= 4096;
933
934 dev_dbg(dev->dev, "final diff: %08x\n", diff_pwr);
935
936 val = mt7601u_rr(dev, MT_TX_ALC_CFG_1);
937 curr_pwr = s6_to_int(FIELD_GET(MT_TX_ALC_CFG_1_TEMP_COMP, val));
938 diff_pwr += curr_pwr;
939 val = (val & ~MT_TX_ALC_CFG_1_TEMP_COMP) | int_to_s6(diff_pwr);
940 mt7601u_wr(dev, MT_TX_ALC_CFG_1, val);
941
942 return mt7601u_mcu_tssi_read_kick(dev, hvga);
943 }
944
mt7601u_agc_default(struct mt7601u_dev * dev)945 static u8 mt7601u_agc_default(struct mt7601u_dev *dev)
946 {
947 return (dev->ee->lna_gain - 8) * 2 + 0x34;
948 }
949
mt7601u_agc_reset(struct mt7601u_dev * dev)950 static void mt7601u_agc_reset(struct mt7601u_dev *dev)
951 {
952 u8 agc = mt7601u_agc_default(dev);
953
954 mt7601u_bbp_wr(dev, 66, agc);
955 }
956
mt7601u_agc_save(struct mt7601u_dev * dev)957 void mt7601u_agc_save(struct mt7601u_dev *dev)
958 {
959 dev->agc_save = mt7601u_bbp_rr(dev, 66);
960 }
961
mt7601u_agc_restore(struct mt7601u_dev * dev)962 void mt7601u_agc_restore(struct mt7601u_dev *dev)
963 {
964 mt7601u_bbp_wr(dev, 66, dev->agc_save);
965 }
966
mt7601u_agc_tune(struct mt7601u_dev * dev)967 static void mt7601u_agc_tune(struct mt7601u_dev *dev)
968 {
969 u8 val = mt7601u_agc_default(dev);
970 long avg_rssi;
971
972 if (test_bit(MT7601U_STATE_SCANNING, &dev->state))
973 return;
974
975 /* Note: only in STA mode and not dozing; perhaps do this only if
976 * there is enough rssi updates since last run?
977 * Rssi updates are only on beacons and U2M so should work...
978 */
979 spin_lock_bh(&dev->con_mon_lock);
980 avg_rssi = ewma_rssi_read(&dev->avg_rssi);
981 spin_unlock_bh(&dev->con_mon_lock);
982 if (avg_rssi == 0)
983 return;
984
985 avg_rssi = -avg_rssi;
986 if (avg_rssi <= -70)
987 val -= 0x20;
988 else if (avg_rssi <= -60)
989 val -= 0x10;
990
991 if (val != mt7601u_bbp_rr(dev, 66))
992 mt7601u_bbp_wr(dev, 66, val);
993
994 /* TODO: also if lost a lot of beacons try resetting
995 * (see RTMPSetAGCInitValue() call in mlme.c).
996 */
997 }
998
mt7601u_phy_calibrate(struct work_struct * work)999 static void mt7601u_phy_calibrate(struct work_struct *work)
1000 {
1001 struct mt7601u_dev *dev = container_of(work, struct mt7601u_dev,
1002 cal_work.work);
1003
1004 mt7601u_agc_tune(dev);
1005 mt7601u_tssi_cal(dev);
1006 /* If TSSI calibration was run it already updated temperature. */
1007 if (!dev->ee->tssi_enabled)
1008 dev->raw_temp = mt7601u_read_temp(dev);
1009 mt7601u_temp_comp(dev, true); /* TODO: find right value for @on */
1010
1011 ieee80211_queue_delayed_work(dev->hw, &dev->cal_work,
1012 MT_CALIBRATE_INTERVAL);
1013 }
1014
1015 static unsigned long
__mt7601u_phy_freq_cal(struct mt7601u_dev * dev,s8 last_offset,u8 phy_mode)1016 __mt7601u_phy_freq_cal(struct mt7601u_dev *dev, s8 last_offset, u8 phy_mode)
1017 {
1018 u8 activate_threshold, deactivate_threshold;
1019
1020 trace_freq_cal_offset(dev, phy_mode, last_offset);
1021
1022 /* No beacons received - reschedule soon */
1023 if (last_offset == MT_FREQ_OFFSET_INVALID)
1024 return MT_FREQ_CAL_ADJ_INTERVAL;
1025
1026 switch (phy_mode) {
1027 case MT_PHY_TYPE_CCK:
1028 activate_threshold = 19;
1029 deactivate_threshold = 5;
1030 break;
1031 case MT_PHY_TYPE_OFDM:
1032 activate_threshold = 102;
1033 deactivate_threshold = 32;
1034 break;
1035 case MT_PHY_TYPE_HT:
1036 case MT_PHY_TYPE_HT_GF:
1037 activate_threshold = 82;
1038 deactivate_threshold = 20;
1039 break;
1040 default:
1041 WARN_ON(1);
1042 return MT_FREQ_CAL_CHECK_INTERVAL;
1043 }
1044
1045 if (abs(last_offset) >= activate_threshold)
1046 dev->freq_cal.adjusting = true;
1047 else if (abs(last_offset) <= deactivate_threshold)
1048 dev->freq_cal.adjusting = false;
1049
1050 if (!dev->freq_cal.adjusting)
1051 return MT_FREQ_CAL_CHECK_INTERVAL;
1052
1053 if (last_offset > deactivate_threshold) {
1054 if (dev->freq_cal.freq > 0)
1055 dev->freq_cal.freq--;
1056 else
1057 dev->freq_cal.adjusting = false;
1058 } else if (last_offset < -deactivate_threshold) {
1059 if (dev->freq_cal.freq < 0xbf)
1060 dev->freq_cal.freq++;
1061 else
1062 dev->freq_cal.adjusting = false;
1063 }
1064
1065 trace_freq_cal_adjust(dev, dev->freq_cal.freq);
1066 mt7601u_rf_wr(dev, 0, 12, dev->freq_cal.freq);
1067 mt7601u_vco_cal(dev);
1068
1069 return dev->freq_cal.adjusting ? MT_FREQ_CAL_ADJ_INTERVAL :
1070 MT_FREQ_CAL_CHECK_INTERVAL;
1071 }
1072
mt7601u_phy_freq_cal(struct work_struct * work)1073 static void mt7601u_phy_freq_cal(struct work_struct *work)
1074 {
1075 struct mt7601u_dev *dev = container_of(work, struct mt7601u_dev,
1076 freq_cal.work.work);
1077 s8 last_offset;
1078 u8 phy_mode;
1079 unsigned long delay;
1080
1081 spin_lock_bh(&dev->con_mon_lock);
1082 last_offset = dev->bcn_freq_off;
1083 phy_mode = dev->bcn_phy_mode;
1084 spin_unlock_bh(&dev->con_mon_lock);
1085
1086 delay = __mt7601u_phy_freq_cal(dev, last_offset, phy_mode);
1087 ieee80211_queue_delayed_work(dev->hw, &dev->freq_cal.work, delay);
1088
1089 spin_lock_bh(&dev->con_mon_lock);
1090 dev->bcn_freq_off = MT_FREQ_OFFSET_INVALID;
1091 spin_unlock_bh(&dev->con_mon_lock);
1092 }
1093
mt7601u_phy_con_cal_onoff(struct mt7601u_dev * dev,struct ieee80211_bss_conf * info)1094 void mt7601u_phy_con_cal_onoff(struct mt7601u_dev *dev,
1095 struct ieee80211_bss_conf *info)
1096 {
1097 if (!info->assoc)
1098 cancel_delayed_work_sync(&dev->freq_cal.work);
1099
1100 /* Start/stop collecting beacon data */
1101 spin_lock_bh(&dev->con_mon_lock);
1102 ether_addr_copy(dev->ap_bssid, info->bssid);
1103 ewma_rssi_init(&dev->avg_rssi);
1104 dev->bcn_freq_off = MT_FREQ_OFFSET_INVALID;
1105 spin_unlock_bh(&dev->con_mon_lock);
1106
1107 dev->freq_cal.freq = dev->ee->rf_freq_off;
1108 dev->freq_cal.enabled = info->assoc;
1109 dev->freq_cal.adjusting = false;
1110
1111 if (info->assoc)
1112 ieee80211_queue_delayed_work(dev->hw, &dev->freq_cal.work,
1113 MT_FREQ_CAL_INIT_DELAY);
1114 }
1115
mt7601u_init_cal(struct mt7601u_dev * dev)1116 static int mt7601u_init_cal(struct mt7601u_dev *dev)
1117 {
1118 u32 mac_ctrl;
1119 int ret;
1120
1121 dev->raw_temp = mt7601u_read_bootup_temp(dev);
1122 dev->curr_temp = (dev->raw_temp - dev->ee->ref_temp) *
1123 MT_EE_TEMPERATURE_SLOPE;
1124 dev->dpd_temp = dev->curr_temp;
1125
1126 mac_ctrl = mt7601u_rr(dev, MT_MAC_SYS_CTRL);
1127
1128 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_R, 0);
1129 if (ret)
1130 return ret;
1131
1132 ret = mt7601u_rf_rr(dev, 0, 4);
1133 if (ret < 0)
1134 return ret;
1135 ret |= 0x80;
1136 ret = mt7601u_rf_wr(dev, 0, 4, ret);
1137 if (ret)
1138 return ret;
1139 msleep(2);
1140
1141 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_TXDCOC, 0);
1142 if (ret)
1143 return ret;
1144
1145 mt7601u_rxdc_cal(dev);
1146
1147 ret = mt7601u_set_bw_filter(dev, true);
1148 if (ret)
1149 return ret;
1150 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_LOFT, 0);
1151 if (ret)
1152 return ret;
1153 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_TXIQ, 0);
1154 if (ret)
1155 return ret;
1156 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_RXIQ, 0);
1157 if (ret)
1158 return ret;
1159 ret = mt7601u_mcu_calibrate(dev, MCU_CAL_DPD, dev->dpd_temp);
1160 if (ret)
1161 return ret;
1162
1163 mt7601u_rxdc_cal(dev);
1164
1165 mt7601u_tssi_dc_gain_cal(dev);
1166
1167 mt7601u_wr(dev, MT_MAC_SYS_CTRL, mac_ctrl);
1168
1169 mt7601u_temp_comp(dev, true);
1170
1171 return 0;
1172 }
1173
mt7601u_bbp_set_bw(struct mt7601u_dev * dev,int bw)1174 int mt7601u_bbp_set_bw(struct mt7601u_dev *dev, int bw)
1175 {
1176 u32 val, old;
1177
1178 if (bw == dev->bw) {
1179 /* Vendor driver does the rmc even when no change is needed. */
1180 mt7601u_bbp_rmc(dev, 4, 0x18, bw == MT_BW_20 ? 0 : 0x10);
1181
1182 return 0;
1183 }
1184 dev->bw = bw;
1185
1186 /* Stop MAC for the time of bw change */
1187 old = mt7601u_rr(dev, MT_MAC_SYS_CTRL);
1188 val = old & ~(MT_MAC_SYS_CTRL_ENABLE_TX | MT_MAC_SYS_CTRL_ENABLE_RX);
1189 mt7601u_wr(dev, MT_MAC_SYS_CTRL, val);
1190 mt76_poll(dev, MT_MAC_STATUS, MT_MAC_STATUS_TX | MT_MAC_STATUS_RX,
1191 0, 500000);
1192
1193 mt7601u_bbp_rmc(dev, 4, 0x18, bw == MT_BW_20 ? 0 : 0x10);
1194
1195 mt7601u_wr(dev, MT_MAC_SYS_CTRL, old);
1196
1197 return mt7601u_load_bbp_temp_table_bw(dev);
1198 }
1199
1200 /**
1201 * mt7601u_set_rx_path - set rx path in BBP
1202 * @dev: pointer to adapter structure
1203 * @path: rx path to set values are 0-based
1204 */
mt7601u_set_rx_path(struct mt7601u_dev * dev,u8 path)1205 void mt7601u_set_rx_path(struct mt7601u_dev *dev, u8 path)
1206 {
1207 mt7601u_bbp_rmw(dev, 3, 0x18, path << 3);
1208 }
1209
1210 /**
1211 * mt7601u_set_tx_dac - set which tx DAC to use
1212 * @dev: pointer to adapter structure
1213 * @dac: DAC index, values are 0-based
1214 */
mt7601u_set_tx_dac(struct mt7601u_dev * dev,u8 dac)1215 void mt7601u_set_tx_dac(struct mt7601u_dev *dev, u8 dac)
1216 {
1217 mt7601u_bbp_rmc(dev, 1, 0x18, dac << 3);
1218 }
1219
mt7601u_phy_init(struct mt7601u_dev * dev)1220 int mt7601u_phy_init(struct mt7601u_dev *dev)
1221 {
1222 int ret;
1223
1224 dev->rf_pa_mode[0] = mt7601u_rr(dev, MT_RF_PA_MODE_CFG0);
1225 dev->rf_pa_mode[1] = mt7601u_rr(dev, MT_RF_PA_MODE_CFG1);
1226
1227 ret = mt7601u_rf_wr(dev, 0, 12, dev->ee->rf_freq_off);
1228 if (ret)
1229 return ret;
1230 ret = mt7601u_write_reg_pairs(dev, 0, rf_central,
1231 ARRAY_SIZE(rf_central));
1232 if (ret)
1233 return ret;
1234 ret = mt7601u_write_reg_pairs(dev, 0, rf_channel,
1235 ARRAY_SIZE(rf_channel));
1236 if (ret)
1237 return ret;
1238 ret = mt7601u_write_reg_pairs(dev, 0, rf_vga, ARRAY_SIZE(rf_vga));
1239 if (ret)
1240 return ret;
1241
1242 ret = mt7601u_init_cal(dev);
1243 if (ret)
1244 return ret;
1245
1246 dev->prev_pwr_diff = 100;
1247
1248 INIT_DELAYED_WORK(&dev->cal_work, mt7601u_phy_calibrate);
1249 INIT_DELAYED_WORK(&dev->freq_cal.work, mt7601u_phy_freq_cal);
1250
1251 return 0;
1252 }
1253