1 // SPDX-License-Identifier: ISC
2 /*
3 * Copyright (c) 2013 Broadcom Corporation
4 */
5 #include <linux/slab.h>
6 #include <linux/netdevice.h>
7 #include <net/cfg80211.h>
8
9 #include <brcmu_wifi.h>
10 #include <brcmu_utils.h>
11 #include <defs.h>
12 #include "core.h"
13 #include "debug.h"
14 #include "fwil.h"
15 #include "fwil_types.h"
16 #include "btcoex.h"
17 #include "p2p.h"
18 #include "cfg80211.h"
19
20 /* T1 start SCO/eSCO priority suppression */
21 #define BRCMF_BTCOEX_OPPR_WIN_TIME msecs_to_jiffies(2000)
22
23 /* BT registers values during DHCP */
24 #define BRCMF_BT_DHCP_REG50 0x8022
25 #define BRCMF_BT_DHCP_REG51 0
26 #define BRCMF_BT_DHCP_REG64 0
27 #define BRCMF_BT_DHCP_REG65 0
28 #define BRCMF_BT_DHCP_REG71 0
29 #define BRCMF_BT_DHCP_REG66 0x2710
30 #define BRCMF_BT_DHCP_REG41 0x33
31 #define BRCMF_BT_DHCP_REG68 0x190
32
33 /* number of samples for SCO detection */
34 #define BRCMF_BT_SCO_SAMPLES 12
35
36 /**
37 * enum brcmf_btcoex_state - BT coex DHCP state machine states
38 * @BRCMF_BT_DHCP_IDLE: DCHP is idle
39 * @BRCMF_BT_DHCP_START: DHCP started, wait before
40 * boosting wifi priority
41 * @BRCMF_BT_DHCP_OPPR_WIN: graceful DHCP opportunity ended,
42 * boost wifi priority
43 * @BRCMF_BT_DHCP_FLAG_FORCE_TIMEOUT: wifi priority boost end,
44 * restore defaults
45 */
46 enum brcmf_btcoex_state {
47 BRCMF_BT_DHCP_IDLE,
48 BRCMF_BT_DHCP_START,
49 BRCMF_BT_DHCP_OPPR_WIN,
50 BRCMF_BT_DHCP_FLAG_FORCE_TIMEOUT
51 };
52
53 /**
54 * struct brcmf_btcoex_info - BT coex related information
55 * @vif: interface for which request was done.
56 * @timer: timer for DHCP state machine
57 * @timeout: configured timeout.
58 * @timer_on: DHCP timer active
59 * @dhcp_done: DHCP finished before T1/T2 timer expiration
60 * @bt_state: DHCP state machine state
61 * @work: DHCP state machine work
62 * @cfg: driver private data for cfg80211 interface
63 * @reg66: saved value of btc_params 66
64 * @reg41: saved value of btc_params 41
65 * @reg68: saved value of btc_params 68
66 * @saved_regs_part1: flag indicating regs 66,41,68
67 * have been saved
68 * @reg51: saved value of btc_params 51
69 * @reg64: saved value of btc_params 64
70 * @reg65: saved value of btc_params 65
71 * @reg71: saved value of btc_params 71
72 * @saved_regs_part1: flag indicating regs 50,51,64,65,71
73 * have been saved
74 */
75 struct brcmf_btcoex_info {
76 struct brcmf_cfg80211_vif *vif;
77 struct timer_list timer;
78 u16 timeout;
79 bool timer_on;
80 bool dhcp_done;
81 enum brcmf_btcoex_state bt_state;
82 struct work_struct work;
83 struct brcmf_cfg80211_info *cfg;
84 u32 reg66;
85 u32 reg41;
86 u32 reg68;
87 bool saved_regs_part1;
88 u32 reg50;
89 u32 reg51;
90 u32 reg64;
91 u32 reg65;
92 u32 reg71;
93 bool saved_regs_part2;
94 };
95
96 /**
97 * brcmf_btcoex_params_write() - write btc_params firmware variable
98 * @ifp: interface
99 * @addr: btc_params register number
100 * @data: data to write
101 */
brcmf_btcoex_params_write(struct brcmf_if * ifp,u32 addr,u32 data)102 static s32 brcmf_btcoex_params_write(struct brcmf_if *ifp, u32 addr, u32 data)
103 {
104 struct {
105 __le32 addr;
106 __le32 data;
107 } reg_write;
108
109 reg_write.addr = cpu_to_le32(addr);
110 reg_write.data = cpu_to_le32(data);
111 return brcmf_fil_iovar_data_set(ifp, "btc_params",
112 ®_write, sizeof(reg_write));
113 }
114
115 /**
116 * brcmf_btcoex_params_read() - read btc_params firmware variable
117 * @ifp: interface
118 * @addr: btc_params register number
119 * @data: read data
120 */
brcmf_btcoex_params_read(struct brcmf_if * ifp,u32 addr,u32 * data)121 static s32 brcmf_btcoex_params_read(struct brcmf_if *ifp, u32 addr, u32 *data)
122 {
123 *data = addr;
124
125 return brcmf_fil_iovar_int_get(ifp, "btc_params", data);
126 }
127
128 /**
129 * brcmf_btcoex_boost_wifi() - control BT SCO/eSCO parameters
130 * @btci: BT coex info
131 * @trump_sco:
132 * true - set SCO/eSCO parameters for compatibility
133 * during DHCP window
134 * false - restore saved parameter values
135 *
136 * Enhanced BT COEX settings for eSCO compatibility during DHCP window
137 */
brcmf_btcoex_boost_wifi(struct brcmf_btcoex_info * btci,bool trump_sco)138 static void brcmf_btcoex_boost_wifi(struct brcmf_btcoex_info *btci,
139 bool trump_sco)
140 {
141 struct brcmf_if *ifp = brcmf_get_ifp(btci->cfg->pub, 0);
142
143 if (trump_sco && !btci->saved_regs_part2) {
144 /* this should reduce eSCO agressive
145 * retransmit w/o breaking it
146 */
147
148 /* save current */
149 brcmf_dbg(INFO, "new SCO/eSCO coex algo {save & override}\n");
150 brcmf_btcoex_params_read(ifp, 50, &btci->reg50);
151 brcmf_btcoex_params_read(ifp, 51, &btci->reg51);
152 brcmf_btcoex_params_read(ifp, 64, &btci->reg64);
153 brcmf_btcoex_params_read(ifp, 65, &btci->reg65);
154 brcmf_btcoex_params_read(ifp, 71, &btci->reg71);
155
156 btci->saved_regs_part2 = true;
157 brcmf_dbg(INFO,
158 "saved bt_params[50,51,64,65,71]: 0x%x 0x%x 0x%x 0x%x 0x%x\n",
159 btci->reg50, btci->reg51, btci->reg64,
160 btci->reg65, btci->reg71);
161
162 /* pacify the eSco */
163 brcmf_btcoex_params_write(ifp, 50, BRCMF_BT_DHCP_REG50);
164 brcmf_btcoex_params_write(ifp, 51, BRCMF_BT_DHCP_REG51);
165 brcmf_btcoex_params_write(ifp, 64, BRCMF_BT_DHCP_REG64);
166 brcmf_btcoex_params_write(ifp, 65, BRCMF_BT_DHCP_REG65);
167 brcmf_btcoex_params_write(ifp, 71, BRCMF_BT_DHCP_REG71);
168
169 } else if (btci->saved_regs_part2) {
170 /* restore previously saved bt params */
171 brcmf_dbg(INFO, "Do new SCO/eSCO coex algo {restore}\n");
172 brcmf_btcoex_params_write(ifp, 50, btci->reg50);
173 brcmf_btcoex_params_write(ifp, 51, btci->reg51);
174 brcmf_btcoex_params_write(ifp, 64, btci->reg64);
175 brcmf_btcoex_params_write(ifp, 65, btci->reg65);
176 brcmf_btcoex_params_write(ifp, 71, btci->reg71);
177
178 brcmf_dbg(INFO,
179 "restored bt_params[50,51,64,65,71]: 0x%x 0x%x 0x%x 0x%x 0x%x\n",
180 btci->reg50, btci->reg51, btci->reg64,
181 btci->reg65, btci->reg71);
182
183 btci->saved_regs_part2 = false;
184 } else {
185 brcmf_dbg(INFO, "attempted to restore not saved BTCOEX params\n");
186 }
187 }
188
189 /**
190 * brcmf_btcoex_is_sco_active() - check if SCO/eSCO is active
191 * @ifp: interface
192 *
193 * return: true if SCO/eSCO session is active
194 */
brcmf_btcoex_is_sco_active(struct brcmf_if * ifp)195 static bool brcmf_btcoex_is_sco_active(struct brcmf_if *ifp)
196 {
197 int ioc_res = 0;
198 bool res = false;
199 int sco_id_cnt = 0;
200 u32 param27;
201 int i;
202
203 for (i = 0; i < BRCMF_BT_SCO_SAMPLES; i++) {
204 ioc_res = brcmf_btcoex_params_read(ifp, 27, ¶m27);
205
206 if (ioc_res < 0) {
207 brcmf_err("ioc read btc params error\n");
208 break;
209 }
210
211 brcmf_dbg(INFO, "sample[%d], btc_params 27:%x\n", i, param27);
212
213 if ((param27 & 0x6) == 2) { /* count both sco & esco */
214 sco_id_cnt++;
215 }
216
217 if (sco_id_cnt > 2) {
218 brcmf_dbg(INFO,
219 "sco/esco detected, pkt id_cnt:%d samples:%d\n",
220 sco_id_cnt, i);
221 res = true;
222 break;
223 }
224 }
225 brcmf_dbg(TRACE, "exit: result=%d\n", res);
226 return res;
227 }
228
229 /**
230 * btcmf_btcoex_save_part1() - save first step parameters.
231 */
btcmf_btcoex_save_part1(struct brcmf_btcoex_info * btci)232 static void btcmf_btcoex_save_part1(struct brcmf_btcoex_info *btci)
233 {
234 struct brcmf_if *ifp = btci->vif->ifp;
235
236 if (!btci->saved_regs_part1) {
237 /* Retrieve and save original reg value */
238 brcmf_btcoex_params_read(ifp, 66, &btci->reg66);
239 brcmf_btcoex_params_read(ifp, 41, &btci->reg41);
240 brcmf_btcoex_params_read(ifp, 68, &btci->reg68);
241 btci->saved_regs_part1 = true;
242 brcmf_dbg(INFO,
243 "saved btc_params regs (66,41,68) 0x%x 0x%x 0x%x\n",
244 btci->reg66, btci->reg41,
245 btci->reg68);
246 }
247 }
248
249 /**
250 * brcmf_btcoex_restore_part1() - restore first step parameters.
251 */
brcmf_btcoex_restore_part1(struct brcmf_btcoex_info * btci)252 static void brcmf_btcoex_restore_part1(struct brcmf_btcoex_info *btci)
253 {
254 struct brcmf_if *ifp;
255
256 if (btci->saved_regs_part1) {
257 btci->saved_regs_part1 = false;
258 ifp = btci->vif->ifp;
259 brcmf_btcoex_params_write(ifp, 66, btci->reg66);
260 brcmf_btcoex_params_write(ifp, 41, btci->reg41);
261 brcmf_btcoex_params_write(ifp, 68, btci->reg68);
262 brcmf_dbg(INFO,
263 "restored btc_params regs {66,41,68} 0x%x 0x%x 0x%x\n",
264 btci->reg66, btci->reg41,
265 btci->reg68);
266 }
267 }
268
269 /**
270 * brcmf_btcoex_timerfunc() - BT coex timer callback
271 */
brcmf_btcoex_timerfunc(struct timer_list * t)272 static void brcmf_btcoex_timerfunc(struct timer_list *t)
273 {
274 struct brcmf_btcoex_info *bt_local = from_timer(bt_local, t, timer);
275 brcmf_dbg(TRACE, "enter\n");
276
277 bt_local->timer_on = false;
278 schedule_work(&bt_local->work);
279 }
280
281 /**
282 * brcmf_btcoex_handler() - BT coex state machine work handler
283 * @work: work
284 */
brcmf_btcoex_handler(struct work_struct * work)285 static void brcmf_btcoex_handler(struct work_struct *work)
286 {
287 struct brcmf_btcoex_info *btci;
288 btci = container_of(work, struct brcmf_btcoex_info, work);
289 if (btci->timer_on) {
290 btci->timer_on = false;
291 del_timer_sync(&btci->timer);
292 }
293
294 switch (btci->bt_state) {
295 case BRCMF_BT_DHCP_START:
296 /* DHCP started provide OPPORTUNITY window
297 to get DHCP address
298 */
299 brcmf_dbg(INFO, "DHCP started\n");
300 btci->bt_state = BRCMF_BT_DHCP_OPPR_WIN;
301 if (btci->timeout < BRCMF_BTCOEX_OPPR_WIN_TIME) {
302 mod_timer(&btci->timer, btci->timer.expires);
303 } else {
304 btci->timeout -= BRCMF_BTCOEX_OPPR_WIN_TIME;
305 mod_timer(&btci->timer,
306 jiffies + BRCMF_BTCOEX_OPPR_WIN_TIME);
307 }
308 btci->timer_on = true;
309 break;
310
311 case BRCMF_BT_DHCP_OPPR_WIN:
312 if (btci->dhcp_done) {
313 brcmf_dbg(INFO, "DHCP done before T1 expiration\n");
314 goto idle;
315 }
316
317 /* DHCP is not over yet, start lowering BT priority */
318 brcmf_dbg(INFO, "DHCP T1:%d expired\n",
319 jiffies_to_msecs(BRCMF_BTCOEX_OPPR_WIN_TIME));
320 brcmf_btcoex_boost_wifi(btci, true);
321
322 btci->bt_state = BRCMF_BT_DHCP_FLAG_FORCE_TIMEOUT;
323 mod_timer(&btci->timer, jiffies + btci->timeout);
324 btci->timer_on = true;
325 break;
326
327 case BRCMF_BT_DHCP_FLAG_FORCE_TIMEOUT:
328 if (btci->dhcp_done)
329 brcmf_dbg(INFO, "DHCP done before T2 expiration\n");
330 else
331 brcmf_dbg(INFO, "DHCP T2:%d expired\n",
332 BRCMF_BT_DHCP_FLAG_FORCE_TIMEOUT);
333
334 goto idle;
335
336 default:
337 brcmf_err("invalid state=%d !!!\n", btci->bt_state);
338 goto idle;
339 }
340
341 return;
342
343 idle:
344 btci->bt_state = BRCMF_BT_DHCP_IDLE;
345 btci->timer_on = false;
346 brcmf_btcoex_boost_wifi(btci, false);
347 cfg80211_crit_proto_stopped(&btci->vif->wdev, GFP_KERNEL);
348 brcmf_btcoex_restore_part1(btci);
349 btci->vif = NULL;
350 }
351
352 /**
353 * brcmf_btcoex_attach() - initialize BT coex data
354 * @cfg: driver private cfg80211 data
355 *
356 * return: 0 on success
357 */
brcmf_btcoex_attach(struct brcmf_cfg80211_info * cfg)358 int brcmf_btcoex_attach(struct brcmf_cfg80211_info *cfg)
359 {
360 struct brcmf_btcoex_info *btci = NULL;
361 brcmf_dbg(TRACE, "enter\n");
362
363 btci = kmalloc(sizeof(struct brcmf_btcoex_info), GFP_KERNEL);
364 if (!btci)
365 return -ENOMEM;
366
367 btci->bt_state = BRCMF_BT_DHCP_IDLE;
368
369 /* Set up timer for BT */
370 btci->timer_on = false;
371 btci->timeout = BRCMF_BTCOEX_OPPR_WIN_TIME;
372 timer_setup(&btci->timer, brcmf_btcoex_timerfunc, 0);
373 btci->cfg = cfg;
374 btci->saved_regs_part1 = false;
375 btci->saved_regs_part2 = false;
376
377 INIT_WORK(&btci->work, brcmf_btcoex_handler);
378
379 cfg->btcoex = btci;
380 return 0;
381 }
382
383 /**
384 * brcmf_btcoex_detach - clean BT coex data
385 * @cfg: driver private cfg80211 data
386 */
brcmf_btcoex_detach(struct brcmf_cfg80211_info * cfg)387 void brcmf_btcoex_detach(struct brcmf_cfg80211_info *cfg)
388 {
389 brcmf_dbg(TRACE, "enter\n");
390
391 if (!cfg->btcoex)
392 return;
393
394 if (cfg->btcoex->timer_on) {
395 cfg->btcoex->timer_on = false;
396 del_timer_sync(&cfg->btcoex->timer);
397 }
398
399 cancel_work_sync(&cfg->btcoex->work);
400
401 brcmf_btcoex_boost_wifi(cfg->btcoex, false);
402 brcmf_btcoex_restore_part1(cfg->btcoex);
403
404 kfree(cfg->btcoex);
405 cfg->btcoex = NULL;
406 }
407
brcmf_btcoex_dhcp_start(struct brcmf_btcoex_info * btci)408 static void brcmf_btcoex_dhcp_start(struct brcmf_btcoex_info *btci)
409 {
410 struct brcmf_if *ifp = btci->vif->ifp;
411
412 btcmf_btcoex_save_part1(btci);
413 /* set new regs values */
414 brcmf_btcoex_params_write(ifp, 66, BRCMF_BT_DHCP_REG66);
415 brcmf_btcoex_params_write(ifp, 41, BRCMF_BT_DHCP_REG41);
416 brcmf_btcoex_params_write(ifp, 68, BRCMF_BT_DHCP_REG68);
417 btci->dhcp_done = false;
418 btci->bt_state = BRCMF_BT_DHCP_START;
419 schedule_work(&btci->work);
420 brcmf_dbg(TRACE, "enable BT DHCP Timer\n");
421 }
422
brcmf_btcoex_dhcp_end(struct brcmf_btcoex_info * btci)423 static void brcmf_btcoex_dhcp_end(struct brcmf_btcoex_info *btci)
424 {
425 /* Stop any bt timer because DHCP session is done */
426 btci->dhcp_done = true;
427 if (btci->timer_on) {
428 brcmf_dbg(INFO, "disable BT DHCP Timer\n");
429 btci->timer_on = false;
430 del_timer_sync(&btci->timer);
431
432 /* schedule worker if transition to IDLE is needed */
433 if (btci->bt_state != BRCMF_BT_DHCP_IDLE) {
434 brcmf_dbg(INFO, "bt_state:%d\n",
435 btci->bt_state);
436 schedule_work(&btci->work);
437 }
438 } else {
439 /* Restore original values */
440 brcmf_btcoex_restore_part1(btci);
441 }
442 }
443
444 /**
445 * brcmf_btcoex_set_mode - set BT coex mode
446 * @cfg: driver private cfg80211 data
447 * @mode: Wifi-Bluetooth coexistence mode
448 *
449 * return: 0 on success
450 */
brcmf_btcoex_set_mode(struct brcmf_cfg80211_vif * vif,enum brcmf_btcoex_mode mode,u16 duration)451 int brcmf_btcoex_set_mode(struct brcmf_cfg80211_vif *vif,
452 enum brcmf_btcoex_mode mode, u16 duration)
453 {
454 struct brcmf_cfg80211_info *cfg = wiphy_to_cfg(vif->wdev.wiphy);
455 struct brcmf_btcoex_info *btci = cfg->btcoex;
456 struct brcmf_if *ifp = brcmf_get_ifp(cfg->pub, 0);
457
458 switch (mode) {
459 case BRCMF_BTCOEX_DISABLED:
460 brcmf_dbg(INFO, "DHCP session starts\n");
461 if (btci->bt_state != BRCMF_BT_DHCP_IDLE)
462 return -EBUSY;
463 /* Start BT timer only for SCO connection */
464 if (brcmf_btcoex_is_sco_active(ifp)) {
465 btci->timeout = msecs_to_jiffies(duration);
466 btci->vif = vif;
467 brcmf_btcoex_dhcp_start(btci);
468 }
469 break;
470
471 case BRCMF_BTCOEX_ENABLED:
472 brcmf_dbg(INFO, "DHCP session ends\n");
473 if (btci->bt_state != BRCMF_BT_DHCP_IDLE &&
474 vif == btci->vif) {
475 brcmf_btcoex_dhcp_end(btci);
476 }
477 break;
478 default:
479 brcmf_dbg(INFO, "Unknown mode, ignored\n");
480 }
481 return 0;
482 }
483
