projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Staging: rtl8723au: Use snprintf instead rsprintf
[deliverable/linux.git] / drivers / staging / rtl8723au / hal / rtl8723a_bt-coexist.c
CommitLineData
f7c92d2c
LF		 1/******************************************************************************
2 *
3 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 *published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 ******************************************************************************/
15#include <drv_types.h>
16#include <rtl8723a_hal.h>
050abc45 17#include <usb_ops_linux.h>
f7c92d2c
LF		 18
19#define DIS_PS_RX_BCN
20
f7c92d2c
LF		 21u32 BTCoexDbgLevel = _bt_dbg_off_;
22
23#define RTPRINT(_Comp, _Level, Fmt)\
24do {\
25 if ((BTCoexDbgLevel == _bt_dbg_on_)) {\
26 printk Fmt;\
27 } \
28} while (0)
29
30#define RTPRINT_ADDR(dbgtype, dbgflag, printstr, _Ptr)\
31if ((BTCoexDbgLevel == _bt_dbg_on_)) {\
32 u32 __i; \
33 u8 *ptr = (u8 *)_Ptr; \
34 printk printstr; \
35 printk(" "); \
36 for (__i = 0; __i < 6; __i++) \
37 printk("%02X%s", ptr[__i], (__i == 5)?"":"-"); \
38 printk("\n"); \
39}
40#define RTPRINT_DATA(dbgtype, dbgflag, _TitleString, _HexData, _HexDataLen)\
41if ((BTCoexDbgLevel == _bt_dbg_on_)) {\
42 u32 __i; \
43 u8 *ptr = (u8 *)_HexData; \
44 printk(_TitleString); \
45 for (__i = 0; __i < (u32)_HexDataLen; __i++) { \
46 printk("%02X%s", ptr[__i], (((__i + 1) % 4) == 0)?" ":" ");\
47 if (((__i + 1) % 16) == 0) \
48 printk("\n"); \
49 } \
50 printk("\n"); \
51}
52/* Added by Annie, 2005-11-22. */
53#define MAX_STR_LEN 64
54/* I want to see ASCII 33 to 126 only. Otherwise, I print '?'. */
55#define PRINTABLE(_ch) (_ch >= ' ' && _ch <= '~')
56#define RT_PRINT_STR(_Comp, _Level, _TitleString, _Ptr, _Len) \
57 { \
58 u32 __i; \
59 u8 buffer[MAX_STR_LEN]; \
60 u32 length = (_Len < MAX_STR_LEN) ? _Len : (MAX_STR_LEN-1);\
61 memset(buffer, 0, MAX_STR_LEN); \
62 memcpy(buffer, (u8 *)_Ptr, length); \
63 for (__i = 0; __i < length; __i++) { \
64 if (!PRINTABLE(buffer[__i])) \
65 buffer[__i] = '?'; \
66 } \
67 buffer[length] = '\0'; \
68 printk(_TitleString); \
69 printk(": %d, <%s>\n", _Len, buffer); \
70 }
f7c92d2c
LF		 71
72#define DCMD_Printf(...)
73#define RT_ASSERT(...)
74
f7c92d2c
LF		 75
76#define GetDefaultAdapter(padapter) padapter
77
78#define PlatformZeroMemory(ptr, sz) memset(ptr, 0, sz)
79
80#define PlatformProcessHCICommands(...)
81#define PlatformTxBTQueuedPackets(...)
82#define PlatformIndicateBTACLData(...) (RT_STATUS_SUCCESS)
83#define PlatformAcquireSpinLock(padapter, type)
84#define PlatformReleaseSpinLock(padapter, type)
85
86#define GET_UNDECORATED_AVERAGE_RSSI(padapter) \
87 (GET_HAL_DATA(padapter)->dmpriv.EntryMinUndecoratedSmoothedPWDB)
88#define RT_RF_CHANGE_SOURCE u32
89
90enum {
91 RT_JOIN_INFRA = 1,
92 RT_JOIN_IBSS = 2,
93 RT_START_IBSS = 3,
94 RT_NO_ACTION = 4,
95};
96
97/* power saving */
98
f7c92d2c
LF		 99/* ===== Below this line is sync from SD7 driver COMMOM/BT.c ===== */
100
101static u8 BT_Operation(struct rtw_adapter *padapter)
102{
103 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
104 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
105
106 if (pBtMgnt->BtOperationOn)
107 return true;
108 else
109 return false;
110}
111
112static u8 BT_IsLegalChannel(struct rtw_adapter *padapter, u8 channel)
113{
114 struct rt_channel_info *pChanneList = NULL;
115 u8 channelLen, i;
116
117 pChanneList = padapter->mlmeextpriv.channel_set;
118 channelLen = padapter->mlmeextpriv.max_chan_nums;
119
120 for (i = 0; i < channelLen; i++) {
121 RTPRINT(FIOCTL, IOCTL_STATE,
122 ("Check if chnl(%d) in channel plan contains bt target chnl(%d) for BT connection\n",
123 pChanneList[i].ChannelNum, channel));
124 if ((channel == pChanneList[i].ChannelNum) ||
125 (channel == pChanneList[i].ChannelNum + 2))
126 return channel;
127 }
128 return 0;
129}
130
131void BT_SignalCompensation(struct rtw_adapter *padapter, u8 *rssi_wifi, u8 *rssi_bt)
132{
133 BTDM_SignalCompensation(padapter, rssi_wifi, rssi_bt);
134}
135
d952e4c4 136void rtl8723a_BT_wifiscan_notify(struct rtw_adapter *padapter, u8 scanType)
f7c92d2c
LF		 137{
138 BTHCI_WifiScanNotify(padapter, scanType);
139 BTDM_CheckAntSelMode(padapter);
140 BTDM_WifiScanNotify(padapter, scanType);
141}
142
c814d4d6 143void rtl8723a_BT_wifiassociate_notify(struct rtw_adapter *padapter, u8 action)
f7c92d2c
LF		 144{
145 /* action : */
146 /* true = associate start */
147 /* false = associate finished */
148 if (action)
149 BTDM_CheckAntSelMode(padapter);
150
151 BTDM_WifiAssociateNotify(padapter, action);
152}
153
f7c92d2c
LF		 154void BT_HaltProcess(struct rtw_adapter *padapter)
155{
156 BTDM_ForHalt(padapter);
157}
158
f7c92d2c 159/* ===== End of sync from SD7 driver COMMOM/BT.c ===== */
f7c92d2c
LF		 160
161#define i64fmt "ll"
162#define UINT64_C(v) (v)
163
164#define FillOctetString(_os, _octet, _len) \
165 (_os).Octet = (u8 *)(_octet); \
166 (_os).Length = (_len);
167
168static enum rt_status PlatformIndicateBTEvent(
169 struct rtw_adapter *padapter,
170 void *pEvntData,
171 u32 dataLen
172 )
173{
174 enum rt_status rt_status = RT_STATUS_FAILURE;
175
176 RTPRINT(FIOCTL, IOCTL_BT_EVENT_DETAIL, ("BT event start, %d bytes data to Transferred!!\n", dataLen));
177 RTPRINT_DATA(FIOCTL, IOCTL_BT_EVENT_DETAIL, "To transfer Hex Data :\n",
178 pEvntData, dataLen);
179
180 BT_EventParse(padapter, pEvntData, dataLen);
181
182 printk(KERN_WARNING "%s: Linux has no way to report BT event!!\n", __func__);
183
184 RTPRINT(FIOCTL, IOCTL_BT_EVENT_DETAIL, ("BT event end, %s\n",
185 (rt_status == RT_STATUS_SUCCESS) ? "SUCCESS" : "FAIL"));
186
187 return rt_status;
188}
189
190/* ===== Below this line is sync from SD7 driver COMMOM/bt_hci.c ===== */
191
192static u8 bthci_GetLocalChannel(struct rtw_adapter *padapter)
193{
194 return padapter->mlmeextpriv.cur_channel;
195}
196
197static u8 bthci_GetCurrentEntryNum(struct rtw_adapter *padapter, u8 PhyHandle)
198{
199 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
200 u8 i;
201
202 for (i = 0; i < MAX_BT_ASOC_ENTRY_NUM; i++) {
203 if ((pBTInfo->BtAsocEntry[i].bUsed) &&
204 (pBTInfo->BtAsocEntry[i].PhyLinkCmdData.BtPhyLinkhandle == PhyHandle))
205 return i;
206 }
207
208 return 0xFF;
209}
210
211static void bthci_DecideBTChannel(struct rtw_adapter *padapter, u8 EntryNum)
212{
213/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
214 struct mlme_priv *pmlmepriv;
215 struct bt_30info *pBTInfo;
216 struct bt_mgnt *pBtMgnt;
217 struct bt_hci_info *pBtHciInfo;
218 struct chnl_txpower_triple *pTriple_subband = NULL;
219 struct common_triple *pTriple;
220 u8 i, j, localchnl, firstRemoteLegalChnlInTriplet = 0;
221 u8 regulatory_skipLen = 0;
222 u8 subbandTripletCnt = 0;
223
224 pmlmepriv = &padapter->mlmepriv;
225 pBTInfo = GET_BT_INFO(padapter);
226 pBtMgnt = &pBTInfo->BtMgnt;
227 pBtHciInfo = &pBTInfo->BtHciInfo;
228
229 pBtMgnt->CheckChnlIsSuit = true;
230 localchnl = bthci_GetLocalChannel(padapter);
231
232 pTriple = (struct common_triple *)
233 &pBtHciInfo->BTPreChnllist[COUNTRY_STR_LEN];
234
235 /* contains country string, len is 3 */
236 for (i = 0; i < (pBtHciInfo->BtPreChnlListLen-COUNTRY_STR_LEN); i += 3, pTriple++) {
237 /* */
238 /* check every triplet, an triplet may be */
239 /* regulatory extension identifier or sub-band triplet */
240 /* */
241 if (pTriple->byte_1st == 0xc9) {
242 /* Regulatory Extension Identifier, skip it */
243 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO),
244 ("Find Regulatory ID, regulatory class = %d\n", pTriple->byte_2nd));
245 regulatory_skipLen += 3;
246 pTriple_subband = NULL;
247 continue;
248 } else { /* Sub-band triplet */
249 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Find Sub-band triplet \n"));
250 subbandTripletCnt++;
251 pTriple_subband = (struct chnl_txpower_triple *)pTriple;
252 /* if remote first legal channel not found, then find first remote channel */
253 /* and it's legal for our channel plan. */
254
255 /* search the sub-band triplet and find if remote channel is legal to our channel plan. */
256 for (j = pTriple_subband->FirstChnl; j < (pTriple_subband->FirstChnl+pTriple_subband->NumChnls); j++) {
257 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), (" Check if chnl(%d) is legal\n", j));
258 if (BT_IsLegalChannel(padapter, j)) {
259 /* remote channel is legal for our channel plan. */
260 firstRemoteLegalChnlInTriplet = j;
261 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO),
262 ("Find first remote legal channel : %d\n",
263 firstRemoteLegalChnlInTriplet));
264
265 /* If we find a remote legal channel in the sub-band triplet */
266 /* and only BT connection is established(local not connect to any AP or IBSS), */
267 /* then we just switch channel to remote channel. */
268 if (!(check_fwstate(pmlmepriv, WIFI_ASOC_STATE|WIFI_ADHOC_STATE|WIFI_AP_STATE) ||
269 BTHCI_HsConnectionEstablished(padapter))) {
270 pBtMgnt->BTChannel = firstRemoteLegalChnlInTriplet;
271 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Remote legal channel (%d) is selected, Local not connect to any!!\n", pBtMgnt->BTChannel));
272 return;
273 } else {
274 if ((localchnl >= firstRemoteLegalChnlInTriplet) &&
275 (localchnl < (pTriple_subband->FirstChnl+pTriple_subband->NumChnls))) {
276 pBtMgnt->BTChannel = localchnl;
277 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Local channel (%d) is selected, wifi or BT connection exists\n", pBtMgnt->BTChannel));
278 return;
279 }
280 }
281 break;
282 }
283 }
284 }
285 }
286
287 if (subbandTripletCnt) {
288 /* if any preferred channel triplet exists */
289 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("There are %d sub band triplet exists, ", subbandTripletCnt));
290 if (firstRemoteLegalChnlInTriplet == 0) {
291 /* no legal channel is found, reject the connection. */
292 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("no legal channel is found!!\n"));
293 } else {
294 /* Remote Legal channel is found but not match to local */
295 /* wifi connection exists), so reject the connection. */
296 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO),
297 ("Remote Legal channel is found but not match to local(wifi connection exists)!!\n"));
298 }
299 pBtMgnt->CheckChnlIsSuit = false;
300 } else {
301 /* There are not any preferred channel triplet exists */
302 /* Use current legal channel as the bt channel. */
303 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("No sub band triplet exists!!\n"));
304 }
305 pBtMgnt->BTChannel = localchnl;
306 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Local channel (%d) is selected!!\n", pBtMgnt->BTChannel));
307}
308
309/* Success:return true */
310/* Fail:return false */
311static u8 bthci_GetAssocInfo(struct rtw_adapter *padapter, u8 EntryNum)
312{
313 struct bt_30info *pBTInfo;
314 struct bt_hci_info *pBtHciInfo;
315 u8 tempBuf[256];
316 u8 i = 0;
317 u8 BaseMemoryShift = 0;
318 u16 TotalLen = 0;
319 struct amp_assoc_structure *pAmpAsoc;
320
321 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("GetAssocInfo start\n"));
322 pBTInfo = GET_BT_INFO(padapter);
323 pBtHciInfo = &pBTInfo->BtHciInfo;
324
325 if (pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar == 0) {
326 if (pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocRemLen < (MAX_AMP_ASSOC_FRAG_LEN))
327 TotalLen = pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocRemLen;
328 else if (pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocRemLen == (MAX_AMP_ASSOC_FRAG_LEN))
329 TotalLen = MAX_AMP_ASSOC_FRAG_LEN;
330 } else if (pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar > 0)
331 TotalLen = pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar;
332
333 while ((pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar >= BaseMemoryShift) || TotalLen > BaseMemoryShift) {
334 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_DETAIL, ("GetAssocInfo, TotalLen =%d, BaseMemoryShift =%d\n", TotalLen, BaseMemoryShift));
335 memcpy(tempBuf,
336 (u8 *)pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocfragment+BaseMemoryShift,
337 TotalLen-BaseMemoryShift);
338 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_DETAIL, "GetAssocInfo :\n",
339 tempBuf, TotalLen-BaseMemoryShift);
340
341 pAmpAsoc = (struct amp_assoc_structure *)tempBuf;
8488d6ec 342 le16_to_cpus(&pAmpAsoc->Length);
f7c92d2c
LF		 343 BaseMemoryShift += 3 + pAmpAsoc->Length;
344
345 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("TypeID = 0x%x, ", pAmpAsoc->TypeID));
346 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD, "Hex Data: \n", pAmpAsoc->Data, pAmpAsoc->Length);
347 switch (pAmpAsoc->TypeID) {
348 case AMP_MAC_ADDR:
349 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("==> AMP_MAC_ADDR\n"));
350 if (pAmpAsoc->Length > 6)
351 return false;
352 memcpy(pBTInfo->BtAsocEntry[EntryNum].BTRemoteMACAddr, pAmpAsoc->Data, 6);
353 RTPRINT_ADDR(FIOCTL, IOCTL_BT_HCICMD, ("Remote Mac address \n"), pBTInfo->BtAsocEntry[EntryNum].BTRemoteMACAddr);
354 break;
355 case AMP_PREFERRED_CHANNEL_LIST:
356 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("==> AMP_PREFERRED_CHANNEL_LIST\n"));
357 pBtHciInfo->BtPreChnlListLen = pAmpAsoc->Length;
358 memcpy(pBtHciInfo->BTPreChnllist,
359 pAmpAsoc->Data,
360 pBtHciInfo->BtPreChnlListLen);
361 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD, "Preferred channel list : \n", pBtHciInfo->BTPreChnllist, pBtHciInfo->BtPreChnlListLen);
362 bthci_DecideBTChannel(padapter, EntryNum);
363 break;
364 case AMP_CONNECTED_CHANNEL:
365 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("==> AMP_CONNECTED_CHANNEL\n"));
366 pBtHciInfo->BTConnectChnlListLen = pAmpAsoc->Length;
367 memcpy(pBtHciInfo->BTConnectChnllist,
368 pAmpAsoc->Data,
369 pBtHciInfo->BTConnectChnlListLen);
370 break;
371 case AMP_80211_PAL_CAP_LIST:
372 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("==> AMP_80211_PAL_CAP_LIST\n"));
373 pBTInfo->BtAsocEntry[EntryNum].BTCapability = *(u32 *)(pAmpAsoc->Data);
374 if (pBTInfo->BtAsocEntry[EntryNum].BTCapability & 0x00000001) {
375 /* TODO: */
376
377 /* Signifies PAL capable of utilizing received activity reports. */
378 }
379 if (pBTInfo->BtAsocEntry[EntryNum].BTCapability & 0x00000002) {
380 /* TODO: */
381 /* Signifies PAL is capable of utilizing scheduling information received in an activity reports. */
382 }
383 break;
384 case AMP_80211_PAL_VISION:
385 pBtHciInfo->BTPalVersion = *(u8 *)(pAmpAsoc->Data);
386 pBtHciInfo->BTPalCompanyID = *(u16 *)(((u8 *)(pAmpAsoc->Data))+1);
387 pBtHciInfo->BTPalsubversion = *(u16 *)(((u8 *)(pAmpAsoc->Data))+3);
388 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("==> AMP_80211_PAL_VISION PalVersion 0x%x, PalCompanyID 0x%x, Palsubversion 0x%x\n",
389 pBtHciInfo->BTPalVersion,
390 pBtHciInfo->BTPalCompanyID,
391 pBtHciInfo->BTPalsubversion));
392 break;
393 default:
394 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("==> Unsupport TypeID !!\n"));
395 break;
396 }
397 i++;
398 }
399 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("GetAssocInfo end\n"));
400
401 return true;
402}
403
404static u8 bthci_AddEntry(struct rtw_adapter *padapter)
405{
406 struct bt_30info *pBTInfo;
407 struct bt_mgnt *pBtMgnt;
408 u8 i;
409
410 pBTInfo = GET_BT_INFO(padapter);
411 pBtMgnt = &pBTInfo->BtMgnt;
412
413 for (i = 0; i < MAX_BT_ASOC_ENTRY_NUM; i++) {
414 if (pBTInfo->BtAsocEntry[i].bUsed == false) {
415 pBTInfo->BtAsocEntry[i].bUsed = true;
416 pBtMgnt->CurrentConnectEntryNum = i;
417 break;
418 }
419 }
420
421 if (i == MAX_BT_ASOC_ENTRY_NUM) {
422 RTPRINT(FIOCTL, IOCTL_STATE, ("bthci_AddEntry(), Add entry fail!!\n"));
423 return false;
424 }
425 return true;
426}
427
428static u8 bthci_DiscardTxPackets(struct rtw_adapter *padapter, u16 LLH)
429{
430 return false;
431}
432
433static u8
434bthci_CheckLogLinkBehavior(
435 struct rtw_adapter *padapter,
436 struct hci_flow_spec TxFlowSpec
437 )
438{
439 u8 ID = TxFlowSpec.Identifier;
440 u8 ServiceType = TxFlowSpec.ServiceType;
441 u16 MaxSDUSize = TxFlowSpec.MaximumSDUSize;
442 u32 SDUInterArrivatime = TxFlowSpec.SDUInterArrivalTime;
443 u8 match = false;
444
445 switch (ID) {
446 case 1:
447 if (ServiceType == BT_LL_BE) {
448 match = true;
449 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = TX best effort flowspec\n"));
450 } else if ((ServiceType == BT_LL_GU) && (MaxSDUSize == 0xffff)) {
451 match = true;
452 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = RX guaranteed latency flowspec\n"));
453 } else if ((ServiceType == BT_LL_GU) && (MaxSDUSize == 2500)) {
454 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = RX guaranteed Large latency flowspec\n"));
455 }
456 break;
457 case 2:
458 if (ServiceType == BT_LL_BE) {
459 match = true;
460 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = RX best effort flowspec\n"));
461
462 }
463 break;
464 case 3:
465 if ((ServiceType == BT_LL_GU) && (MaxSDUSize == 1492)) {
466 match = true;
467 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = TX guaranteed latency flowspec\n"));
468 } else if ((ServiceType == BT_LL_GU) && (MaxSDUSize == 2500)) {
469 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = TX guaranteed Large latency flowspec\n"));
470 }
471 break;
472 case 4:
473 if (ServiceType == BT_LL_BE) {
474 if ((SDUInterArrivatime == 0xffffffff) && (ServiceType == BT_LL_BE) && (MaxSDUSize == 1492)) {
475 match = true;
476 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = TX/RX aggregated best effort flowspec\n"));
477 }
478 } else if (ServiceType == BT_LL_GU) {
479 if (SDUInterArrivatime == 100) {
480 match = true;
481 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = TX/RX guaranteed bandwidth flowspec\n"));
482 }
483 }
484 break;
485 default:
486 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Logical Link Type = Unknow Type !!!!!!!!\n"));
487 break;
488 }
489
490 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO),
491 ("ID = 0x%x, ServiceType = 0x%x, MaximumSDUSize = 0x%x, SDUInterArrivalTime = 0x%x, AccessLatency = 0x%x, FlushTimeout = 0x%x\n",
492 TxFlowSpec.Identifier, TxFlowSpec.ServiceType, MaxSDUSize,
493 SDUInterArrivatime, TxFlowSpec.AccessLatency, TxFlowSpec.FlushTimeout));
494 return match;
495}
496
497static u16 bthci_AssocMACAddr(struct rtw_adapter *padapter, void *pbuf)
498{
499 struct amp_assoc_structure *pAssoStrc = (struct amp_assoc_structure *)pbuf;
500 pAssoStrc->TypeID = AMP_MAC_ADDR;
501 pAssoStrc->Length = 0x06;
502 memcpy(&pAssoStrc->Data[0], padapter->eeprompriv.mac_addr, 6);
503 RTPRINT_DATA(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO),
504 ("AssocMACAddr : \n"), pAssoStrc, pAssoStrc->Length+3);
505
506 return pAssoStrc->Length + 3;
507}
508
509static u16
510bthci_PALCapabilities(
511 struct rtw_adapter *padapter,
512 void *pbuf
513 )
514{
515 struct amp_assoc_structure *pAssoStrc = (struct amp_assoc_structure *)pbuf;
516
517 pAssoStrc->TypeID = AMP_80211_PAL_CAP_LIST;
518 pAssoStrc->Length = 0x04;
519
520 pAssoStrc->Data[0] = 0x00;
521 pAssoStrc->Data[1] = 0x00;
522
523 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_DETAIL, ("PALCapabilities:\n"), pAssoStrc, pAssoStrc->Length+3);
524 RTPRINT(FIOCTL, IOCTL_BT_LOGO, ("PALCapabilities \n"));
525
526 RTPRINT(FIOCTL, IOCTL_BT_LOGO, (" TypeID = 0x%x,\n Length = 0x%x,\n Content = 0x0000\n",
527 pAssoStrc->TypeID,
528 pAssoStrc->Length));
529
530 return pAssoStrc->Length + 3;
531}
532
533static u16 bthci_AssocPreferredChannelList(struct rtw_adapter *padapter,
534 void *pbuf, u8 EntryNum)
535{
536 struct bt_30info *pBTInfo;
537 struct amp_assoc_structure *pAssoStrc;
538 struct amp_pref_chnl_regulatory *pReg;
539 struct chnl_txpower_triple *pTriple;
540 char ctrString[3] = {'X', 'X', 'X'};
541 u32 len = 0;
542 u8 preferredChnl;
543
544 pBTInfo = GET_BT_INFO(padapter);
545 pAssoStrc = (struct amp_assoc_structure *)pbuf;
546 pReg = (struct amp_pref_chnl_regulatory *)&pAssoStrc->Data[3];
547
548 preferredChnl = bthci_GetLocalChannel(padapter);
549 pAssoStrc->TypeID = AMP_PREFERRED_CHANNEL_LIST;
550
551 /* locale unknown */
552 memcpy(&pAssoStrc->Data[0], &ctrString[0], 3);
553 pReg->reXId = 201;
554 pReg->regulatoryClass = 254;
555 pReg->coverageClass = 0;
556 len += 6;
557 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD | IOCTL_BT_LOGO), ("PREFERRED_CHNL_LIST\n"));
558 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD | IOCTL_BT_LOGO), ("XXX, 201, 254, 0\n"));
559 /* at the following, chnl 1~11 should be contained */
560 pTriple = (struct chnl_txpower_triple *)&pAssoStrc->Data[len];
561
562 /* (1) if any wifi or bt HS connection exists */
563 if ((pBTInfo->BtAsocEntry[EntryNum].AMPRole == AMP_BTAP_CREATOR) ||
564 (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE |
565 WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE |
566 WIFI_AP_STATE)) ||
567 BTHCI_HsConnectionEstablished(padapter)) {
568 pTriple->FirstChnl = preferredChnl;
569 pTriple->NumChnls = 1;
570 pTriple->MaxTxPowerInDbm = 20;
571 len += 3;
572 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD | IOCTL_BT_LOGO), ("First Channel = %d, Channel Num = %d, MaxDbm = %d\n",
573 pTriple->FirstChnl,
574 pTriple->NumChnls,
575 pTriple->MaxTxPowerInDbm));
576 }
577
578 pAssoStrc->Length = (u16)len;
579 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD, ("AssocPreferredChannelList : \n"), pAssoStrc, pAssoStrc->Length+3);
580
581 return pAssoStrc->Length + 3;
582}
583
584static u16 bthci_AssocPALVer(struct rtw_adapter *padapter, void *pbuf)
585{
586 struct amp_assoc_structure *pAssoStrc = (struct amp_assoc_structure *)pbuf;
587 u8 *pu1Tmp;
588 u16 *pu2Tmp;
589
590 pAssoStrc->TypeID = AMP_80211_PAL_VISION;
591 pAssoStrc->Length = 0x5;
592 pu1Tmp = &pAssoStrc->Data[0];
593 *pu1Tmp = 0x1; /* PAL Version */
594 pu2Tmp = (u16 *)&pAssoStrc->Data[1];
595 *pu2Tmp = 0x5D; /* SIG Company identifier of 802.11 PAL vendor */
596 pu2Tmp = (u16 *)&pAssoStrc->Data[3];
597 *pu2Tmp = 0x1; /* PAL Sub-version specifier */
598
599 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_DETAIL, ("AssocPALVer : \n"), pAssoStrc, pAssoStrc->Length+3);
600 RTPRINT(FIOCTL, IOCTL_BT_LOGO, ("AssocPALVer \n"));
601
602 RTPRINT(FIOCTL, IOCTL_BT_LOGO, (" TypeID = 0x%x,\n Length = 0x%x,\n PAL Version = 0x01,\n PAL vendor = 0x01,\n PAL Sub-version specifier = 0x01\n",
603 pAssoStrc->TypeID,
604 pAssoStrc->Length));
605 return pAssoStrc->Length + 3;
606}
607
608static u8 bthci_CheckRfStateBeforeConnect(struct rtw_adapter *padapter)
609{
610 struct bt_30info *pBTInfo;
611 enum rt_rf_power_state RfState;
612
613 pBTInfo = GET_BT_INFO(padapter);
614
615 RfState = padapter->pwrctrlpriv.rf_pwrstate;
616
617 if (RfState != rf_on) {
618 mod_timer(&pBTInfo->BTPsDisableTimer,
619 jiffies + msecs_to_jiffies(50));
620 return false;
621 }
622 return true;
623}
624
625static void bthci_ResponderStartToScan(struct rtw_adapter *padapter)
626{
627}
628
629static u8 bthci_PhyLinkConnectionInProgress(struct rtw_adapter *padapter, u8 PhyLinkHandle)
630{
631 struct bt_30info *pBTInfo;
632 struct bt_mgnt *pBtMgnt;
633
634 pBTInfo = GET_BT_INFO(padapter);
635 pBtMgnt = &pBTInfo->BtMgnt;
636
637 if (pBtMgnt->bPhyLinkInProgress &&
638 (pBtMgnt->BtCurrentPhyLinkhandle == PhyLinkHandle))
639 return true;
640 return false;
641}
642
643static void bthci_ResetFlowSpec(struct rtw_adapter *padapter, u8 EntryNum, u8 index)
644{
645 struct bt_30info *pBTinfo;
646
647 pBTinfo = GET_BT_INFO(padapter);
648
649 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].BtLogLinkhandle = 0;
650 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].BtPhyLinkhandle = 0;
651 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].bLLCompleteEventIsSet = false;
652 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].bLLCancelCMDIsSetandComplete = false;
653 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].BtTxFlowSpecID = 0;
654 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].TxPacketCount = 0;
655
656 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Tx_Flow_Spec.Identifier = 0x01;
657 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Tx_Flow_Spec.ServiceType = SERVICE_BEST_EFFORT;
658 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Tx_Flow_Spec.MaximumSDUSize = 0xffff;
659 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Tx_Flow_Spec.SDUInterArrivalTime = 0xffffffff;
660 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Tx_Flow_Spec.AccessLatency = 0xffffffff;
661 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Tx_Flow_Spec.FlushTimeout = 0xffffffff;
662
663 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Rx_Flow_Spec.Identifier = 0x01;
664 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Rx_Flow_Spec.ServiceType = SERVICE_BEST_EFFORT;
665 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Rx_Flow_Spec.MaximumSDUSize = 0xffff;
666 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Rx_Flow_Spec.SDUInterArrivalTime = 0xffffffff;
667 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Rx_Flow_Spec.AccessLatency = 0xffffffff;
668 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[index].Rx_Flow_Spec.FlushTimeout = 0xffffffff;
669}
670
671static void bthci_ResetEntry(struct rtw_adapter *padapter, u8 EntryNum)
672{
673 struct bt_30info *pBTinfo;
674 struct bt_mgnt *pBtMgnt;
675 u8 j;
676
677 pBTinfo = GET_BT_INFO(padapter);
678 pBtMgnt = &pBTinfo->BtMgnt;
679
680 pBTinfo->BtAsocEntry[EntryNum].bUsed = false;
681 pBTinfo->BtAsocEntry[EntryNum].BtCurrentState = HCI_STATE_DISCONNECTED;
682 pBTinfo->BtAsocEntry[EntryNum].BtNextState = HCI_STATE_DISCONNECTED;
683
684 pBTinfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocRemLen = 0;
685 pBTinfo->BtAsocEntry[EntryNum].AmpAsocCmdData.BtPhyLinkhandle = 0;
686 if (pBTinfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocfragment != NULL)
687 memset(pBTinfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocfragment, 0, TOTAL_ALLOCIATE_ASSOC_LEN);
688 pBTinfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar = 0;
689
690 pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyType = 0;
691 pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle = 0;
692 memset(pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKey, 0,
693 pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyLen);
694 pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyLen = 0;
695
696 /* 0x640; 0.625ms*1600 = 1000ms, 0.625ms*16000 = 10000ms */
697 pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.LinkSuperversionTimeout = 0x3e80;
698
699 pBTinfo->BtAsocEntry[EntryNum].AMPRole = AMP_BTAP_NONE;
700
701 pBTinfo->BtAsocEntry[EntryNum].mAssoc = false;
702 pBTinfo->BtAsocEntry[EntryNum].b4waySuccess = false;
703
704 /* Reset BT WPA */
705 pBTinfo->BtAsocEntry[EntryNum].KeyReplayCounter = 0;
706 pBTinfo->BtAsocEntry[EntryNum].BTWPAAuthState = STATE_WPA_AUTH_UNINITIALIZED;
707
708 pBTinfo->BtAsocEntry[EntryNum].bSendSupervisionPacket = false;
709 pBTinfo->BtAsocEntry[EntryNum].NoRxPktCnt = 0;
710 pBTinfo->BtAsocEntry[EntryNum].ShortRangeMode = 0;
711 pBTinfo->BtAsocEntry[EntryNum].rxSuvpPktCnt = 0;
712
713 for (j = 0; j < MAX_LOGICAL_LINK_NUM; j++)
714 bthci_ResetFlowSpec(padapter, EntryNum, j);
715
716 pBtMgnt->BTAuthCount = 0;
717 pBtMgnt->BTAsocCount = 0;
718 pBtMgnt->BTCurrentConnectType = BT_DISCONNECT;
719 pBtMgnt->BTReceiveConnectPkt = BT_DISCONNECT;
720
721 HALBT_RemoveKey(padapter, EntryNum);
722}
723
724static void bthci_RemoveEntryByEntryNum(struct rtw_adapter *padapter, u8 EntryNum)
725{
726 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
727 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
728
729 bthci_ResetEntry(padapter, EntryNum);
730
731 if (pBtMgnt->CurrentBTConnectionCnt > 0)
732 pBtMgnt->CurrentBTConnectionCnt--;
733
734 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], CurrentBTConnectionCnt = %d!!\n",
735 pBtMgnt->CurrentBTConnectionCnt));
736
737 if (pBtMgnt->CurrentBTConnectionCnt > 0) {
738 pBtMgnt->BtOperationOn = true;
739 } else {
740 pBtMgnt->BtOperationOn = false;
741 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], Bt Operation OFF!!\n"));
742 }
743
744 if (!pBtMgnt->BtOperationOn) {
745 del_timer_sync(&pBTInfo->BTHCIDiscardAclDataTimer);
746 del_timer_sync(&pBTInfo->BTBeaconTimer);
747 pBtMgnt->bStartSendSupervisionPkt = false;
748 }
749}
750
751static u8
752bthci_CommandCompleteHeader(
753 u8 *pbuf,
754 u16 OGF,
755 u16 OCF,
756 enum hci_status status
757 )
758{
759 struct packet_irp_hcievent_data *PPacketIrpEvent = (struct packet_irp_hcievent_data *)pbuf;
760 u8 NumHCI_Comm = 0x1;
761
762 PPacketIrpEvent->EventCode = HCI_EVENT_COMMAND_COMPLETE;
763 PPacketIrpEvent->Data[0] = NumHCI_Comm; /* packet # */
764 PPacketIrpEvent->Data[1] = HCIOPCODELOW(OCF, OGF);
765 PPacketIrpEvent->Data[2] = HCIOPCODEHIGHT(OCF, OGF);
766
767 if (OGF == OGF_EXTENSION) {
768 if (OCF == HCI_SET_RSSI_VALUE) {
769 RTPRINT(FIOCTL, (IOCTL_BT_EVENT_PERIODICAL),
770 ("[BT event], CommandComplete, Num_HCI_Comm = 0x%x, Opcode = 0x%02x%02x, status = 0x%x, OGF = 0x%x, OCF = 0x%x\n",
771 NumHCI_Comm, (HCIOPCODEHIGHT(OCF, OGF)), (HCIOPCODELOW(OCF, OGF)), status, OGF, OCF));
772 } else {
773 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_EXT),
774 ("[BT event], CommandComplete, Num_HCI_Comm = 0x%x, Opcode = 0x%02x%02x, status = 0x%x, OGF = 0x%x, OCF = 0x%x\n",
775 NumHCI_Comm, (HCIOPCODEHIGHT(OCF, OGF)), (HCIOPCODELOW(OCF, OGF)), status, OGF, OCF));
776 }
777 } else {
778 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO),
779 ("[BT event], CommandComplete, Num_HCI_Comm = 0x%x, Opcode = 0x%02x%02x, status = 0x%x, OGF = 0x%x, OCF = 0x%x\n",
780 NumHCI_Comm, (HCIOPCODEHIGHT(OCF, OGF)), (HCIOPCODELOW(OCF, OGF)), status, OGF, OCF));
781 }
782 return 3;
783}
784
785static u8 bthci_ExtensionEventHeaderRtk(u8 *pbuf, u8 extensionEvent)
786{
787 struct packet_irp_hcievent_data *PPacketIrpEvent = (struct packet_irp_hcievent_data *)pbuf;
788 PPacketIrpEvent->EventCode = HCI_EVENT_EXTENSION_RTK;
789 PPacketIrpEvent->Data[0] = extensionEvent; /* extension event code */
790
791 return 1;
792}
793
794static enum rt_status
795bthci_IndicateEvent(
796 struct rtw_adapter *padapter,
797 void *pEvntData,
798 u32 dataLen
799 )
800{
801 enum rt_status rt_status;
802
803 rt_status = PlatformIndicateBTEvent(padapter, pEvntData, dataLen);
804
805 return rt_status;
806}
807
808static void
809bthci_EventWriteRemoteAmpAssoc(
810 struct rtw_adapter *padapter,
811 enum hci_status status,
812 u8 PLHandle
813 )
814{
815 u8 localBuf[TmpLocalBufSize] = "";
816 u8 *pRetPar;
817 u8 len = 0;
818 struct packet_irp_hcievent_data *PPacketIrpEvent;
819
820 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
821 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
822
823 len += bthci_CommandCompleteHeader(&localBuf[0],
824 OGF_STATUS_PARAMETERS,
825 HCI_WRITE_REMOTE_AMP_ASSOC,
826 status);
827 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("PhyLinkHandle = 0x%x, status = %d\n", PLHandle, status));
828 /* Return parameters starts from here */
829 pRetPar = &PPacketIrpEvent->Data[len];
830 pRetPar[0] = status; /* status */
831 pRetPar[1] = PLHandle;
832 len += 2;
833 PPacketIrpEvent->Length = len;
834
835 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
836}
837
838static void
839bthci_EventEnhancedFlushComplete(
840 struct rtw_adapter *padapter,
841 u16 LLH
842 )
843{
844 u8 localBuf[4] = "";
845 struct packet_irp_hcievent_data *PPacketIrpEvent;
846
847 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("EventEnhancedFlushComplete, LLH = 0x%x\n", LLH));
848
849 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
850 PPacketIrpEvent->EventCode = HCI_EVENT_ENHANCED_FLUSH_COMPLETE;
851 PPacketIrpEvent->Length = 2;
852 /* Logical link handle */
853 PPacketIrpEvent->Data[0] = TWOBYTE_LOWBYTE(LLH);
854 PPacketIrpEvent->Data[1] = TWOBYTE_HIGHTBYTE(LLH);
855
856 bthci_IndicateEvent(padapter, PPacketIrpEvent, 4);
857}
858
859static void
860bthci_EventShortRangeModeChangeComplete(
861 struct rtw_adapter *padapter,
862 enum hci_status HciStatus,
863 u8 ShortRangeState,
864 u8 EntryNum
865 )
866{
867 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
868 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
869 u8 localBuf[5] = "";
870 struct packet_irp_hcievent_data *PPacketIrpEvent;
871
872 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_SHORT_RANGE_MODE_CHANGE_COMPLETE)) {
873 RTPRINT(FIOCTL, IOCTL_BT_EVENT,
874 ("[BT event], Short Range Mode Change Complete, Ignore to send this event due to event mask page 2\n"));
875 return;
876 }
877 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("[BT event], Short Range Mode Change Complete, Status = %d\n , PLH = 0x%x\n, Short_Range_Mode_State = 0x%x\n",
878 HciStatus, pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle, ShortRangeState));
879
880 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
881 PPacketIrpEvent->EventCode = HCI_EVENT_SHORT_RANGE_MODE_CHANGE_COMPLETE;
882 PPacketIrpEvent->Length = 3;
883 PPacketIrpEvent->Data[0] = HciStatus;
884 PPacketIrpEvent->Data[1] = pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle;
885 PPacketIrpEvent->Data[2] = ShortRangeState;
886 bthci_IndicateEvent(padapter, PPacketIrpEvent, 5);
887}
888
889static void bthci_EventSendFlowSpecModifyComplete(struct rtw_adapter *padapter,
890 enum hci_status HciStatus,
891 u16 logicHandle)
892{
893 u8 localBuf[5] = "";
894 struct packet_irp_hcievent_data *PPacketIrpEvent;
895 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
896 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
897
898 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_FLOW_SPEC_MODIFY_COMPLETE)) {
899 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO),
900 ("[BT event], Flow Spec Modify Complete, Ignore to send this event due to event mask page 2\n"));
901 return;
902 }
903 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO),
904 ("[BT event], Flow Spec Modify Complete, status = 0x%x, LLH = 0x%x\n", HciStatus, logicHandle));
905 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
906 PPacketIrpEvent->EventCode = HCI_EVENT_FLOW_SPEC_MODIFY_COMPLETE;
907 PPacketIrpEvent->Length = 3;
908
909 PPacketIrpEvent->Data[0] = HciStatus;
910 /* Logical link handle */
911 PPacketIrpEvent->Data[1] = TWOBYTE_LOWBYTE(logicHandle);
912 PPacketIrpEvent->Data[2] = TWOBYTE_HIGHTBYTE(logicHandle);
913
914 bthci_IndicateEvent(padapter, PPacketIrpEvent, 5);
915}
916
917static void
918bthci_EventExtWifiScanNotify(
919 struct rtw_adapter *padapter,
920 u8 scanType
921 )
922{
923 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
924 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
925 u8 len = 0;
926 u8 localBuf[7] = "";
927 u8 *pRetPar;
928 u8 *pu1Temp;
929 struct packet_irp_hcievent_data *PPacketIrpEvent;
930
931 if (!pBtMgnt->BtOperationOn)
932 return;
933
934 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
935
936 len += bthci_ExtensionEventHeaderRtk(&localBuf[0], HCI_EVENT_EXT_WIFI_SCAN_NOTIFY);
937
938 /* Return parameters starts from here */
939 pRetPar = &PPacketIrpEvent->Data[len];
940 pu1Temp = (u8 *)&pRetPar[0];
941 *pu1Temp = scanType;
942 len += 1;
943
944 PPacketIrpEvent->Length = len;
945
946 if (bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2) == RT_STATUS_SUCCESS) {
947 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("[BT event], Wifi scan notify, scan type = %d\n",
948 scanType));
949 }
950}
951
952static void
953bthci_EventAMPReceiverReport(
954 struct rtw_adapter *padapter,
955 u8 Reason
956 )
957{
958 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
959 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
960
961 if (pBtHciInfo->bTestNeedReport) {
962 u8 localBuf[20] = "";
963 u32 *pu4Temp;
964 u16 *pu2Temp;
965 struct packet_irp_hcievent_data *PPacketIrpEvent;
966
967 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), (" HCI_EVENT_AMP_RECEIVER_REPORT\n"));
968 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
969 PPacketIrpEvent->EventCode = HCI_EVENT_AMP_RECEIVER_REPORT;
970 PPacketIrpEvent->Length = 2;
971
972 PPacketIrpEvent->Data[0] = pBtHciInfo->TestCtrType;
973
974 PPacketIrpEvent->Data[1] = Reason;
975
976 pu4Temp = (u32 *)&PPacketIrpEvent->Data[2];
977 *pu4Temp = pBtHciInfo->TestEventType;
978
979 pu2Temp = (u16 *)&PPacketIrpEvent->Data[6];
980 *pu2Temp = pBtHciInfo->TestNumOfFrame;
981
982 pu2Temp = (u16 *)&PPacketIrpEvent->Data[8];
983 *pu2Temp = pBtHciInfo->TestNumOfErrFrame;
984
985 pu4Temp = (u32 *)&PPacketIrpEvent->Data[10];
986 *pu4Temp = pBtHciInfo->TestNumOfBits;
987
988 pu4Temp = (u32 *)&PPacketIrpEvent->Data[14];
989 *pu4Temp = pBtHciInfo->TestNumOfErrBits;
990
991 bthci_IndicateEvent(padapter, PPacketIrpEvent, 20);
992
993 /* Return to Idel state with RX and TX off. */
994
995 }
996
997 pBtHciInfo->TestNumOfFrame = 0x00;
998}
999
1000static void
1001bthci_EventChannelSelected(
1002 struct rtw_adapter *padapter,
1003 u8 EntryNum
1004 )
1005{
1006 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1007 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1008 u8 localBuf[3] = "";
1009 struct packet_irp_hcievent_data *PPacketIrpEvent;
1010
1011 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_CHANNEL_SELECT)) {
1012 RTPRINT(FIOCTL, IOCTL_BT_EVENT,
1013 ("[BT event], Channel Selected, Ignore to send this event due to event mask page 2\n"));
1014 return;
1015 }
1016
1017 RTPRINT(FIOCTL, IOCTL_BT_EVENT|IOCTL_STATE,
1018 ("[BT event], Channel Selected, PhyLinkHandle %d\n",
1019 pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle));
1020
1021 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1022 PPacketIrpEvent->EventCode = HCI_EVENT_CHANNEL_SELECT;
1023 PPacketIrpEvent->Length = 1;
1024 PPacketIrpEvent->Data[0] = pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle;
1025 bthci_IndicateEvent(padapter, PPacketIrpEvent, 3);
1026}
1027
1028static void
1029bthci_EventDisconnectPhyLinkComplete(
1030 struct rtw_adapter *padapter,
1031 enum hci_status HciStatus,
1032 enum hci_status Reason,
1033 u8 EntryNum
1034 )
1035{
1036 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1037 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1038 u8 localBuf[5] = "";
1039 struct packet_irp_hcievent_data *PPacketIrpEvent;
1040
1041 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_DISCONNECT_PHY_LINK_COMPLETE)) {
1042 RTPRINT(FIOCTL, IOCTL_BT_EVENT,
1043 ("[BT event], Disconnect Physical Link Complete, Ignore to send this event due to event mask page 2\n"));
1044 return;
1045 }
1046 RTPRINT(FIOCTL, IOCTL_BT_EVENT,
1047 ("[BT event], Disconnect Physical Link Complete, Status = 0x%x, PLH = 0x%x Reason = 0x%x\n",
1048 HciStatus, pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle, Reason));
1049 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1050 PPacketIrpEvent->EventCode = HCI_EVENT_DISCONNECT_PHY_LINK_COMPLETE;
1051 PPacketIrpEvent->Length = 3;
1052 PPacketIrpEvent->Data[0] = HciStatus;
1053 PPacketIrpEvent->Data[1] = pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle;
1054 PPacketIrpEvent->Data[2] = Reason;
1055 bthci_IndicateEvent(padapter, PPacketIrpEvent, 5);
1056}
1057
1058static void
1059bthci_EventPhysicalLinkComplete(
1060 struct rtw_adapter *padapter,
1061 enum hci_status HciStatus,
1062 u8 EntryNum,
1063 u8 PLHandle
1064 )
1065{
1066 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1067 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
1068 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1069 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
1070 u8 localBuf[4] = "";
1071 struct packet_irp_hcievent_data *PPacketIrpEvent;
1072 u8 PL_handle;
1073
1074 pBtMgnt->bPhyLinkInProgress = false;
1075 pBtDbg->dbgHciInfo.hciCmdPhyLinkStatus = HciStatus;
1076 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_PHY_LINK_COMPLETE)) {
1077 RTPRINT(FIOCTL, IOCTL_BT_EVENT,
1078 ("[BT event], Physical Link Complete, Ignore to send this event due to event mask page 2\n"));
1079 return;
1080 }
1081
1082 if (EntryNum == 0xff) {
1083 /* connection not started yet, just use the input physical link handle to response. */
1084 PL_handle = PLHandle;
1085 } else {
1086 /* connection is under progress, use the phy link handle we recorded. */
1087 PL_handle = pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle;
1088 pBTInfo->BtAsocEntry[EntryNum].bNeedPhysLinkCompleteEvent = false;
1089 }
1090
1091 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("[BT event], Physical Link Complete, Status = 0x%x PhyLinkHandle = 0x%x\n", HciStatus,
1092 PL_handle));
1093
1094 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1095 PPacketIrpEvent->EventCode = HCI_EVENT_PHY_LINK_COMPLETE;
1096 PPacketIrpEvent->Length = 2;
1097
1098 PPacketIrpEvent->Data[0] = HciStatus;
1099 PPacketIrpEvent->Data[1] = PL_handle;
1100 bthci_IndicateEvent(padapter, PPacketIrpEvent, 4);
1101
1102}
1103
1104static void
1105bthci_EventCommandStatus(
1106 struct rtw_adapter *padapter,
1107 u8 OGF,
1108 u16 OCF,
1109 enum hci_status HciStatus
1110 )
1111{
1112
1113 u8 localBuf[6] = "";
1114 struct packet_irp_hcievent_data *PPacketIrpEvent;
1115 u8 Num_Hci_Comm = 0x1;
1116 RTPRINT(FIOCTL, IOCTL_BT_EVENT,
1117 ("[BT event], CommandStatus, Opcode = 0x%02x%02x, OGF = 0x%x, OCF = 0x%x, Status = 0x%x, Num_HCI_COMM = 0x%x\n",
1118 (HCIOPCODEHIGHT(OCF, OGF)), (HCIOPCODELOW(OCF, OGF)), OGF, OCF, HciStatus, Num_Hci_Comm));
1119
1120 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1121 PPacketIrpEvent->EventCode = HCI_EVENT_COMMAND_STATUS;
1122 PPacketIrpEvent->Length = 4;
1123 PPacketIrpEvent->Data[0] = HciStatus; /* current pending */
1124 PPacketIrpEvent->Data[1] = Num_Hci_Comm; /* packet # */
1125 PPacketIrpEvent->Data[2] = HCIOPCODELOW(OCF, OGF);
1126 PPacketIrpEvent->Data[3] = HCIOPCODEHIGHT(OCF, OGF);
1127
1128 bthci_IndicateEvent(padapter, PPacketIrpEvent, 6);
1129
1130}
1131
1132static void
1133bthci_EventLogicalLinkComplete(
1134 struct rtw_adapter *padapter,
1135 enum hci_status HciStatus,
1136 u8 PhyLinkHandle,
1137 u16 LogLinkHandle,
1138 u8 LogLinkIndex,
1139 u8 EntryNum
1140 )
1141{
1142/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
1143 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1144 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1145 u8 localBuf[7] = "";
1146 struct packet_irp_hcievent_data *PPacketIrpEvent;
1147
1148 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_LOGICAL_LINK_COMPLETE)) {
1149 RTPRINT(FIOCTL, IOCTL_BT_EVENT,
1150 ("[BT event], Logical Link Complete, Ignore to send this event due to event mask page 2\n"));
1151 return;
1152 }
1153 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("[BT event], Logical Link Complete, PhyLinkHandle = 0x%x, LogLinkHandle = 0x%x, Status = 0x%x\n",
1154 PhyLinkHandle, LogLinkHandle, HciStatus));
1155
1156 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1157 PPacketIrpEvent->EventCode = HCI_EVENT_LOGICAL_LINK_COMPLETE;
1158 PPacketIrpEvent->Length = 5;
1159
1160 PPacketIrpEvent->Data[0] = HciStatus;/* status code */
1161 /* Logical link handle */
1162 PPacketIrpEvent->Data[1] = TWOBYTE_LOWBYTE(LogLinkHandle);
1163 PPacketIrpEvent->Data[2] = TWOBYTE_HIGHTBYTE(LogLinkHandle);
1164 /* Physical link handle */
1165 PPacketIrpEvent->Data[3] = TWOBYTE_LOWBYTE(PhyLinkHandle);
1166 /* corresponding Tx flow spec ID */
1167 if (HciStatus == HCI_STATUS_SUCCESS) {
1168 PPacketIrpEvent->Data[4] =
1169 pBTInfo->BtAsocEntry[EntryNum].LogLinkCmdData[LogLinkIndex].Tx_Flow_Spec.Identifier;
1170 } else {
1171 PPacketIrpEvent->Data[4] = 0x0;
1172 }
1173
1174 bthci_IndicateEvent(padapter, PPacketIrpEvent, 7);
1175}
1176
1177static void
1178bthci_EventDisconnectLogicalLinkComplete(
1179 struct rtw_adapter *padapter,
1180 enum hci_status HciStatus,
1181 u16 LogLinkHandle,
1182 enum hci_status Reason
1183 )
1184{
1185 u8 localBuf[6] = "";
1186 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1187 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1188 struct packet_irp_hcievent_data *PPacketIrpEvent;
1189
1190 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_DISCONNECT_LOGICAL_LINK_COMPLETE)) {
1191 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("[BT event], Disconnect Logical Link Complete, Ignore to send this event due to event mask page 2\n"));
1192 return;
1193 }
1194 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("[BT event], Disconnect Logical Link Complete, Status = 0x%x, LLH = 0x%x Reason = 0x%x\n", HciStatus, LogLinkHandle, Reason));
1195
1196 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1197 PPacketIrpEvent->EventCode = HCI_EVENT_DISCONNECT_LOGICAL_LINK_COMPLETE;
1198 PPacketIrpEvent->Length = 4;
1199
1200 PPacketIrpEvent->Data[0] = HciStatus;
1201 /* Logical link handle */
1202 PPacketIrpEvent->Data[1] = TWOBYTE_LOWBYTE(LogLinkHandle);
1203 PPacketIrpEvent->Data[2] = TWOBYTE_HIGHTBYTE(LogLinkHandle);
1204 /* Disconnect reason */
1205 PPacketIrpEvent->Data[3] = Reason;
1206
1207 bthci_IndicateEvent(padapter, PPacketIrpEvent, 6);
1208}
1209
1210static void
1211bthci_EventFlushOccurred(
1212 struct rtw_adapter *padapter,
1213 u16 LogLinkHandle
1214 )
1215{
1216 u8 localBuf[4] = "";
1217 struct packet_irp_hcievent_data *PPacketIrpEvent;
1218 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("bthci_EventFlushOccurred(), LLH = 0x%x\n", LogLinkHandle));
1219
1220 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1221 PPacketIrpEvent->EventCode = HCI_EVENT_FLUSH_OCCRUED;
1222 PPacketIrpEvent->Length = 2;
1223 /* Logical link handle */
1224 PPacketIrpEvent->Data[0] = TWOBYTE_LOWBYTE(LogLinkHandle);
1225 PPacketIrpEvent->Data[1] = TWOBYTE_HIGHTBYTE(LogLinkHandle);
1226
1227 bthci_IndicateEvent(padapter, PPacketIrpEvent, 4);
1228}
1229
1230static enum hci_status
1231bthci_BuildPhysicalLink(
1232 struct rtw_adapter *padapter,
1233 struct packet_irp_hcicmd_data *pHciCmd,
1234 u16 OCF
1235)
1236{
1237 enum hci_status status = HCI_STATUS_SUCCESS;
1238 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1239 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
1240 u8 EntryNum, PLH;
1241
1242 /* Send HCI Command status event to AMP. */
1243 bthci_EventCommandStatus(padapter,
1244 LINK_CONTROL_COMMANDS,
1245 OCF,
1246 HCI_STATUS_SUCCESS);
1247
1248 PLH = *((u8 *)pHciCmd->Data);
1249
1250 /* Check if resource or bt connection is under progress, if yes, reject the link creation. */
1251 if (!bthci_AddEntry(padapter)) {
1252 status = HCI_STATUS_CONNECT_RJT_LIMIT_RESOURCE;
1253 bthci_EventPhysicalLinkComplete(padapter, status, INVALID_ENTRY_NUM, PLH);
1254 return status;
1255 }
1256
1257 EntryNum = pBtMgnt->CurrentConnectEntryNum;
1258 pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle = PLH;
1259 pBtMgnt->BtCurrentPhyLinkhandle = PLH;
1260
1261 if (pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.AMPAssocfragment == NULL) {
1262 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Create/Accept PhysicalLink, AMP controller is busy\n"));
1263 status = HCI_STATUS_CONTROLLER_BUSY;
1264 bthci_EventPhysicalLinkComplete(padapter, status, INVALID_ENTRY_NUM, PLH);
1265 return status;
1266 }
1267
1268 /* Record Key and the info */
1269 pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyLen = (*((u8 *)pHciCmd->Data+1));
1270 pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyType = (*((u8 *)pHciCmd->Data+2));
1271 memcpy(pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKey,
1272 (((u8 *)pHciCmd->Data+3)), pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyLen);
1273 memcpy(pBTInfo->BtAsocEntry[EntryNum].PMK, pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKey, PMK_LEN);
1274 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("BuildPhysicalLink, EntryNum = %d, PLH = 0x%x KeyLen = 0x%x, KeyType = 0x%x\n",
1275 EntryNum, pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle,
1276 pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyLen,
1277 pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyType));
1278 RTPRINT_DATA(FIOCTL, (IOCTL_BT_LOGO|IOCTL_BT_HCICMD), ("BtAMPKey\n"), pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKey,
1279 pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtAMPKeyLen);
1280 RTPRINT_DATA(FIOCTL, (IOCTL_BT_LOGO|IOCTL_BT_HCICMD), ("PMK\n"), pBTInfo->BtAsocEntry[EntryNum].PMK,
1281 PMK_LEN);
1282
1283 if (OCF == HCI_CREATE_PHYSICAL_LINK) {
1284 /* These macros require braces */
1285 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTED, STATE_CMD_CREATE_PHY_LINK, EntryNum);
1286 } else if (OCF == HCI_ACCEPT_PHYSICAL_LINK) {
1287 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTED, STATE_CMD_ACCEPT_PHY_LINK, EntryNum);
1288 }
1289
1290 return status;
1291}
1292
1293static void
1294bthci_BuildLogicalLink(
1295 struct rtw_adapter *padapter,
1296 struct packet_irp_hcicmd_data *pHciCmd,
1297 u16 OCF
1298 )
1299{
1300 enum hci_status status = HCI_STATUS_SUCCESS;
1301 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
1302 struct bt_mgnt *pBtMgnt = &pBTinfo->BtMgnt;
1303 u8 PhyLinkHandle, EntryNum;
1304 static u16 AssignLogHandle = 1;
1305
1306 struct hci_flow_spec TxFlowSpec;
1307 struct hci_flow_spec RxFlowSpec;
1308 u32 MaxSDUSize, ArriveTime, Bandwidth;
1309
1310 PhyLinkHandle = *((u8 *)pHciCmd->Data);
1311
1312 EntryNum = bthci_GetCurrentEntryNum(padapter, PhyLinkHandle);
1313
1314 memcpy(&TxFlowSpec,
1315 &pHciCmd->Data[1], sizeof(struct hci_flow_spec));
1316 memcpy(&RxFlowSpec,
1317 &pHciCmd->Data[17], sizeof(struct hci_flow_spec));
1318
1319 MaxSDUSize = TxFlowSpec.MaximumSDUSize;
1320 ArriveTime = TxFlowSpec.SDUInterArrivalTime;
1321
1322 if (bthci_CheckLogLinkBehavior(padapter, TxFlowSpec) && bthci_CheckLogLinkBehavior(padapter, RxFlowSpec))
1323 Bandwidth = BTTOTALBANDWIDTH;
1324 else if (MaxSDUSize == 0xffff && ArriveTime == 0xffffffff)
1325 Bandwidth = BTTOTALBANDWIDTH;
1326 else
1327 Bandwidth = MaxSDUSize*8*1000/(ArriveTime+244);
1328
1329 RTPRINT(FIOCTL, IOCTL_BT_HCICMD,
1330 ("BuildLogicalLink, PhyLinkHandle = 0x%x, MaximumSDUSize = 0x%x, SDUInterArrivalTime = 0x%x, Bandwidth = 0x%x\n",
1331 PhyLinkHandle, MaxSDUSize, ArriveTime, Bandwidth));
1332
1333 if (EntryNum == 0xff) {
1334 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Invalid Physical Link handle = 0x%x, status = HCI_STATUS_UNKNOW_CONNECT_ID, return\n", PhyLinkHandle));
1335 status = HCI_STATUS_UNKNOW_CONNECT_ID;
1336
1337 /* When we receive Create/Accept logical link command, we should send command status event first. */
1338 bthci_EventCommandStatus(padapter,
1339 LINK_CONTROL_COMMANDS,
1340 OCF,
1341 status);
1342 return;
1343 }
1344
1345 if (!pBtMgnt->bLogLinkInProgress) {
1346 if (bthci_PhyLinkConnectionInProgress(padapter, PhyLinkHandle)) {
1347 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Physical link connection in progress, status = HCI_STATUS_CMD_DISALLOW, return\n"));
1348 status = HCI_STATUS_CMD_DISALLOW;
1349
1350 pBtMgnt->bPhyLinkInProgressStartLL = true;
1351 /* When we receive Create/Accept logical link command, we should send command status event first. */
1352 bthci_EventCommandStatus(padapter,
1353 LINK_CONTROL_COMMANDS,
1354 OCF,
1355 status);
1356
1357 return;
1358 }
1359
1360 if (Bandwidth > BTTOTALBANDWIDTH) {
1361 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("status = HCI_STATUS_QOS_REJECT, Bandwidth = 0x%x, return\n", Bandwidth));
1362 status = HCI_STATUS_QOS_REJECT;
1363
1364 /* When we receive Create/Accept logical link command, we should send command status event first. */
1365 bthci_EventCommandStatus(padapter,
1366 LINK_CONTROL_COMMANDS,
1367 OCF,
1368 status);
1369 } else {
1370 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("status = HCI_STATUS_SUCCESS\n"));
1371 status = HCI_STATUS_SUCCESS;
1372
1373 /* When we receive Create/Accept logical link command, we should send command status event first. */
1374 bthci_EventCommandStatus(padapter,
1375 LINK_CONTROL_COMMANDS,
1376 OCF,
1377 status);
1378
1379 }
1380
1381 if (pBTinfo->BtAsocEntry[EntryNum].BtCurrentState != HCI_STATE_CONNECTED) {
1382 bthci_EventLogicalLinkComplete(padapter,
1383 HCI_STATUS_CMD_DISALLOW, 0, 0, 0, EntryNum);
1384 } else {
1385 u8 i, find = 0;
1386
1387 pBtMgnt->bLogLinkInProgress = true;
1388
1389 /* find an unused logical link index and copy the data */
1390 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
1391 if (pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].BtLogLinkhandle == 0) {
1392 enum hci_status LogCompEventstatus = HCI_STATUS_SUCCESS;
1393
1394 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].BtPhyLinkhandle = *((u8 *)pHciCmd->Data);
1395 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].BtLogLinkhandle = AssignLogHandle;
1396 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("BuildLogicalLink, EntryNum = %d, physical link handle = 0x%x, logical link handle = 0x%x\n",
1397 EntryNum, pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle,
1398 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].BtLogLinkhandle));
1399 memcpy(&pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].Tx_Flow_Spec,
1400 &TxFlowSpec, sizeof(struct hci_flow_spec));
1401 memcpy(&pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].Rx_Flow_Spec,
1402 &RxFlowSpec, sizeof(struct hci_flow_spec));
1403
1404 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].bLLCompleteEventIsSet = false;
1405
1406 if (pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].bLLCancelCMDIsSetandComplete)
1407 LogCompEventstatus = HCI_STATUS_UNKNOW_CONNECT_ID;
1408 bthci_EventLogicalLinkComplete(padapter,
1409 LogCompEventstatus,
1410 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].BtPhyLinkhandle,
1411 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].BtLogLinkhandle, i, EntryNum);
1412
1413 pBTinfo->BtAsocEntry[EntryNum].LogLinkCmdData[i].bLLCompleteEventIsSet = true;
1414
1415 find = 1;
1416 pBtMgnt->BtCurrentLogLinkhandle = AssignLogHandle;
1417 AssignLogHandle++;
1418 break;
1419 }
1420 }
1421
1422 if (!find) {
1423 bthci_EventLogicalLinkComplete(padapter,
1424 HCI_STATUS_CONNECT_RJT_LIMIT_RESOURCE, 0, 0, 0, EntryNum);
1425 }
1426 pBtMgnt->bLogLinkInProgress = false;
1427 }
1428 } else {
1429 bthci_EventLogicalLinkComplete(padapter,
1430 HCI_STATUS_CONTROLLER_BUSY, 0, 0, 0, EntryNum);
1431 }
1432
1433}
1434
1435static void
1436bthci_StartBeaconAndConnect(
1437 struct rtw_adapter *padapter,
1438 struct packet_irp_hcicmd_data *pHciCmd,
1439 u8 CurrentAssocNum
1440 )
1441{
1442/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
1443 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1444 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
1445
1446 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("StartBeaconAndConnect, CurrentAssocNum =%d, AMPRole =%d\n",
1447 CurrentAssocNum,
1448 pBTInfo->BtAsocEntry[CurrentAssocNum].AMPRole));
1449
1450 if (!pBtMgnt->CheckChnlIsSuit) {
1451 bthci_EventPhysicalLinkComplete(padapter, HCI_STATUS_CONNECT_REJ_NOT_SUIT_CHNL_FOUND, CurrentAssocNum, INVALID_PL_HANDLE);
1452 bthci_RemoveEntryByEntryNum(padapter, CurrentAssocNum);
1453 return;
1454 }
1455
1456 if (pBTInfo->BtAsocEntry[CurrentAssocNum].AMPRole == AMP_BTAP_CREATOR) {
3fd624b3 1457 snprintf((char *)pBTInfo->BtAsocEntry[CurrentAssocNum].BTSsidBuf, 32, "AMP-%02x-%02x-%02x-%02x-%02x-%02x",
f7c92d2c
LF		 1458 padapter->eeprompriv.mac_addr[0],
1459 padapter->eeprompriv.mac_addr[1],
1460 padapter->eeprompriv.mac_addr[2],
1461 padapter->eeprompriv.mac_addr[3],
1462 padapter->eeprompriv.mac_addr[4],
1463 padapter->eeprompriv.mac_addr[5]);
1464 } else if (pBTInfo->BtAsocEntry[CurrentAssocNum].AMPRole == AMP_BTAP_JOINER) {
3fd624b3 1465 snprintf((char *)pBTInfo->BtAsocEntry[CurrentAssocNum].BTSsidBuf, 32, "AMP-%02x-%02x-%02x-%02x-%02x-%02x",
f7c92d2c
LF		 1466 pBTInfo->BtAsocEntry[CurrentAssocNum].BTRemoteMACAddr[0],
1467 pBTInfo->BtAsocEntry[CurrentAssocNum].BTRemoteMACAddr[1],
1468 pBTInfo->BtAsocEntry[CurrentAssocNum].BTRemoteMACAddr[2],
1469 pBTInfo->BtAsocEntry[CurrentAssocNum].BTRemoteMACAddr[3],
1470 pBTInfo->BtAsocEntry[CurrentAssocNum].BTRemoteMACAddr[4],
1471 pBTInfo->BtAsocEntry[CurrentAssocNum].BTRemoteMACAddr[5]);
1472 }
1473
1474 FillOctetString(pBTInfo->BtAsocEntry[CurrentAssocNum].BTSsid, pBTInfo->BtAsocEntry[CurrentAssocNum].BTSsidBuf, 21);
1475 pBTInfo->BtAsocEntry[CurrentAssocNum].BTSsid.Length = 21;
1476
1477 /* To avoid set the start ap or connect twice, or the original connection will be disconnected. */
1478 if (!pBtMgnt->bBTConnectInProgress) {
1479 pBtMgnt->bBTConnectInProgress = true;
1480 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], BT Connect in progress ON!!\n"));
1481 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_STARTING, STATE_CMD_MAC_START_COMPLETE, CurrentAssocNum);
1482
1483 /* 20100325 Joseph: Check RF ON/OFF. */
1484 /* If RF OFF, it reschedule connecting operation after 50ms. */
1485 if (!bthci_CheckRfStateBeforeConnect(padapter))
1486 return;
1487
1488 if (pBTInfo->BtAsocEntry[CurrentAssocNum].AMPRole == AMP_BTAP_CREATOR) {
1489 /* These macros need braces */
1490 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_CONNECTING, STATE_CMD_MAC_CONNECT_COMPLETE, CurrentAssocNum);
1491 } else if (pBTInfo->BtAsocEntry[CurrentAssocNum].AMPRole == AMP_BTAP_JOINER) {
1492 bthci_ResponderStartToScan(padapter);
1493 }
1494 }
1495 RT_PRINT_STR(_module_rtl871x_mlme_c_, _drv_notice_,
1496 "StartBeaconAndConnect, SSID:\n",
1497 pBTInfo->BtAsocEntry[pBtMgnt->CurrentConnectEntryNum].BTSsid.Octet,
1498 pBTInfo->BtAsocEntry[pBtMgnt->CurrentConnectEntryNum].BTSsid.Length);
1499}
1500
1501static void bthci_ResetBtMgnt(struct bt_mgnt *pBtMgnt)
1502{
1503 pBtMgnt->BtOperationOn = false;
1504 pBtMgnt->bBTConnectInProgress = false;
1505 pBtMgnt->bLogLinkInProgress = false;
1506 pBtMgnt->bPhyLinkInProgress = false;
1507 pBtMgnt->bPhyLinkInProgressStartLL = false;
1508 pBtMgnt->DisconnectEntryNum = 0xff;
1509 pBtMgnt->bStartSendSupervisionPkt = false;
1510 pBtMgnt->JoinerNeedSendAuth = false;
1511 pBtMgnt->CurrentBTConnectionCnt = 0;
1512 pBtMgnt->BTCurrentConnectType = BT_DISCONNECT;
1513 pBtMgnt->BTReceiveConnectPkt = BT_DISCONNECT;
1514 pBtMgnt->BTAuthCount = 0;
1515 pBtMgnt->btLogoTest = 0;
1516}
1517
1518static void bthci_ResetBtHciInfo(struct bt_hci_info *pBtHciInfo)
1519{
1520 pBtHciInfo->BTEventMask = 0;
1521 pBtHciInfo->BTEventMaskPage2 = 0;
1522 pBtHciInfo->ConnAcceptTimeout = 10000;
1523 pBtHciInfo->PageTimeout = 0x30;
1524 pBtHciInfo->LocationDomainAware = 0x0;
1525 pBtHciInfo->LocationDomain = 0x5858;
1526 pBtHciInfo->LocationDomainOptions = 0x58;
1527 pBtHciInfo->LocationOptions = 0x0;
1528 pBtHciInfo->FlowControlMode = 0x1; /* 0:Packet based data flow control mode(BR/EDR), 1: Data block based data flow control mode(AMP). */
1529
1530 pBtHciInfo->enFlush_LLH = 0;
1531 pBtHciInfo->FLTO_LLH = 0;
1532
1533 /* Test command only */
1534 pBtHciInfo->bTestIsEnd = true;
1535 pBtHciInfo->bInTestMode = false;
1536 pBtHciInfo->bTestNeedReport = false;
1537 pBtHciInfo->TestScenario = 0xff;
1538 pBtHciInfo->TestReportInterval = 0x01;
1539 pBtHciInfo->TestCtrType = 0x5d;
1540 pBtHciInfo->TestEventType = 0x00;
1541 pBtHciInfo->TestNumOfFrame = 0;
1542 pBtHciInfo->TestNumOfErrFrame = 0;
1543 pBtHciInfo->TestNumOfBits = 0;
1544 pBtHciInfo->TestNumOfErrBits = 0;
1545}
1546
1547static void bthci_ResetBtSec(struct rtw_adapter *padapter, struct bt_security *pBtSec)
1548{
1549/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
1550
1551 /* Set BT used HW or SW encrypt !! */
1552 if (GET_HAL_DATA(padapter)->bBTMode)
1553 pBtSec->bUsedHwEncrypt = true;
1554 else
1555 pBtSec->bUsedHwEncrypt = false;
90403aa1
JP		 1556 RT_TRACE(_module_rtl871x_security_c_, _drv_info_,
1557 "%s: bUsedHwEncrypt =%d\n", __func__, pBtSec->bUsedHwEncrypt);
f7c92d2c
LF		 1558
1559 pBtSec->RSNIE.Octet = pBtSec->RSNIEBuf;
1560}
1561
1562static void bthci_ResetBtExtInfo(struct bt_mgnt *pBtMgnt)
1563{
1564 u8 i;
1565
1566 for (i = 0; i < MAX_BT_ASOC_ENTRY_NUM; i++) {
1567 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle = 0;
1568 pBtMgnt->ExtConfig.linkInfo[i].IncomingTrafficMode = 0;
1569 pBtMgnt->ExtConfig.linkInfo[i].OutgoingTrafficMode = 0;
1570 pBtMgnt->ExtConfig.linkInfo[i].BTProfile = BT_PROFILE_NONE;
1571 pBtMgnt->ExtConfig.linkInfo[i].BTCoreSpec = BT_SPEC_2_1_EDR;
1572 pBtMgnt->ExtConfig.linkInfo[i].BT_RSSI = 0;
1573 pBtMgnt->ExtConfig.linkInfo[i].TrafficProfile = BT_PROFILE_NONE;
1574 pBtMgnt->ExtConfig.linkInfo[i].linkRole = BT_LINK_MASTER;
1575 }
1576
1577 pBtMgnt->ExtConfig.CurrentConnectHandle = 0;
1578 pBtMgnt->ExtConfig.CurrentIncomingTrafficMode = 0;
1579 pBtMgnt->ExtConfig.CurrentOutgoingTrafficMode = 0;
1580 pBtMgnt->ExtConfig.MIN_BT_RSSI = 0;
1581 pBtMgnt->ExtConfig.NumberOfHandle = 0;
1582 pBtMgnt->ExtConfig.NumberOfSCO = 0;
1583 pBtMgnt->ExtConfig.CurrentBTStatus = 0;
1584 pBtMgnt->ExtConfig.HCIExtensionVer = 0;
1585
1586 pBtMgnt->ExtConfig.bManualControl = false;
1587 pBtMgnt->ExtConfig.bBTBusy = false;
1588 pBtMgnt->ExtConfig.bBTA2DPBusy = false;
1589}
1590
1591static enum hci_status bthci_CmdReset(struct rtw_adapter *_padapter, u8 bNeedSendEvent)
1592{
1593 enum hci_status status = HCI_STATUS_SUCCESS;
1594 struct rtw_adapter *padapter;
1595/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
1596 struct bt_30info *pBTInfo;
1597 struct bt_mgnt *pBtMgnt;
1598 struct bt_hci_info *pBtHciInfo;
1599 struct bt_security *pBtSec;
1600 struct bt_dgb *pBtDbg;
1601 u8 i;
1602
1603 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("bthci_CmdReset()\n"));
1604
1605 padapter = GetDefaultAdapter(_padapter);
1606 pBTInfo = GET_BT_INFO(padapter);
1607 pBtMgnt = &pBTInfo->BtMgnt;
1608 pBtHciInfo = &pBTInfo->BtHciInfo;
1609 pBtSec = &pBTInfo->BtSec;
1610 pBtDbg = &pBTInfo->BtDbg;
1611
1612 pBTInfo->padapter = padapter;
1613
1614 for (i = 0; i < MAX_BT_ASOC_ENTRY_NUM; i++)
1615 bthci_ResetEntry(padapter, i);
1616
1617 bthci_ResetBtMgnt(pBtMgnt);
1618 bthci_ResetBtHciInfo(pBtHciInfo);
1619 bthci_ResetBtSec(padapter, pBtSec);
1620
1621 pBtMgnt->BTChannel = BT_Default_Chnl;
1622 pBtMgnt->CheckChnlIsSuit = true;
1623
1624 pBTInfo->BTBeaconTmrOn = false;
1625
1626 pBtMgnt->bCreateSpportQos = true;
1627
1628 del_timer_sync(&pBTInfo->BTHCIDiscardAclDataTimer);
1629 del_timer_sync(&pBTInfo->BTBeaconTimer);
1630
1631 HALBT_SetRtsCtsNoLenLimit(padapter);
1632 /* */
1633 /* Maybe we need to take care Group != AES case !! */
1634 /* now we Pairwise and Group all used AES !! */
1635
1636 bthci_ResetBtExtInfo(pBtMgnt);
1637
1638 /* send command complete event here when all data are received. */
1639 if (bNeedSendEvent) {
1640 u8 localBuf[6] = "";
1641 u8 *pRetPar;
1642 u8 len = 0;
1643 struct packet_irp_hcievent_data *PPacketIrpEvent;
1644
1645 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1646
1647 len += bthci_CommandCompleteHeader(&localBuf[0],
1648 OGF_SET_EVENT_MASK_COMMAND,
1649 HCI_RESET,
1650 status);
1651
1652 /* Return parameters starts from here */
1653 pRetPar = &PPacketIrpEvent->Data[len];
1654 pRetPar[0] = status; /* status */
1655 len += 1;
1656 PPacketIrpEvent->Length = len;
1657
1658 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
1659 }
1660
1661 return status;
1662}
1663
1664static enum hci_status
1665bthci_CmdWriteRemoteAMPAssoc(
1666 struct rtw_adapter *padapter,
1667 struct packet_irp_hcicmd_data *pHciCmd
1668 )
1669{
1670 enum hci_status status = HCI_STATUS_SUCCESS;
1671 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1672 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
1673 u8 CurrentAssocNum;
1674 u8 PhyLinkHandle;
1675
1676 pBtDbg->dbgHciInfo.hciCmdCntWriteRemoteAmpAssoc++;
1677 PhyLinkHandle = *((u8 *)pHciCmd->Data);
1678 CurrentAssocNum = bthci_GetCurrentEntryNum(padapter, PhyLinkHandle);
1679
1680 if (CurrentAssocNum == 0xff) {
1681 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("WriteRemoteAMPAssoc, No such Handle in the Entry\n"));
1682 status = HCI_STATUS_UNKNOW_CONNECT_ID;
1683 bthci_EventWriteRemoteAmpAssoc(padapter, status, PhyLinkHandle);
1684 return status;
1685 }
1686
1687 if (pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocfragment == NULL) {
1688 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("WriteRemoteAMPAssoc, AMP controller is busy\n"));
1689 status = HCI_STATUS_CONTROLLER_BUSY;
1690 bthci_EventWriteRemoteAmpAssoc(padapter, status, PhyLinkHandle);
1691 return status;
1692 }
1693
1694 pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.BtPhyLinkhandle = PhyLinkHandle;/* u8 *)pHciCmd->Data); */
1695 pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.LenSoFar = *((u16 *)((u8 *)pHciCmd->Data+1));
1696 pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocRemLen = *((u16 *)((u8 *)pHciCmd->Data+3));
1697
1698 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("WriteRemoteAMPAssoc, LenSoFar = 0x%x, AssocRemLen = 0x%x\n",
1699 pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.LenSoFar,
1700 pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocRemLen));
1701
1702 RTPRINT_DATA(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO),
1703 ("WriteRemoteAMPAssoc fragment \n"),
1704 pHciCmd->Data,
1705 pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocRemLen+5);
1706 if ((pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocRemLen) > MAX_AMP_ASSOC_FRAG_LEN) {
1707 memcpy(((u8 *)pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocfragment+(pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.LenSoFar*(sizeof(u8)))),
1708 (u8 *)pHciCmd->Data+5,
1709 MAX_AMP_ASSOC_FRAG_LEN);
1710 } else {
1711 memcpy((u8 *)(pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocfragment)+(pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.LenSoFar*(sizeof(u8))),
1712 ((u8 *)pHciCmd->Data+5),
1713 (pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocRemLen));
1714
1715 RTPRINT_DATA(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), "WriteRemoteAMPAssoc :\n",
1716 pHciCmd->Data+5, pBTInfo->BtAsocEntry[CurrentAssocNum].AmpAsocCmdData.AMPAssocRemLen);
1717
1718 if (!bthci_GetAssocInfo(padapter, CurrentAssocNum))
1719 status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE;
1720
1721 bthci_EventWriteRemoteAmpAssoc(padapter, status, PhyLinkHandle);
1722
1723 bthci_StartBeaconAndConnect(padapter, pHciCmd, CurrentAssocNum);
1724 }
1725
1726 return status;
1727}
1728
1729/* 7.3.13 */
1730static enum hci_status bthci_CmdReadConnectionAcceptTimeout(struct rtw_adapter *padapter)
1731{
1732 enum hci_status status = HCI_STATUS_SUCCESS;
1733/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
1734 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1735 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1736 u8 localBuf[8] = "";
1737 u8 *pRetPar;
1738 u8 len = 0;
1739 struct packet_irp_hcievent_data *PPacketIrpEvent;
1740 u16 *pu2Temp;
1741
1742 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1743
1744 len += bthci_CommandCompleteHeader(&localBuf[0],
1745 OGF_SET_EVENT_MASK_COMMAND,
1746 HCI_READ_CONNECTION_ACCEPT_TIMEOUT,
1747 status);
1748
1749 /* Return parameters starts from here */
1750 pRetPar = &PPacketIrpEvent->Data[len];
1751 pRetPar[0] = status; /* status */
1752 pu2Temp = (u16 *)&pRetPar[1]; /* Conn_Accept_Timeout */
1753 *pu2Temp = pBtHciInfo->ConnAcceptTimeout;
1754 len += 3;
1755 PPacketIrpEvent->Length = len;
1756
1757 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
1758
1759 return status;
1760}
1761
f7c92d2c
LF		 1762/* 7.3.14 */
1763static enum hci_status
1764bthci_CmdWriteConnectionAcceptTimeout(
1765 struct rtw_adapter *padapter,
1766 struct packet_irp_hcicmd_data *pHciCmd
1767 )
1768{
1769 enum hci_status status = HCI_STATUS_SUCCESS;
1770 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1771 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1772 u16 *pu2Temp;
1773 u8 localBuf[6] = "";
1774 u8 *pRetPar;
1775 u8 len = 0;
1776 struct packet_irp_hcievent_data *PPacketIrpEvent;
1777
1778 pu2Temp = (u16 *)&pHciCmd->Data[0];
1779 pBtHciInfo->ConnAcceptTimeout = *pu2Temp;
1780 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_DETAIL, ("ConnAcceptTimeout = 0x%x",
1781 pBtHciInfo->ConnAcceptTimeout));
1782
1783 /* send command complete event here when all data are received. */
1784 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1785
1786 len += bthci_CommandCompleteHeader(&localBuf[0],
1787 OGF_SET_EVENT_MASK_COMMAND,
1788 HCI_WRITE_CONNECTION_ACCEPT_TIMEOUT,
1789 status);
1790
1791 /* Return parameters starts from here */
1792 pRetPar = &PPacketIrpEvent->Data[len];
1793 pRetPar[0] = status; /* status */
1794 len += 1;
1795 PPacketIrpEvent->Length = len;
1796
1797 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
1798
1799 return status;
1800}
1801
1802static enum hci_status
1803bthci_CmdReadPageTimeout(
1804 struct rtw_adapter *padapter,
1805 struct packet_irp_hcicmd_data *pHciCmd
1806 )
1807{
1808 enum hci_status status = HCI_STATUS_SUCCESS;
1809 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1810 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1811 u8 localBuf[8] = "";
1812 u8 *pRetPar;
1813 u8 len = 0;
1814 struct packet_irp_hcievent_data *PPacketIrpEvent;
1815 u16 *pu2Temp;
1816
1817 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1818
1819 len += bthci_CommandCompleteHeader(&localBuf[0],
1820 OGF_SET_EVENT_MASK_COMMAND,
1821 HCI_READ_PAGE_TIMEOUT,
1822 status);
1823
1824 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Read PageTimeout = 0x%x\n", pBtHciInfo->PageTimeout));
1825 /* Return parameters starts from here */
1826 pRetPar = &PPacketIrpEvent->Data[len];
1827 pRetPar[0] = status; /* status */
1828 pu2Temp = (u16 *)&pRetPar[1]; /* Page_Timeout */
1829 *pu2Temp = pBtHciInfo->PageTimeout;
1830 len += 3;
1831 PPacketIrpEvent->Length = len;
1832
1833 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
1834
1835 return status;
1836}
1837
1838static enum hci_status
1839bthci_CmdWritePageTimeout(
1840 struct rtw_adapter *padapter,
1841 struct packet_irp_hcicmd_data *pHciCmd
1842 )
1843{
1844 enum hci_status status = HCI_STATUS_SUCCESS;
1845 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
1846 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
1847 u16 *pu2Temp;
1848
1849 pu2Temp = (u16 *)&pHciCmd->Data[0];
1850 pBtHciInfo->PageTimeout = *pu2Temp;
1851 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Write PageTimeout = 0x%x\n",
1852 pBtHciInfo->PageTimeout));
1853
1854 /* send command complete event here when all data are received. */
1855 {
1856 u8 localBuf[6] = "";
1857 u8 *pRetPar;
1858 u8 len = 0;
1859 struct packet_irp_hcievent_data *PPacketIrpEvent;
1860
1861 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1862
1863 len += bthci_CommandCompleteHeader(&localBuf[0],
1864 OGF_SET_EVENT_MASK_COMMAND,
1865 HCI_WRITE_PAGE_TIMEOUT,
1866 status);
1867
1868 /* Return parameters starts from here */
1869 pRetPar = &PPacketIrpEvent->Data[len];
1870 pRetPar[0] = status; /* status */
1871 len += 1;
1872 PPacketIrpEvent->Length = len;
1873
1874 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
1875 }
1876
1877 return status;
1878}
1879
1880static enum hci_status
1881bthci_CmdReadLinkSupervisionTimeout(
1882 struct rtw_adapter *padapter,
1883 struct packet_irp_hcicmd_data *pHciCmd
1884 )
1885{
1886 enum hci_status status = HCI_STATUS_SUCCESS;
1887 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
1888 u8 physicalLinkHandle, EntryNum;
1889
1890 physicalLinkHandle = *((u8 *)pHciCmd->Data);
1891
1892 EntryNum = bthci_GetCurrentEntryNum(padapter, physicalLinkHandle);
1893
1894 if (EntryNum == 0xff) {
1895 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("ReadLinkSupervisionTimeout, No such Handle in the Entry\n"));
1896 status = HCI_STATUS_UNKNOW_CONNECT_ID;
1897 return status;
1898 }
1899
1900 if (pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle != physicalLinkHandle)
1901 status = HCI_STATUS_UNKNOW_CONNECT_ID;
1902
1903 {
1904 u8 localBuf[10] = "";
1905 u8 *pRetPar;
1906 u8 len = 0;
1907 struct packet_irp_hcievent_data *PPacketIrpEvent;
1908 u16 *pu2Temp;
1909
1910 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1911
1912 len += bthci_CommandCompleteHeader(&localBuf[0],
1913 OGF_SET_EVENT_MASK_COMMAND,
1914 HCI_READ_LINK_SUPERVISION_TIMEOUT,
1915 status);
1916
1917 /* Return parameters starts from here */
1918 pRetPar = &PPacketIrpEvent->Data[len];
1919 pRetPar[0] = status;
1920 pRetPar[1] = pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle;
1921 pRetPar[2] = 0;
1922 pu2Temp = (u16 *)&pRetPar[3]; /* Conn_Accept_Timeout */
1923 *pu2Temp = pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.LinkSuperversionTimeout;
1924 len += 5;
1925 PPacketIrpEvent->Length = len;
1926
1927 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
1928 }
1929
1930 return status;
1931}
1932
1933static enum hci_status
1934bthci_CmdWriteLinkSupervisionTimeout(
1935 struct rtw_adapter *padapter,
1936 struct packet_irp_hcicmd_data *pHciCmd
1937 )
1938{
1939 enum hci_status status = HCI_STATUS_SUCCESS;
1940 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
1941 u8 physicalLinkHandle, EntryNum;
1942
1943 physicalLinkHandle = *((u8 *)pHciCmd->Data);
1944
1945 EntryNum = bthci_GetCurrentEntryNum(padapter, physicalLinkHandle);
1946
1947 if (EntryNum == 0xff) {
1948 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("WriteLinkSupervisionTimeout, No such Handle in the Entry\n"));
1949 status = HCI_STATUS_UNKNOW_CONNECT_ID;
1950 } else {
1951 if (pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle != physicalLinkHandle) {
1952 status = HCI_STATUS_UNKNOW_CONNECT_ID;
1953 } else {
1954 pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.LinkSuperversionTimeout = *((u16 *)(((u8 *)pHciCmd->Data)+2));
1955 RTPRINT(FIOCTL, IOCTL_STATE, ("BT Write LinkSuperversionTimeout[%d] = 0x%x\n",
1956 EntryNum, pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.LinkSuperversionTimeout));
1957 }
1958 }
1959
1960 {
1961 u8 localBuf[8] = "";
1962 u8 *pRetPar;
1963 u8 len = 0;
1964 struct packet_irp_hcievent_data *PPacketIrpEvent;
1965
1966 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
1967
1968 len += bthci_CommandCompleteHeader(&localBuf[0],
1969 OGF_SET_EVENT_MASK_COMMAND,
1970 HCI_WRITE_LINK_SUPERVISION_TIMEOUT,
1971 status);
1972
1973 /* Return parameters starts from here */
1974 pRetPar = &PPacketIrpEvent->Data[len];
1975 pRetPar[0] = status;
1976 pRetPar[1] = pBTinfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle;
1977 pRetPar[2] = 0;
1978 len += 3;
1979 PPacketIrpEvent->Length = len;
1980
1981 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
1982 }
1983
1984 return status;
1985}
1986
1987static enum hci_status
1988bthci_CmdEnhancedFlush(
1989 struct rtw_adapter *padapter,
1990 struct packet_irp_hcicmd_data *pHciCmd
1991 )
1992{
1993 enum hci_status status = HCI_STATUS_SUCCESS;
1994 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
1995 struct bt_hci_info *pBtHciInfo = &pBTinfo->BtHciInfo;
1996 u16 logicHandle;
1997 u8 Packet_Type;
1998
1999 logicHandle = *((u16 *)&pHciCmd->Data[0]);
2000 Packet_Type = pHciCmd->Data[2];
2001
2002 if (Packet_Type != 0)
2003 status = HCI_STATUS_INVALID_HCI_CMD_PARA_VALUE;
2004 else
2005 pBtHciInfo->enFlush_LLH = logicHandle;
2006
2007 if (bthci_DiscardTxPackets(padapter, pBtHciInfo->enFlush_LLH))
2008 bthci_EventFlushOccurred(padapter, pBtHciInfo->enFlush_LLH);
2009
2010 /* should send command status event */
2011 bthci_EventCommandStatus(padapter,
2012 OGF_SET_EVENT_MASK_COMMAND,
2013 HCI_ENHANCED_FLUSH,
2014 status);
2015
2016 if (pBtHciInfo->enFlush_LLH) {
2017 bthci_EventEnhancedFlushComplete(padapter, pBtHciInfo->enFlush_LLH);
2018 pBtHciInfo->enFlush_LLH = 0;
2019 }
2020
2021 return status;
2022}
2023
2024static enum hci_status
2025bthci_CmdReadLogicalLinkAcceptTimeout(
2026 struct rtw_adapter *padapter,
2027 struct packet_irp_hcicmd_data *pHciCmd
2028 )
2029{
2030 enum hci_status status = HCI_STATUS_SUCCESS;
2031/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
2032 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2033 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2034 u8 localBuf[8] = "";
2035 u8 *pRetPar;
2036 u8 len = 0;
2037 struct packet_irp_hcievent_data *PPacketIrpEvent;
2038 u16 *pu2Temp;
2039
2040 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2041
2042 len += bthci_CommandCompleteHeader(&localBuf[0],
2043 OGF_SET_EVENT_MASK_COMMAND,
2044 HCI_READ_LOGICAL_LINK_ACCEPT_TIMEOUT,
2045 status);
2046
2047 /* Return parameters starts from here */
2048 pRetPar = &PPacketIrpEvent->Data[len];
2049 pRetPar[0] = status;
2050
2051 pu2Temp = (u16 *)&pRetPar[1]; /* Conn_Accept_Timeout */
2052 *pu2Temp = pBtHciInfo->LogicalAcceptTimeout;
2053 len += 3;
2054 PPacketIrpEvent->Length = len;
2055
2056 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2057
2058 return status;
2059}
2060
2061static enum hci_status
2062bthci_CmdWriteLogicalLinkAcceptTimeout(
2063 struct rtw_adapter *padapter,
2064 struct packet_irp_hcicmd_data *pHciCmd
2065 )
2066{
2067 enum hci_status status = HCI_STATUS_SUCCESS;
2068/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
2069 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2070 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2071 u8 localBuf[6] = "";
2072 u8 *pRetPar;
2073 u8 len = 0;
2074 struct packet_irp_hcievent_data *PPacketIrpEvent;
2075
2076 pBtHciInfo->LogicalAcceptTimeout = *((u16 *)pHciCmd->Data);
2077
2078 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2079
2080 len += bthci_CommandCompleteHeader(&localBuf[0],
2081 OGF_SET_EVENT_MASK_COMMAND,
2082 HCI_WRITE_LOGICAL_LINK_ACCEPT_TIMEOUT,
2083 status);
2084
2085 /* Return parameters starts from here */
2086 pRetPar = &PPacketIrpEvent->Data[len];
2087 pRetPar[0] = status;
2088
2089 len += 1;
2090 PPacketIrpEvent->Length = len;
2091
2092 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2093 return status;
2094}
2095
2096static enum hci_status
2097bthci_CmdSetEventMask(
2098 struct rtw_adapter *padapter,
2099 struct packet_irp_hcicmd_data *pHciCmd
2100 )
2101{
2102 enum hci_status status = HCI_STATUS_SUCCESS;
2103/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
2104 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2105 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2106 u8 *pu8Temp;
2107 u8 localBuf[6] = "";
2108 u8 *pRetPar;
2109 u8 len = 0;
2110 struct packet_irp_hcievent_data *PPacketIrpEvent;
2111
2112 pu8Temp = (u8 *)&pHciCmd->Data[0];
2113 pBtHciInfo->BTEventMask = *pu8Temp;
2114 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_DETAIL, ("BTEventMask = 0x%"i64fmt"x\n",
2115 pBtHciInfo->BTEventMask));
2116
2117 /* send command complete event here when all data are received. */
2118 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2119
2120 len += bthci_CommandCompleteHeader(&localBuf[0],
2121 OGF_SET_EVENT_MASK_COMMAND,
2122 HCI_SET_EVENT_MASK,
2123 status);
2124
2125 /* Return parameters starts from here */
2126 pRetPar = &PPacketIrpEvent->Data[len];
2127 pRetPar[0] = status; /* status */
2128 len += 1;
2129 PPacketIrpEvent->Length = len;
2130
2131 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2132
2133 return status;
2134}
2135
2136/* 7.3.69 */
2137static enum hci_status
2138bthci_CmdSetEventMaskPage2(
2139 struct rtw_adapter *padapter,
2140 struct packet_irp_hcicmd_data *pHciCmd
2141 )
2142{
2143 enum hci_status status = HCI_STATUS_SUCCESS;
2144 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2145 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2146 u8 *pu8Temp;
2147 u8 localBuf[6] = "";
2148 u8 *pRetPar;
2149 u8 len = 0;
2150 struct packet_irp_hcievent_data *PPacketIrpEvent;
2151
2152 pu8Temp = (u8 *)&pHciCmd->Data[0];
2153 pBtHciInfo->BTEventMaskPage2 = *pu8Temp;
2154 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("BTEventMaskPage2 = 0x%"i64fmt"x\n",
2155 pBtHciInfo->BTEventMaskPage2));
2156
2157 /* send command complete event here when all data are received. */
2158 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2159
2160 len += bthci_CommandCompleteHeader(&localBuf[0],
2161 OGF_SET_EVENT_MASK_COMMAND,
2162 HCI_SET_EVENT_MASK_PAGE_2,
2163 status);
2164
2165 /* Return parameters starts from here */
2166 pRetPar = &PPacketIrpEvent->Data[len];
2167 pRetPar[0] = status; /* status */
2168 len += 1;
2169 PPacketIrpEvent->Length = len;
2170
2171 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2172
2173 return status;
2174}
2175
2176static enum hci_status
2177bthci_CmdReadLocationData(
2178 struct rtw_adapter *padapter,
2179 struct packet_irp_hcicmd_data *pHciCmd
2180 )
2181{
2182 enum hci_status status = HCI_STATUS_SUCCESS;
2183 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2184 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2185 u8 localBuf[12] = "";
2186 u8 *pRetPar;
2187 u8 len = 0;
2188 struct packet_irp_hcievent_data *PPacketIrpEvent;
2189 u16 *pu2Temp;
2190
2191 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2192
2193 len += bthci_CommandCompleteHeader(&localBuf[0],
2194 OGF_SET_EVENT_MASK_COMMAND,
2195 HCI_READ_LOCATION_DATA,
2196 status);
2197 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("DomainAware = 0x%x\n", pBtHciInfo->LocationDomainAware));
2198 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Domain = 0x%x\n", pBtHciInfo->LocationDomain));
2199 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("DomainOptions = 0x%x\n", pBtHciInfo->LocationDomainOptions));
2200 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Options = 0x%x\n", pBtHciInfo->LocationOptions));
2201
2202 /* Return parameters starts from here */
2203 pRetPar = &PPacketIrpEvent->Data[len];
2204 pRetPar[0] = status;
2205
2206 pRetPar[1] = pBtHciInfo->LocationDomainAware; /* 0x0; Location_Domain_Aware */
2207 pu2Temp = (u16 *)&pRetPar[2]; /* Location_Domain */
2208 *pu2Temp = pBtHciInfo->LocationDomain; /* 0x5858; */
2209 pRetPar[4] = pBtHciInfo->LocationDomainOptions; /* 0x58; Location_Domain_Options */
2210 pRetPar[5] = pBtHciInfo->LocationOptions; /* 0x0; Location_Options */
2211 len += 6;
2212 PPacketIrpEvent->Length = len;
2213
2214 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2215 return status;
2216}
2217
2218static enum hci_status
2219bthci_CmdWriteLocationData(
2220 struct rtw_adapter *padapter,
2221 struct packet_irp_hcicmd_data *pHciCmd
2222 )
2223{
2224 enum hci_status status = HCI_STATUS_SUCCESS;
2225 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2226 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2227 u16 *pu2Temp;
2228 u8 localBuf[6] = "";
2229 u8 *pRetPar;
2230 u8 len = 0;
2231 struct packet_irp_hcievent_data *PPacketIrpEvent;
2232
2233 pBtHciInfo->LocationDomainAware = pHciCmd->Data[0];
2234 pu2Temp = (u16 *)&pHciCmd->Data[1];
2235 pBtHciInfo->LocationDomain = *pu2Temp;
2236 pBtHciInfo->LocationDomainOptions = pHciCmd->Data[3];
2237 pBtHciInfo->LocationOptions = pHciCmd->Data[4];
2238 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("DomainAware = 0x%x\n", pBtHciInfo->LocationDomainAware));
2239 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Domain = 0x%x\n", pBtHciInfo->LocationDomain));
2240 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("DomainOptions = 0x%x\n", pBtHciInfo->LocationDomainOptions));
2241 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Options = 0x%x\n", pBtHciInfo->LocationOptions));
2242
2243 /* send command complete event here when all data are received. */
2244 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2245
2246 len += bthci_CommandCompleteHeader(&localBuf[0],
2247 OGF_SET_EVENT_MASK_COMMAND,
2248 HCI_WRITE_LOCATION_DATA,
2249 status);
2250
2251 /* Return parameters starts from here */
2252 pRetPar = &PPacketIrpEvent->Data[len];
2253 pRetPar[0] = status; /* status */
2254 len += 1;
2255 PPacketIrpEvent->Length = len;
2256
2257 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2258
2259 return status;
2260}
2261
2262static enum hci_status
2263bthci_CmdReadFlowControlMode(
2264 struct rtw_adapter *padapter,
2265 struct packet_irp_hcicmd_data *pHciCmd
2266 )
2267{
2268 enum hci_status status = HCI_STATUS_SUCCESS;
2269 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2270 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2271 u8 localBuf[7] = "";
2272 u8 *pRetPar;
2273 u8 len = 0;
2274 struct packet_irp_hcievent_data *PPacketIrpEvent;
2275
2276 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2277
2278 len += bthci_CommandCompleteHeader(&localBuf[0],
2279 OGF_SET_EVENT_MASK_COMMAND,
2280 HCI_READ_FLOW_CONTROL_MODE,
2281 status);
2282
2283 /* Return parameters starts from here */
2284 pRetPar = &PPacketIrpEvent->Data[len];
2285 pRetPar[0] = status;
2286 pRetPar[1] = pBtHciInfo->FlowControlMode; /* Flow Control Mode */
2287 len += 2;
2288 PPacketIrpEvent->Length = len;
2289
2290 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2291 return status;
2292}
2293
2294static enum hci_status
2295bthci_CmdWriteFlowControlMode(
2296 struct rtw_adapter *padapter,
2297 struct packet_irp_hcicmd_data *pHciCmd
2298 )
2299{
2300 enum hci_status status = HCI_STATUS_SUCCESS;
2301 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2302 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2303 u8 localBuf[6] = "";
2304 u8 *pRetPar;
2305 u8 len = 0;
2306 struct packet_irp_hcievent_data *PPacketIrpEvent;
2307
2308 pBtHciInfo->FlowControlMode = pHciCmd->Data[0];
2309
2310 /* send command complete event here when all data are received. */
2311 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2312
2313 len += bthci_CommandCompleteHeader(&localBuf[0],
2314 OGF_SET_EVENT_MASK_COMMAND,
2315 HCI_WRITE_FLOW_CONTROL_MODE,
2316 status);
2317
2318 /* Return parameters starts from here */
2319 pRetPar = &PPacketIrpEvent->Data[len];
2320 pRetPar[0] = status; /* status */
2321 len += 1;
2322 PPacketIrpEvent->Length = len;
2323
2324 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2325
2326 return status;
2327}
2328
2329static enum hci_status
2330bthci_CmdReadBestEffortFlushTimeout(
2331 struct rtw_adapter *padapter,
2332 struct packet_irp_hcicmd_data *pHciCmd
2333 )
2334{
2335 enum hci_status status = HCI_STATUS_SUCCESS;
2336 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
2337 u16 i, j, logicHandle;
2338 u32 BestEffortFlushTimeout = 0xffffffff;
2339 u8 find = 0;
2340
2341 logicHandle = *((u16 *)pHciCmd->Data);
2342 /* find an matched logical link index and copy the data */
2343 for (j = 0; j < MAX_BT_ASOC_ENTRY_NUM; j++) {
2344 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
2345 if (pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].BtLogLinkhandle == logicHandle) {
2346 BestEffortFlushTimeout = pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].BestEffortFlushTimeout;
2347 find = 1;
2348 break;
2349 }
2350 }
2351 }
2352
2353 if (!find)
2354 status = HCI_STATUS_UNKNOW_CONNECT_ID;
2355
2356 {
2357 u8 localBuf[10] = "";
2358 u8 *pRetPar;
2359 u8 len = 0;
2360 struct packet_irp_hcievent_data *PPacketIrpEvent;
2361 u32 *pu4Temp;
2362
2363 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2364
2365 len += bthci_CommandCompleteHeader(&localBuf[0],
2366 OGF_SET_EVENT_MASK_COMMAND,
2367 HCI_READ_BEST_EFFORT_FLUSH_TIMEOUT,
2368 status);
2369
2370 /* Return parameters starts from here */
2371 pRetPar = &PPacketIrpEvent->Data[len];
2372 pRetPar[0] = status;
2373 pu4Temp = (u32 *)&pRetPar[1]; /* Best_Effort_Flush_Timeout */
2374 *pu4Temp = BestEffortFlushTimeout;
2375 len += 5;
2376 PPacketIrpEvent->Length = len;
2377
2378 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2379 }
2380 return status;
2381}
2382
2383static enum hci_status
2384bthci_CmdWriteBestEffortFlushTimeout(
2385 struct rtw_adapter *padapter,
2386 struct packet_irp_hcicmd_data *pHciCmd
2387 )
2388{
2389 enum hci_status status = HCI_STATUS_SUCCESS;
2390 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
2391 u16 i, j, logicHandle;
2392 u32 BestEffortFlushTimeout = 0xffffffff;
2393 u8 find = 0;
2394
2395 logicHandle = *((u16 *)pHciCmd->Data);
2396 BestEffortFlushTimeout = *((u32 *)(pHciCmd->Data+1));
2397
2398 /* find an matched logical link index and copy the data */
2399 for (j = 0; j < MAX_BT_ASOC_ENTRY_NUM; j++) {
2400 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
2401 if (pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].BtLogLinkhandle == logicHandle) {
2402 pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].BestEffortFlushTimeout = BestEffortFlushTimeout;
2403 find = 1;
2404 break;
2405 }
2406 }
2407 }
2408
2409 if (!find)
2410 status = HCI_STATUS_UNKNOW_CONNECT_ID;
2411
2412 {
2413 u8 localBuf[6] = "";
2414 u8 *pRetPar;
2415 u8 len = 0;
2416 struct packet_irp_hcievent_data *PPacketIrpEvent;
2417
2418 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2419
2420 len += bthci_CommandCompleteHeader(&localBuf[0],
2421 OGF_SET_EVENT_MASK_COMMAND,
2422 HCI_WRITE_BEST_EFFORT_FLUSH_TIMEOUT,
2423 status);
2424
2425 /* Return parameters starts from here */
2426 pRetPar = &PPacketIrpEvent->Data[len];
2427 pRetPar[0] = status;
2428 len += 1;
2429 PPacketIrpEvent->Length = len;
2430
2431 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2432 }
2433 return status;
2434}
2435
2436static enum hci_status
2437bthci_CmdShortRangeMode(
2438 struct rtw_adapter *padapter,
2439 struct packet_irp_hcicmd_data *pHciCmd
2440 )
2441{
2442 enum hci_status status = HCI_STATUS_SUCCESS;
2443 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2444 u8 PhyLinkHandle, EntryNum, ShortRangeMode;
2445
2446 PhyLinkHandle = pHciCmd->Data[0];
2447 ShortRangeMode = pHciCmd->Data[1];
2448 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("PLH = 0x%x, Short_Range_Mode = 0x%x\n", PhyLinkHandle, ShortRangeMode));
2449
2450 EntryNum = bthci_GetCurrentEntryNum(padapter, PhyLinkHandle);
2451 if (EntryNum != 0xff) {
2452 pBTInfo->BtAsocEntry[EntryNum].ShortRangeMode = ShortRangeMode;
2453 } else {
2454 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("No such PLH(0x%x)\n", PhyLinkHandle));
2455 status = HCI_STATUS_UNKNOW_CONNECT_ID;
2456 }
2457
2458 bthci_EventCommandStatus(padapter,
2459 OGF_SET_EVENT_MASK_COMMAND,
2460 HCI_SHORT_RANGE_MODE,
2461 status);
2462
2463 bthci_EventShortRangeModeChangeComplete(padapter, status, ShortRangeMode, EntryNum);
2464
2465 return status;
2466}
2467
2468static enum hci_status bthci_CmdReadLocalSupportedCommands(struct rtw_adapter *padapter)
2469{
2470 enum hci_status status = HCI_STATUS_SUCCESS;
2471 u8 localBuf[TmpLocalBufSize] = "";
2472 u8 *pRetPar, *pSupportedCmds;
2473 u8 len = 0;
2474 struct packet_irp_hcievent_data *PPacketIrpEvent;
2475
2476 /* send command complete event here when all data are received. */
2477 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2478 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2479
2480 len += bthci_CommandCompleteHeader(&localBuf[0],
2481 OGF_INFORMATIONAL_PARAMETERS,
2482 HCI_READ_LOCAL_SUPPORTED_COMMANDS,
2483 status);
2484
2485 /* Return parameters starts from here */
2486 pRetPar = &PPacketIrpEvent->Data[len];
2487 pRetPar[0] = status; /* status */
2488 len += 1;
2489 pSupportedCmds = &pRetPar[1];
2490 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[5]= 0xc0\nBit [6]= Set Event Mask, [7]= Reset\n"));
2491 pSupportedCmds[5] = 0xc0;
2492 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[6]= 0x01\nBit [0]= Set Event Filter\n"));
2493 pSupportedCmds[6] = 0x01;
2494 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[7]= 0x0c\nBit [2]= Read Connection Accept Timeout, [3]= Write Connection Accept Timeout\n"));
2495 pSupportedCmds[7] = 0x0c;
2496 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[10]= 0x80\nBit [7]= Host Number Of Completed Packets\n"));
2497 pSupportedCmds[10] = 0x80;
2498 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[11]= 0x03\nBit [0]= Read Link Supervision Timeout, [1]= Write Link Supervision Timeout\n"));
2499 pSupportedCmds[11] = 0x03;
2500 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[14]= 0xa8\nBit [3]= Read Local Version Information, [5]= Read Local Supported Features, [7]= Read Buffer Size\n"));
2501 pSupportedCmds[14] = 0xa8;
2502 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[15]= 0x1c\nBit [2]= Read Failed Contact Count, [3]= Reset Failed Contact Count, [4]= Get Link Quality\n"));
2503 pSupportedCmds[15] = 0x1c;
2504 /* pSupportedCmds[16] = 0x04; */
2505 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[19]= 0x40\nBit [6]= Enhanced Flush\n"));
2506 pSupportedCmds[19] = 0x40;
2507 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[21]= 0xff\nBit [0]= Create Physical Link, [1]= Accept Physical Link, [2]= Disconnect Physical Link, [3]= Create Logical Link\n"));
2508 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), (" [4]= Accept Logical Link, [5]= Disconnect Logical Link, [6]= Logical Link Cancel, [7]= Flow Spec Modify\n"));
2509 pSupportedCmds[21] = 0xff;
2510 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[22]= 0xff\nBit [0]= Read Logical Link Accept Timeout, [1]= Write Logical Link Accept Timeout, [2]= Set Event Mask Page 2, [3]= Read Location Data\n"));
2511 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), (" [4]= Write Location Data, [5]= Read Local AMP Info, [6]= Read Local AMP_ASSOC, [7]= Write Remote AMP_ASSOC\n"));
2512 pSupportedCmds[22] = 0xff;
2513 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[23]= 0x07\nBit [0]= Read Flow Control Mode, [1]= Write Flow Control Mode, [2]= Read Data Block Size\n"));
2514 pSupportedCmds[23] = 0x07;
2515 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD|IOCTL_BT_LOGO), ("Octet[24]= 0x1c\nBit [2]= Read Best Effort Flush Timeout, [3]= Write Best Effort Flush Timeout, [4]= Short Range Mode\n"));
2516 pSupportedCmds[24] = 0x1c;
2517 len += 64;
2518 PPacketIrpEvent->Length = len;
2519
2520 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2521
2522 return status;
2523}
2524
2525static enum hci_status bthci_CmdReadLocalSupportedFeatures(struct rtw_adapter *padapter)
2526{
2527 enum hci_status status = HCI_STATUS_SUCCESS;
2528 u8 localBuf[TmpLocalBufSize] = "";
2529 u8 *pRetPar;
2530 u8 len = 0;
2531 struct packet_irp_hcievent_data *PPacketIrpEvent;
2532
2533 /* send command complete event here when all data are received. */
2534 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2535 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2536
2537 len += bthci_CommandCompleteHeader(&localBuf[0],
2538 OGF_INFORMATIONAL_PARAMETERS,
2539 HCI_READ_LOCAL_SUPPORTED_FEATURES,
2540 status);
2541
2542 /* Return parameters starts from here */
2543 pRetPar = &PPacketIrpEvent->Data[len];
2544 pRetPar[0] = status; /* status */
2545 len += 9;
2546 PPacketIrpEvent->Length = len;
2547
2548 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2549 return status;
2550}
2551
2552static enum hci_status bthci_CmdReadLocalAMPAssoc(struct rtw_adapter *padapter,
2553 struct packet_irp_hcicmd_data *pHciCmd)
2554{
2555 enum hci_status status = HCI_STATUS_SUCCESS;
2556 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2557 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
2558 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
2559 u8 PhyLinkHandle, EntryNum;
2560
2561 pBtDbg->dbgHciInfo.hciCmdCntReadLocalAmpAssoc++;
2562 PhyLinkHandle = *((u8 *)pHciCmd->Data);
2563 EntryNum = bthci_GetCurrentEntryNum(padapter, PhyLinkHandle);
2564
2565 if ((EntryNum == 0xff) && PhyLinkHandle != 0) {
2566 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("ReadLocalAMPAssoc, EntryNum = %d !!!!!, physical link handle = 0x%x\n",
2567 EntryNum, PhyLinkHandle));
2568 status = HCI_STATUS_UNKNOW_CONNECT_ID;
2569 } else if (pBtMgnt->bPhyLinkInProgressStartLL) {
2570 status = HCI_STATUS_UNKNOW_CONNECT_ID;
2571 pBtMgnt->bPhyLinkInProgressStartLL = false;
2572 } else {
2573 pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.BtPhyLinkhandle = *((u8 *)pHciCmd->Data);
2574 pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar = *((u16 *)((u8 *)pHciCmd->Data+1));
2575 pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.MaxRemoteASSOCLen = *((u16 *)((u8 *)pHciCmd->Data+3));
2576 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_DETAIL, ("ReadLocalAMPAssoc, LenSoFar =%d, MaxRemoteASSOCLen =%d\n",
2577 pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar,
2578 pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.MaxRemoteASSOCLen));
2579 }
2580
2581 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("ReadLocalAMPAssoc, EntryNum = %d !!!!!, physical link handle = 0x%x, LengthSoFar = %x \n",
2582 EntryNum, PhyLinkHandle, pBTInfo->BtAsocEntry[EntryNum].AmpAsocCmdData.LenSoFar));
2583
2584 /* send command complete event here when all data are received. */
2585 {
2586 struct packet_irp_hcievent_data *PPacketIrpEvent;
2587
2588 /* PVOID buffer = padapter->IrpHCILocalbuf.Ptr; */
2589 u8 localBuf[TmpLocalBufSize] = "";
2590 u16 *pRemainLen;
2591 u32 totalLen = 0;
2592 u16 typeLen = 0, remainLen = 0, ret_index = 0;
2593 u8 *pRetPar;
2594
2595 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2596 /* PPacketIrpEvent = (struct packet_irp_hcievent_data *)(buffer); */
2597 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2598
2599 totalLen += bthci_CommandCompleteHeader(&localBuf[0],
2600 OGF_STATUS_PARAMETERS,
2601 HCI_READ_LOCAL_AMP_ASSOC,
2602 status);
2603 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("ReadLocalAMPAssoc, Remaining_Len =%d \n", remainLen));
2604 /* Return parameters starts from here */
2605 pRetPar = &PPacketIrpEvent->Data[totalLen];
2606 pRetPar[0] = status; /* status */
2607 pRetPar[1] = *((u8 *)pHciCmd->Data);
2608 pRemainLen = (u16 *)&pRetPar[2]; /* AMP_ASSOC_Remaining_Length */
2609 totalLen += 4; /* 0]~[3] */
2610 ret_index = 4;
2611
2612 typeLen = bthci_AssocMACAddr(padapter, &pRetPar[ret_index]);
2613 totalLen += typeLen;
2614 remainLen += typeLen;
2615 ret_index += typeLen;
2616 typeLen = bthci_AssocPreferredChannelList(padapter, &pRetPar[ret_index], EntryNum);
2617 totalLen += typeLen;
2618 remainLen += typeLen;
2619 ret_index += typeLen;
2620 typeLen = bthci_PALCapabilities(padapter, &pRetPar[ret_index]);
2621 totalLen += typeLen;
2622 remainLen += typeLen;
2623 ret_index += typeLen;
2624 typeLen = bthci_AssocPALVer(padapter, &pRetPar[ret_index]);
2625 totalLen += typeLen;
2626 remainLen += typeLen;
2627 PPacketIrpEvent->Length = (u8)totalLen;
2628 *pRemainLen = remainLen; /* AMP_ASSOC_Remaining_Length */
2629 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("ReadLocalAMPAssoc, Remaining_Len =%d \n", remainLen));
2630 RTPRINT_DATA(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("AMP_ASSOC_fragment : \n"), PPacketIrpEvent->Data, totalLen);
2631
2632 bthci_IndicateEvent(padapter, PPacketIrpEvent, totalLen+2);
2633 }
2634
2635 return status;
2636}
2637
2638static enum hci_status bthci_CmdReadFailedContactCounter(struct rtw_adapter *padapter,
2639 struct packet_irp_hcicmd_data *pHciCmd)
2640{
2641
2642 enum hci_status status = HCI_STATUS_SUCCESS;
2643 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2644 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2645 u8 localBuf[TmpLocalBufSize] = "";
2646 u8 *pRetPar;
2647 u8 len = 0;
2648 struct packet_irp_hcievent_data *PPacketIrpEvent;
2649 u16 handle;
2650
2651 handle = *((u16 *)pHciCmd->Data);
2652 /* send command complete event here when all data are received. */
2653 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2654 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2655
2656 len += bthci_CommandCompleteHeader(&localBuf[0],
2657 OGF_STATUS_PARAMETERS,
2658 HCI_READ_FAILED_CONTACT_COUNTER,
2659 status);
2660
2661 /* Return parameters starts from here */
2662 pRetPar = &PPacketIrpEvent->Data[len];
2663 pRetPar[0] = status; /* status */
2664 pRetPar[1] = TWOBYTE_LOWBYTE(handle);
2665 pRetPar[2] = TWOBYTE_HIGHTBYTE(handle);
2666 pRetPar[3] = TWOBYTE_LOWBYTE(pBtHciInfo->FailContactCount);
2667 pRetPar[4] = TWOBYTE_HIGHTBYTE(pBtHciInfo->FailContactCount);
2668 len += 5;
2669 PPacketIrpEvent->Length = len;
2670
2671 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2672
2673 return status;
2674}
2675
2676static enum hci_status
2677bthci_CmdResetFailedContactCounter(
2678 struct rtw_adapter *padapter,
2679 struct packet_irp_hcicmd_data *pHciCmd
2680 )
2681{
2682 enum hci_status status = HCI_STATUS_SUCCESS;
2683/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
2684 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2685 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
2686 u16 handle;
2687 u8 localBuf[TmpLocalBufSize] = "";
2688 u8 *pRetPar;
2689 u8 len = 0;
2690 struct packet_irp_hcievent_data *PPacketIrpEvent;
2691
2692 handle = *((u16 *)pHciCmd->Data);
2693 pBtHciInfo->FailContactCount = 0;
2694
2695 /* send command complete event here when all data are received. */
2696 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2697 /* PPacketIrpEvent = (struct packet_irp_hcievent_data *)(buffer); */
2698 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2699
2700 len += bthci_CommandCompleteHeader(&localBuf[0],
2701 OGF_STATUS_PARAMETERS,
2702 HCI_RESET_FAILED_CONTACT_COUNTER,
2703 status);
2704
2705 /* Return parameters starts from here */
2706 pRetPar = &PPacketIrpEvent->Data[len];
2707 pRetPar[0] = status; /* status */
2708 pRetPar[1] = TWOBYTE_LOWBYTE(handle);
2709 pRetPar[2] = TWOBYTE_HIGHTBYTE(handle);
2710 len += 3;
2711 PPacketIrpEvent->Length = len;
2712
2713 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2714 return status;
2715}
2716
2717/* */
2718/* BT 3.0+HS [Vol 2] 7.4.1 */
2719/* */
2720static enum hci_status
2721bthci_CmdReadLocalVersionInformation(
2722 struct rtw_adapter *padapter
2723 )
2724{
2725 enum hci_status status = HCI_STATUS_SUCCESS;
2726 /* send command complete event here when all data are received. */
2727 u8 localBuf[TmpLocalBufSize] = "";
2728 u8 *pRetPar;
2729 u8 len = 0;
2730 struct packet_irp_hcievent_data *PPacketIrpEvent;
2731 u16 *pu2Temp;
2732
2733 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2734 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2735
2736 len += bthci_CommandCompleteHeader(&localBuf[0],
2737 OGF_INFORMATIONAL_PARAMETERS,
2738 HCI_READ_LOCAL_VERSION_INFORMATION,
2739 status);
2740
2741 /* Return parameters starts from here */
2742 pRetPar = &PPacketIrpEvent->Data[len];
2743 pRetPar[0] = status; /* status */
2744 pRetPar[1] = 0x05; /* HCI_Version */
2745 pu2Temp = (u16 *)&pRetPar[2]; /* HCI_Revision */
2746 *pu2Temp = 0x0001;
2747 pRetPar[4] = 0x05; /* LMP/PAL_Version */
2748 pu2Temp = (u16 *)&pRetPar[5]; /* Manufacturer_Name */
2749 *pu2Temp = 0x005d;
2750 pu2Temp = (u16 *)&pRetPar[7]; /* LMP/PAL_Subversion */
2751 *pu2Temp = 0x0001;
2752 len += 9;
2753 PPacketIrpEvent->Length = len;
2754
2755 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("LOCAL_VERSION_INFORMATION\n"));
2756 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("Status %x\n", status));
2757 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("HCI_Version = 0x05\n"));
2758 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("HCI_Revision = 0x0001\n"));
2759 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("LMP/PAL_Version = 0x05\n"));
2760 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("Manufacturer_Name = 0x0001\n"));
2761 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("LMP/PAL_Subversion = 0x0001\n"));
2762
2763 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2764
2765 return status;
2766}
2767
2768/* 7.4.7 */
2769static enum hci_status bthci_CmdReadDataBlockSize(struct rtw_adapter *padapter)
2770{
2771 enum hci_status status = HCI_STATUS_SUCCESS;
2772 u8 localBuf[TmpLocalBufSize] = "";
2773 u8 *pRetPar;
2774 u8 len = 0;
2775 struct packet_irp_hcievent_data *PPacketIrpEvent;
2776 u16 *pu2Temp;
2777
2778 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2779 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2780
2781 len += bthci_CommandCompleteHeader(&localBuf[0],
2782 OGF_INFORMATIONAL_PARAMETERS,
2783 HCI_READ_DATA_BLOCK_SIZE,
2784 status);
2785
2786 /* Return parameters starts from here */
2787 pRetPar = &PPacketIrpEvent->Data[len];
2788 pRetPar[0] = HCI_STATUS_SUCCESS; /* status */
2789 pu2Temp = (u16 *)&pRetPar[1]; /* Max_ACL_Data_Packet_Length */
2790 *pu2Temp = Max80211PALPDUSize;
2791
2792 pu2Temp = (u16 *)&pRetPar[3]; /* Data_Block_Length */
2793 *pu2Temp = Max80211PALPDUSize;
2794 pu2Temp = (u16 *)&pRetPar[5]; /* Total_Num_Data_Blocks */
2795 *pu2Temp = BTTotalDataBlockNum;
2796 len += 7;
2797 PPacketIrpEvent->Length = len;
2798
2799 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2800
2801 return status;
2802}
2803
2804/* 7.4.5 */
2805static enum hci_status bthci_CmdReadBufferSize(struct rtw_adapter *padapter)
2806{
2807 enum hci_status status = HCI_STATUS_SUCCESS;
2808 u8 localBuf[TmpLocalBufSize] = "";
2809 u8 *pRetPar;
2810 u8 len = 0;
2811 struct packet_irp_hcievent_data *PPacketIrpEvent;
2812 u16 *pu2Temp;
2813
2814 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2815 /* PPacketIrpEvent = (struct packet_irp_hcievent_data *)(buffer); */
2816 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2817
2818 len += bthci_CommandCompleteHeader(&localBuf[0],
2819 OGF_INFORMATIONAL_PARAMETERS,
2820 HCI_READ_BUFFER_SIZE,
2821 status);
2822 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Synchronous_Data_Packet_Length = 0x%x\n", BTSynDataPacketLength));
2823 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Total_Num_ACL_Data_Packets = 0x%x\n", BTTotalDataBlockNum));
2824 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("Total_Num_Synchronous_Data_Packets = 0x%x\n", BTTotalDataBlockNum));
2825 /* Return parameters starts from here */
2826 pRetPar = &PPacketIrpEvent->Data[len];
2827 pRetPar[0] = status; /* status */
2828 pu2Temp = (u16 *)&pRetPar[1]; /* HC_ACL_Data_Packet_Length */
2829 *pu2Temp = Max80211PALPDUSize;
2830
2831 pRetPar[3] = BTSynDataPacketLength; /* HC_Synchronous_Data_Packet_Length */
2832 pu2Temp = (u16 *)&pRetPar[4]; /* HC_Total_Num_ACL_Data_Packets */
2833 *pu2Temp = BTTotalDataBlockNum;
2834 pu2Temp = (u16 *)&pRetPar[6]; /* HC_Total_Num_Synchronous_Data_Packets */
2835 *pu2Temp = BTTotalDataBlockNum;
2836 len += 8;
2837 PPacketIrpEvent->Length = len;
2838
2839 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2840
2841 return status;
2842}
2843
2844static enum hci_status bthci_CmdReadLocalAMPInfo(struct rtw_adapter *padapter)
2845{
2846 enum hci_status status = HCI_STATUS_SUCCESS;
2847 struct pwrctrl_priv *ppwrctrl = &padapter->pwrctrlpriv;
2848 u8 localBuf[TmpLocalBufSize] = "";
2849 u8 *pRetPar;
2850 u8 len = 0;
2851 struct packet_irp_hcievent_data *PPacketIrpEvent;
2852 u16 *pu2Temp;
2853 u32 *pu4Temp;
2854 u32 TotalBandwidth = BTTOTALBANDWIDTH, MaxBandGUBandwidth = BTMAXBANDGUBANDWIDTH;
2855 u8 ControlType = 0x01, AmpStatus = 0x01;
2856 u32 MaxFlushTimeout = 10000, BestEffortFlushTimeout = 5000;
2857 u16 MaxPDUSize = Max80211PALPDUSize, PalCap = 0x1, AmpAssocLen = Max80211AMPASSOCLen, MinLatency = 20;
2858
2859 if ((ppwrctrl->rfoff_reason & RF_CHANGE_BY_HW) ||
2860 (ppwrctrl->rfoff_reason & RF_CHANGE_BY_SW)) {
2861 AmpStatus = AMP_STATUS_NO_CAPACITY_FOR_BT;
2862 }
2863
2864 PlatformZeroMemory(&localBuf[0], TmpLocalBufSize);
2865 /* PPacketIrpEvent = (struct packet_irp_hcievent_data *)(buffer); */
2866 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2867
2868 len += bthci_CommandCompleteHeader(&localBuf[0],
2869 OGF_STATUS_PARAMETERS,
2870 HCI_READ_LOCAL_AMP_INFO,
2871 status);
2872
2873 /* Return parameters starts from here */
2874 pRetPar = &PPacketIrpEvent->Data[len];
2875 pRetPar[0] = status; /* status */
2876 pRetPar[1] = AmpStatus; /* AMP_Status */
2877 pu4Temp = (u32 *)&pRetPar[2]; /* Total_Bandwidth */
2878 *pu4Temp = TotalBandwidth; /* 0x19bfcc00;0x7530; */
2879 pu4Temp = (u32 *)&pRetPar[6]; /* Max_Guaranteed_Bandwidth */
2880 *pu4Temp = MaxBandGUBandwidth; /* 0x19bfcc00;0x4e20; */
2881 pu4Temp = (u32 *)&pRetPar[10]; /* Min_Latency */
2882 *pu4Temp = MinLatency; /* 150; */
2883 pu4Temp = (u32 *)&pRetPar[14]; /* Max_PDU_Size */
2884 *pu4Temp = MaxPDUSize;
2885 pRetPar[18] = ControlType; /* Controller_Type */
2886 pu2Temp = (u16 *)&pRetPar[19]; /* PAL_Capabilities */
2887 *pu2Temp = PalCap;
2888 pu2Temp = (u16 *)&pRetPar[21]; /* AMP_ASSOC_Length */
2889 *pu2Temp = AmpAssocLen;
2890 pu4Temp = (u32 *)&pRetPar[23]; /* Max_Flush_Timeout */
2891 *pu4Temp = MaxFlushTimeout;
2892 pu4Temp = (u32 *)&pRetPar[27]; /* Best_Effort_Flush_Timeout */
2893 *pu4Temp = BestEffortFlushTimeout;
2894 len += 31;
2895 PPacketIrpEvent->Length = len;
2896 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("AmpStatus = 0x%x\n",
2897 AmpStatus));
2898 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("TotalBandwidth = 0x%x, MaxBandGUBandwidth = 0x%x, MinLatency = 0x%x, \n MaxPDUSize = 0x%x, ControlType = 0x%x\n",
2899 TotalBandwidth, MaxBandGUBandwidth, MinLatency, MaxPDUSize, ControlType));
2900 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("PalCap = 0x%x, AmpAssocLen = 0x%x, MaxFlushTimeout = 0x%x, BestEffortFlushTimeout = 0x%x\n",
2901 PalCap, AmpAssocLen, MaxFlushTimeout, BestEffortFlushTimeout));
2902 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2903 return status;
2904}
2905
2906static enum hci_status
2907bthci_CmdCreatePhysicalLink(
2908 struct rtw_adapter *padapter,
2909 struct packet_irp_hcicmd_data *pHciCmd
2910 )
2911{
2912 enum hci_status status;
2913 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2914 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
2915
2916 pBtDbg->dbgHciInfo.hciCmdCntCreatePhyLink++;
2917
2918 status = bthci_BuildPhysicalLink(padapter,
2919 pHciCmd, HCI_CREATE_PHYSICAL_LINK);
2920
2921 return status;
2922}
2923
2924static enum hci_status
2925bthci_CmdReadLinkQuality(
2926 struct rtw_adapter *padapter,
2927 struct packet_irp_hcicmd_data *pHciCmd
2928 )
2929{
2930 enum hci_status status = HCI_STATUS_SUCCESS;
2931 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2932 u16 PLH;
2933 u8 EntryNum, LinkQuality = 0x55;
2934
2935 PLH = *((u16 *)&pHciCmd->Data[0]);
2936 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("PLH = 0x%x\n", PLH));
2937
2938 EntryNum = bthci_GetCurrentEntryNum(padapter, (u8)PLH);
2939 if (EntryNum == 0xff) {
2940 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("No such PLH(0x%x)\n", PLH));
2941 status = HCI_STATUS_UNKNOW_CONNECT_ID;
2942 }
2943
2944 {
2945 u8 localBuf[11] = "";
2946 u8 *pRetPar;
2947 u8 len = 0;
2948 struct packet_irp_hcievent_data *PPacketIrpEvent;
2949
2950 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
2951
2952 len += bthci_CommandCompleteHeader(&localBuf[0],
2953 OGF_STATUS_PARAMETERS,
2954 HCI_READ_LINK_QUALITY,
2955 status);
2956
2957 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, (" PLH = 0x%x\n Link Quality = 0x%x\n", PLH, LinkQuality));
2958
2959 /* Return parameters starts from here */
2960 pRetPar = &PPacketIrpEvent->Data[len];
2961 pRetPar[0] = status; /* status */
2962 *((u16 *)&pRetPar[1]) = pBTInfo->BtAsocEntry[EntryNum].PhyLinkCmdData.BtPhyLinkhandle; /* Handle */
2963 pRetPar[3] = 0x55; /* Link Quailty */
2964 len += 4;
2965 PPacketIrpEvent->Length = len;
2966
2967 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
2968 }
2969
2970 return status;
2971}
2972
f7c92d2c
LF		 2973static enum hci_status
2974bthci_CmdCreateLogicalLink(
2975 struct rtw_adapter *padapter,
2976 struct packet_irp_hcicmd_data *pHciCmd
2977 )
2978{
f7c92d2c
LF		 2979 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2980 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
2981
2982 pBtDbg->dbgHciInfo.hciCmdCntCreateLogLink++;
2983
2984 bthci_BuildLogicalLink(padapter, pHciCmd,
2985 HCI_CREATE_LOGICAL_LINK);
2986
147e45d9 2987 return HCI_STATUS_SUCCESS;
f7c92d2c
LF		 2988}
2989
2990static enum hci_status
2991bthci_CmdAcceptLogicalLink(
2992 struct rtw_adapter *padapter,
2993 struct packet_irp_hcicmd_data *pHciCmd
2994 )
2995{
f7c92d2c
LF		 2996 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
2997 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
2998
2999 pBtDbg->dbgHciInfo.hciCmdCntAcceptLogLink++;
3000
3001 bthci_BuildLogicalLink(padapter, pHciCmd,
3002 HCI_ACCEPT_LOGICAL_LINK);
3003
147e45d9 3004 return HCI_STATUS_SUCCESS;
f7c92d2c
LF		 3005}
3006
3007static enum hci_status
3008bthci_CmdDisconnectLogicalLink(
3009 struct rtw_adapter *padapter,
3010 struct packet_irp_hcicmd_data *pHciCmd
3011 )
3012{
3013 enum hci_status status = HCI_STATUS_SUCCESS;
3014/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
3015 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
3016 struct bt_mgnt *pBtMgnt = &pBTinfo->BtMgnt;
3017 struct bt_dgb *pBtDbg = &pBTinfo->BtDbg;
3018 u16 logicHandle;
3019 u8 i, j, find = 0, LogLinkCount = 0;
3020
3021 pBtDbg->dbgHciInfo.hciCmdCntDisconnectLogLink++;
3022
3023 logicHandle = *((u16 *)pHciCmd->Data);
3024 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("DisconnectLogicalLink, logicHandle = 0x%x\n", logicHandle));
3025
3026 /* find an created logical link index and clear the data */
3027 for (j = 0; j < MAX_BT_ASOC_ENTRY_NUM; j++) {
3028 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
3029 if (pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].BtLogLinkhandle == logicHandle) {
3030 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("DisconnectLogicalLink, logicHandle is matched 0x%x\n", logicHandle));
3031 bthci_ResetFlowSpec(padapter, j, i);
3032 find = 1;
3033 pBtMgnt->DisconnectEntryNum = j;
3034 break;
3035 }
3036 }
3037 }
3038
3039 if (!find)
3040 status = HCI_STATUS_UNKNOW_CONNECT_ID;
3041
3042 /* To check each */
3043 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
3044 if (pBTinfo->BtAsocEntry[pBtMgnt->DisconnectEntryNum].LogLinkCmdData[i].BtLogLinkhandle != 0)
3045 LogLinkCount++;
3046 }
3047
3048 /* When we receive Create logical link command, we should send command status event first. */
3049 bthci_EventCommandStatus(padapter,
3050 LINK_CONTROL_COMMANDS,
3051 HCI_DISCONNECT_LOGICAL_LINK,
3052 status);
3053 /* */
3054 /* When we determines the logical link is established, we should send command complete event. */
3055 /* */
3056 if (status == HCI_STATUS_SUCCESS) {
3057 bthci_EventDisconnectLogicalLinkComplete(padapter, status,
3058 logicHandle, HCI_STATUS_CONNECT_TERMINATE_LOCAL_HOST);
3059 }
3060
3061 if (LogLinkCount == 0)
3062 mod_timer(&pBTinfo->BTDisconnectPhyLinkTimer,
3063 jiffies + msecs_to_jiffies(100));
3064
3065 return status;
3066}
3067
3068static enum hci_status
3069bthci_CmdLogicalLinkCancel(struct rtw_adapter *padapter,
3070 struct packet_irp_hcicmd_data *pHciCmd)
3071{
3072 enum hci_status status = HCI_STATUS_SUCCESS;
3073 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
3074 struct bt_mgnt *pBtMgnt = &pBTinfo->BtMgnt;
3075 u8 CurrentEntryNum, CurrentLogEntryNum;
3076
3077 u8 physicalLinkHandle, TxFlowSpecID, i;
3078 u16 CurrentLogicalHandle;
3079
3080 physicalLinkHandle = *((u8 *)pHciCmd->Data);
3081 TxFlowSpecID = *(((u8 *)pHciCmd->Data)+1);
3082
3083 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("LogicalLinkCancel, physicalLinkHandle = 0x%x, TxFlowSpecID = 0x%x\n",
3084 physicalLinkHandle, TxFlowSpecID));
3085
3086 CurrentEntryNum = pBtMgnt->CurrentConnectEntryNum;
3087 CurrentLogicalHandle = pBtMgnt->BtCurrentLogLinkhandle;
3088
3089 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("CurrentEntryNum = 0x%x, CurrentLogicalHandle = 0x%x\n",
3090 CurrentEntryNum, CurrentLogicalHandle));
3091
3092 CurrentLogEntryNum = 0xff;
3093 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
3094 if ((CurrentLogicalHandle == pBTinfo->BtAsocEntry[CurrentEntryNum].LogLinkCmdData[i].BtLogLinkhandle) &&
3095 (physicalLinkHandle == pBTinfo->BtAsocEntry[CurrentEntryNum].LogLinkCmdData[i].BtPhyLinkhandle)) {
3096 CurrentLogEntryNum = i;
3097 break;
3098 }
3099 }
3100
3101 if (CurrentLogEntryNum == 0xff) {
3102 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("LogicalLinkCancel, CurrentLogEntryNum == 0xff !!!!\n"));
3103 status = HCI_STATUS_UNKNOW_CONNECT_ID;
3104 return status;
3105 } else {
3106 if (pBTinfo->BtAsocEntry[CurrentEntryNum].LogLinkCmdData[CurrentLogEntryNum].bLLCompleteEventIsSet) {
3107 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("LogicalLinkCancel, LLCompleteEventIsSet!!!!\n"));
3108 status = HCI_STATUS_ACL_CONNECT_EXISTS;
3109 }
3110 }
3111
3112 {
3113 u8 localBuf[8] = "";
3114 u8 *pRetPar;
3115 u8 len = 0;
3116 struct packet_irp_hcievent_data *PPacketIrpEvent;
3117
3118 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3119
3120 len += bthci_CommandCompleteHeader(&localBuf[0],
3121 LINK_CONTROL_COMMANDS,
3122 HCI_LOGICAL_LINK_CANCEL,
3123 status);
3124
3125 /* Return parameters starts from here */
3126 pRetPar = &PPacketIrpEvent->Data[len];
3127 pRetPar[0] = status; /* status */
3128 pRetPar[1] = pBTinfo->BtAsocEntry[CurrentEntryNum].LogLinkCmdData[CurrentLogEntryNum].BtPhyLinkhandle;
3129 pRetPar[2] = pBTinfo->BtAsocEntry[CurrentEntryNum].LogLinkCmdData[CurrentLogEntryNum].BtTxFlowSpecID;
3130 len += 3;
3131 PPacketIrpEvent->Length = len;
3132
3133 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3134 }
3135
3136 pBTinfo->BtAsocEntry[CurrentEntryNum].LogLinkCmdData[CurrentLogEntryNum].bLLCancelCMDIsSetandComplete = true;
3137
3138 return status;
3139}
3140
3141static enum hci_status
3142bthci_CmdFlowSpecModify(struct rtw_adapter *padapter,
3143 struct packet_irp_hcicmd_data *pHciCmd)
3144{
3145 enum hci_status status = HCI_STATUS_SUCCESS;
3146/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
3147 struct bt_30info *pBTinfo = GET_BT_INFO(padapter);
3148 u8 i, j, find = 0;
3149 u16 logicHandle;
3150
3151 logicHandle = *((u16 *)pHciCmd->Data);
3152 /* find an matched logical link index and copy the data */
3153 for (j = 0; j < MAX_BT_ASOC_ENTRY_NUM; j++) {
3154 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
3155 if (pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].BtLogLinkhandle == logicHandle) {
3156 memcpy(&pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].Tx_Flow_Spec,
3157 &pHciCmd->Data[2], sizeof(struct hci_flow_spec));
3158 memcpy(&pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].Rx_Flow_Spec,
3159 &pHciCmd->Data[18], sizeof(struct hci_flow_spec));
3160
3161 bthci_CheckLogLinkBehavior(padapter, pBTinfo->BtAsocEntry[j].LogLinkCmdData[i].Tx_Flow_Spec);
3162 find = 1;
3163 break;
3164 }
3165 }
3166 }
3167 RTPRINT(FIOCTL, IOCTL_BT_LOGO, ("FlowSpecModify, LLH = 0x%x, \n", logicHandle));
3168
3169 /* When we receive Flow Spec Modify command, we should send command status event first. */
3170 bthci_EventCommandStatus(padapter,
3171 LINK_CONTROL_COMMANDS,
3172 HCI_FLOW_SPEC_MODIFY,
3173 HCI_STATUS_SUCCESS);
3174
3175 if (!find)
3176 status = HCI_STATUS_UNKNOW_CONNECT_ID;
3177
3178 bthci_EventSendFlowSpecModifyComplete(padapter, status, logicHandle);
3179
3180 return status;
3181}
3182
3183static enum hci_status
3184bthci_CmdAcceptPhysicalLink(struct rtw_adapter *padapter,
3185 struct packet_irp_hcicmd_data *pHciCmd)
3186{
3187 enum hci_status status;
3188 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3189 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
3190
3191 pBtDbg->dbgHciInfo.hciCmdCntAcceptPhyLink++;
3192
3193 status = bthci_BuildPhysicalLink(padapter,
3194 pHciCmd, HCI_ACCEPT_PHYSICAL_LINK);
3195
3196 return status;
3197}
3198
3199static enum hci_status
3200bthci_CmdDisconnectPhysicalLink(struct rtw_adapter *padapter,
3201 struct packet_irp_hcicmd_data *pHciCmd)
3202{
3203 enum hci_status status = HCI_STATUS_SUCCESS;
3204 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3205 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
3206 u8 PLH, CurrentEntryNum, PhysLinkDisconnectReason;
3207
3208 pBtDbg->dbgHciInfo.hciCmdCntDisconnectPhyLink++;
3209
3210 PLH = *((u8 *)pHciCmd->Data);
acc4b97b 3211 PhysLinkDisconnectReason = *((u8 *)pHciCmd->Data+1);
f7c92d2c
LF		 3212 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_DISCONNECT_PHYSICAL_LINK PhyHandle = 0x%x, Reason = 0x%x\n",
3213 PLH, PhysLinkDisconnectReason));
3214
3215 CurrentEntryNum = bthci_GetCurrentEntryNum(padapter, PLH);
3216
3217 if (CurrentEntryNum == 0xff) {
3218 RTPRINT(FIOCTL, IOCTL_BT_HCICMD,
3219 ("DisconnectPhysicalLink, No such Handle in the Entry\n"));
3220 status = HCI_STATUS_UNKNOW_CONNECT_ID;
3221 } else {
3222 pBTInfo->BtAsocEntry[CurrentEntryNum].PhyLinkDisconnectReason =
3223 (enum hci_status)PhysLinkDisconnectReason;
3224 }
3225 /* Send HCI Command status event to AMP. */
3226 bthci_EventCommandStatus(padapter, LINK_CONTROL_COMMANDS,
3227 HCI_DISCONNECT_PHYSICAL_LINK, status);
3228
3229 if (status != HCI_STATUS_SUCCESS)
3230 return status;
3231
3232 /* The macros below require { and } in the if statement */
3233 if (pBTInfo->BtAsocEntry[CurrentEntryNum].BtCurrentState == HCI_STATE_DISCONNECTED) {
3234 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTED, STATE_CMD_DISCONNECT_PHY_LINK, CurrentEntryNum);
3235 } else {
3236 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTING, STATE_CMD_DISCONNECT_PHY_LINK, CurrentEntryNum);
3237 }
3238 return status;
3239}
3240
3241static enum hci_status
3242bthci_CmdSetACLLinkDataFlowMode(struct rtw_adapter *padapter,
3243 struct packet_irp_hcicmd_data *pHciCmd)
3244{
3245 enum hci_status status = HCI_STATUS_SUCCESS;
3246 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3247 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3248 u8 localBuf[8] = "";
3249 u8 *pRetPar;
3250 u8 len = 0;
3251 struct packet_irp_hcievent_data *PPacketIrpEvent;
3252 u16 *pu2Temp;
3253
3254 pBtMgnt->ExtConfig.CurrentConnectHandle = *((u16 *)pHciCmd->Data);
3255 pBtMgnt->ExtConfig.CurrentIncomingTrafficMode = *((u8 *)pHciCmd->Data)+2;
3256 pBtMgnt->ExtConfig.CurrentOutgoingTrafficMode = *((u8 *)pHciCmd->Data)+3;
3257 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("Connection Handle = 0x%x, Incoming Traffic mode = 0x%x, Outgoing Traffic mode = 0x%x",
3258 pBtMgnt->ExtConfig.CurrentConnectHandle,
3259 pBtMgnt->ExtConfig.CurrentIncomingTrafficMode,
3260 pBtMgnt->ExtConfig.CurrentOutgoingTrafficMode));
3261
3262
3263 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3264
3265 len += bthci_CommandCompleteHeader(&localBuf[0],
3266 OGF_EXTENSION,
3267 HCI_SET_ACL_LINK_DATA_FLOW_MODE,
3268 status);
3269
3270 /* Return parameters starts from here */
3271 pRetPar = &PPacketIrpEvent->Data[len];
3272 pRetPar[0] = status; /* status */
3273
3274 pu2Temp = (u16 *)&pRetPar[1];
3275 *pu2Temp = pBtMgnt->ExtConfig.CurrentConnectHandle;
3276 len += 3;
3277 PPacketIrpEvent->Length = len;
3278
3279 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3280 return status;
3281}
3282
3283static enum hci_status
3284bthci_CmdSetACLLinkStatus(struct rtw_adapter *padapter,
3285 struct packet_irp_hcicmd_data *pHciCmd)
3286{
3287 enum hci_status status = HCI_STATUS_SUCCESS;
3288 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3289 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3290 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
3291 u8 i;
3292 u8 *pTriple;
3293
3294 pBtDbg->dbgHciInfo.hciCmdCntSetAclLinkStatus++;
3295 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "SetACLLinkStatus, Hex Data :\n",
3296 &pHciCmd->Data[0], pHciCmd->Length);
3297
3298 /* Only Core Stack v251 and later version support this command. */
3299 pBtMgnt->bSupportProfile = true;
3300
3301 pBtMgnt->ExtConfig.NumberOfHandle = *((u8 *)pHciCmd->Data);
3302 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("NumberOfHandle = 0x%x\n", pBtMgnt->ExtConfig.NumberOfHandle));
3303
3304 pTriple = &pHciCmd->Data[1];
3305 for (i = 0; i < pBtMgnt->ExtConfig.NumberOfHandle; i++) {
3306 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle = *((u16 *)&pTriple[0]);
3307 pBtMgnt->ExtConfig.linkInfo[i].IncomingTrafficMode = pTriple[2];
3308 pBtMgnt->ExtConfig.linkInfo[i].OutgoingTrafficMode = pTriple[3];
3309 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT,
3310 ("Connection_Handle = 0x%x, Incoming Traffic mode = 0x%x, Outgoing Traffic Mode = 0x%x\n",
3311 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle,
3312 pBtMgnt->ExtConfig.linkInfo[i].IncomingTrafficMode,
3313 pBtMgnt->ExtConfig.linkInfo[i].OutgoingTrafficMode));
3314 pTriple += 4;
3315 }
3316
3317 {
3318 u8 localBuf[6] = "";
3319 u8 *pRetPar;
3320 u8 len = 0;
3321 struct packet_irp_hcievent_data *PPacketIrpEvent;
3322
3323 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3324
3325 len += bthci_CommandCompleteHeader(&localBuf[0],
3326 OGF_EXTENSION,
3327 HCI_SET_ACL_LINK_STATUS,
3328 status);
3329
3330 /* Return parameters starts from here */
3331 pRetPar = &PPacketIrpEvent->Data[len];
3332 pRetPar[0] = status; /* status */
3333
3334 len += 1;
3335 PPacketIrpEvent->Length = len;
3336
3337 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3338 }
3339
3340 return status;
3341}
3342
3343static enum hci_status
3344bthci_CmdSetSCOLinkStatus(
3345 struct rtw_adapter *padapter,
3346 struct packet_irp_hcicmd_data *pHciCmd
3347 )
3348{
3349 enum hci_status status = HCI_STATUS_SUCCESS;
3350 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3351 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3352 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
3353
3354 pBtDbg->dbgHciInfo.hciCmdCntSetScoLinkStatus++;
3355 pBtMgnt->ExtConfig.NumberOfSCO = *((u8 *)pHciCmd->Data);
3356 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("NumberOfSCO = 0x%x\n",
3357 pBtMgnt->ExtConfig.NumberOfSCO));
3358
3359 {
3360 u8 localBuf[6] = "";
3361 u8 *pRetPar;
3362 u8 len = 0;
3363 struct packet_irp_hcievent_data *PPacketIrpEvent;
3364
3365 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3366
3367 len += bthci_CommandCompleteHeader(&localBuf[0],
3368 OGF_EXTENSION,
3369 HCI_SET_SCO_LINK_STATUS,
3370 status);
3371
3372 /* Return parameters starts from here */
3373 pRetPar = &PPacketIrpEvent->Data[len];
3374 pRetPar[0] = status; /* status */
3375
3376 len += 1;
3377 PPacketIrpEvent->Length = len;
3378
3379 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3380 }
3381
3382 return status;
3383}
3384
3385static enum hci_status
3386bthci_CmdSetRSSIValue(
3387 struct rtw_adapter *padapter,
3388 struct packet_irp_hcicmd_data *pHciCmd
3389 )
3390{
3391 enum hci_status status = HCI_STATUS_SUCCESS;
3392 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3393 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3394 s8 min_bt_rssi = 0;
3395 u8 i;
3396 for (i = 0; i < pBtMgnt->ExtConfig.NumberOfHandle; i++) {
3397 if (pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle == *((u16 *)&pHciCmd->Data[0])) {
3398 pBtMgnt->ExtConfig.linkInfo[i].BT_RSSI = (s8)(pHciCmd->Data[2]);
3399 RTPRINT(FIOCTL, IOCTL_BT_EVENT_PERIODICAL,
3400 ("Connection_Handle = 0x%x, RSSI = %d \n",
3401 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle,
3402 pBtMgnt->ExtConfig.linkInfo[i].BT_RSSI));
3403 }
3404 /* get the minimum bt rssi value */
3405 if (pBtMgnt->ExtConfig.linkInfo[i].BT_RSSI <= min_bt_rssi)
3406 min_bt_rssi = pBtMgnt->ExtConfig.linkInfo[i].BT_RSSI;
3407 }
3408
3409 pBtMgnt->ExtConfig.MIN_BT_RSSI = min_bt_rssi;
3410 RTPRINT(FBT, BT_TRACE, ("[bt rssi], the min rssi is %d\n", min_bt_rssi));
3411
3412 {
3413 u8 localBuf[6] = "";
3414 u8 *pRetPar;
3415 u8 len = 0;
3416 struct packet_irp_hcievent_data *PPacketIrpEvent;
3417
3418 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3419
3420 len += bthci_CommandCompleteHeader(&localBuf[0],
3421 OGF_EXTENSION,
3422 HCI_SET_RSSI_VALUE,
3423 status);
3424
3425 /* Return parameters starts from here */
3426 pRetPar = &PPacketIrpEvent->Data[len];
3427 pRetPar[0] = status; /* status */
3428
3429 len += 1;
3430 PPacketIrpEvent->Length = len;
3431
3432 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3433 }
3434
3435 return status;
3436}
3437
3438static enum hci_status
3439bthci_CmdSetCurrentBluetoothStatus(
3440 struct rtw_adapter *padapter,
3441 struct packet_irp_hcicmd_data *pHciCmd
3442 )
3443{
3444 enum hci_status status = HCI_STATUS_SUCCESS;
3445/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
3446 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3447 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3448
3449 pBtMgnt->ExtConfig.CurrentBTStatus = *((u8 *)&pHciCmd->Data[0]);
3450 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("SetCurrentBluetoothStatus, CurrentBTStatus = 0x%x\n",
3451 pBtMgnt->ExtConfig.CurrentBTStatus));
3452
3453 {
3454 u8 localBuf[6] = "";
3455 u8 *pRetPar;
3456 u8 len = 0;
3457 struct packet_irp_hcievent_data *PPacketIrpEvent;
3458
3459 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3460
3461 len += bthci_CommandCompleteHeader(&localBuf[0],
3462 OGF_EXTENSION,
3463 HCI_SET_CURRENT_BLUETOOTH_STATUS,
3464 status);
3465
3466 /* Return parameters starts from here */
3467 pRetPar = &PPacketIrpEvent->Data[len];
3468 pRetPar[0] = status; /* status */
3469 len += 1;
3470
3471 PPacketIrpEvent->Length = len;
3472
3473 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3474 }
3475
3476 return status;
3477}
3478
3479static enum hci_status
3480bthci_CmdExtensionVersionNotify(
3481 struct rtw_adapter *padapter,
3482 struct packet_irp_hcicmd_data *pHciCmd
3483 )
3484{
3485 enum hci_status status = HCI_STATUS_SUCCESS;
3486 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3487 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3488 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
3489
3490 pBtDbg->dbgHciInfo.hciCmdCntExtensionVersionNotify++;
3491 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "ExtensionVersionNotify, Hex Data :\n",
3492 &pHciCmd->Data[0], pHciCmd->Length);
3493
3494 pBtMgnt->ExtConfig.HCIExtensionVer = *((u16 *)&pHciCmd->Data[0]);
3495 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCIExtensionVer = 0x%x\n", pBtMgnt->ExtConfig.HCIExtensionVer));
3496
3497 {
3498 u8 localBuf[6] = "";
3499 u8 *pRetPar;
3500 u8 len = 0;
3501 struct packet_irp_hcievent_data *PPacketIrpEvent;
3502
3503 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3504
3505 len += bthci_CommandCompleteHeader(&localBuf[0],
3506 OGF_EXTENSION,
3507 HCI_EXTENSION_VERSION_NOTIFY,
3508 status);
3509
3510 /* Return parameters starts from here */
3511 pRetPar = &PPacketIrpEvent->Data[len];
3512 pRetPar[0] = status; /* status */
3513
3514 len += 1;
3515 PPacketIrpEvent->Length = len;
3516
3517 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3518 }
3519
3520 return status;
3521}
3522
3523static enum hci_status
3524bthci_CmdLinkStatusNotify(
3525 struct rtw_adapter *padapter,
3526 struct packet_irp_hcicmd_data *pHciCmd
3527 )
3528{
3529 enum hci_status status = HCI_STATUS_SUCCESS;
3530 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3531 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3532 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
3533 u8 i;
3534 u8 *pTriple;
3535
3536 pBtDbg->dbgHciInfo.hciCmdCntLinkStatusNotify++;
3537 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "LinkStatusNotify, Hex Data :\n",
3538 &pHciCmd->Data[0], pHciCmd->Length);
3539
3540 /* Current only RTL8723 support this command. */
3541 pBtMgnt->bSupportProfile = true;
3542
3543 pBtMgnt->ExtConfig.NumberOfHandle = *((u8 *)pHciCmd->Data);
3544 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("NumberOfHandle = 0x%x\n", pBtMgnt->ExtConfig.NumberOfHandle));
3545 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCIExtensionVer = %d\n", pBtMgnt->ExtConfig.HCIExtensionVer));
3546
3547 pTriple = &pHciCmd->Data[1];
3548 for (i = 0; i < pBtMgnt->ExtConfig.NumberOfHandle; i++) {
3549 if (pBtMgnt->ExtConfig.HCIExtensionVer < 1) {
3550 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle = *((u16 *)&pTriple[0]);
3551 pBtMgnt->ExtConfig.linkInfo[i].BTProfile = pTriple[2];
3552 pBtMgnt->ExtConfig.linkInfo[i].BTCoreSpec = pTriple[3];
3553 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT,
3554 ("Connection_Handle = 0x%x, BTProfile =%d, BTSpec =%d\n",
3555 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle,
3556 pBtMgnt->ExtConfig.linkInfo[i].BTProfile,
3557 pBtMgnt->ExtConfig.linkInfo[i].BTCoreSpec));
3558 pTriple += 4;
3559 } else if (pBtMgnt->ExtConfig.HCIExtensionVer >= 1) {
3560 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle = *((u16 *)&pTriple[0]);
3561 pBtMgnt->ExtConfig.linkInfo[i].BTProfile = pTriple[2];
3562 pBtMgnt->ExtConfig.linkInfo[i].BTCoreSpec = pTriple[3];
3563 pBtMgnt->ExtConfig.linkInfo[i].linkRole = pTriple[4];
3564 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT,
3565 ("Connection_Handle = 0x%x, BTProfile =%d, BTSpec =%d, LinkRole =%d\n",
3566 pBtMgnt->ExtConfig.linkInfo[i].ConnectHandle,
3567 pBtMgnt->ExtConfig.linkInfo[i].BTProfile,
3568 pBtMgnt->ExtConfig.linkInfo[i].BTCoreSpec,
3569 pBtMgnt->ExtConfig.linkInfo[i].linkRole));
3570 pTriple += 5;
3571 }
3572
3573 }
3574 BTHCI_UpdateBTProfileRTKToMoto(padapter);
3575 {
3576 u8 localBuf[6] = "";
3577 u8 *pRetPar;
3578 u8 len = 0;
3579 struct packet_irp_hcievent_data *PPacketIrpEvent;
3580
3581 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3582
3583 len += bthci_CommandCompleteHeader(&localBuf[0],
3584 OGF_EXTENSION,
3585 HCI_LINK_STATUS_NOTIFY,
3586 status);
3587
3588 /* Return parameters starts from here */
3589 pRetPar = &PPacketIrpEvent->Data[len];
3590 pRetPar[0] = status; /* status */
3591
3592 len += 1;
3593 PPacketIrpEvent->Length = len;
3594
3595 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3596 }
3597
3598 return status;
3599}
3600
3601static enum hci_status
3602bthci_CmdBtOperationNotify(
3603 struct rtw_adapter *padapter,
3604 struct packet_irp_hcicmd_data *pHciCmd
3605 )
3606{
3607 enum hci_status status = HCI_STATUS_SUCCESS;
3608 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3609 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3610
3611 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "Bt Operation notify, Hex Data :\n",
3612 &pHciCmd->Data[0], pHciCmd->Length);
3613
3614 pBtMgnt->ExtConfig.btOperationCode = *((u8 *)pHciCmd->Data);
3615 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("btOperationCode = 0x%x\n", pBtMgnt->ExtConfig.btOperationCode));
3616 switch (pBtMgnt->ExtConfig.btOperationCode) {
3617 case HCI_BT_OP_NONE:
3618 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Operation None!!\n"));
3619 break;
3620 case HCI_BT_OP_INQUIRY_START:
3621 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Inquire start!!\n"));
3622 break;
3623 case HCI_BT_OP_INQUIRY_FINISH:
3624 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Inquire finished!!\n"));
3625 break;
3626 case HCI_BT_OP_PAGING_START:
3627 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Paging is started!!\n"));
3628 break;
3629 case HCI_BT_OP_PAGING_SUCCESS:
3630 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Paging complete successfully!!\n"));
3631 break;
3632 case HCI_BT_OP_PAGING_UNSUCCESS:
3633 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Paging complete unsuccessfully!!\n"));
3634 break;
3635 case HCI_BT_OP_PAIRING_START:
3636 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Pairing start!!\n"));
3637 break;
3638 case HCI_BT_OP_PAIRING_FINISH:
3639 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Pairing finished!!\n"));
3640 break;
3641 case HCI_BT_OP_BT_DEV_ENABLE:
3642 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : BT Device is enabled!!\n"));
3643 break;
3644 case HCI_BT_OP_BT_DEV_DISABLE:
3645 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : BT Device is disabled!!\n"));
3646 break;
3647 default:
3648 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[bt operation] : Unknown, error!!\n"));
3649 break;
3650 }
3651 BTDM_AdjustForBtOperation(padapter);
3652 {
3653 u8 localBuf[6] = "";
3654 u8 *pRetPar;
3655 u8 len = 0;
3656 struct packet_irp_hcievent_data *PPacketIrpEvent;
3657
3658 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3659
3660 len += bthci_CommandCompleteHeader(&localBuf[0],
3661 OGF_EXTENSION,
3662 HCI_BT_OPERATION_NOTIFY,
3663 status);
3664
3665 /* Return parameters starts from here */
3666 pRetPar = &PPacketIrpEvent->Data[len];
3667 pRetPar[0] = status; /* status */
3668
3669 len += 1;
3670 PPacketIrpEvent->Length = len;
3671
3672 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3673 }
3674
3675 return status;
3676}
3677
3678static enum hci_status
3679bthci_CmdEnableWifiScanNotify(struct rtw_adapter *padapter,
3680 struct packet_irp_hcicmd_data *pHciCmd)
3681{
3682 enum hci_status status = HCI_STATUS_SUCCESS;
3683 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3684 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
3685
3686 RTPRINT_DATA(FIOCTL, IOCTL_BT_HCICMD_EXT, "Enable Wifi scan notify, Hex Data :\n",
3687 &pHciCmd->Data[0], pHciCmd->Length);
3688
3689 pBtMgnt->ExtConfig.bEnableWifiScanNotify = *((u8 *)pHciCmd->Data);
3690 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("bEnableWifiScanNotify = %d\n", pBtMgnt->ExtConfig.bEnableWifiScanNotify));
3691
3692 {
3693 u8 localBuf[6] = "";
3694 u8 *pRetPar;
3695 u8 len = 0;
3696 struct packet_irp_hcievent_data *PPacketIrpEvent;
3697
3698 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3699
3700 len += bthci_CommandCompleteHeader(&localBuf[0],
3701 OGF_EXTENSION,
3702 HCI_ENABLE_WIFI_SCAN_NOTIFY,
3703 status);
3704
3705 /* Return parameters starts from here */
3706 pRetPar = &PPacketIrpEvent->Data[len];
3707 pRetPar[0] = status; /* status */
3708
3709 len += 1;
3710 PPacketIrpEvent->Length = len;
3711
3712 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3713 }
3714
3715 return status;
3716}
3717
3718static enum hci_status
3719bthci_CmdWIFICurrentChannel(struct rtw_adapter *padapter,
3720 struct packet_irp_hcicmd_data *pHciCmd)
3721{
3722 enum hci_status status = HCI_STATUS_SUCCESS;
3723 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv;
3724 u8 chnl = pmlmeext->cur_channel;
3725
3726 if (pmlmeext->cur_bwmode == HT_CHANNEL_WIDTH_40) {
3727 if (pmlmeext->cur_ch_offset == HAL_PRIME_CHNL_OFFSET_UPPER)
3728 chnl += 2;
3729 else if (pmlmeext->cur_ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER)
3730 chnl -= 2;
3731 }
3732
3733 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("Current Channel = 0x%x\n", chnl));
3734
3735 {
3736 u8 localBuf[8] = "";
3737 u8 *pRetPar;
3738 u8 len = 0;
3739 struct packet_irp_hcievent_data *PPacketIrpEvent;
3740
3741 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3742
3743 len += bthci_CommandCompleteHeader(&localBuf[0],
3744 OGF_EXTENSION,
3745 HCI_WIFI_CURRENT_CHANNEL,
3746 status);
3747
3748 /* Return parameters starts from here */
3749 pRetPar = &PPacketIrpEvent->Data[len];
3750 pRetPar[0] = status; /* status */
3751 pRetPar[1] = chnl; /* current channel */
3752 len += 2;
3753 PPacketIrpEvent->Length = len;
3754
3755 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3756 }
3757
3758 return status;
3759}
3760
3761static enum hci_status
3762bthci_CmdWIFICurrentBandwidth(struct rtw_adapter *padapter,
3763 struct packet_irp_hcicmd_data *pHciCmd)
3764{
3765 enum hci_status status = HCI_STATUS_SUCCESS;
3766 enum ht_channel_width bw;
3767 u8 CurrentBW = 0;
3768
3769 bw = padapter->mlmeextpriv.cur_bwmode;
3770
3771 if (bw == HT_CHANNEL_WIDTH_20)
3772 CurrentBW = 0;
3773 else if (bw == HT_CHANNEL_WIDTH_40)
3774 CurrentBW = 1;
3775
3776 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("Current BW = 0x%x\n",
3777 CurrentBW));
3778
3779 {
3780 u8 localBuf[8] = "";
3781 u8 *pRetPar;
3782 u8 len = 0;
3783 struct packet_irp_hcievent_data *PPacketIrpEvent;
3784
3785 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3786
3787 len += bthci_CommandCompleteHeader(&localBuf[0],
3788 OGF_EXTENSION,
3789 HCI_WIFI_CURRENT_BANDWIDTH,
3790 status);
3791
3792 /* Return parameters starts from here */
3793 pRetPar = &PPacketIrpEvent->Data[len];
3794 pRetPar[0] = status; /* status */
3795 pRetPar[1] = CurrentBW; /* current BW */
3796 len += 2;
3797 PPacketIrpEvent->Length = len;
3798
3799 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3800 }
3801
3802 return status;
3803}
3804
3805static enum hci_status
3806bthci_CmdWIFIConnectionStatus(
3807 struct rtw_adapter *padapter,
3808 struct packet_irp_hcicmd_data *pHciCmd
3809 )
3810{
3811 enum hci_status status = HCI_STATUS_SUCCESS;
3812 u8 connectStatus = HCI_WIFI_NOT_CONNECTED;
3813
3814 if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) {
3815 if (padapter->stapriv.asoc_sta_count >= 3)
3816 connectStatus = HCI_WIFI_CONNECTED;
3817 else
3818 connectStatus = HCI_WIFI_NOT_CONNECTED;
3819 } else if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE|WIFI_ASOC_STATE)) {
3820 connectStatus = HCI_WIFI_CONNECTED;
3821 } else if (check_fwstate(&padapter->mlmepriv, WIFI_UNDER_LINKING)) {
3822 connectStatus = HCI_WIFI_CONNECT_IN_PROGRESS;
3823 } else {
3824 connectStatus = HCI_WIFI_NOT_CONNECTED;
3825 }
3826
3827 {
3828 u8 localBuf[8] = "";
3829 u8 *pRetPar;
3830 u8 len = 0;
3831 struct packet_irp_hcievent_data *PPacketIrpEvent;
3832
3833 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3834
3835 len += bthci_CommandCompleteHeader(&localBuf[0],
3836 OGF_EXTENSION,
3837 HCI_WIFI_CONNECTION_STATUS,
3838 status);
3839
3840 /* Return parameters starts from here */
3841 pRetPar = &PPacketIrpEvent->Data[len];
3842 pRetPar[0] = status; /* status */
3843 pRetPar[1] = connectStatus; /* connect status */
3844 len += 2;
3845 PPacketIrpEvent->Length = len;
3846
3847 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3848 }
3849
3850 return status;
3851}
3852
3853static enum hci_status
3854bthci_CmdEnableDeviceUnderTestMode(
3855 struct rtw_adapter *padapter,
3856 struct packet_irp_hcicmd_data *pHciCmd
3857 )
3858{
3859 enum hci_status status = HCI_STATUS_SUCCESS;
3860 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3861 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
3862
3863 pBtHciInfo->bInTestMode = true;
3864 pBtHciInfo->bTestIsEnd = false;
3865
3866 /* send command complete event here when all data are received. */
3867 {
3868 u8 localBuf[6] = "";
3869 u8 *pRetPar;
3870 u8 len = 0;
3871 struct packet_irp_hcievent_data *PPacketIrpEvent;
3872
3873 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3874
3875 len += bthci_CommandCompleteHeader(&localBuf[0],
3876 OGF_TESTING_COMMANDS,
3877 HCI_ENABLE_DEVICE_UNDER_TEST_MODE,
3878 status);
3879
3880 /* Return parameters starts from here */
3881 pRetPar = &PPacketIrpEvent->Data[len];
3882 pRetPar[0] = status; /* status */
3883 len += 1;
3884 PPacketIrpEvent->Length = len;
3885
3886 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
3887 }
3888
3889 return status;
3890}
3891
3892static enum hci_status
3893bthci_CmdAMPTestEnd(struct rtw_adapter *padapter,
3894 struct packet_irp_hcicmd_data *pHciCmd)
3895{
3896 enum hci_status status = HCI_STATUS_SUCCESS;
3897 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3898 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
f7c92d2c
LF		 3899
3900 if (!pBtHciInfo->bInTestMode) {
3901 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Not in Test mode, return status = HCI_STATUS_CMD_DISALLOW\n"));
3902 status = HCI_STATUS_CMD_DISALLOW;
3903 return status;
3904 }
3905
3906 pBtHciInfo->bTestIsEnd = true;
3907
3908 del_timer_sync(&pBTInfo->BTTestSendPacketTimer);
3909
ea0cd730 3910 rtl8723a_check_bssid(padapter, true);
f7c92d2c
LF		 3911
3912 /* send command complete event here when all data are received. */
3913 {
3914 u8 localBuf[4] = "";
3915 struct packet_irp_hcievent_data *PPacketIrpEvent;
3916
3917 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("AMP Test End Event \n"));
3918 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3919 PPacketIrpEvent->EventCode = HCI_EVENT_AMP_TEST_END;
3920 PPacketIrpEvent->Length = 2;
3921
3922 PPacketIrpEvent->Data[0] = status;
3923 PPacketIrpEvent->Data[1] = pBtHciInfo->TestScenario;
3924
3925 bthci_IndicateEvent(padapter, PPacketIrpEvent, 4);
3926 }
3927
3928 bthci_EventAMPReceiverReport(padapter, 0x01);
3929
3930 return status;
3931}
3932
3933static enum hci_status
3934bthci_CmdAMPTestCommand(struct rtw_adapter *padapter,
3935 struct packet_irp_hcicmd_data *pHciCmd)
3936{
3937 enum hci_status status = HCI_STATUS_SUCCESS;
3938 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
3939 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
3940
3941 if (!pBtHciInfo->bInTestMode) {
3942 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Not in Test mode, return status = HCI_STATUS_CMD_DISALLOW\n"));
3943 status = HCI_STATUS_CMD_DISALLOW;
3944 return status;
3945 }
3946
3947 pBtHciInfo->TestScenario = *((u8 *)pHciCmd->Data);
3948
3949 if (pBtHciInfo->TestScenario == 0x01)
3950 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("TX Single Test \n"));
3951 else if (pBtHciInfo->TestScenario == 0x02)
3952 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Receive Frame Test \n"));
3953 else
3954 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("No Such Test !!!!!!!!!!!!!!!!!! \n"));
3955
3956 if (pBtHciInfo->bTestIsEnd) {
3957 u8 localBuf[5] = "";
3958 struct packet_irp_hcievent_data *PPacketIrpEvent;
3959
3960 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("AMP Test End Event \n"));
3961 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3962 PPacketIrpEvent->EventCode = HCI_EVENT_AMP_TEST_END;
3963 PPacketIrpEvent->Length = 2;
3964
3965 PPacketIrpEvent->Data[0] = status;
3966 PPacketIrpEvent->Data[1] = pBtHciInfo->TestScenario ;
3967
3968 bthci_IndicateEvent(padapter, PPacketIrpEvent, 4);
3969
3970 /* Return to Idel state with RX and TX off. */
3971
3972 return status;
3973 }
3974
3975 /* should send command status event */
3976 bthci_EventCommandStatus(padapter,
3977 OGF_TESTING_COMMANDS,
3978 HCI_AMP_TEST_COMMAND,
3979 status);
3980
3981 /* The HCI_AMP_Start Test Event shall be generated when the */
3982 /* HCI_AMP_Test_Command has completed and the first data is ready to be sent */
3983 /* or received. */
3984
3985 {
3986 u8 localBuf[5] = "";
3987 struct packet_irp_hcievent_data *PPacketIrpEvent;
3988
3989 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), (" HCI_AMP_Start Test Event \n"));
3990 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
3991 PPacketIrpEvent->EventCode = HCI_EVENT_AMP_START_TEST;
3992 PPacketIrpEvent->Length = 2;
3993
3994 PPacketIrpEvent->Data[0] = status;
3995 PPacketIrpEvent->Data[1] = pBtHciInfo->TestScenario ;
3996
3997 bthci_IndicateEvent(padapter, PPacketIrpEvent, 4);
3998
3999 /* Return to Idel state with RX and TX off. */
4000 }
4001
4002 if (pBtHciInfo->TestScenario == 0x01) {
4003 /*
4004 When in a transmitter test scenario and the frames/bursts count have been
4005 transmitted the HCI_AMP_Test_End event shall be sent.
4006 */
4007 mod_timer(&pBTInfo->BTTestSendPacketTimer,
4008 jiffies + msecs_to_jiffies(50));
4009 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("TX Single Test \n"));
4010 } else if (pBtHciInfo->TestScenario == 0x02) {
ea0cd730 4011 rtl8723a_check_bssid(padapter, false);
f7c92d2c
LF		 4012 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_BT_LOGO), ("Receive Frame Test \n"));
4013 }
4014
4015 return status;
4016}
4017
4018static enum hci_status
4019bthci_CmdEnableAMPReceiverReports(struct rtw_adapter *padapter,
4020 struct packet_irp_hcicmd_data *pHciCmd)
4021{
4022 enum hci_status status = HCI_STATUS_SUCCESS;
4023 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4024 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
4025
4026 if (!pBtHciInfo->bInTestMode) {
4027 status = HCI_STATUS_CMD_DISALLOW;
4028 /* send command complete event here when all data are received. */
4029 {
4030 u8 localBuf[6] = "";
4031 u8 *pRetPar;
4032 u8 len = 0;
4033 struct packet_irp_hcievent_data *PPacketIrpEvent;
4034
4035 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
4036
4037 len += bthci_CommandCompleteHeader(&localBuf[0],
4038 OGF_TESTING_COMMANDS,
4039 HCI_ENABLE_AMP_RECEIVER_REPORTS,
4040 status);
4041
4042 /* Return parameters starts from here */
4043 pRetPar = &PPacketIrpEvent->Data[len];
4044 pRetPar[0] = status; /* status */
4045 len += 1;
4046 PPacketIrpEvent->Length = len;
4047
4048 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
4049 }
4050 return status;
4051 }
4052
4053 pBtHciInfo->bTestNeedReport = *((u8 *)pHciCmd->Data);
4054 pBtHciInfo->TestReportInterval = (*((u8 *)pHciCmd->Data+2));
4055
4056 bthci_EventAMPReceiverReport(padapter, 0x00);
4057
4058 /* send command complete event here when all data are received. */
4059 {
4060 u8 localBuf[6] = "";
4061 u8 *pRetPar;
4062 u8 len = 0;
4063 struct packet_irp_hcievent_data *PPacketIrpEvent;
4064
4065 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
4066
4067 len += bthci_CommandCompleteHeader(&localBuf[0],
4068 OGF_TESTING_COMMANDS,
4069 HCI_ENABLE_AMP_RECEIVER_REPORTS,
4070 status);
4071
4072 /* Return parameters starts from here */
4073 pRetPar = &PPacketIrpEvent->Data[len];
4074 pRetPar[0] = status; /* status */
4075 len += 1;
4076 PPacketIrpEvent->Length = len;
4077
4078 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
4079 }
4080
4081 return status;
4082}
4083
4084static enum hci_status
4085bthci_CmdHostBufferSize(struct rtw_adapter *padapter,
4086 struct packet_irp_hcicmd_data *pHciCmd)
4087{
4088 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4089 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4090 struct packet_irp_hcievent_data *PPacketIrpEvent;
4091 enum hci_status status = HCI_STATUS_SUCCESS;
4092 u8 localBuf[6] = "";
4093 u8 *pRetPar;
4094 u8 len = 0;
4095
4096 pBTInfo->BtAsocEntry[pBtMgnt->CurrentConnectEntryNum].ACLPacketsData.ACLDataPacketLen = *((u16 *)pHciCmd->Data);
4097 pBTInfo->BtAsocEntry[pBtMgnt->CurrentConnectEntryNum].SyncDataPacketLen = *((u8 *)(pHciCmd->Data+2));
4098 pBTInfo->BtAsocEntry[pBtMgnt->CurrentConnectEntryNum].TotalNumACLDataPackets = *((u16 *)(pHciCmd->Data+3));
4099 pBTInfo->BtAsocEntry[pBtMgnt->CurrentConnectEntryNum].TotalSyncNumDataPackets = *((u16 *)(pHciCmd->Data+5));
4100
4101 /* send command complete event here when all data are received. */
4102 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
4103
4104 len += bthci_CommandCompleteHeader(&localBuf[0],
4105 OGF_SET_EVENT_MASK_COMMAND,
4106 HCI_HOST_BUFFER_SIZE,
4107 status);
4108
4109 /* Return parameters starts from here */
4110 pRetPar = &PPacketIrpEvent->Data[len];
4111 pRetPar[0] = status; /* status */
4112 len += 1;
4113 PPacketIrpEvent->Length = len;
4114
4115 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
4116
4117 return status;
4118}
4119
f7c92d2c
LF		 4120static enum hci_status
4121bthci_UnknownCMD(struct rtw_adapter *padapter, struct packet_irp_hcicmd_data *pHciCmd)
4122{
4123 enum hci_status status = HCI_STATUS_UNKNOW_HCI_CMD;
4124 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4125 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
4126
4127 pBtDbg->dbgHciInfo.hciCmdCntUnknown++;
4128 bthci_EventCommandStatus(padapter,
4129 (u8)pHciCmd->OGF,
4130 pHciCmd->OCF,
4131 status);
4132
4133 return status;
4134}
4135
4136static enum hci_status
4137bthci_HandleOGFInformationalParameters(struct rtw_adapter *padapter,
4138 struct packet_irp_hcicmd_data *pHciCmd)
4139{
4140 enum hci_status status = HCI_STATUS_SUCCESS;
4141
4142 switch (pHciCmd->OCF) {
4143 case HCI_READ_LOCAL_VERSION_INFORMATION:
4144 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LOCAL_VERSION_INFORMATION\n"));
4145 status = bthci_CmdReadLocalVersionInformation(padapter);
4146 break;
4147 case HCI_READ_LOCAL_SUPPORTED_COMMANDS:
4148 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LOCAL_SUPPORTED_COMMANDS\n"));
4149 status = bthci_CmdReadLocalSupportedCommands(padapter);
4150 break;
4151 case HCI_READ_LOCAL_SUPPORTED_FEATURES:
4152 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LOCAL_SUPPORTED_FEATURES\n"));
4153 status = bthci_CmdReadLocalSupportedFeatures(padapter);
4154 break;
4155 case HCI_READ_BUFFER_SIZE:
4156 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_BUFFER_SIZE\n"));
4157 status = bthci_CmdReadBufferSize(padapter);
4158 break;
4159 case HCI_READ_DATA_BLOCK_SIZE:
4160 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_DATA_BLOCK_SIZE\n"));
4161 status = bthci_CmdReadDataBlockSize(padapter);
4162 break;
4163 default:
4164 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("bthci_HandleOGFInformationalParameters(), Unknown case = 0x%x\n", pHciCmd->OCF));
4165 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_UNKNOWN_COMMAND\n"));
4166 status = bthci_UnknownCMD(padapter, pHciCmd);
4167 break;
4168 }
4169 return status;
4170}
4171
4172static enum hci_status
4173bthci_HandleOGFSetEventMaskCMD(struct rtw_adapter *padapter,
4174 struct packet_irp_hcicmd_data *pHciCmd)
4175{
4176 enum hci_status status = HCI_STATUS_SUCCESS;
4177
4178 switch (pHciCmd->OCF) {
4179 case HCI_SET_EVENT_MASK:
4180 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_SET_EVENT_MASK\n"));
4181 status = bthci_CmdSetEventMask(padapter, pHciCmd);
4182 break;
4183 case HCI_RESET:
4184 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_RESET\n"));
4185 status = bthci_CmdReset(padapter, true);
4186 break;
4187 case HCI_READ_CONNECTION_ACCEPT_TIMEOUT:
4188 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_CONNECTION_ACCEPT_TIMEOUT\n"));
4189 status = bthci_CmdReadConnectionAcceptTimeout(padapter);
4190 break;
4191 case HCI_SET_EVENT_FILTER:
4192 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_SET_EVENT_FILTER\n"));
f7c92d2c
LF		 4193 break;
4194 case HCI_WRITE_CONNECTION_ACCEPT_TIMEOUT:
4195 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_CONNECTION_ACCEPT_TIMEOUT\n"));
4196 status = bthci_CmdWriteConnectionAcceptTimeout(padapter, pHciCmd);
4197 break;
4198 case HCI_READ_PAGE_TIMEOUT:
4199 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_PAGE_TIMEOUT\n"));
4200 status = bthci_CmdReadPageTimeout(padapter, pHciCmd);
4201 break;
4202 case HCI_WRITE_PAGE_TIMEOUT:
4203 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_PAGE_TIMEOUT\n"));
4204 status = bthci_CmdWritePageTimeout(padapter, pHciCmd);
4205 break;
4206 case HCI_HOST_NUMBER_OF_COMPLETED_PACKETS:
4207 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_HOST_NUMBER_OF_COMPLETED_PACKETS\n"));
f7c92d2c
LF		 4208 break;
4209 case HCI_READ_LINK_SUPERVISION_TIMEOUT:
4210 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LINK_SUPERVISION_TIMEOUT\n"));
4211 status = bthci_CmdReadLinkSupervisionTimeout(padapter, pHciCmd);
4212 break;
4213 case HCI_WRITE_LINK_SUPERVISION_TIMEOUT:
4214 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_LINK_SUPERVISION_TIMEOUT\n"));
4215 status = bthci_CmdWriteLinkSupervisionTimeout(padapter, pHciCmd);
4216 break;
4217 case HCI_ENHANCED_FLUSH:
4218 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_ENHANCED_FLUSH\n"));
4219 status = bthci_CmdEnhancedFlush(padapter, pHciCmd);
4220 break;
4221 case HCI_READ_LOGICAL_LINK_ACCEPT_TIMEOUT:
4222 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LOGICAL_LINK_ACCEPT_TIMEOUT\n"));
4223 status = bthci_CmdReadLogicalLinkAcceptTimeout(padapter, pHciCmd);
4224 break;
4225 case HCI_WRITE_LOGICAL_LINK_ACCEPT_TIMEOUT:
4226 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_LOGICAL_LINK_ACCEPT_TIMEOUT\n"));
4227 status = bthci_CmdWriteLogicalLinkAcceptTimeout(padapter, pHciCmd);
4228 break;
4229 case HCI_SET_EVENT_MASK_PAGE_2:
4230 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_SET_EVENT_MASK_PAGE_2\n"));
4231 status = bthci_CmdSetEventMaskPage2(padapter, pHciCmd);
4232 break;
4233 case HCI_READ_LOCATION_DATA:
4234 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LOCATION_DATA\n"));
4235 status = bthci_CmdReadLocationData(padapter, pHciCmd);
4236 break;
4237 case HCI_WRITE_LOCATION_DATA:
4238 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_LOCATION_DATA\n"));
4239 status = bthci_CmdWriteLocationData(padapter, pHciCmd);
4240 break;
4241 case HCI_READ_FLOW_CONTROL_MODE:
4242 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_FLOW_CONTROL_MODE\n"));
4243 status = bthci_CmdReadFlowControlMode(padapter, pHciCmd);
4244 break;
4245 case HCI_WRITE_FLOW_CONTROL_MODE:
4246 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_FLOW_CONTROL_MODE\n"));
4247 status = bthci_CmdWriteFlowControlMode(padapter, pHciCmd);
4248 break;
4249 case HCI_READ_BEST_EFFORT_FLUSH_TIMEOUT:
4250 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_BEST_EFFORT_FLUSH_TIMEOUT\n"));
4251 status = bthci_CmdReadBestEffortFlushTimeout(padapter, pHciCmd);
4252 break;
4253 case HCI_WRITE_BEST_EFFORT_FLUSH_TIMEOUT:
4254 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_BEST_EFFORT_FLUSH_TIMEOUT\n"));
4255 status = bthci_CmdWriteBestEffortFlushTimeout(padapter, pHciCmd);
4256 break;
4257 case HCI_SHORT_RANGE_MODE:
4258 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_SHORT_RANGE_MODE\n"));
4259 status = bthci_CmdShortRangeMode(padapter, pHciCmd);
4260 break;
4261 case HCI_HOST_BUFFER_SIZE:
4262 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_HOST_BUFFER_SIZE\n"));
4263 status = bthci_CmdHostBufferSize(padapter, pHciCmd);
4264 break;
4265 default:
4266 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("bthci_HandleOGFSetEventMaskCMD(), Unknown case = 0x%x\n", pHciCmd->OCF));
4267 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_UNKNOWN_COMMAND\n"));
4268 status = bthci_UnknownCMD(padapter, pHciCmd);
4269 break;
4270 }
4271 return status;
4272}
4273
4274static enum hci_status
4275bthci_HandleOGFStatusParameters(struct rtw_adapter *padapter,
4276 struct packet_irp_hcicmd_data *pHciCmd)
4277{
4278 enum hci_status status = HCI_STATUS_SUCCESS;
4279
4280 switch (pHciCmd->OCF) {
4281 case HCI_READ_FAILED_CONTACT_COUNTER:
4282 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_FAILED_CONTACT_COUNTER\n"));
4283 status = bthci_CmdReadFailedContactCounter(padapter, pHciCmd);
4284 break;
4285 case HCI_RESET_FAILED_CONTACT_COUNTER:
4286 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_RESET_FAILED_CONTACT_COUNTER\n"));
4287 status = bthci_CmdResetFailedContactCounter(padapter, pHciCmd);
4288 break;
4289 case HCI_READ_LINK_QUALITY:
4290 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LINK_QUALITY\n"));
4291 status = bthci_CmdReadLinkQuality(padapter, pHciCmd);
4292 break;
4293 case HCI_READ_RSSI:
4294 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_RSSI\n"));
f7c92d2c
LF		 4295 break;
4296 case HCI_READ_LOCAL_AMP_INFO:
4297 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LOCAL_AMP_INFO\n"));
4298 status = bthci_CmdReadLocalAMPInfo(padapter);
4299 break;
4300 case HCI_READ_LOCAL_AMP_ASSOC:
4301 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_READ_LOCAL_AMP_ASSOC\n"));
4302 status = bthci_CmdReadLocalAMPAssoc(padapter, pHciCmd);
4303 break;
4304 case HCI_WRITE_REMOTE_AMP_ASSOC:
4305 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_WRITE_REMOTE_AMP_ASSOC\n"));
4306 status = bthci_CmdWriteRemoteAMPAssoc(padapter, pHciCmd);
4307 break;
4308 default:
4309 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("bthci_HandleOGFStatusParameters(), Unknown case = 0x%x\n", pHciCmd->OCF));
4310 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_UNKNOWN_COMMAND\n"));
4311 status = bthci_UnknownCMD(padapter, pHciCmd);
4312 break;
4313 }
4314 return status;
4315}
4316
4317static enum hci_status
4318bthci_HandleOGFLinkControlCMD(struct rtw_adapter *padapter,
4319 struct packet_irp_hcicmd_data *pHciCmd)
4320{
4321 enum hci_status status = HCI_STATUS_SUCCESS;
4322
4323 switch (pHciCmd->OCF) {
4324 case HCI_CREATE_PHYSICAL_LINK:
4325 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_CREATE_PHYSICAL_LINK\n"));
4326 status = bthci_CmdCreatePhysicalLink(padapter, pHciCmd);
4327 break;
4328 case HCI_ACCEPT_PHYSICAL_LINK:
4329 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_ACCEPT_PHYSICAL_LINK\n"));
4330 status = bthci_CmdAcceptPhysicalLink(padapter, pHciCmd);
4331 break;
4332 case HCI_DISCONNECT_PHYSICAL_LINK:
4333 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_DISCONNECT_PHYSICAL_LINK\n"));
4334 status = bthci_CmdDisconnectPhysicalLink(padapter, pHciCmd);
4335 break;
4336 case HCI_CREATE_LOGICAL_LINK:
4337 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_CREATE_LOGICAL_LINK\n"));
4338 status = bthci_CmdCreateLogicalLink(padapter, pHciCmd);
4339 break;
4340 case HCI_ACCEPT_LOGICAL_LINK:
4341 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_ACCEPT_LOGICAL_LINK\n"));
4342 status = bthci_CmdAcceptLogicalLink(padapter, pHciCmd);
4343 break;
4344 case HCI_DISCONNECT_LOGICAL_LINK:
4345 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_DISCONNECT_LOGICAL_LINK\n"));
4346 status = bthci_CmdDisconnectLogicalLink(padapter, pHciCmd);
4347 break;
4348 case HCI_LOGICAL_LINK_CANCEL:
4349 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_LOGICAL_LINK_CANCEL\n"));
4350 status = bthci_CmdLogicalLinkCancel(padapter, pHciCmd);
4351 break;
4352 case HCI_FLOW_SPEC_MODIFY:
4353 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_FLOW_SPEC_MODIFY\n"));
4354 status = bthci_CmdFlowSpecModify(padapter, pHciCmd);
4355 break;
4356 default:
4357 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("bthci_HandleOGFLinkControlCMD(), Unknown case = 0x%x\n", pHciCmd->OCF));
4358 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_UNKNOWN_COMMAND\n"));
4359 status = bthci_UnknownCMD(padapter, pHciCmd);
4360 break;
4361 }
4362 return status;
4363}
4364
4365static enum hci_status
4366bthci_HandleOGFTestingCMD(struct rtw_adapter *padapter,
4367 struct packet_irp_hcicmd_data *pHciCmd)
4368{
4369 enum hci_status status = HCI_STATUS_SUCCESS;
4370 switch (pHciCmd->OCF) {
4371 case HCI_ENABLE_DEVICE_UNDER_TEST_MODE:
4372 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_ENABLE_DEVICE_UNDER_TEST_MODE\n"));
4373 bthci_CmdEnableDeviceUnderTestMode(padapter, pHciCmd);
4374 break;
4375 case HCI_AMP_TEST_END:
4376 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_AMP_TEST_END\n"));
4377 bthci_CmdAMPTestEnd(padapter, pHciCmd);
4378 break;
4379 case HCI_AMP_TEST_COMMAND:
4380 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_AMP_TEST_COMMAND\n"));
4381 bthci_CmdAMPTestCommand(padapter, pHciCmd);
4382 break;
4383 case HCI_ENABLE_AMP_RECEIVER_REPORTS:
4384 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_ENABLE_AMP_RECEIVER_REPORTS\n"));
4385 bthci_CmdEnableAMPReceiverReports(padapter, pHciCmd);
4386 break;
4387 default:
4388 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_UNKNOWN_COMMAND\n"));
4389 status = bthci_UnknownCMD(padapter, pHciCmd);
4390 break;
4391 }
4392 return status;
4393}
4394
4395static enum hci_status
4396bthci_HandleOGFExtension(struct rtw_adapter *padapter,
4397 struct packet_irp_hcicmd_data *pHciCmd)
4398{
4399 enum hci_status status = HCI_STATUS_SUCCESS;
4400 switch (pHciCmd->OCF) {
4401 case HCI_SET_ACL_LINK_DATA_FLOW_MODE:
4402 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_SET_ACL_LINK_DATA_FLOW_MODE\n"));
4403 status = bthci_CmdSetACLLinkDataFlowMode(padapter, pHciCmd);
4404 break;
4405 case HCI_SET_ACL_LINK_STATUS:
4406 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_SET_ACL_LINK_STATUS\n"));
4407 status = bthci_CmdSetACLLinkStatus(padapter, pHciCmd);
4408 break;
4409 case HCI_SET_SCO_LINK_STATUS:
4410 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_SET_SCO_LINK_STATUS\n"));
4411 status = bthci_CmdSetSCOLinkStatus(padapter, pHciCmd);
4412 break;
4413 case HCI_SET_RSSI_VALUE:
4414 RTPRINT(FIOCTL, IOCTL_BT_EVENT_PERIODICAL, ("HCI_SET_RSSI_VALUE\n"));
4415 status = bthci_CmdSetRSSIValue(padapter, pHciCmd);
4416 break;
4417 case HCI_SET_CURRENT_BLUETOOTH_STATUS:
4418 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_SET_CURRENT_BLUETOOTH_STATUS\n"));
4419 status = bthci_CmdSetCurrentBluetoothStatus(padapter, pHciCmd);
4420 break;
4421 /* The following is for RTK8723 */
4422
4423 case HCI_EXTENSION_VERSION_NOTIFY:
4424 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_EXTENSION_VERSION_NOTIFY\n"));
4425 status = bthci_CmdExtensionVersionNotify(padapter, pHciCmd);
4426 break;
4427 case HCI_LINK_STATUS_NOTIFY:
4428 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_LINK_STATUS_NOTIFY\n"));
4429 status = bthci_CmdLinkStatusNotify(padapter, pHciCmd);
4430 break;
4431 case HCI_BT_OPERATION_NOTIFY:
4432 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_BT_OPERATION_NOTIFY\n"));
4433 status = bthci_CmdBtOperationNotify(padapter, pHciCmd);
4434 break;
4435 case HCI_ENABLE_WIFI_SCAN_NOTIFY:
4436 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_ENABLE_WIFI_SCAN_NOTIFY\n"));
4437 status = bthci_CmdEnableWifiScanNotify(padapter, pHciCmd);
4438 break;
4439
4440 /* The following is for IVT */
4441 case HCI_WIFI_CURRENT_CHANNEL:
4442 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_WIFI_CURRENT_CHANNEL\n"));
4443 status = bthci_CmdWIFICurrentChannel(padapter, pHciCmd);
4444 break;
4445 case HCI_WIFI_CURRENT_BANDWIDTH:
4446 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_WIFI_CURRENT_BANDWIDTH\n"));
4447 status = bthci_CmdWIFICurrentBandwidth(padapter, pHciCmd);
4448 break;
4449 case HCI_WIFI_CONNECTION_STATUS:
4450 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_WIFI_CONNECTION_STATUS\n"));
4451 status = bthci_CmdWIFIConnectionStatus(padapter, pHciCmd);
4452 break;
4453
4454 default:
4455 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("HCI_UNKNOWN_COMMAND\n"));
4456 status = bthci_UnknownCMD(padapter, pHciCmd);
4457 break;
4458 }
4459 return status;
4460}
4461
4462static void
4463bthci_StateStarting(struct rtw_adapter *padapter,
4464 enum hci_state_with_cmd StateCmd, u8 EntryNum)
4465{
4466 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4467 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4468
4469 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT state], [Starting], "));
4470 switch (StateCmd) {
4471 case STATE_CMD_CONNECT_ACCEPT_TIMEOUT:
4472 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_CONNECT_ACCEPT_TIMEOUT\n"));
4473 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_CONNECT_ACCEPT_TIMEOUT;
4474 pBtMgnt->bNeedNotifyAMPNoCap = true;
4475 BTHCI_DisconnectPeer(padapter, EntryNum);
4476 break;
4477 case STATE_CMD_DISCONNECT_PHY_LINK:
4478 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_DISCONNECT_PHY_LINK\n"));
4479
4480 bthci_EventDisconnectPhyLinkComplete(padapter,
4481 HCI_STATUS_SUCCESS,
4482 pBTInfo->BtAsocEntry[EntryNum].PhyLinkDisconnectReason,
4483 EntryNum);
4484
4485 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4486
4487 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_UNKNOW_CONNECT_ID;
4488
4489 BTHCI_DisconnectPeer(padapter, EntryNum);
4490 break;
4491 case STATE_CMD_MAC_START_COMPLETE:
4492 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_MAC_START_COMPLETE\n"));
4493 if (pBTInfo->BtAsocEntry[EntryNum].AMPRole == AMP_BTAP_CREATOR)
4494 bthci_EventChannelSelected(padapter, EntryNum);
4495 break;
4496 default:
4497 RTPRINT(FIOCTL, IOCTL_STATE, ("State command(%d) is Wrong !!!\n", StateCmd));
4498 break;
4499 }
4500}
4501
4502static void
4503bthci_StateConnecting(struct rtw_adapter *padapter,
4504 enum hci_state_with_cmd StateCmd, u8 EntryNum)
4505{
4506 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4507 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4508
4509 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT state], [Connecting], "));
4510 switch (StateCmd) {
4511 case STATE_CMD_CONNECT_ACCEPT_TIMEOUT:
4512 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_CONNECT_ACCEPT_TIMEOUT\n"));
4513 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_CONNECT_ACCEPT_TIMEOUT;
4514 pBtMgnt->bNeedNotifyAMPNoCap = true;
4515 BTHCI_DisconnectPeer(padapter, EntryNum);
4516 break;
4517 case STATE_CMD_MAC_CONNECT_COMPLETE:
4518 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_MAC_CONNECT_COMPLETE\n"));
4519
4520 if (pBTInfo->BtAsocEntry[EntryNum].AMPRole == AMP_BTAP_JOINER) {
90403aa1
JP		 4521 RT_TRACE(_module_rtl871x_security_c_, _drv_info_,
4522 "StateConnecting\n");
f7c92d2c
LF		 4523 }
4524 break;
4525 case STATE_CMD_DISCONNECT_PHY_LINK:
4526 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_DISCONNECT_PHY_LINK\n"));
4527
4528 bthci_EventDisconnectPhyLinkComplete(padapter,
4529 HCI_STATUS_SUCCESS,
4530 pBTInfo->BtAsocEntry[EntryNum].PhyLinkDisconnectReason,
4531 EntryNum);
4532
4533 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_UNKNOW_CONNECT_ID;
4534
4535 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4536
4537 BTHCI_DisconnectPeer(padapter, EntryNum);
4538
4539 break;
4540 case STATE_CMD_MAC_CONNECT_CANCEL_INDICATE:
4541 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_MAC_CONNECT_CANCEL_INDICATE\n"));
4542 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_CONTROLLER_BUSY;
4543 /* Because this state cmd is caused by the BTHCI_EventAMPStatusChange(), */
4544 /* we don't need to send event in the following BTHCI_DisconnectPeer() again. */
4545 pBtMgnt->bNeedNotifyAMPNoCap = false;
4546 BTHCI_DisconnectPeer(padapter, EntryNum);
4547 break;
4548 default:
4549 RTPRINT(FIOCTL, IOCTL_STATE, ("State command(%d) is Wrong !!!\n", StateCmd));
4550 break;
4551 }
4552}
4553
4554static void
4555bthci_StateConnected(struct rtw_adapter *padapter,
4556 enum hci_state_with_cmd StateCmd, u8 EntryNum)
4557{
4558/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
4559 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4560 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
c17416ef
LF		 4561 u8 i;
4562 u16 logicHandle = 0;
f7c92d2c
LF		 4563
4564 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT state], [Connected], "));
4565 switch (StateCmd) {
f7c92d2c
LF		 4566 case STATE_CMD_DISCONNECT_PHY_LINK:
4567 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_DISCONNECT_PHY_LINK\n"));
4568
4569 /* When we are trying to disconnect the phy link, we should disconnect log link first, */
4570 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
4571 if (pBTInfo->BtAsocEntry[EntryNum].LogLinkCmdData->BtLogLinkhandle != 0) {
4572 logicHandle = pBTInfo->BtAsocEntry[EntryNum].LogLinkCmdData->BtLogLinkhandle;
4573
4574 bthci_EventDisconnectLogicalLinkComplete(padapter, HCI_STATUS_SUCCESS,
4575 logicHandle, pBTInfo->BtAsocEntry[EntryNum].PhyLinkDisconnectReason);
4576
4577 pBTInfo->BtAsocEntry[EntryNum].LogLinkCmdData->BtLogLinkhandle = 0;
4578 }
4579 }
4580
4581 bthci_EventDisconnectPhyLinkComplete(padapter,
4582 HCI_STATUS_SUCCESS,
4583 pBTInfo->BtAsocEntry[EntryNum].PhyLinkDisconnectReason,
4584 EntryNum);
4585
4586 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4587
4588 BTHCI_DisconnectPeer(padapter, EntryNum);
4589 break;
4590
4591 case STATE_CMD_MAC_DISCONNECT_INDICATE:
4592 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_MAC_DISCONNECT_INDICATE\n"));
4593
4594 bthci_EventDisconnectPhyLinkComplete(padapter,
4595 HCI_STATUS_SUCCESS,
4596 /* TODO: Remote Host not local host */
4597 HCI_STATUS_CONNECT_TERMINATE_LOCAL_HOST,
4598 EntryNum);
4599 BTHCI_DisconnectPeer(padapter, EntryNum);
4600
4601 break;
4602 case STATE_CMD_ENTER_STATE:
4603 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_ENTER_STATE\n"));
4604
4605 if (pBtMgnt->bBTConnectInProgress) {
4606 pBtMgnt->bBTConnectInProgress = false;
4607 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], BT Connect in progress OFF!!\n"));
4608 }
4609 pBTInfo->BtAsocEntry[EntryNum].BtCurrentState = HCI_STATE_CONNECTED;
4610 pBTInfo->BtAsocEntry[EntryNum].b4waySuccess = true;
4611 pBtMgnt->bStartSendSupervisionPkt = true;
4612
4613 /* for rate adaptive */
4614
ac4cbc68
JS		 4615 rtl8723a_update_ramask(padapter,
4616 MAX_FW_SUPPORT_MACID_NUM-1-EntryNum, 0);
f7c92d2c 4617
fa2e5209 4618 HalSetBrateCfg23a(padapter, padapter->mlmepriv.cur_network.network.SupportedRates);
f7c92d2c
LF		 4619 BTDM_SetFwChnlInfo(padapter, RT_MEDIA_CONNECT);
4620 break;
4621 default:
4622 RTPRINT(FIOCTL, IOCTL_STATE, ("State command(%d) is Wrong !!!\n", StateCmd));
4623 break;
4624 }
4625}
4626
4627static void
4628bthci_StateAuth(struct rtw_adapter *padapter, enum hci_state_with_cmd StateCmd,
4629 u8 EntryNum)
4630{
4631 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4632 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4633
4634 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT state], [Authenticating], "));
4635 switch (StateCmd) {
4636 case STATE_CMD_CONNECT_ACCEPT_TIMEOUT:
4637 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_CONNECT_ACCEPT_TIMEOUT\n"));
4638 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_CONNECT_ACCEPT_TIMEOUT;
4639 pBtMgnt->bNeedNotifyAMPNoCap = true;
4640 BTHCI_DisconnectPeer(padapter, EntryNum);
4641 break;
4642 case STATE_CMD_DISCONNECT_PHY_LINK:
4643 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_DISCONNECT_PHY_LINK\n"));
4644 bthci_EventDisconnectPhyLinkComplete(padapter,
4645 HCI_STATUS_SUCCESS,
4646 pBTInfo->BtAsocEntry[EntryNum].PhyLinkDisconnectReason,
4647 EntryNum);
4648
4649 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_UNKNOW_CONNECT_ID;
4650
4651 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4652
4653 BTHCI_DisconnectPeer(padapter, EntryNum);
4654 break;
4655 case STATE_CMD_4WAY_FAILED:
4656 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_4WAY_FAILED\n"));
4657
4658 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus = HCI_STATUS_AUTH_FAIL;
4659 pBtMgnt->bNeedNotifyAMPNoCap = true;
4660
4661 BTHCI_DisconnectPeer(padapter, EntryNum);
4662
4663 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4664 break;
4665 case STATE_CMD_4WAY_SUCCESSED:
4666 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_4WAY_SUCCESSED\n"));
4667
4668 bthci_EventPhysicalLinkComplete(padapter, HCI_STATUS_SUCCESS, EntryNum, INVALID_PL_HANDLE);
4669
4670 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4671
4672 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_CONNECTED, STATE_CMD_ENTER_STATE, EntryNum);
4673 break;
4674 default:
4675 RTPRINT(FIOCTL, IOCTL_STATE, ("State command(%d) is Wrong !!!\n", StateCmd));
4676 break;
4677 }
4678}
4679
4680static void
4681bthci_StateDisconnecting(struct rtw_adapter *padapter,
4682 enum hci_state_with_cmd StateCmd, u8 EntryNum)
4683{
4684 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4685 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4686
4687 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT state], [Disconnecting], "));
4688 switch (StateCmd) {
4689 case STATE_CMD_MAC_CONNECT_CANCEL_INDICATE:
4690 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_MAC_CONNECT_CANCEL_INDICATE\n"));
4691 if (pBTInfo->BtAsocEntry[EntryNum].bNeedPhysLinkCompleteEvent) {
4692 bthci_EventPhysicalLinkComplete(padapter,
4693 pBTInfo->BtAsocEntry[EntryNum].PhysLinkCompleteStatus,
4694 EntryNum, INVALID_PL_HANDLE);
4695 }
4696
4697 if (pBtMgnt->bBTConnectInProgress) {
4698 pBtMgnt->bBTConnectInProgress = false;
4699 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], BT Connect in progress OFF!!\n"));
4700 }
4701
4702 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTED, STATE_CMD_ENTER_STATE, EntryNum);
4703 break;
4704 case STATE_CMD_DISCONNECT_PHY_LINK:
4705 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_DISCONNECT_PHY_LINK\n"));
4706
4707 bthci_EventDisconnectPhyLinkComplete(padapter,
4708 HCI_STATUS_SUCCESS,
4709 pBTInfo->BtAsocEntry[EntryNum].PhyLinkDisconnectReason,
4710 EntryNum);
4711
4712 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4713
4714 BTHCI_DisconnectPeer(padapter, EntryNum);
4715 break;
4716 default:
4717 RTPRINT(FIOCTL, IOCTL_STATE, ("State command(%d) is Wrong !!!\n", StateCmd));
4718 break;
4719 }
4720}
4721
4722static void
4723bthci_StateDisconnected(struct rtw_adapter *padapter,
4724 enum hci_state_with_cmd StateCmd, u8 EntryNum)
4725{
4726/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
4727 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4728 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
4729 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4730
4731 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT state], [Disconnected], "));
4732 switch (StateCmd) {
4733 case STATE_CMD_CREATE_PHY_LINK:
4734 case STATE_CMD_ACCEPT_PHY_LINK:
4735 if (StateCmd == STATE_CMD_CREATE_PHY_LINK)
4736 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_CREATE_PHY_LINK\n"));
4737 else
4738 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_ACCEPT_PHY_LINK\n"));
4739
4740 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT PS], Disable IPS and LPS\n"));
4741 ips_leave23a(padapter);
4742 LPS_Leave23a(padapter);
4743
4744 pBtMgnt->bPhyLinkInProgress = true;
4745 pBtMgnt->BTCurrentConnectType = BT_DISCONNECT;
4746 pBtMgnt->CurrentBTConnectionCnt++;
4747 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], CurrentBTConnectionCnt = %d\n",
4748 pBtMgnt->CurrentBTConnectionCnt));
4749 pBtMgnt->BtOperationOn = true;
4750 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], Bt Operation ON!! CurrentConnectEntryNum = %d\n",
4751 pBtMgnt->CurrentConnectEntryNum));
4752
4753 if (pBtMgnt->bBTConnectInProgress) {
4754 bthci_EventPhysicalLinkComplete(padapter, HCI_STATUS_CONTROLLER_BUSY, INVALID_ENTRY_NUM, pBtMgnt->BtCurrentPhyLinkhandle);
4755 bthci_RemoveEntryByEntryNum(padapter, EntryNum);
4756 return;
4757 }
4758
4759 if (StateCmd == STATE_CMD_CREATE_PHY_LINK)
4760 pBTInfo->BtAsocEntry[EntryNum].AMPRole = AMP_BTAP_CREATOR;
4761 else
4762 pBTInfo->BtAsocEntry[EntryNum].AMPRole = AMP_BTAP_JOINER;
4763
4764 /* 1. MAC not yet in selected channel */
4765 while (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE|WIFI_SITE_MONITOR)) {
4766 RTPRINT(FIOCTL, IOCTL_STATE, ("Scan/Roaming/Wifi Link is in Progress, wait 200 ms\n"));
4767 mdelay(200);
4768 }
4769 /* 2. MAC already in selected channel */
4770 RTPRINT(FIOCTL, IOCTL_STATE, ("Channel is Ready\n"));
4771 mod_timer(&pBTInfo->BTHCIJoinTimeoutTimer,
4772 jiffies + msecs_to_jiffies(pBtHciInfo->ConnAcceptTimeout));
4773
4774 pBTInfo->BtAsocEntry[EntryNum].bNeedPhysLinkCompleteEvent = true;
4775 break;
4776 case STATE_CMD_DISCONNECT_PHY_LINK:
4777 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_DISCONNECT_PHY_LINK\n"));
4778
4779 del_timer_sync(&pBTInfo->BTHCIJoinTimeoutTimer);
4780
4781 bthci_EventDisconnectPhyLinkComplete(padapter,
4782 HCI_STATUS_SUCCESS,
4783 pBTInfo->BtAsocEntry[EntryNum].PhyLinkDisconnectReason,
4784 EntryNum);
4785
4786 if (pBTInfo->BtAsocEntry[EntryNum].bNeedPhysLinkCompleteEvent) {
4787 bthci_EventPhysicalLinkComplete(padapter,
4788 HCI_STATUS_UNKNOW_CONNECT_ID,
4789 EntryNum, INVALID_PL_HANDLE);
4790 }
4791
4792 if (pBtMgnt->bBTConnectInProgress) {
4793 pBtMgnt->bBTConnectInProgress = false;
4794 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], BT Connect in progress OFF!!\n"));
4795 }
4796 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTED, STATE_CMD_ENTER_STATE, EntryNum);
4797 bthci_RemoveEntryByEntryNum(padapter, EntryNum);
4798 break;
4799 case STATE_CMD_ENTER_STATE:
4800 RTPRINT(FIOCTL, IOCTL_STATE, ("STATE_CMD_ENTER_STATE\n"));
4801 break;
4802 default:
4803 RTPRINT(FIOCTL, IOCTL_STATE, ("State command(%d) is Wrong !!!\n", StateCmd));
4804 break;
4805 }
4806}
4807
4808void BTHCI_EventParse(struct rtw_adapter *padapter, void *pEvntData, u32 dataLen)
4809{
4810}
4811
4812u8 BTHCI_HsConnectionEstablished(struct rtw_adapter *padapter)
4813{
4814 u8 bBtConnectionExist = false;
4815 struct bt_30info *pBtinfo = GET_BT_INFO(padapter);
4816 u8 i;
4817
4818 for (i = 0; i < MAX_BT_ASOC_ENTRY_NUM; i++) {
4819 if (pBtinfo->BtAsocEntry[i].b4waySuccess) {
4820 bBtConnectionExist = true;
4821 break;
4822 }
4823 }
4824
4825/*RTPRINT(FIOCTL, IOCTL_STATE, (" BTHCI_HsConnectionEstablished(), connection exist = %d\n", bBtConnectionExist)); */
4826
4827 return bBtConnectionExist;
4828}
4829
4830static u8
4831BTHCI_CheckProfileExist(struct rtw_adapter *padapter,
4832 enum bt_traffic_mode_profile Profile)
4833{
4834 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4835 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4836 u8 IsPRofile = false;
4837 u8 i = 0;
4838
4839 for (i = 0; i < pBtMgnt->ExtConfig.NumberOfHandle; i++) {
4840 if (pBtMgnt->ExtConfig.linkInfo[i].TrafficProfile == Profile) {
4841 IsPRofile = true;
4842 break;
4843 }
4844 }
4845
4846 return IsPRofile;
4847}
4848
4849void BTHCI_UpdateBTProfileRTKToMoto(struct rtw_adapter *padapter)
4850{
4851 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4852 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4853 u8 i = 0;
4854
4855 pBtMgnt->ExtConfig.NumberOfSCO = 0;
4856
4857 for (i = 0; i < pBtMgnt->ExtConfig.NumberOfHandle; i++) {
4858 pBtMgnt->ExtConfig.linkInfo[i].TrafficProfile = BT_PROFILE_NONE;
4859
4860 if (pBtMgnt->ExtConfig.linkInfo[i].BTProfile == BT_PROFILE_SCO)
4861 pBtMgnt->ExtConfig.NumberOfSCO++;
4862
4863 pBtMgnt->ExtConfig.linkInfo[i].TrafficProfile = pBtMgnt->ExtConfig.linkInfo[i].BTProfile;
4864 switch (pBtMgnt->ExtConfig.linkInfo[i].TrafficProfile) {
4865 case BT_PROFILE_SCO:
4866 break;
4867 case BT_PROFILE_PAN:
4868 pBtMgnt->ExtConfig.linkInfo[i].IncomingTrafficMode = BT_MOTOR_EXT_BE;
4869 pBtMgnt->ExtConfig.linkInfo[i].OutgoingTrafficMode = BT_MOTOR_EXT_BE;
4870 break;
4871 case BT_PROFILE_A2DP:
4872 pBtMgnt->ExtConfig.linkInfo[i].IncomingTrafficMode = BT_MOTOR_EXT_GULB;
4873 pBtMgnt->ExtConfig.linkInfo[i].OutgoingTrafficMode = BT_MOTOR_EXT_GULB;
4874 break;
4875 case BT_PROFILE_HID:
4876 pBtMgnt->ExtConfig.linkInfo[i].IncomingTrafficMode = BT_MOTOR_EXT_GUL;
4877 pBtMgnt->ExtConfig.linkInfo[i].OutgoingTrafficMode = BT_MOTOR_EXT_BE;
4878 break;
4879 default:
4880 break;
4881 }
4882 }
4883
4884 RTPRINT(FBT, BT_TRACE, ("[DM][BT], RTK, NumberOfHandle = %d, NumberOfSCO = %d\n",
4885 pBtMgnt->ExtConfig.NumberOfHandle, pBtMgnt->ExtConfig.NumberOfSCO));
4886}
4887
4888void BTHCI_WifiScanNotify(struct rtw_adapter *padapter, u8 scanType)
4889{
4890 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4891 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4892
4893 if (pBtMgnt->ExtConfig.bEnableWifiScanNotify)
4894 bthci_EventExtWifiScanNotify(padapter, scanType);
4895}
4896
4897void
4898BTHCI_StateMachine(
4899 struct rtw_adapter *padapter,
4900 u8 StateToEnter,
4901 enum hci_state_with_cmd StateCmd,
4902 u8 EntryNum
4903 )
4904{
4905 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4906 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4907
4908 if (EntryNum == 0xff) {
4909 RTPRINT(FIOCTL, IOCTL_STATE, (" StateMachine, error EntryNum = 0x%x \n", EntryNum));
4910 return;
4911 }
4912 RTPRINT(FIOCTL, IOCTL_STATE, (" StateMachine, EntryNum = 0x%x, CurrentState = 0x%x, BtNextState = 0x%x, StateCmd = 0x%x , StateToEnter = 0x%x\n",
4913 EntryNum, pBTInfo->BtAsocEntry[EntryNum].BtCurrentState, pBTInfo->BtAsocEntry[EntryNum].BtNextState, StateCmd, StateToEnter));
4914
4915 if (pBTInfo->BtAsocEntry[EntryNum].BtNextState & StateToEnter) {
4916 pBTInfo->BtAsocEntry[EntryNum].BtCurrentState = StateToEnter;
4917
4918 switch (StateToEnter) {
4919 case HCI_STATE_STARTING:
4920 pBTInfo->BtAsocEntry[EntryNum].BtNextState = HCI_STATE_DISCONNECTING | HCI_STATE_CONNECTING;
4921 bthci_StateStarting(padapter, StateCmd, EntryNum);
4922 break;
4923 case HCI_STATE_CONNECTING:
4924 pBTInfo->BtAsocEntry[EntryNum].BtNextState = HCI_STATE_CONNECTING | HCI_STATE_DISCONNECTING | HCI_STATE_AUTHENTICATING;
4925 bthci_StateConnecting(padapter, StateCmd, EntryNum);
4926 break;
4927 case HCI_STATE_AUTHENTICATING:
4928 pBTInfo->BtAsocEntry[EntryNum].BtNextState = HCI_STATE_DISCONNECTING | HCI_STATE_CONNECTED;
4929 bthci_StateAuth(padapter, StateCmd, EntryNum);
4930 break;
4931 case HCI_STATE_CONNECTED:
4932 pBTInfo->BtAsocEntry[EntryNum].BtNextState = HCI_STATE_CONNECTED | HCI_STATE_DISCONNECTING;
4933 bthci_StateConnected(padapter, StateCmd, EntryNum);
4934 break;
4935 case HCI_STATE_DISCONNECTING:
4936 pBTInfo->BtAsocEntry[EntryNum].BtNextState = HCI_STATE_DISCONNECTED | HCI_STATE_DISCONNECTING;
4937 bthci_StateDisconnecting(padapter, StateCmd, EntryNum);
4938 break;
4939 case HCI_STATE_DISCONNECTED:
4940 pBTInfo->BtAsocEntry[EntryNum].BtNextState = HCI_STATE_DISCONNECTED | HCI_STATE_STARTING | HCI_STATE_CONNECTING;
4941 bthci_StateDisconnected(padapter, StateCmd, EntryNum);
4942 break;
4943 default:
4944 RTPRINT(FIOCTL, IOCTL_STATE, (" StateMachine, Unknown state to enter!!!\n"));
4945 break;
4946 }
4947 } else {
4948 RTPRINT(FIOCTL, IOCTL_STATE, (" StateMachine, Wrong state to enter\n"));
4949 }
4950
4951 /* 20100325 Joseph: Disable/Enable IPS/LPS according to BT status. */
4952 if (!pBtMgnt->bBTConnectInProgress && !pBtMgnt->BtOperationOn) {
4953 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT PS], ips_enter23a()\n"));
4954 ips_enter23a(padapter);
4955 }
4956}
4957
4958void BTHCI_DisconnectPeer(struct rtw_adapter *padapter, u8 EntryNum)
4959{
4960 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4961 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
4962
4963 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, (" BTHCI_DisconnectPeer()\n"));
4964
4965 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTING, STATE_CMD_MAC_CONNECT_CANCEL_INDICATE, EntryNum);
4966
4967 if (pBTInfo->BtAsocEntry[EntryNum].bUsed) {
4968/*BTPKT_SendDeauthentication(padapter, pBTInfo->BtAsocEntry[EntryNum].BTRemoteMACAddr, unspec_reason); not porting yet */
4969 }
4970
4971 if (pBtMgnt->bBTConnectInProgress) {
4972 pBtMgnt->bBTConnectInProgress = false;
4973 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT Flag], BT Connect in progress OFF!!\n"));
4974 }
4975
4976 bthci_RemoveEntryByEntryNum(padapter, EntryNum);
4977
4978 if (pBtMgnt->bNeedNotifyAMPNoCap) {
4979 RTPRINT(FIOCTL, IOCTL_STATE, ("[BT AMPStatus], set to invalid in BTHCI_DisconnectPeer()\n"));
4980 BTHCI_EventAMPStatusChange(padapter, AMP_STATUS_NO_CAPACITY_FOR_BT);
4981 }
4982}
4983
4984void BTHCI_EventNumOfCompletedDataBlocks(struct rtw_adapter *padapter)
4985{
4986/*PMGNT_INFO pMgntInfo = &padapter->MgntInfo; */
4987 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
4988 struct bt_hci_info *pBtHciInfo = &pBTInfo->BtHciInfo;
4989 u8 localBuf[TmpLocalBufSize] = "";
4990 u8 *pRetPar, *pTriple;
4991 u8 len = 0, i, j, handleNum = 0;
4992 struct packet_irp_hcievent_data *PPacketIrpEvent;
4993 u16 *pu2Temp, *pPackets, *pHandle, *pDblocks;
4994 u8 sent = 0;
4995
4996 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
4997
4998 if (!(pBtHciInfo->BTEventMaskPage2 & EMP2_HCI_EVENT_NUM_OF_COMPLETE_DATA_BLOCKS)) {
4999 RTPRINT(FIOCTL, IOCTL_BT_EVENT, ("[BT event], Num Of Completed DataBlocks, Ignore to send NumOfCompletedDataBlocksEvent due to event mask page 2\n"));
5000 return;
5001 }
5002
5003 /* Return parameters starts from here */
5004 pRetPar = &PPacketIrpEvent->Data[0];
5005 pTriple = &pRetPar[3];
5006 for (j = 0; j < MAX_BT_ASOC_ENTRY_NUM; j++) {
5007
5008 for (i = 0; i < MAX_LOGICAL_LINK_NUM; i++) {
5009 if (pBTInfo->BtAsocEntry[j].LogLinkCmdData[i].BtLogLinkhandle) {
5010 handleNum++;
5011 pHandle = (u16 *)&pTriple[0]; /* Handle[i] */
5012 pPackets = (u16 *)&pTriple[2]; /* Num_Of_Completed_Packets[i] */
5013 pDblocks = (u16 *)&pTriple[4]; /* Num_Of_Completed_Blocks[i] */
5014 *pHandle = pBTInfo->BtAsocEntry[j].LogLinkCmdData[i].BtLogLinkhandle;
5015 *pPackets = (u16)pBTInfo->BtAsocEntry[j].LogLinkCmdData[i].TxPacketCount;
5016 *pDblocks = (u16)pBTInfo->BtAsocEntry[j].LogLinkCmdData[i].TxPacketCount;
5017 if (pBTInfo->BtAsocEntry[j].LogLinkCmdData[i].TxPacketCount) {
5018 sent = 1;
5019 RTPRINT(FIOCTL, IOCTL_BT_EVENT_DETAIL,
5020 ("[BT event], Num Of Completed DataBlocks, Handle = 0x%x, Num_Of_Completed_Packets = 0x%x, Num_Of_Completed_Blocks = 0x%x\n",
5021 *pHandle, *pPackets, *pDblocks));
5022 }
5023 pBTInfo->BtAsocEntry[j].LogLinkCmdData[i].TxPacketCount = 0;
5024 len += 6;
5025 pTriple += len;
5026 }
5027 }
5028 }
5029
5030 pRetPar[2] = handleNum; /* Number_of_Handles */
5031 len += 1;
5032 pu2Temp = (u16 *)&pRetPar[0];
5033 *pu2Temp = BTTotalDataBlockNum;
5034 len += 2;
5035
5036 PPacketIrpEvent->EventCode = HCI_EVENT_NUM_OF_COMPLETE_DATA_BLOCKS;
5037 PPacketIrpEvent->Length = len;
5038 if (handleNum && sent)
5039 bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2);
5040}
5041
5042void BTHCI_EventAMPStatusChange(struct rtw_adapter *padapter, u8 AMP_Status)
5043{
5044 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
5045 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
5046 struct packet_irp_hcievent_data *PPacketIrpEvent;
5047 u8 len = 0;
5048 u8 localBuf[7] = "";
5049 u8 *pRetPar;
5050
5051 if (AMP_Status == AMP_STATUS_NO_CAPACITY_FOR_BT) {
5052 pBtMgnt->BTNeedAMPStatusChg = true;
5053 pBtMgnt->bNeedNotifyAMPNoCap = false;
5054
5055 BTHCI_DisconnectAll(padapter);
5056 } else if (AMP_Status == AMP_STATUS_FULL_CAPACITY_FOR_BT) {
5057 pBtMgnt->BTNeedAMPStatusChg = false;
5058 }
5059
5060 PPacketIrpEvent = (struct packet_irp_hcievent_data *)(&localBuf[0]);
5061 /* Return parameters starts from here */
5062 pRetPar = &PPacketIrpEvent->Data[0];
5063
5064 pRetPar[0] = 0; /* Status */
5065 len += 1;
5066 pRetPar[1] = AMP_Status; /* AMP_Status */
5067 len += 1;
5068
5069 PPacketIrpEvent->EventCode = HCI_EVENT_AMP_STATUS_CHANGE;
5070 PPacketIrpEvent->Length = len;
5071 if (bthci_IndicateEvent(padapter, PPacketIrpEvent, len+2) == RT_STATUS_SUCCESS)
5072 RTPRINT(FIOCTL, (IOCTL_BT_EVENT|IOCTL_STATE), ("[BT event], AMP Status Change, AMP_Status = %d\n", AMP_Status));
5073}
5074
5075void BTHCI_DisconnectAll(struct rtw_adapter *padapter)
5076{
5077 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
5078 u8 i;
5079
5080 RTPRINT(FIOCTL, IOCTL_STATE, (" DisconnectALL()\n"));
5081
5082 for (i = 0; i < MAX_BT_ASOC_ENTRY_NUM; i++) {
5083 if (pBTInfo->BtAsocEntry[i].b4waySuccess) {
5084 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_CONNECTED, STATE_CMD_DISCONNECT_PHY_LINK, i);
5085 } else if (pBTInfo->BtAsocEntry[i].bUsed) {
5086 if (pBTInfo->BtAsocEntry[i].BtCurrentState == HCI_STATE_CONNECTING) {
5087 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_CONNECTING, STATE_CMD_MAC_CONNECT_CANCEL_INDICATE, i);
5088 } else if (pBTInfo->BtAsocEntry[i].BtCurrentState == HCI_STATE_DISCONNECTING) {
5089 BTHCI_SM_WITH_INFO(padapter, HCI_STATE_DISCONNECTING, STATE_CMD_MAC_CONNECT_CANCEL_INDICATE, i);
5090 }
5091 }
5092 }
5093}
5094
5095enum hci_status
5096BTHCI_HandleHCICMD(
5097 struct rtw_adapter *padapter,
5098 struct packet_irp_hcicmd_data *pHciCmd
5099 )
5100{
5101 enum hci_status status = HCI_STATUS_SUCCESS;
5102 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
5103 struct bt_dgb *pBtDbg = &pBTInfo->BtDbg;
5104
5105 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("\n"));
5106 RTPRINT(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), ("HCI Command start, OGF = 0x%x, OCF = 0x%x, Length = 0x%x\n",
5107 pHciCmd->OGF, pHciCmd->OCF, pHciCmd->Length));
5108 if (pHciCmd->Length) {
5109 RTPRINT_DATA(FIOCTL, (IOCTL_BT_HCICMD_DETAIL|IOCTL_BT_LOGO), "HCI Command, Hex Data :\n",
5110 &pHciCmd->Data[0], pHciCmd->Length);
5111 }
5112 if (pHciCmd->OGF == OGF_EXTENSION) {
5113 if (pHciCmd->OCF == HCI_SET_RSSI_VALUE)
5114 RTPRINT(FIOCTL, IOCTL_BT_EVENT_PERIODICAL, ("[BT cmd], "));
5115 else
5116 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_EXT, ("[BT cmd], "));
5117 } else {
5118 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("[BT cmd], "));
5119 }
5120
5121 pBtDbg->dbgHciInfo.hciCmdCnt++;
5122
5123 switch (pHciCmd->OGF) {
5124 case LINK_CONTROL_COMMANDS:
5125 status = bthci_HandleOGFLinkControlCMD(padapter, pHciCmd);
5126 break;
5127 case HOLD_MODE_COMMAND:
5128 break;
5129 case OGF_SET_EVENT_MASK_COMMAND:
5130 status = bthci_HandleOGFSetEventMaskCMD(padapter, pHciCmd);
5131 break;
5132 case OGF_INFORMATIONAL_PARAMETERS:
5133 status = bthci_HandleOGFInformationalParameters(padapter, pHciCmd);
5134 break;
5135 case OGF_STATUS_PARAMETERS:
5136 status = bthci_HandleOGFStatusParameters(padapter, pHciCmd);
5137 break;
5138 case OGF_TESTING_COMMANDS:
5139 status = bthci_HandleOGFTestingCMD(padapter, pHciCmd);
5140 break;
5141 case OGF_EXTENSION:
5142 status = bthci_HandleOGFExtension(padapter, pHciCmd);
5143 break;
5144 default:
5145 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI Command(), Unknown OGF = 0x%x\n", pHciCmd->OGF));
5146 RTPRINT(FIOCTL, IOCTL_BT_HCICMD, ("HCI_UNKNOWN_COMMAND\n"));
5147 status = bthci_UnknownCMD(padapter, pHciCmd);
5148 break;
5149 }
5150 RTPRINT(FIOCTL, IOCTL_BT_HCICMD_DETAIL, ("HCI Command execution end!!\n"));
5151
5152 return status;
5153}
5154
5155/* ===== End of sync from SD7 driver COMMOM/bt_hci.c ===== */
f7c92d2c
LF		 5156
5157static const char *const BtStateString[] = {
5158 "BT_DISABLED",
5159 "BT_NO_CONNECTION",
5160 "BT_CONNECT_IDLE",
5161 "BT_INQ_OR_PAG",
5162 "BT_ACL_ONLY_BUSY",
5163 "BT_SCO_ONLY_BUSY",
5164 "BT_ACL_SCO_BUSY",
5165 "BT_ACL_INQ_OR_PAG",
5166 "BT_STATE_NOT_DEFINED"
5167};
5168
5169/* ===== Below this line is sync from SD7 driver HAL/BTCoexist/HalBtc87231Ant.c ===== */
5170
5171static void btdm_SetFwIgnoreWlanAct(struct rtw_adapter *padapter, u8 bEnable)
5172{
5173 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
5174 u8 H2C_Parameter[1] = {0};
5175
5176 if (bEnable) {
5177 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT Ignore Wlan_Act !!\n"));
5178 H2C_Parameter[0] |= BIT(0); /* function enable */
5179 pHalData->bt_coexist.bFWCoexistAllOff = false;
5180 } else {
5181 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT don't ignore Wlan_Act !!\n"));
5182 }
5183
5184 RTPRINT(FBT, BT_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, write 0x25 = 0x%02x\n",
5185 H2C_Parameter[0]));
5186
5187 FillH2CCmd(padapter, BT_IGNORE_WLAN_ACT_EID, 1, H2C_Parameter);
5188}
5189
5190static void btdm_NotifyFwScan(struct rtw_adapter *padapter, u8 scanType)
5191{
5192 u8 H2C_Parameter[1] = {0};
5193
5194 if (scanType == true)
5195 H2C_Parameter[0] = 0x1;
5196
5197 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Notify FW for wifi scan, write 0x3b = 0x%02x\n",
5198 H2C_Parameter[0]));
5199
5200 FillH2CCmd(padapter, 0x3b, 1, H2C_Parameter);
5201}
5202
5203static void btdm_1AntSetPSMode(struct rtw_adapter *padapter,
5204 u8 enable, u8 smartps, u8 mode)
5205{
5206 struct pwrctrl_priv *pwrctrl;
5207
5208 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Current LPS(%s, %d), smartps =%d\n", enable == true?"ON":"OFF", mode, smartps));
5209
5210 pwrctrl = &padapter->pwrctrlpriv;
5211
5212 if (enable == true) {
5213 rtw_set_ps_mode23a(padapter, PS_MODE_MIN, smartps, mode);
5214 } else {
5215 rtw_set_ps_mode23a(padapter, PS_MODE_ACTIVE, 0, 0);
5216 LPS_RF_ON_check23a(padapter, 100);
5217 }
5218}
5219
5220static void btdm_1AntTSFSwitch(struct rtw_adapter *padapter, u8 enable)
5221{
5222 u8 oldVal, newVal;
5223
050abc45 5224 oldVal = rtl8723au_read8(padapter, 0x550);
f7c92d2c
LF		 5225
5226 if (enable)
5227 newVal = oldVal | EN_BCN_FUNCTION;
5228 else
5229 newVal = oldVal & ~EN_BCN_FUNCTION;
5230
5231 if (oldVal != newVal)
edbfd672 5232 rtl8723au_write8(padapter, 0x550, newVal);
f7c92d2c
LF		 5233}
5234
5235static u8 btdm_Is1AntPsTdmaStateChange(struct rtw_adapter *padapter)
5236{
5237 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
5238 struct btdm_8723a_1ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm1Ant;
5239
5240 if ((pBtdm8723->bPrePsTdmaOn != pBtdm8723->bCurPsTdmaOn) ||
5241 (pBtdm8723->prePsTdma != pBtdm8723->curPsTdma))
5242 return true;
5243 else
5244 return false;
5245}
5246
5247/* Before enter TDMA, make sure Power Saving is enable! */
5248static void
5249btdm_1AntPsTdma(
5250 struct rtw_adapter *padapter,
5251 u8 bTurnOn,
5252 u8 type
5253 )
5254{
5255 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
5256 struct btdm_8723a_1ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm1Ant;
5257
5258 pBtdm8723->bCurPsTdmaOn = bTurnOn;
5259 pBtdm8723->curPsTdma = type;
5260 if (bTurnOn) {
5261 switch (type) {
5262 case 1: /* A2DP Level-1 or FTP/OPP */
5263 default:
5264 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5265 /* wide duration for WiFi */
5266 BTDM_SetFw3a(padapter, 0xd3, 0x1a, 0x1a, 0x0, 0x58);
5267 }
5268 break;
5269 case 2: /* A2DP Level-2 */
5270 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5271 /* normal duration for WiFi */
5272 BTDM_SetFw3a(padapter, 0xd3, 0x12, 0x12, 0x0, 0x58);
5273 }
5274 break;
5275 case 3: /* BT FTP/OPP */
5276 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5277 /* normal duration for WiFi */
5278 BTDM_SetFw3a(padapter, 0xd3, 0x30, 0x03, 0x10, 0x58);
5279
5280 }
5281 break;
5282 case 4: /* for wifi scan & BT is connected */
5283 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5284 /* protect 3 beacons in 3-beacon period & no Tx pause at BT slot */
5285 BTDM_SetFw3a(padapter, 0x93, 0x15, 0x03, 0x14, 0x0);
5286 }
5287 break;
5288 case 5: /* for WiFi connected-busy & BT is Non-Connected-Idle */
5289 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5290 /* SCO mode, Ant fixed at WiFi, WLAN_Act toggle */
5291 BTDM_SetFw3a(padapter, 0x61, 0x15, 0x03, 0x31, 0x00);
5292 }
5293 break;
5294 case 9: /* ACL high-retry type - 2 */
5295 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5296 /* narrow duration for WiFi */
5297 BTDM_SetFw3a(padapter, 0xd3, 0xa, 0xa, 0x0, 0x58); /* narrow duration for WiFi */
5298 }
5299 break;
5300 case 10: /* for WiFi connect idle & BT ACL busy or WiFi Connected-Busy & BT is Inquiry */
5301 if (btdm_Is1AntPsTdmaStateChange(padapter))
5302 BTDM_SetFw3a(padapter, 0x13, 0xa, 0xa, 0x0, 0x40);
5303 break;
5304 case 11: /* ACL high-retry type - 3 */
5305 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5306 /* narrow duration for WiFi */
5307 BTDM_SetFw3a(padapter, 0xd3, 0x05, 0x05, 0x00, 0x58);
5308 }
5309 break;
5310 case 12: /* for WiFi Connected-Busy & BT is Connected-Idle */
5311 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5312 /* Allow High-Pri BT */
5313 BTDM_SetFw3a(padapter, 0xeb, 0x0a, 0x03, 0x31, 0x18);
5314 }
5315 break;
5316 case 20: /* WiFi only busy , TDMA mode for power saving */
5317 if (btdm_Is1AntPsTdmaStateChange(padapter))
5318 BTDM_SetFw3a(padapter, 0x13, 0x25, 0x25, 0x00, 0x00);
5319 break;
5320 case 27: /* WiFi DHCP/Site Survey & BT SCO busy */
5321 if (btdm_Is1AntPsTdmaStateChange(padapter))
5322 BTDM_SetFw3a(padapter, 0xa3, 0x25, 0x03, 0x31, 0x98);
5323 break;
5324 case 28: /* WiFi DHCP/Site Survey & BT idle */
5325 if (btdm_Is1AntPsTdmaStateChange(padapter))
5326 BTDM_SetFw3a(padapter, 0x69, 0x25, 0x03, 0x31, 0x00);
5327 break;
5328 case 29: /* WiFi DHCP/Site Survey & BT ACL busy */
5329 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5330 BTDM_SetFw3a(padapter, 0xeb, 0x1a, 0x1a, 0x01, 0x18);
edbfd672
JS		 5331 rtl8723au_write32(padapter, 0x6c0, 0x5afa5afa);
5332 rtl8723au_write32(padapter, 0x6c4, 0x5afa5afa);
f7c92d2c
LF		 5333 }
5334 break;
5335 case 30: /* WiFi idle & BT Inquiry */
5336 if (btdm_Is1AntPsTdmaStateChange(padapter))
5337 BTDM_SetFw3a(padapter, 0x93, 0x15, 0x03, 0x14, 0x00);
5338 break;
5339 case 31: /* BT HID */
5340 if (btdm_Is1AntPsTdmaStateChange(padapter))
5341 BTDM_SetFw3a(padapter, 0xd3, 0x1a, 0x1a, 0x00, 0x58);
5342 break;
5343 case 32: /* BT SCO & Inquiry */
5344 if (btdm_Is1AntPsTdmaStateChange(padapter))
5345 BTDM_SetFw3a(padapter, 0xab, 0x0a, 0x03, 0x11, 0x98);
5346 break;
5347 case 33: /* BT SCO & WiFi site survey */
5348 if (btdm_Is1AntPsTdmaStateChange(padapter))
5349 BTDM_SetFw3a(padapter, 0xa3, 0x25, 0x03, 0x30, 0x98);
5350 break;
5351 case 34: /* BT HID & WiFi site survey */
5352 if (btdm_Is1AntPsTdmaStateChange(padapter))
5353 BTDM_SetFw3a(padapter, 0xd3, 0x1a, 0x1a, 0x00, 0x18);
5354 break;
5355 case 35: /* BT HID & WiFi Connecting */
5356 if (btdm_Is1AntPsTdmaStateChange(padapter))
5357 BTDM_SetFw3a(padapter, 0xe3, 0x1a, 0x1a, 0x00, 0x18);
5358 break;
5359 }
5360 } else {
5361 /* disable PS-TDMA */
5362 switch (type) {
5363 case 8:
5364 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5365 /* Antenna control by PTA, 0x870 = 0x310 */
5366 BTDM_SetFw3a(padapter, 0x8, 0x0, 0x0, 0x0, 0x0);
5367 }
5368 break;
5369 case 0:
5370 default:
5371 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5372 /* Antenna control by PTA, 0x870 = 0x310 */
5373 BTDM_SetFw3a(padapter, 0x0, 0x0, 0x0, 0x8, 0x0);
5374 }
edbfd672
JS		 5375 /* Switch Antenna to BT */
5376 rtl8723au_write16(padapter, 0x860, 0x210);
f7c92d2c
LF		 5377 RTPRINT(FBT, BT_TRACE, ("[BTCoex], 0x860 = 0x210, Switch Antenna to BT\n"));
5378 break;
5379 case 9:
5380 if (btdm_Is1AntPsTdmaStateChange(padapter)) {
5381 /* Antenna control by PTA, 0x870 = 0x310 */
5382 BTDM_SetFw3a(padapter, 0x0, 0x0, 0x0, 0x8, 0x0);
5383 }
edbfd672
JS		 5384 /* Switch Antenna to WiFi */
5385 rtl8723au_write16(padapter, 0x860, 0x110);
f7c92d2c
LF		 5386 RTPRINT(FBT, BT_TRACE, ("[BTCoex], 0x860 = 0x110, Switch Antenna to WiFi\n"));
5387 break;
5388 }
5389 }
5390
5391 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Current TDMA(%s, %d)\n",
5392 pBtdm8723->bCurPsTdmaOn?"ON":"OFF", pBtdm8723->curPsTdma));
5393
5394 /* update pre state */
5395 pBtdm8723->bPrePsTdmaOn = pBtdm8723->bCurPsTdmaOn;
5396 pBtdm8723->prePsTdma = pBtdm8723->curPsTdma;
5397}
5398
5399static void
5400_btdm_1AntSetPSTDMA(struct rtw_adapter *padapter, u8 bPSEn, u8 smartps,
5401 u8 psOption, u8 bTDMAOn, u8 tdmaType)
5402{
5403 struct pwrctrl_priv *pwrctrl;
5404 struct hal_data_8723a *pHalData;
5405 struct btdm_8723a_1ant *pBtdm8723;
5406 u8 psMode;
5407 u8 bSwitchPS;
5408
5409 if (!check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) &&
5410 (get_fwstate(&padapter->mlmepriv) != WIFI_NULL_STATE)) {
5411 btdm_1AntPsTdma(padapter, bTDMAOn, tdmaType);
5412 return;
5413 }
5414 psOption &= ~BIT(0);
5415
5416 RTPRINT(FBT, BT_TRACE,
5417 ("[BTCoex], Set LPS(%s, %d) TDMA(%s, %d)\n",
5418 bPSEn == true?"ON":"OFF", psOption,
5419 bTDMAOn == true?"ON":"OFF", tdmaType));
5420
5421 pwrctrl = &padapter->pwrctrlpriv;
5422 pHalData = GET_HAL_DATA(padapter);
5423 pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm1Ant;
5424
5425 if (bPSEn) {
5426 if (pBtdm8723->bWiFiHalt) {
5427 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Enable PS Fail, WiFi in Halt!!\n"));
5428 return;
5429 }
5430
5431 if (pwrctrl->bInSuspend) {
5432 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Enable PS Fail, WiFi in Suspend!!\n"));
5433 return;
5434 }
5435
5436 if (padapter->bDriverStopped) {
5437 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Enable PS Fail, WiFi driver stopped!!\n"));
5438 return;
5439 }
5440
5441 if (padapter->bSurpriseRemoved) {
5442 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Enable PS Fail, WiFi Surprise Removed!!\n"));
5443 return;
5444 }
5445
5446 psMode = PS_MODE_MIN;
5447 } else {
5448 psMode = PS_MODE_ACTIVE;
5449 psOption = 0;
5450 }
5451
5452 if (psMode != pwrctrl->pwr_mode) {
5453 bSwitchPS = true;
5454 } else if (psMode != PS_MODE_ACTIVE) {
5455 if (psOption != pwrctrl->bcn_ant_mode)
5456 bSwitchPS = true;
5457 else if (smartps != pwrctrl->smart_ps)
5458 bSwitchPS = true;
5459 else
5460 bSwitchPS = false;
5461 } else {
5462 bSwitchPS = false;
5463 }
5464
5465 if (bSwitchPS) {
5466 /* disable TDMA */
5467 if (pBtdm8723->bCurPsTdmaOn) {
5468 if (!bTDMAOn) {
5469 btdm_1AntPsTdma(padapter, false, tdmaType);
5470 } else {
bf2a7b99 5471 if (!rtl8723a_BT_enabled(padapter) ||
f7c92d2c
LF		 5472 (pHalData->bt_coexist.halCoex8723.c2hBtInfo == BT_INFO_STATE_NO_CONNECTION) ||
5473 (pHalData->bt_coexist.halCoex8723.c2hBtInfo == BT_INFO_STATE_CONNECT_IDLE) ||
5474 (tdmaType == 29))
5475 btdm_1AntPsTdma(padapter, false, 9);
5476 else
5477 btdm_1AntPsTdma(padapter, false, 0);
5478 }
5479 }
5480
5481 /* change Power Save State */
5482 btdm_1AntSetPSMode(padapter, bPSEn, smartps, psOption);
5483 }
5484
5485 btdm_1AntPsTdma(padapter, bTDMAOn, tdmaType);
5486}
5487
5488static void
5489btdm_1AntSetPSTDMA(struct rtw_adapter *padapter, u8 bPSEn,
5490 u8 psOption, u8 bTDMAOn, u8 tdmaType)
5491{
5492 _btdm_1AntSetPSTDMA(padapter, bPSEn, 0, psOption, bTDMAOn, tdmaType);
5493}
5494
5495static void btdm_1AntWifiParaAdjust(struct rtw_adapter *padapter, u8 bEnable)
5496{
5497 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
5498 struct btdm_8723a_1ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm1Ant;
5499
5500 if (bEnable) {
5501 pBtdm8723->curWifiPara = 1;
5502 if (pBtdm8723->preWifiPara != pBtdm8723->curWifiPara)
5503 BTDM_SetSwPenaltyTxRateAdaptive(padapter, BT_TX_RATE_ADAPTIVE_LOW_PENALTY);
5504 } else {
5505 pBtdm8723->curWifiPara = 2;
5506 if (pBtdm8723->preWifiPara != pBtdm8723->curWifiPara)
5507 BTDM_SetSwPenaltyTxRateAdaptive(padapter, BT_TX_RATE_ADAPTIVE_NORMAL);
5508 }
5509
5510}
5511
5512static void btdm_1AntPtaParaReload(struct rtw_adapter *padapter)
5513{
5514 /* PTA parameter */
edbfd672
JS		 5515 rtl8723au_write8(padapter, 0x6cc, 0x0); /* 1-Ant coex */
5516 rtl8723au_write32(padapter, 0x6c8, 0xffff); /* wifi break table */
5517 rtl8723au_write32(padapter, 0x6c4, 0x55555555); /* coex table */
f7c92d2c
LF		 5518
5519 /* Antenna switch control parameter */
edbfd672 5520 rtl8723au_write32(padapter, 0x858, 0xaaaaaaaa);
f7c92d2c 5521 if (IS_8723A_A_CUT(GET_HAL_DATA(padapter)->VersionID)) {
edbfd672
JS		 5522 /* SPDT(connected with TRSW) control by hardware PTA */
5523 rtl8723au_write32(padapter, 0x870, 0x0);
5524 rtl8723au_write8(padapter, 0x40, 0x24);
f7c92d2c 5525 } else {
edbfd672
JS		 5526 rtl8723au_write8(padapter, 0x40, 0x20);
5527 /* set antenna at bt side if ANTSW is software control */
5528 rtl8723au_write16(padapter, 0x860, 0x210);
5529 /* SPDT(connected with TRSW) control by hardware PTA */
5530 rtl8723au_write32(padapter, 0x870, 0x300);
5531 /* ANTSW keep by GNT_BT */
5532 rtl8723au_write32(padapter, 0x874, 0x22804000);
f7c92d2c
LF		 5533 }
5534
5535 /* coexistence parameters */
edbfd672 5536 rtl8723au_write8(padapter, 0x778, 0x1); /* enable RTK mode PTA */
f7c92d2c
LF		 5537
5538 /* BT don't ignore WLAN_Act */
5539 btdm_SetFwIgnoreWlanAct(padapter, false);
5540}
5541
5542/*
5543 * Return
5544 *1: upgrade (add WiFi duration time)
5545 *0: keep
5546 *-1: downgrade (add BT duration time)
5547 */
5548static s8 btdm_1AntTdmaJudgement(struct rtw_adapter *padapter, u8 retry)
5549{
5550 struct hal_data_8723a *pHalData;
5551 struct btdm_8723a_1ant *pBtdm8723;
5552 static s8 up, dn, m = 1, n = 3, WaitCount;
5553 s8 ret;
5554
5555 pHalData = GET_HAL_DATA(padapter);
5556 pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm1Ant;
5557 ret = 0;
5558
5559 if (pBtdm8723->psTdmaMonitorCnt == 0) {
5560 up = 0;
5561 dn = 0;
5562 m = 1;
5563 n = 3;
5564 WaitCount = 0;
5565 } else {
5566 WaitCount++;
5567 }
5568
5569 if (retry == 0) {
5570 /* no retry in the last 2-second duration */
5571 up++;
5572 dn--;
5573 if (dn < 0)
5574 dn = 0;
5575 if (up >= 3*m) {
5576 /* retry = 0 in consecutive 3m*(2s), add WiFi duration */
5577 ret = 1;
5578
5579 n = 3;
5580 up = 0;
5581 dn = 0;
5582 WaitCount = 0;
5583 }
5584 } else if (retry <= 3) {
5585 /* retry<= 3 in the last 2-second duration */
5586 up--;
5587 dn++;
5588 if (up < 0)
5589 up = 0;
5590
5591 if (dn == 2) {
5592 /* retry<= 3 in consecutive 2*(2s), minus WiFi duration (add BT duration) */
5593 ret = -1;
5594
5595 /* record how many time downgrad WiFi duration */
5596 if (WaitCount <= 2)
5597 m++;
5598 else
5599 m = 1;
5600 /* the max number of m is 20 */
5601 /* the longest time of upgrade WiFi duration is 20*3*2s = 120s */
5602 if (m >= 20)
5603 m = 20;
5604 up = 0;
5605 dn = 0;
5606 WaitCount = 0;
5607 }
5608 } else {
5609 /* retry count > 3 */
5610 /* retry>3, minus WiFi duration (add BT duration) */
5611 ret = -1;
5612
5613 /* record how many time downgrad WiFi duration */
5614 if (WaitCount == 1)
5615 m++;
5616 else
5617 m = 1;
5618 if (m >= 20)
5619 m = 20;
5620
5621 up = 0;
5622 dn = 0;
5623 WaitCount = 0;
5624 }
5625 return ret;
5626}
5627
5628static void btdm_1AntTdmaDurationAdjustForACL(struct rtw_adapter *padapter)
5629{
5630 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
5631 struct btdm_8723a_1ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm1Ant;
5632
5633 if (pBtdm8723->psTdmaGlobalCnt != pBtdm8723->psTdmaMonitorCnt) {
5634 pBtdm8723->psTdmaMonitorCnt = 0;
5635 pBtdm8723->psTdmaGlobalCnt = 0;
5636 }
5637 if (pBtdm8723->psTdmaMonitorCnt == 0) {
5638 btdm_1AntSetPSTDMA(padapter, true, 0, true, 2);
5639 pBtdm8723->psTdmaDuAdjType = 2;
5640 } else {
5641 /* Now we only have 4 level Ps Tdma, */
5642 /* if that's not the following 4 level(will changed by wifi scan, dhcp...), */
5643 /* then we have to adjust it back to the previous record one. */
5644 if ((pBtdm8723->curPsTdma != 1) &&
5645 (pBtdm8723->curPsTdma != 2) &&
5646 (pBtdm8723->curPsTdma != 9) &&
5647 (pBtdm8723->curPsTdma != 11)) {
5648 btdm_1AntSetPSTDMA(padapter, true, 0, true, pBtdm8723->psTdmaDuAdjType);
5649 } else {
5650 s32 judge = 0;
5651
5652 judge = btdm_1AntTdmaJudgement(padapter, pHalData->bt_coexist.halCoex8723.btRetryCnt);
5653 if (judge == -1) {
5654 if (pBtdm8723->curPsTdma == 1) {
5655 /* Decrease WiFi duration for high BT retry */
5656 if (pHalData->bt_coexist.halCoex8723.btInfoExt)
5657 pBtdm8723->psTdmaDuAdjType = 9;
5658 else
5659 pBtdm8723->psTdmaDuAdjType = 2;
5660 btdm_1AntSetPSTDMA(padapter, true, 0, true, pBtdm8723->psTdmaDuAdjType);
5661 } else if (pBtdm8723->curPsTdma == 2) {
5662 btdm_1AntSetPSTDMA(padapter, true, 0, true, 9);
5663 pBtdm8723->psTdmaDuAdjType = 9;
5664 } else if (pBtdm8723->curPsTdma == 9) {
5665 btdm_1AntSetPSTDMA(padapter, true, 0, true, 11);
5666 pBtdm8723->psTdmaDuAdjType = 11;
5667 }
5668 } else if (judge == 1) {
5669 if (pBtdm8723->curPsTdma == 11) {
5670 btdm_1AntSetPSTDMA(padapter, true, 0, true, 9);
5671 pBtdm8723->psTdmaDuAdjType = 9;
5672 } else if (pBtdm8723->curPsTdma == 9) {
5673 if (pHalData->bt_coexist.halCoex8723.btInfoExt)
5674 pBtdm8723->psTdmaDuAdjType = 9;
5675 else
5676 pBtdm8723->psTdmaDuAdjType = 2;
5677 btdm_1AntSetPSTDMA(padapter, true, 0, true, pBtdm8723->psTdmaDuAdjType);
5678 } else if (pBtdm8723->curPsTdma == 2) {
5679 if (pHalData->bt_coexist.halCoex8723.btInfoExt)
5680 pBtdm8723->psTdmaDuAdjType = 9;
5681 else
5682 pBtdm8723->psTdmaDuAdjType = 1;
5683 btdm_1AntSetPSTDMA(padapter, true, 0, true, pBtdm8723->psTdmaDuAdjType);
5684 }
5685 }
5686 }
5687 RTPRINT(FBT, BT_TRACE,
5688 ("[BTCoex], ACL current TDMA(%s, %d)\n",
5689 (pBtdm8723->bCurPsTdmaOn ? "ON" : "OFF"), pBtdm8723->curPsTdma));
5690 }
5691 pBtdm8723->psTdmaMonitorCnt++;
5692}
5693
5694static void btdm_1AntCoexProcessForWifiConnect(struct rtw_adapter *padapter)
5695{
5696 struct mlme_priv *pmlmepriv;
5697 struct hal_data_8723a *pHalData;
5698 struct bt_coexist_8723a *pBtCoex;
5699 struct btdm_8723a_1ant *pBtdm8723;
5700 u8 BtState;
5701
5702 pmlmepriv = &padapter->mlmepriv;
5703 pHalData = GET_HAL_DATA(padapter);
5704 pBtCoex = &pHalData->bt_coexist.halCoex8723;
5705 pBtdm8723 = &pBtCoex->btdm1Ant;
5706 BtState = pBtCoex->c2hBtInfo;
5707
4d435952
JS		 5708 RTPRINT(FBT, BT_TRACE, ("[BTCoex], WiFi is %s\n",
5709 BTDM_IsWifiBusy(padapter)?"Busy":"IDLE"));
5710 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT is %s\n",
5711 BtStateString[BtState]));
f7c92d2c
LF		 5712
5713 padapter->pwrctrlpriv.btcoex_rfon = false;
5714
4d435952
JS		 5715 if (!BTDM_IsWifiBusy(padapter) &&
5716 !check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) &&
5717 (BtState == BT_INFO_STATE_NO_CONNECTION ||
5718 BtState == BT_INFO_STATE_CONNECT_IDLE)) {
f7c92d2c
LF		 5719 switch (BtState) {
5720 case BT_INFO_STATE_NO_CONNECTION:
5721 _btdm_1AntSetPSTDMA(padapter, true, 2, 0x26, false, 9);
5722 break;
5723 case BT_INFO_STATE_CONNECT_IDLE:
5724 _btdm_1AntSetPSTDMA(padapter, true, 2, 0x26, false, 0);
5725 break;
5726 }
5727 } else {
5728 switch (BtState) {
5729 case BT_INFO_STATE_NO_CONNECTION:
5730 case BT_INFO_STATE_CONNECT_IDLE:
5731 /* WiFi is Busy */
5732 btdm_1AntSetPSTDMA(padapter, false, 0, true, 5);
edbfd672
JS		 5733 rtl8723au_write32(padapter, 0x6c0, 0x5a5a5a5a);
5734 rtl8723au_write32(padapter, 0x6c4, 0x5a5a5a5a);
f7c92d2c
LF		 5735 break;
5736 case BT_INFO_STATE_ACL_INQ_OR_PAG:
4d435952
JS		 5737 RTPRINT(FBT, BT_TRACE,
5738 ("[BTCoex], BT PROFILE is "
5739 "BT_INFO_STATE_ACL_INQ_OR_PAG\n"));
f7c92d2c
LF		 5740 case BT_INFO_STATE_INQ_OR_PAG:
5741 padapter->pwrctrlpriv.btcoex_rfon = true;
5742 btdm_1AntSetPSTDMA(padapter, true, 0, true, 30);
5743 break;
5744 case BT_INFO_STATE_SCO_ONLY_BUSY:
5745 case BT_INFO_STATE_ACL_SCO_BUSY:
4d435952
JS		 5746 if (true == pBtCoex->bC2hBtInquiryPage)
5747 btdm_1AntSetPSTDMA(padapter, false, 0,
5748 true, 32);
5749 else {
f7c92d2c 5750#ifdef BTCOEX_CMCC_TEST
4d435952
JS		 5751 btdm_1AntSetPSTDMA(padapter, false, 0,
5752 true, 23);
f7c92d2c 5753#else /* !BTCOEX_CMCC_TEST */
4d435952
JS		 5754 btdm_1AntSetPSTDMA(padapter, false, 0,
5755 false, 8);
edbfd672
JS		 5756 rtl8723au_write32(padapter, 0x6c0, 0x5a5a5a5a);
5757 rtl8723au_write32(padapter, 0x6c4, 0x5a5a5a5a);
f7c92d2c
LF		 5758#endif /* !BTCOEX_CMCC_TEST */
5759 }
5760 break;
5761 case BT_INFO_STATE_ACL_ONLY_BUSY:
5762 padapter->pwrctrlpriv.btcoex_rfon = true;
5763 if (pBtCoex->c2hBtProfile == BT_INFO_HID) {
4d435952
JS		 5764 RTPRINT(FBT, BT_TRACE,
5765 ("[BTCoex], BT PROFILE is HID\n"));
f7c92d2c
LF		 5766 btdm_1AntSetPSTDMA(padapter, true, 0, true, 31);
5767 } else if (pBtCoex->c2hBtProfile == BT_INFO_FTP) {
4d435952
JS		 5768 RTPRINT(FBT, BT_TRACE,
5769 ("[BTCoex], BT PROFILE is FTP/OPP\n"));
f7c92d2c
LF		 5770 btdm_1AntSetPSTDMA(padapter, true, 0, true, 3);
5771 } else if (pBtCoex->c2hBtProfile == (BT_INFO_A2DP|BT_INFO_FTP)) {
4d435952
JS		 5772 RTPRINT(FBT, BT_TRACE,
5773 ("[BTCoex], BT PROFILE is A2DP_FTP\n"));
f7c92d2c
LF		 5774 btdm_1AntSetPSTDMA(padapter, true, 0, true, 11);
5775 } else {
5776 if (pBtCoex->c2hBtProfile == BT_INFO_A2DP)
4d435952
JS		 5777 RTPRINT(FBT, BT_TRACE,
5778 ("[BTCoex], BT PROFILE is "
5779 "A2DP\n"));
f7c92d2c 5780 else
4d435952
JS		 5781 RTPRINT(FBT, BT_TRACE,
5782 ("[BTCoex], BT PROFILE is "
5783 "UNKNOWN(0x%02X)! Use A2DP "
5784 "Profile\n",
5785 pBtCoex->c2hBtProfile));
f7c92d2c
LF		 5786 btdm_1AntTdmaDurationAdjustForACL(padapter);
5787 }
5788 break;
5789 }
5790 }
5791
5792 pBtdm8723->psTdmaGlobalCnt++;
5793}
5794
4d435952
JS		 5795static void
5796btdm_1AntUpdateHalRAMask(struct rtw_adapter *padapter, u32 mac_id, u32 filter)
f7c92d2c
LF		 5797{
5798 u8 init_rate = 0;
b1e4d2f6 5799 u8 raid, arg;
f7c92d2c
LF		 5800 u32 mask;
5801 u8 shortGIrate = false;
4d435952 5802 int supportRateNum = 0;
f7c92d2c
LF		 5803 struct sta_info *psta;
5804 struct hal_data_8723a *pHalData;
5805 struct dm_priv *pdmpriv;
5806 struct mlme_ext_priv *pmlmeext;
5807 struct mlme_ext_info *pmlmeinfo;
5808 struct wlan_bssid_ex *cur_network;
5809
4d435952
JS		 5810 RTPRINT(FBT, BT_TRACE, ("[BTCoex], %s, MACID =%d, filter = 0x%08x!!\n",
5811 __func__, mac_id, filter));
f7c92d2c
LF		 5812
5813 pHalData = GET_HAL_DATA(padapter);
5814 pdmpriv = &pHalData->dmpriv;
5815 pmlmeext = &padapter->mlmeextpriv;
5816 pmlmeinfo = &pmlmeext->mlmext_info;
5817 cur_network = &pmlmeinfo->network;
5818
5819 if (mac_id >= NUM_STA) { /* CAM_SIZE */
4d435952
JS		 5820 RTPRINT(FBT, BT_TRACE, ("[BTCoex], %s, MACID =%d illegal!!\n",
5821 __func__, mac_id));
f7c92d2c
LF		 5822 return;
5823 }
5824
5825 psta = pmlmeinfo->FW_sta_info[mac_id].psta;
4d435952
JS		 5826 if (!psta) {
5827 RTPRINT(FBT, BT_TRACE, ("[BTCoex], %s, Can't find station!!\n",
5828 __func__));
f7c92d2c
LF		 5829 return;
5830 }
5831
5832 raid = psta->raid;
5833
5834 switch (mac_id) {
5835 case 0:/* for infra mode */
4d435952
JS		 5836 supportRateNum =
5837 rtw_get_rateset_len23a(cur_network->SupportedRates);
5838 mask = update_supported_rate23a(cur_network->SupportedRates,
5839 supportRateNum);
5840 mask |= (pmlmeinfo->HT_enable) ?
65be27da
JS		 5841 update_MSC_rate23a(&pmlmeinfo->ht_cap):0;
5842 if (support_short_GI23a(padapter, &pmlmeinfo->ht_cap))
f7c92d2c
LF		 5843 shortGIrate = true;
5844 break;
5845 case 1:/* for broadcast/multicast */
4d435952
JS		 5846 supportRateNum = rtw_get_rateset_len23a(
5847 pmlmeinfo->FW_sta_info[mac_id].SupportedRates);
5848 mask = update_basic_rate23a(cur_network->SupportedRates,
5849 supportRateNum);
f7c92d2c
LF		 5850 break;
5851 default: /* for each sta in IBSS */
4d435952
JS		 5852 supportRateNum = rtw_get_rateset_len23a(
5853 pmlmeinfo->FW_sta_info[mac_id].SupportedRates);
5854 mask = update_supported_rate23a(cur_network->SupportedRates,
5855 supportRateNum);
f7c92d2c
LF		 5856 break;
5857 }
5858 mask |= ((raid<<28)&0xf0000000);
5859 mask &= 0xffffffff;
5860 mask &= ~filter;
5861 init_rate = get_highest_rate_idx23a(mask)&0x3f;
5862
b1e4d2f6
JS		 5863 arg = mac_id&0x1f;/* MACID */
5864 arg |= BIT(7);
5865 if (true == shortGIrate)
5866 arg |= BIT(5);
f7c92d2c 5867
b1e4d2f6
JS		 5868 RTPRINT(FBT, BT_TRACE,
5869 ("[BTCoex], Update FW RAID entry, MASK = 0x%08x, "
5870 "arg = 0x%02x\n", mask, arg));
f7c92d2c 5871
b1e4d2f6 5872 rtl8723a_set_raid_cmd(padapter, mask, arg);
f7c92d2c
LF		 5873
5874 psta->init_rate = init_rate;
5875 pdmpriv->INIDATA_RATE[mac_id] = init_rate;
5876}
5877
4d435952
JS		 5878static void
5879btdm_1AntUpdateHalRAMaskForSCO(struct rtw_adapter *padapter, u8 forceUpdate)
f7c92d2c
LF		 5880{
5881 struct btdm_8723a_1ant *pBtdm8723;
5882 struct sta_priv *pstapriv;
5883 struct wlan_bssid_ex *cur_network;
5884 struct sta_info *psta;
5885 u32 macid;
5886 u32 filter = 0;
5887
5888 pBtdm8723 = &GET_HAL_DATA(padapter)->bt_coexist.halCoex8723.btdm1Ant;
5889
4d435952 5890 if (pBtdm8723->bRAChanged == true && forceUpdate == false)
f7c92d2c
LF		 5891 return;
5892
5893 pstapriv = &padapter->stapriv;
5894 cur_network = &padapter->mlmeextpriv.mlmext_info.network;
5895 psta = rtw_get_stainfo23a(pstapriv, cur_network->MacAddress);
5896 macid = psta->mac_id;
5897
5898 filter |= BIT(_1M_RATE_);
5899 filter |= BIT(_2M_RATE_);
5900 filter |= BIT(_5M_RATE_);
5901 filter |= BIT(_11M_RATE_);
5902 filter |= BIT(_6M_RATE_);
5903 filter |= BIT(_9M_RATE_);
5904
5905 btdm_1AntUpdateHalRAMask(padapter, macid, filter);
5906
5907 pBtdm8723->bRAChanged = true;
5908}
5909
5910static void btdm_1AntRecoverHalRAMask(struct rtw_adapter *padapter)
5911{
5912 struct btdm_8723a_1ant *pBtdm8723;
5913 struct sta_priv *pstapriv;
5914 struct wlan_bssid_ex *cur_network;
5915 struct sta_info *psta;
5916
5917 pBtdm8723 = &GET_HAL_DATA(padapter)->bt_coexist.halCoex8723.btdm1Ant;
5918
5919 if (pBtdm8723->bRAChanged == false)
5920 return;
5921
5922 pstapriv = &padapter->stapriv;
5923 cur_network = &padapter->mlmeextpriv.mlmext_info.network;
5924 psta = rtw_get_stainfo23a(pstapriv, cur_network->MacAddress);
5925
5926 Update_RA_Entry23a(padapter, psta);
5927
5928 pBtdm8723->bRAChanged = false;
5929}
5930
5931static void
5932btdm_1AntBTStateChangeHandler(struct rtw_adapter *padapter,
4d435952
JS		 5933 enum bt_state_1ant oldState,
5934 enum bt_state_1ant newState)
f7c92d2c 5935{
4d435952
JS		 5936 struct hal_data_8723a *phaldata;
5937 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT state change, %s => %s\n",
5938 BtStateString[oldState],
5939 BtStateString[newState]));
f7c92d2c
LF		 5940
5941 /* BT default ignore wlan active, */
5942 /* WiFi MUST disable this when BT is enable */
5943 if (newState > BT_INFO_STATE_DISABLED)
5944 btdm_SetFwIgnoreWlanAct(padapter, false);
5945
5946 if ((check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) &&
5947 (BTDM_IsWifiConnectionExist(padapter))) {
5948 if ((newState == BT_INFO_STATE_SCO_ONLY_BUSY) ||
5949 (newState == BT_INFO_STATE_ACL_SCO_BUSY)) {
5950 btdm_1AntUpdateHalRAMaskForSCO(padapter, false);
5951 } else {
5952 /* Recover original RA setting */
5953 btdm_1AntRecoverHalRAMask(padapter);
5954 }
5955 } else {
4d435952
JS		 5956 phaldata = GET_HAL_DATA(padapter);
5957 phaldata->bt_coexist.halCoex8723.btdm1Ant.bRAChanged = false;
f7c92d2c
LF		 5958 }
5959
5960 if (oldState == newState)
5961 return;
5962
5963 if (oldState == BT_INFO_STATE_ACL_ONLY_BUSY) {
4d435952
JS		 5964 struct hal_data_8723a *Hal = GET_HAL_DATA(padapter);
5965 Hal->bt_coexist.halCoex8723.btdm1Ant.psTdmaMonitorCnt = 0;
5966 Hal->bt_coexist.halCoex8723.btdm1Ant.psTdmaMonitorCntForSCO = 0;
f7c92d2c
LF		 5967 }
5968
5969 if ((oldState == BT_INFO_STATE_SCO_ONLY_BUSY) ||
5970 (oldState == BT_INFO_STATE_ACL_SCO_BUSY)) {
4d435952
JS		 5971 struct hal_data_8723a *Hal = GET_HAL_DATA(padapter);
5972 Hal->bt_coexist.halCoex8723.btdm1Ant.psTdmaMonitorCntForSCO = 0;
f7c92d2c
LF		 5973 }
5974
5975 /* Active 2Ant mechanism when BT Connected */
5976 if ((oldState == BT_INFO_STATE_DISABLED) ||
5977 (oldState == BT_INFO_STATE_NO_CONNECTION)) {
5978 if ((newState != BT_INFO_STATE_DISABLED) &&
5979 (newState != BT_INFO_STATE_NO_CONNECTION)) {
4d435952
JS		 5980 BTDM_SetSwRfRxLpfCorner(padapter,
5981 BT_RF_RX_LPF_CORNER_SHRINK);
f7c92d2c
LF		 5982 BTDM_AGCTable(padapter, BT_AGCTABLE_ON);
5983 BTDM_BBBackOffLevel(padapter, BT_BB_BACKOFF_ON);
5984 }
5985 } else {
5986 if ((newState == BT_INFO_STATE_DISABLED) ||
5987 (newState == BT_INFO_STATE_NO_CONNECTION)) {
4d435952
JS		 5988 BTDM_SetSwRfRxLpfCorner(padapter,
5989 BT_RF_RX_LPF_CORNER_RESUME);
f7c92d2c
LF		 5990 BTDM_AGCTable(padapter, BT_AGCTABLE_OFF);
5991 BTDM_BBBackOffLevel(padapter, BT_BB_BACKOFF_OFF);
5992 }
5993 }
5994}
5995
5996static void btdm_1AntBtCoexistHandler(struct rtw_adapter *padapter)
5997{
5998 struct hal_data_8723a *pHalData;
5999 struct bt_coexist_8723a *pBtCoex8723;
6000 struct btdm_8723a_1ant *pBtdm8723;
6001
6002 pHalData = GET_HAL_DATA(padapter);
6003 pBtCoex8723 = &pHalData->bt_coexist.halCoex8723;
6004 pBtdm8723 = &pBtCoex8723->btdm1Ant;
6005 padapter->pwrctrlpriv.btcoex_rfon = false;
bf2a7b99 6006 if (!rtl8723a_BT_enabled(padapter)) {
f7c92d2c
LF		 6007 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT is disabled\n"));
6008
6009 if (BTDM_IsWifiConnectionExist(padapter)) {
4d435952
JS		 6010 RTPRINT(FBT, BT_TRACE,
6011 ("[BTCoex], wifi is connected\n"));
f7c92d2c
LF		 6012
6013 if (BTDM_IsWifiBusy(padapter)) {
4d435952
JS		 6014 RTPRINT(FBT, BT_TRACE,
6015 ("[BTCoex], Wifi is busy\n"));
6016 btdm_1AntSetPSTDMA(padapter, false, 0,
6017 false, 9);
f7c92d2c 6018 } else {
4d435952
JS		 6019 RTPRINT(FBT, BT_TRACE,
6020 ("[BTCoex], Wifi is idle\n"));
6021 _btdm_1AntSetPSTDMA(padapter, true, 2, 1,
6022 false, 9);
f7c92d2c
LF		 6023 }
6024 } else {
4d435952
JS		 6025 RTPRINT(FBT, BT_TRACE,
6026 ("[BTCoex], wifi is disconnected\n"));
f7c92d2c
LF		 6027
6028 btdm_1AntSetPSTDMA(padapter, false, 0, false, 9);
6029 }
6030 } else {
6031 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT is enabled\n"));
6032
6033 if (BTDM_IsWifiConnectionExist(padapter)) {
4d435952
JS		 6034 RTPRINT(FBT, BT_TRACE,
6035 ("[BTCoex], wifi is connected\n"));
f7c92d2c
LF		 6036
6037 btdm_1AntWifiParaAdjust(padapter, true);
6038 btdm_1AntCoexProcessForWifiConnect(padapter);
6039 } else {
4d435952
JS		 6040 RTPRINT(FBT, BT_TRACE,
6041 ("[BTCoex], wifi is disconnected\n"));
f7c92d2c 6042
4d435952
JS		 6043 /* Antenna switch at BT side(0x870 = 0x300,
6044 0x860 = 0x210) after PSTDMA off */
f7c92d2c
LF		 6045 btdm_1AntWifiParaAdjust(padapter, false);
6046 btdm_1AntSetPSTDMA(padapter, false, 0, false, 0);
6047 }
6048 }
6049
4d435952
JS		 6050 btdm_1AntBTStateChangeHandler(padapter, pBtCoex8723->prec2hBtInfo,
6051 pBtCoex8723->c2hBtInfo);
f7c92d2c
LF		 6052 pBtCoex8723->prec2hBtInfo = pBtCoex8723->c2hBtInfo;
6053}
6054
4d435952
JS		 6055void BTDM_1AntSignalCompensation(struct rtw_adapter *padapter,
6056 u8 *rssi_wifi, u8 *rssi_bt)
f7c92d2c
LF		 6057{
6058 struct hal_data_8723a *pHalData;
6059 struct btdm_8723a_1ant *pBtdm8723;
6060 u8 RSSI_WiFi_Cmpnstn, RSSI_BT_Cmpnstn;
6061
6062 pHalData = GET_HAL_DATA(padapter);
6063 pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm1Ant;
6064 RSSI_WiFi_Cmpnstn = 0;
6065 RSSI_BT_Cmpnstn = 0;
6066
6067 switch (pBtdm8723->curPsTdma) {
6068 case 1: /* WiFi 52ms */
6069 RSSI_WiFi_Cmpnstn = 11; /* 22*0.48 */
6070 break;
6071 case 2: /* WiFi 36ms */
6072 RSSI_WiFi_Cmpnstn = 14; /* 22*0.64 */
6073 break;
6074 case 9: /* WiFi 20ms */
6075 RSSI_WiFi_Cmpnstn = 18; /* 22*0.80 */
6076 break;
6077 case 11: /* WiFi 10ms */
6078 RSSI_WiFi_Cmpnstn = 20; /* 22*0.90 */
6079 break;
6080 case 4: /* WiFi 21ms */
6081 RSSI_WiFi_Cmpnstn = 17; /* 22*0.79 */
6082 break;
6083 case 16: /* WiFi 24ms */
6084 RSSI_WiFi_Cmpnstn = 18; /* 22*0.76 */
6085 break;
6086 case 18: /* WiFi 37ms */
6087 RSSI_WiFi_Cmpnstn = 14; /* 22*0.64 */
6088 break;
6089 case 23: /* Level-1, Antenna switch to BT at all time */
6090 case 24: /* Level-2, Antenna switch to BT at all time */
6091 case 25: /* Level-3a, Antenna switch to BT at all time */
6092 case 26: /* Level-3b, Antenna switch to BT at all time */
6093 case 27: /* Level-3b, Antenna switch to BT at all time */
6094 case 33: /* BT SCO & WiFi site survey */
6095 RSSI_WiFi_Cmpnstn = 22;
6096 break;
6097 default:
6098 break;
6099 }
6100
6101 if (rssi_wifi && RSSI_WiFi_Cmpnstn) {
4d435952
JS		 6102 RTPRINT(FBT, BT_TRACE,
6103 ("[BTCoex], 1AntSgnlCmpnstn, case %d, WiFiCmpnstn "
6104 "=%d(%d => %d)\n", pBtdm8723->curPsTdma,
6105 RSSI_WiFi_Cmpnstn, *rssi_wifi,
6106 *rssi_wifi+RSSI_WiFi_Cmpnstn));
f7c92d2c
LF		 6107 *rssi_wifi += RSSI_WiFi_Cmpnstn;
6108 }
6109
6110 if (rssi_bt && RSSI_BT_Cmpnstn) {
4d435952
JS		 6111 RTPRINT(FBT, BT_TRACE,
6112 ("[BTCoex], 1AntSgnlCmpnstn, case %d, BTCmpnstn "
6113 "=%d(%d => %d)\n", pBtdm8723->curPsTdma,
6114 RSSI_BT_Cmpnstn, *rssi_bt, *rssi_bt+RSSI_BT_Cmpnstn));
f7c92d2c
LF		 6115 *rssi_bt += RSSI_BT_Cmpnstn;
6116 }
6117}
6118
6119static void BTDM_1AntParaInit(struct rtw_adapter *padapter)
6120{
6121 struct hal_data_8723a *pHalData;
6122 struct bt_coexist_8723a *pBtCoex;
6123 struct btdm_8723a_1ant *pBtdm8723;
6124
6125 pHalData = GET_HAL_DATA(padapter);
6126 pBtCoex = &pHalData->bt_coexist.halCoex8723;
6127 pBtdm8723 = &pBtCoex->btdm1Ant;
6128
6129 /* Enable counter statistics */
edbfd672 6130 rtl8723au_write8(padapter, 0x76e, 0x4);
f7c92d2c
LF		 6131 btdm_1AntPtaParaReload(padapter);
6132
6133 pBtdm8723->wifiRssiThresh = 48;
6134
6135 pBtdm8723->bWiFiHalt = false;
6136 pBtdm8723->bRAChanged = false;
6137
6138 if ((pBtCoex->c2hBtInfo != BT_INFO_STATE_DISABLED) &&
6139 (pBtCoex->c2hBtInfo != BT_INFO_STATE_NO_CONNECTION)) {
6140 BTDM_SetSwRfRxLpfCorner(padapter, BT_RF_RX_LPF_CORNER_SHRINK);
6141 BTDM_AGCTable(padapter, BT_AGCTABLE_ON);
6142 BTDM_BBBackOffLevel(padapter, BT_BB_BACKOFF_ON);
6143 }
6144}
6145
6146static void BTDM_1AntForHalt(struct rtw_adapter *padapter)
6147{
6148 RTPRINT(FBT, BT_TRACE, ("\n[BTCoex], 1Ant for halt\n"));
6149
4d435952
JS		 6150 GET_HAL_DATA(padapter)->bt_coexist.halCoex8723.btdm1Ant.bWiFiHalt =
6151 true;
f7c92d2c
LF		 6152
6153 btdm_1AntWifiParaAdjust(padapter, false);
6154
6155 /* don't use btdm_1AntSetPSTDMA() here */
6156 /* it will call rtw_set_ps_mode23a() and request pwrpriv->lock. */
6157 /* This will lead to deadlock, if this function is called in IPS */
6158 /* Lucas@20130205 */
6159 btdm_1AntPsTdma(padapter, false, 0);
6160
6161 btdm_SetFwIgnoreWlanAct(padapter, true);
6162}
6163
6164static void BTDM_1AntLpsLeave(struct rtw_adapter *padapter)
6165{
6166 RTPRINT(FBT, BT_TRACE, ("\n[BTCoex], 1Ant for LPS Leave\n"));
6167
6168 /* Prevent from entering LPS again */
4d435952
JS		 6169 GET_HAL_DATA(padapter)->bt_coexist.halCoex8723.btdm1Ant.bWiFiHalt =
6170 true;
f7c92d2c
LF		 6171
6172 btdm_1AntSetPSTDMA(padapter, false, 0, false, 8);
6173/*btdm_1AntPsTdma(padapter, false, 8); */
6174}
6175
6176static void BTDM_1AntWifiAssociateNotify(struct rtw_adapter *padapter, u8 type)
6177{
6178 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6179
4d435952
JS		 6180 RTPRINT(FBT, BT_TRACE,
6181 ("\n[BTCoex], 1Ant for associate, type =%d\n", type));
f7c92d2c
LF		 6182
6183 if (type) {
6184 rtl8723a_CheckAntenna_Selection(padapter);
bf2a7b99 6185 if (!rtl8723a_BT_enabled(padapter))
f7c92d2c 6186 btdm_1AntSetPSTDMA(padapter, false, 0, false, 9);
4d435952 6187 else {
f7c92d2c
LF		 6188 struct bt_coexist_8723a *pBtCoex;
6189 u8 BtState;
6190
6191 pBtCoex = &pHalData->bt_coexist.halCoex8723;
6192 BtState = pBtCoex->c2hBtInfo;
6193
6194 btdm_1AntTSFSwitch(padapter, true);
6195
4d435952
JS		 6196 if (BtState == BT_INFO_STATE_NO_CONNECTION ||
6197 BtState == BT_INFO_STATE_CONNECT_IDLE) {
6198 btdm_1AntSetPSTDMA(padapter, false, 0,
6199 true, 28);
6200 } else if (BtState == BT_INFO_STATE_SCO_ONLY_BUSY ||
6201 BtState == BT_INFO_STATE_ACL_SCO_BUSY) {
6202 btdm_1AntSetPSTDMA(padapter, false, 0,
6203 false, 8);
edbfd672
JS		 6204 rtl8723au_write32(padapter, 0x6c0, 0x5a5a5a5a);
6205 rtl8723au_write32(padapter, 0x6c4, 0x5a5a5a5a);
4d435952
JS		 6206 } else if (BtState == BT_INFO_STATE_ACL_ONLY_BUSY ||
6207 BtState == BT_INFO_STATE_ACL_INQ_OR_PAG) {
f7c92d2c 6208 if (pBtCoex->c2hBtProfile == BT_INFO_HID)
4d435952
JS		 6209 btdm_1AntSetPSTDMA(padapter, false, 0,
6210 true, 35);
f7c92d2c 6211 else
4d435952
JS		 6212 btdm_1AntSetPSTDMA(padapter, false, 0,
6213 true, 29);
f7c92d2c
LF		 6214 }
6215 }
6216 } else {
bf2a7b99 6217 if (!rtl8723a_BT_enabled(padapter)) {
f7c92d2c
LF		 6218 if (!BTDM_IsWifiConnectionExist(padapter)) {
6219 btdm_1AntPsTdma(padapter, false, 0);
6220 btdm_1AntTSFSwitch(padapter, false);
6221 }
6222 }
6223
6224 btdm_1AntBtCoexistHandler(padapter);
6225 }
6226}
6227
6228static void
6229BTDM_1AntMediaStatusNotify(struct rtw_adapter *padapter,
6230 enum rt_media_status mstatus)
6231{
6232 struct bt_coexist_8723a *pBtCoex;
6233
6234 pBtCoex = &GET_HAL_DATA(padapter)->bt_coexist.halCoex8723;
6235
4d435952
JS		 6236 RTPRINT(FBT, BT_TRACE,
6237 ("\n\n[BTCoex]******************************\n"));
f7c92d2c
LF		 6238 RTPRINT(FBT, BT_TRACE, ("[BTCoex], MediaStatus, WiFi %s !!\n",
6239 mstatus == RT_MEDIA_CONNECT?"CONNECT":"DISCONNECT"));
6240 RTPRINT(FBT, BT_TRACE, ("[BTCoex]******************************\n"));
6241
6242 if (RT_MEDIA_CONNECT == mstatus) {
6243 if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) {
4d435952
JS		 6244 if (pBtCoex->c2hBtInfo == BT_INFO_STATE_SCO_ONLY_BUSY ||
6245 pBtCoex->c2hBtInfo == BT_INFO_STATE_ACL_SCO_BUSY)
f7c92d2c
LF		 6246 btdm_1AntUpdateHalRAMaskForSCO(padapter, true);
6247 }
6248
6249 padapter->pwrctrlpriv.DelayLPSLastTimeStamp = jiffies;
6250 BTDM_1AntForDhcp(padapter);
6251 } else {
4d435952
JS		 6252 /* DBG_8723A("%s rtl8723a_DeinitAntenna_Selection\n",
6253 __func__); */
f7c92d2c
LF		 6254 rtl8723a_DeinitAntenna_Selection(padapter);
6255 btdm_1AntBtCoexistHandler(padapter);
6256 pBtCoex->btdm1Ant.bRAChanged = false;
6257 }
6258}
6259
6260void BTDM_1AntForDhcp(struct rtw_adapter *padapter)
6261{
6262 struct hal_data_8723a *pHalData;
6263 u8 BtState;
6264 struct bt_coexist_8723a *pBtCoex;
6265 struct btdm_8723a_1ant *pBtdm8723;
6266
6267 pHalData = GET_HAL_DATA(padapter);
6268 pBtCoex = &pHalData->bt_coexist.halCoex8723;
6269 BtState = pBtCoex->c2hBtInfo;
6270 pBtdm8723 = &pBtCoex->btdm1Ant;
6271
6272 RTPRINT(FBT, BT_TRACE, ("\n[BTCoex], 1Ant for DHCP\n"));
4d435952
JS		 6273 RTPRINT(FBT, BT_TRACE, ("[BTCoex], 1Ant for DHCP, WiFi is %s\n",
6274 BTDM_IsWifiBusy(padapter)?"Busy":"IDLE"));
6275 RTPRINT(FBT, BT_TRACE, ("[BTCoex], 1Ant for DHCP, %s\n",
6276 BtStateString[BtState]));
f7c92d2c
LF		 6277
6278 BTDM_1AntWifiAssociateNotify(padapter, true);
6279}
6280
6281static void BTDM_1AntWifiScanNotify(struct rtw_adapter *padapter, u8 scanType)
6282{
6283 struct hal_data_8723a *pHalData;
6284 u8 BtState;
6285 struct bt_coexist_8723a *pBtCoex;
6286 struct btdm_8723a_1ant *pBtdm8723;
6287
6288 pHalData = GET_HAL_DATA(padapter);
6289 BtState = pHalData->bt_coexist.halCoex8723.c2hBtInfo;
6290 pBtCoex = &pHalData->bt_coexist.halCoex8723;
6291 pBtdm8723 = &pBtCoex->btdm1Ant;
6292
4d435952
JS		 6293 RTPRINT(FBT, BT_TRACE, ("\n[BTCoex], 1Ant for wifi scan =%d!!\n",
6294 scanType));
6295 RTPRINT(FBT, BT_TRACE, ("[BTCoex], 1Ant for wifi scan, WiFi is %s\n",
6296 BTDM_IsWifiBusy(padapter)?"Busy":"IDLE"));
6297 RTPRINT(FBT, BT_TRACE, ("[BTCoex], 1Ant for wifi scan, %s\n",
6298 BtStateString[BtState]));
f7c92d2c
LF		 6299
6300 if (scanType) {
6301 rtl8723a_CheckAntenna_Selection(padapter);
bf2a7b99 6302 if (!rtl8723a_BT_enabled(padapter)) {
f7c92d2c
LF		 6303 btdm_1AntSetPSTDMA(padapter, false, 0, false, 9);
6304 } else if (BTDM_IsWifiConnectionExist(padapter) == false) {
6305 BTDM_1AntWifiAssociateNotify(padapter, true);
6306 } else {
6307 if ((BtState == BT_INFO_STATE_SCO_ONLY_BUSY) ||
6308 (BtState == BT_INFO_STATE_ACL_SCO_BUSY)) {
6309 if (pBtCoex->bC2hBtInquiryPage) {
4d435952
JS		 6310 btdm_1AntSetPSTDMA(padapter, false, 0,
6311 true, 32);
f7c92d2c 6312 } else {
4d435952
JS		 6313 padapter->pwrctrlpriv.btcoex_rfon =
6314 true;
6315 btdm_1AntSetPSTDMA(padapter, true, 0,
6316 true, 33);
f7c92d2c
LF		 6317 }
6318 } else if (true == pBtCoex->bC2hBtInquiryPage) {
6319 padapter->pwrctrlpriv.btcoex_rfon = true;
6320 btdm_1AntSetPSTDMA(padapter, true, 0, true, 30);
6321 } else if (BtState == BT_INFO_STATE_ACL_ONLY_BUSY) {
6322 padapter->pwrctrlpriv.btcoex_rfon = true;
6323 if (pBtCoex->c2hBtProfile == BT_INFO_HID)
4d435952
JS		 6324 btdm_1AntSetPSTDMA(padapter, true, 0,
6325 true, 34);
f7c92d2c 6326 else
4d435952
JS		 6327 btdm_1AntSetPSTDMA(padapter, true, 0,
6328 true, 4);
f7c92d2c
LF		 6329 } else {
6330 padapter->pwrctrlpriv.btcoex_rfon = true;
6331 btdm_1AntSetPSTDMA(padapter, true, 0, true, 5);
6332 }
6333 }
6334
6335 btdm_NotifyFwScan(padapter, 1);
6336 } else {
6337 /* WiFi_Finish_Scan */
6338 btdm_NotifyFwScan(padapter, 0);
6339 btdm_1AntBtCoexistHandler(padapter);
6340 }
6341}
6342
6343static void BTDM_1AntFwC2hBtInfo8723A(struct rtw_adapter *padapter)
6344{
6345 struct hal_data_8723a *pHalData;
6346 struct bt_30info *pBTInfo;
6347 struct bt_mgnt *pBtMgnt;
6348 struct bt_coexist_8723a *pBtCoex;
6349 u8 u1tmp, btState;
6350
6351 pHalData = GET_HAL_DATA(padapter);
6352 pBTInfo = GET_BT_INFO(padapter);
6353 pBtMgnt = &pBTInfo->BtMgnt;
6354 pBtCoex = &pHalData->bt_coexist.halCoex8723;
6355
6356 u1tmp = pBtCoex->c2hBtInfoOriginal;
6357 /* sco BUSY bit is not used on voice over PCM platform */
6358 btState = u1tmp & 0xF;
6359 pBtCoex->c2hBtProfile = u1tmp & 0xE0;
6360
6361 /* default set bt to idle state. */
6362 pBtMgnt->ExtConfig.bBTBusy = false;
6363 pHalData->bt_coexist.CurrentState |= BT_COEX_STATE_BT_IDLE;
6364
6365 /* check BIT2 first ==> check if bt is under inquiry or page scan */
6366 if (btState & BIT(2))
6367 pBtCoex->bC2hBtInquiryPage = true;
6368 else
6369 pBtCoex->bC2hBtInquiryPage = false;
6370 btState &= ~BIT(2);
6371
4d435952 6372 if (!(btState & BIT(0)))
f7c92d2c 6373 pBtCoex->c2hBtInfo = BT_INFO_STATE_NO_CONNECTION;
4d435952
JS		 6374 else {
6375 if (btState == 0x1)
f7c92d2c 6376 pBtCoex->c2hBtInfo = BT_INFO_STATE_CONNECT_IDLE;
4d435952 6377 else if (btState == 0x9) {
f7c92d2c 6378 if (pBtCoex->bC2hBtInquiryPage == true)
4d435952
JS		 6379 pBtCoex->c2hBtInfo =
6380 BT_INFO_STATE_ACL_INQ_OR_PAG;
f7c92d2c 6381 else
4d435952
JS		 6382 pBtCoex->c2hBtInfo =
6383 BT_INFO_STATE_ACL_ONLY_BUSY;
f7c92d2c
LF		 6384 pBtMgnt->ExtConfig.bBTBusy = true;
6385 } else if (btState == 0x3) {
6386 pBtCoex->c2hBtInfo = BT_INFO_STATE_SCO_ONLY_BUSY;
6387 pBtMgnt->ExtConfig.bBTBusy = true;
6388 } else if (btState == 0xb) {
6389 pBtCoex->c2hBtInfo = BT_INFO_STATE_ACL_SCO_BUSY;
6390 pBtMgnt->ExtConfig.bBTBusy = true;
4d435952 6391 } else
f7c92d2c 6392 pBtCoex->c2hBtInfo = BT_INFO_STATE_MAX;
f7c92d2c 6393 if (pBtMgnt->ExtConfig.bBTBusy)
4d435952
JS		 6394 pHalData->bt_coexist.CurrentState &=
6395 ~BT_COEX_STATE_BT_IDLE;
f7c92d2c
LF		 6396 }
6397
4d435952
JS		 6398 if (BT_INFO_STATE_NO_CONNECTION == pBtCoex->c2hBtInfo ||
6399 BT_INFO_STATE_CONNECT_IDLE == pBtCoex->c2hBtInfo) {
f7c92d2c
LF		 6400 if (pBtCoex->bC2hBtInquiryPage)
6401 pBtCoex->c2hBtInfo = BT_INFO_STATE_INQ_OR_PAG;
6402 }
6403
6404 RTPRINT(FBT, BT_TRACE, ("[BTC2H], %s(%d)\n",
6405 BtStateString[pBtCoex->c2hBtInfo], pBtCoex->c2hBtInfo));
6406
6407 if (pBtCoex->c2hBtProfile != BT_INFO_HID)
6408 pBtCoex->c2hBtProfile &= ~BT_INFO_HID;
6409}
6410
6411void BTDM_1AntBtCoexist8723A(struct rtw_adapter *padapter)
6412{
6413 struct mlme_priv *pmlmepriv;
6414 struct hal_data_8723a *pHalData;
6415 unsigned long delta_time;
6416
6417 pmlmepriv = &padapter->mlmepriv;
6418 pHalData = GET_HAL_DATA(padapter);
6419
6420 if (check_fwstate(pmlmepriv, WIFI_SITE_MONITOR)) {
6421 /* already done in BTDM_1AntForScan() */
4d435952
JS		 6422 RTPRINT(FBT, BT_TRACE,
6423 ("[BTCoex], wifi is under scan progress!!\n"));
f7c92d2c
LF		 6424 return;
6425 }
6426
6427 if (check_fwstate(pmlmepriv, WIFI_UNDER_LINKING)) {
4d435952
JS		 6428 RTPRINT(FBT, BT_TRACE,
6429 ("[BTCoex], wifi is under link progress!!\n"));
f7c92d2c
LF		 6430 return;
6431 }
6432
6433 /* under DHCP(Special packet) */
6434 delta_time = jiffies - padapter->pwrctrlpriv.DelayLPSLastTimeStamp;
6435 delta_time = jiffies_to_msecs(delta_time);
6436 if (delta_time < 500) {
6437 RTPRINT(FBT, BT_TRACE, ("[BTCoex], wifi is under DHCP "
6438 "progress(%li ms)!!\n", delta_time));
6439 return;
6440 }
6441
6442 BTDM_CheckWiFiState(padapter);
6443
6444 btdm_1AntBtCoexistHandler(padapter);
6445}
6446
6447/* ===== End of sync from SD7 driver HAL/BTCoexist/HalBtc87231Ant.c ===== */
f7c92d2c 6448
f7c92d2c
LF		 6449/* ===== Below this line is sync from SD7 driver HAL/BTCoexist/HalBtc87232Ant.c ===== */
6450
6451/* local function start with btdm_ */
6452static u8 btdm_ActionAlgorithm(struct rtw_adapter *padapter)
6453{
6454 struct bt_30info *pBTInfo = GET_BT_INFO(padapter);
6455 struct bt_mgnt *pBtMgnt = &pBTInfo->BtMgnt;
6456 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6457 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6458 u8 bScoExist = false, bBtLinkExist = false, bBtHsModeExist = false;
6459 u8 algorithm = BT_2ANT_COEX_ALGO_UNDEFINED;
6460
6461 if (pBtMgnt->ExtConfig.NumberOfHandle)
6462 bBtLinkExist = true;
6463 if (pBtMgnt->ExtConfig.NumberOfSCO)
6464 bScoExist = true;
6465 if (BT_HsConnectionEstablished(padapter))
6466 bBtHsModeExist = true;
6467
6468 /* here we get BT status first */
6469 /* 1) initialize */
6470 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_IDLE;
6471
6472 if ((bScoExist) || (bBtHsModeExist) ||
6473 (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID))) {
6474 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SCO or HID or HS exists, set BT non-idle !!!\n"));
6475 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_NON_IDLE;
6476 } else {
6477 /* A2dp profile */
6478 if ((pBtMgnt->ExtConfig.NumberOfHandle == 1) &&
6479 (BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP))) {
6480 if (BTDM_BtTxRxCounterL(padapter) < 100) {
6481 RTPRINT(FBT, BT_TRACE, ("[BTCoex], A2DP, low priority tx+rx < 100, set BT connected-idle!!!\n"));
6482 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_CONNECTED_IDLE;
6483 } else {
6484 RTPRINT(FBT, BT_TRACE, ("[BTCoex], A2DP, low priority tx+rx >= 100, set BT non-idle!!!\n"));
6485 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_NON_IDLE;
6486 }
6487 }
6488 /* Pan profile */
6489 if ((pBtMgnt->ExtConfig.NumberOfHandle == 1) &&
6490 (BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN))) {
6491 if (BTDM_BtTxRxCounterL(padapter) < 600) {
6492 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN, low priority tx+rx < 600, set BT connected-idle!!!\n"));
6493 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_CONNECTED_IDLE;
6494 } else {
6495 if (pHalData->bt_coexist.halCoex8723.lowPriorityTx) {
6496 if ((pHalData->bt_coexist.halCoex8723.lowPriorityRx /
6497 pHalData->bt_coexist.halCoex8723.lowPriorityTx) > 9) {
6498 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN, low priority rx/tx > 9, set BT connected-idle!!!\n"));
6499 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_CONNECTED_IDLE;
6500 }
6501 }
6502 }
6503 if (BT_2ANT_BT_STATUS_CONNECTED_IDLE != pBtdm8723->btStatus) {
6504 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN, set BT non-idle!!!\n"));
6505 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_NON_IDLE;
6506 }
6507 }
6508 /* Pan+A2dp profile */
6509 if ((pBtMgnt->ExtConfig.NumberOfHandle == 2) &&
6510 (BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) &&
6511 (BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN))) {
6512 if (BTDM_BtTxRxCounterL(padapter) < 600) {
6513 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN+A2DP, low priority tx+rx < 600, set BT connected-idle!!!\n"));
6514 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_CONNECTED_IDLE;
6515 } else {
6516 if (pHalData->bt_coexist.halCoex8723.lowPriorityTx) {
6517 if ((pHalData->bt_coexist.halCoex8723.lowPriorityRx /
6518 pHalData->bt_coexist.halCoex8723.lowPriorityTx) > 9) {
6519 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN+A2DP, low priority rx/tx > 9, set BT connected-idle!!!\n"));
6520 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_CONNECTED_IDLE;
6521 }
6522 }
6523 }
6524 if (BT_2ANT_BT_STATUS_CONNECTED_IDLE != pBtdm8723->btStatus) {
6525 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN+A2DP, set BT non-idle!!!\n"));
6526 pBtdm8723->btStatus = BT_2ANT_BT_STATUS_NON_IDLE;
6527 }
6528 }
6529 }
6530 if (BT_2ANT_BT_STATUS_IDLE != pBtdm8723->btStatus)
6531 pBtMgnt->ExtConfig.bBTBusy = true;
6532 else
6533 pBtMgnt->ExtConfig.bBTBusy = false;
6534
6535 if (!bBtLinkExist) {
6536 RTPRINT(FBT, BT_TRACE, ("[BTCoex], No profile exists!!!\n"));
6537 return algorithm;
6538 }
6539
6540 if (pBtMgnt->ExtConfig.NumberOfHandle == 1) {
6541 if (bScoExist) {
6542 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SCO only\n"));
6543 algorithm = BT_2ANT_COEX_ALGO_SCO;
6544 } else {
6545 if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID)) {
6546 RTPRINT(FBT, BT_TRACE, ("[BTCoex], HID only\n"));
6547 algorithm = BT_2ANT_COEX_ALGO_HID;
6548 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6549 RTPRINT(FBT, BT_TRACE, ("[BTCoex], A2DP only\n"));
6550 algorithm = BT_2ANT_COEX_ALGO_A2DP;
6551 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN)) {
6552 if (bBtHsModeExist) {
6553 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN(HS) only\n"));
6554 algorithm = BT_2ANT_COEX_ALGO_PANHS;
6555 } else {
6556 RTPRINT(FBT, BT_TRACE, ("[BTCoex], PAN(EDR) only\n"));
6557 algorithm = BT_2ANT_COEX_ALGO_PANEDR;
6558 }
6559 } else {
6560 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! NO matched profile for NumberOfHandle =%d \n",
6561 pBtMgnt->ExtConfig.NumberOfHandle));
6562 }
6563 }
6564 } else if (pBtMgnt->ExtConfig.NumberOfHandle == 2) {
6565 if (bScoExist) {
6566 if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID)) {
6567 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SCO + HID\n"));
6568 algorithm = BT_2ANT_COEX_ALGO_HID;
6569 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6570 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO + A2DP\n"));
6571 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN)) {
6572 if (bBtHsModeExist) {
6573 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SCO + PAN(HS)\n"));
6574 algorithm = BT_2ANT_COEX_ALGO_SCO;
6575 } else {
6576 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SCO + PAN(EDR)\n"));
6577 algorithm = BT_2ANT_COEX_ALGO_PANEDR_HID;
6578 }
6579 } else {
6580 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO exists but why NO matched ACL profile for NumberOfHandle =%d\n",
6581 pBtMgnt->ExtConfig.NumberOfHandle));
6582 }
6583 } else {
6584 if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID) &&
6585 BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6586 RTPRINT(FBT, BT_TRACE, ("[BTCoex], HID + A2DP\n"));
6587 algorithm = BT_2ANT_COEX_ALGO_HID_A2DP;
6588 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID) &&
6589 BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN)) {
6590 if (bBtHsModeExist) {
6591 RTPRINT(FBT, BT_TRACE, ("[BTCoex], HID + PAN(HS)\n"));
6592 algorithm = BT_2ANT_COEX_ALGO_HID_A2DP;
6593 } else {
6594 RTPRINT(FBT, BT_TRACE, ("[BTCoex], HID + PAN(EDR)\n"));
6595 algorithm = BT_2ANT_COEX_ALGO_PANEDR_HID;
6596 }
6597 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN) &&
6598 BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6599 if (bBtHsModeExist) {
6600 RTPRINT(FBT, BT_TRACE, ("[BTCoex], A2DP + PAN(HS)\n"));
6601 algorithm = BT_2ANT_COEX_ALGO_A2DP;
6602 } else {
6603 RTPRINT(FBT, BT_TRACE, ("[BTCoex], A2DP + PAN(EDR)\n"));
6604 algorithm = BT_2ANT_COEX_ALGO_PANEDR_A2DP;
6605 }
6606 } else {
6607 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! NO matched profile for NumberOfHandle =%d\n",
6608 pBtMgnt->ExtConfig.NumberOfHandle));
6609 }
6610 }
6611 } else if (pBtMgnt->ExtConfig.NumberOfHandle == 3) {
6612 if (bScoExist) {
6613 if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID) &&
6614 BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6615 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO + HID + A2DP\n"));
6616 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID) &&
6617 BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN)) {
6618 if (bBtHsModeExist) {
6619 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SCO + HID + PAN(HS)\n"));
6620 algorithm = BT_2ANT_COEX_ALGO_HID_A2DP;
6621 } else {
6622 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SCO + HID + PAN(EDR)\n"));
6623 algorithm = BT_2ANT_COEX_ALGO_PANEDR_HID;
6624 }
6625 } else if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN) &&
6626 BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6627 if (bBtHsModeExist) {
6628 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO + A2DP + PAN(HS)\n"));
6629 algorithm = BT_2ANT_COEX_ALGO_SCO;
6630 } else {
6631 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO + A2DP + PAN(EDR)\n"));
6632 }
6633 } else {
6634 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO exists but why NO matched profile for NumberOfHandle =%d\n",
6635 pBtMgnt->ExtConfig.NumberOfHandle));
6636 }
6637 } else {
6638 if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID) &&
6639 BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN) &&
6640 BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6641 if (bBtHsModeExist) {
6642 RTPRINT(FBT, BT_TRACE, ("[BTCoex], HID + A2DP + PAN(HS)\n"));
6643 algorithm = BT_2ANT_COEX_ALGO_HID_A2DP_PANHS;
6644 } else {
6645 RTPRINT(FBT, BT_TRACE, ("[BTCoex], HID + A2DP + PAN(EDR)\n"));
6646 algorithm = BT_2ANT_COEX_ALGO_HID_A2DP_PANEDR;
6647 }
6648 } else {
6649 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! NO matched profile for NumberOfHandle =%d\n",
6650 pBtMgnt->ExtConfig.NumberOfHandle));
6651 }
6652 }
6653 } else if (pBtMgnt->ExtConfig.NumberOfHandle >= 3) {
6654 if (bScoExist) {
6655 if (BTHCI_CheckProfileExist(padapter, BT_PROFILE_HID) &&
6656 BTHCI_CheckProfileExist(padapter, BT_PROFILE_PAN) &&
6657 BTHCI_CheckProfileExist(padapter, BT_PROFILE_A2DP)) {
6658 if (bBtHsModeExist)
6659 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"));
6660 else
6661 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(EDR)\n"));
6662 } else {
6663 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! SCO exists but why NO matched profile for NumberOfHandle =%d\n",
6664 pBtMgnt->ExtConfig.NumberOfHandle));
6665 }
6666 } else {
6667 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Error!!! NO matched profile for NumberOfHandle =%d\n",
6668 pBtMgnt->ExtConfig.NumberOfHandle));
6669 }
6670 }
6671 return algorithm;
6672}
6673
6674static u8 btdm_NeedToDecBtPwr(struct rtw_adapter *padapter)
6675{
6676 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6677 u8 bRet = false;
6678
6679 if (BT_Operation(padapter)) {
6680 if (pHalData->dmpriv.EntryMinUndecoratedSmoothedPWDB > 47) {
6681 RTPRINT(FBT, BT_TRACE, ("Need to decrease bt power for HS mode!!\n"));
6682 bRet = true;
6683 } else {
6684 RTPRINT(FBT, BT_TRACE, ("NO Need to decrease bt power for HS mode!!\n"));
6685 }
6686 } else {
6687 if (BTDM_IsWifiConnectionExist(padapter)) {
6688 RTPRINT(FBT, BT_TRACE, ("Need to decrease bt power for Wifi is connected!!\n"));
6689 bRet = true;
6690 }
6691 }
6692 return bRet;
6693}
6694
6695static void
6696btdm_SetCoexTable(struct rtw_adapter *padapter, u32 val0x6c0,
6697 u32 val0x6c8, u8 val0x6cc)
6698{
6699 RTPRINT(FBT, BT_TRACE, ("set coex table, set 0x6c0 = 0x%x\n", val0x6c0));
edbfd672 6700 rtl8723au_write32(padapter, 0x6c0, val0x6c0);
f7c92d2c
LF		 6701
6702 RTPRINT(FBT, BT_TRACE, ("set coex table, set 0x6c8 = 0x%x\n", val0x6c8));
edbfd672 6703 rtl8723au_write32(padapter, 0x6c8, val0x6c8);
f7c92d2c
LF		 6704
6705 RTPRINT(FBT, BT_TRACE, ("set coex table, set 0x6cc = 0x%x\n", val0x6cc));
edbfd672 6706 rtl8723au_write8(padapter, 0x6cc, val0x6cc);
f7c92d2c
LF		 6707}
6708
6709static void
6710btdm_SetSwFullTimeDacSwing(struct rtw_adapter *padapter, u8 bSwDacSwingOn,
6711 u32 swDacSwingLvl)
6712{
6713 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6714
6715 if (bSwDacSwingOn) {
6716 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SwDacSwing = 0x%x\n", swDacSwingLvl));
6717 PHY_SetBBReg(padapter, 0x880, 0xff000000, swDacSwingLvl);
6718 pHalData->bt_coexist.bSWCoexistAllOff = false;
6719 } else {
6720 RTPRINT(FBT, BT_TRACE, ("[BTCoex], SwDacSwing Off!\n"));
6721 PHY_SetBBReg(padapter, 0x880, 0xff000000, 0xc0);
6722 }
6723}
6724
6725static void
6726btdm_SetFwDacSwingLevel(struct rtw_adapter *padapter, u8 dacSwingLvl)
6727{
6728 u8 H2C_Parameter[1] = {0};
6729
6730 H2C_Parameter[0] = dacSwingLvl;
6731
6732 RTPRINT(FBT, BT_TRACE, ("[BTCoex], Set Dac Swing Level = 0x%x\n", dacSwingLvl));
6733 RTPRINT(FBT, BT_TRACE, ("[BTCoex], write 0x29 = 0x%x\n", H2C_Parameter[0]));
6734
6735 FillH2CCmd(padapter, 0x29, 1, H2C_Parameter);
6736}
6737
6738static void btdm_2AntDecBtPwr(struct rtw_adapter *padapter, u8 bDecBtPwr)
6739{
6740 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6741 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6742
6743 RTPRINT(FBT, BT_TRACE,
6744 ("[BTCoex], Dec BT power = %s\n",
6745 ((bDecBtPwr) ? "ON" : "OFF")));
6746 pBtdm8723->bCurDecBtPwr = bDecBtPwr;
6747
6748 if (pBtdm8723->bPreDecBtPwr == pBtdm8723->bCurDecBtPwr)
6749 return;
6750
6751 BTDM_SetFwDecBtPwr(padapter, pBtdm8723->bCurDecBtPwr);
6752
6753 pBtdm8723->bPreDecBtPwr = pBtdm8723->bCurDecBtPwr;
6754}
6755
6756static void
6757btdm_2AntFwDacSwingLvl(struct rtw_adapter *padapter, u8 fwDacSwingLvl)
6758{
6759 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6760 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6761
6762 RTPRINT(FBT, BT_TRACE, ("[BTCoex], set FW Dac Swing level = %d\n", fwDacSwingLvl));
6763 pBtdm8723->curFwDacSwingLvl = fwDacSwingLvl;
6764
6765 /* RTPRINT(FBT, BT_TRACE, ("[BTCoex], preFwDacSwingLvl =%d, curFwDacSwingLvl =%d\n", */
6766 /*pBtdm8723->preFwDacSwingLvl, pBtdm8723->curFwDacSwingLvl)); */
6767
6768 if (pBtdm8723->preFwDacSwingLvl == pBtdm8723->curFwDacSwingLvl)
6769 return;
6770
6771 btdm_SetFwDacSwingLevel(padapter, pBtdm8723->curFwDacSwingLvl);
6772
6773 pBtdm8723->preFwDacSwingLvl = pBtdm8723->curFwDacSwingLvl;
6774}
6775
6776static void
6777btdm_2AntRfShrink(struct rtw_adapter *padapter, u8 bRxRfShrinkOn)
6778{
6779 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6780 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6781
6782 RTPRINT(FBT, BT_TRACE,
6783 ("[BTCoex], turn Rx RF Shrink = %s\n",
6784 ((bRxRfShrinkOn) ? "ON" : "OFF")));
6785 pBtdm8723->bCurRfRxLpfShrink = bRxRfShrinkOn;
6786
6787 /* RTPRINT(FBT, BT_TRACE, ("[BTCoex], bPreRfRxLpfShrink =%d, bCurRfRxLpfShrink =%d\n", */
6788 /*pBtdm8723->bPreRfRxLpfShrink, pBtdm8723->bCurRfRxLpfShrink)); */
6789
6790 if (pBtdm8723->bPreRfRxLpfShrink == pBtdm8723->bCurRfRxLpfShrink)
6791 return;
6792
6793 BTDM_SetSwRfRxLpfCorner(padapter, (u8)pBtdm8723->bCurRfRxLpfShrink);
6794
6795 pBtdm8723->bPreRfRxLpfShrink = pBtdm8723->bCurRfRxLpfShrink;
6796}
6797
6798static void
6799btdm_2AntLowPenaltyRa(struct rtw_adapter *padapter, u8 bLowPenaltyRa)
6800{
6801 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6802 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6803
6804 RTPRINT(FBT, BT_TRACE,
6805 ("[BTCoex], turn LowPenaltyRA = %s\n",
6806 ((bLowPenaltyRa) ? "ON" : "OFF")));
6807 pBtdm8723->bCurLowPenaltyRa = bLowPenaltyRa;
6808
6809 /* RTPRINT(FBT, BT_TRACE, ("[BTCoex], bPreLowPenaltyRa =%d, bCurLowPenaltyRa =%d\n", */
6810 /*pBtdm8723->bPreLowPenaltyRa, pBtdm8723->bCurLowPenaltyRa)); */
6811
6812 if (pBtdm8723->bPreLowPenaltyRa == pBtdm8723->bCurLowPenaltyRa)
6813 return;
6814
6815 BTDM_SetSwPenaltyTxRateAdaptive(padapter, (u8)pBtdm8723->bCurLowPenaltyRa);
6816
6817 pBtdm8723->bPreLowPenaltyRa = pBtdm8723->bCurLowPenaltyRa;
6818}
6819
6820static void
6821btdm_2AntDacSwing(struct rtw_adapter *padapter,
6822 u8 bDacSwingOn, u32 dacSwingLvl)
6823{
6824 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6825 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6826
6827 RTPRINT(FBT, BT_TRACE,
6828 ("[BTCoex], turn DacSwing =%s, dacSwingLvl = 0x%x\n",
6829 (bDacSwingOn ? "ON" : "OFF"), dacSwingLvl));
6830 pBtdm8723->bCurDacSwingOn = bDacSwingOn;
6831 pBtdm8723->curDacSwingLvl = dacSwingLvl;
6832
6833 if ((pBtdm8723->bPreDacSwingOn == pBtdm8723->bCurDacSwingOn) &&
6834 (pBtdm8723->preDacSwingLvl == pBtdm8723->curDacSwingLvl))
6835 return;
6836
6837 mdelay(30);
6838 btdm_SetSwFullTimeDacSwing(padapter, bDacSwingOn, dacSwingLvl);
6839
6840 pBtdm8723->bPreDacSwingOn = pBtdm8723->bCurDacSwingOn;
6841 pBtdm8723->preDacSwingLvl = pBtdm8723->curDacSwingLvl;
6842}
6843
6844static void btdm_2AntAdcBackOff(struct rtw_adapter *padapter, u8 bAdcBackOff)
6845{
6846 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6847 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6848
6849 RTPRINT(FBT, BT_TRACE,
6850 ("[BTCoex], turn AdcBackOff = %s\n",
6851 ((bAdcBackOff) ? "ON" : "OFF")));
6852 pBtdm8723->bCurAdcBackOff = bAdcBackOff;
6853
6854 if (pBtdm8723->bPreAdcBackOff == pBtdm8723->bCurAdcBackOff)
6855 return;
6856
6857 BTDM_BBBackOffLevel(padapter, (u8)pBtdm8723->bCurAdcBackOff);
6858
6859 pBtdm8723->bPreAdcBackOff = pBtdm8723->bCurAdcBackOff;
6860}
6861
6862static void btdm_2AntAgcTable(struct rtw_adapter *padapter, u8 bAgcTableEn)
6863{
6864 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6865 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6866
6867 RTPRINT(FBT, BT_TRACE,
6868 ("[BTCoex], %s Agc Table\n", ((bAgcTableEn) ? "Enable" : "Disable")));
6869 pBtdm8723->bCurAgcTableEn = bAgcTableEn;
6870
6871 /* RTPRINT(FBT, BT_TRACE, ("[BTCoex], bPreAgcTableEn =%d, bCurAgcTableEn =%d\n", */
6872 /*pBtdm8723->bPreAgcTableEn, pBtdm8723->bCurAgcTableEn)); */
6873
6874 if (pBtdm8723->bPreAgcTableEn == pBtdm8723->bCurAgcTableEn)
6875 return;
6876
6877 BTDM_AGCTable(padapter, (u8)bAgcTableEn);
6878
6879 pBtdm8723->bPreAgcTableEn = pBtdm8723->bCurAgcTableEn;
6880}
6881
6882static void
6883btdm_2AntCoexTable(struct rtw_adapter *padapter,
6884 u32 val0x6c0, u32 val0x6c8, u8 val0x6cc)
6885{
6886 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6887 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6888
6889 RTPRINT(FBT, BT_TRACE, ("[BTCoex], write Coex Table 0x6c0 = 0x%x, 0x6c8 = 0x%x, 0x6cc = 0x%x\n",
6890 val0x6c0, val0x6c8, val0x6cc));
6891 pBtdm8723->curVal0x6c0 = val0x6c0;
6892 pBtdm8723->curVal0x6c8 = val0x6c8;
6893 pBtdm8723->curVal0x6cc = val0x6cc;
6894
6895 /* RTPRINT(FBT, BT_TRACE, ("[BTCoex], preVal0x6c0 = 0x%x, preVal0x6c8 = 0x%x, preVal0x6cc = 0x%x !!\n", */
6896 /*pBtdm8723->preVal0x6c0, pBtdm8723->preVal0x6c8, pBtdm8723->preVal0x6cc)); */
6897 /* RTPRINT(FBT, BT_TRACE, ("[BTCoex], curVal0x6c0 = 0x%x, curVal0x6c8 = 0x%x, curVal0x6cc = 0x%x !!\n", */
6898 /*pBtdm8723->curVal0x6c0, pBtdm8723->curVal0x6c8, pBtdm8723->curVal0x6cc)); */
6899
6900 if ((pBtdm8723->preVal0x6c0 == pBtdm8723->curVal0x6c0) &&
6901 (pBtdm8723->preVal0x6c8 == pBtdm8723->curVal0x6c8) &&
6902 (pBtdm8723->preVal0x6cc == pBtdm8723->curVal0x6cc))
6903 return;
6904
6905 btdm_SetCoexTable(padapter, val0x6c0, val0x6c8, val0x6cc);
6906
6907 pBtdm8723->preVal0x6c0 = pBtdm8723->curVal0x6c0;
6908 pBtdm8723->preVal0x6c8 = pBtdm8723->curVal0x6c8;
6909 pBtdm8723->preVal0x6cc = pBtdm8723->curVal0x6cc;
6910}
6911
6912static void btdm_2AntIgnoreWlanAct(struct rtw_adapter *padapter, u8 bEnable)
6913{
6914 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6915 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6916
6917 RTPRINT(FBT, BT_TRACE,
6918 ("[BTCoex], turn Ignore WlanAct %s\n", (bEnable ? "ON" : "OFF")));
6919 pBtdm8723->bCurIgnoreWlanAct = bEnable;
6920
6921
6922 if (pBtdm8723->bPreIgnoreWlanAct == pBtdm8723->bCurIgnoreWlanAct)
6923 return;
6924
6925 btdm_SetFwIgnoreWlanAct(padapter, bEnable);
6926 pBtdm8723->bPreIgnoreWlanAct = pBtdm8723->bCurIgnoreWlanAct;
6927}
6928
6929static void
6930btdm_2AntSetFw3a(struct rtw_adapter *padapter, u8 byte1, u8 byte2,
6931 u8 byte3, u8 byte4, u8 byte5)
6932{
6933 u8 H2C_Parameter[5] = {0};
6934
6935 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6936
6937 /* byte1[1:0] != 0 means enable pstdma */
6938 /* for 2Ant bt coexist, if byte1 != 0 means enable pstdma */
6939 if (byte1)
6940 pHalData->bt_coexist.bFWCoexistAllOff = false;
6941 H2C_Parameter[0] = byte1;
6942 H2C_Parameter[1] = byte2;
6943 H2C_Parameter[2] = byte3;
6944 H2C_Parameter[3] = byte4;
6945 H2C_Parameter[4] = byte5;
6946
6947 pHalData->bt_coexist.fw3aVal[0] = byte1;
6948 pHalData->bt_coexist.fw3aVal[1] = byte2;
6949 pHalData->bt_coexist.fw3aVal[2] = byte3;
6950 pHalData->bt_coexist.fw3aVal[3] = byte4;
6951 pHalData->bt_coexist.fw3aVal[4] = byte5;
6952
6953 RTPRINT(FBT, BT_TRACE, ("[BTCoex], FW write 0x3a(5bytes) = 0x%x%08x\n",
6954 H2C_Parameter[0],
6955 H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4]));
6956
6957 FillH2CCmd(padapter, 0x3a, 5, H2C_Parameter);
6958 }
6959
6960static void btdm_2AntPsTdma(struct rtw_adapter *padapter, u8 bTurnOn, u8 type)
6961{
6962 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
6963 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
6964 u32 btTxRxCnt = 0;
6965 u8 bTurnOnByCnt = false;
6966 u8 psTdmaTypeByCnt = 0;
6967
6968 btTxRxCnt = BTDM_BtTxRxCounterH(padapter)+BTDM_BtTxRxCounterL(padapter);
6969 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT TxRx Counters = %d\n", btTxRxCnt));
6970 if (btTxRxCnt > 3000) {
6971 bTurnOnByCnt = true;
6972 psTdmaTypeByCnt = 8;
6973
6974 RTPRINT(FBT, BT_TRACE,
6975 ("[BTCoex], For BTTxRxCounters, turn %s PS TDMA, type =%d\n",
6976 (bTurnOnByCnt ? "ON" : "OFF"), psTdmaTypeByCnt));
6977 pBtdm8723->bCurPsTdmaOn = bTurnOnByCnt;
6978 pBtdm8723->curPsTdma = psTdmaTypeByCnt;
6979 } else {
6980 RTPRINT(FBT, BT_TRACE,
6981 ("[BTCoex], turn %s PS TDMA, type =%d\n",
6982 (bTurnOn ? "ON" : "OFF"), type));
6983 pBtdm8723->bCurPsTdmaOn = bTurnOn;
6984 pBtdm8723->curPsTdma = type;
6985 }
6986
6987 if ((pBtdm8723->bPrePsTdmaOn == pBtdm8723->bCurPsTdmaOn) &&
6988 (pBtdm8723->prePsTdma == pBtdm8723->curPsTdma))
6989 return;
6990
6991 if (bTurnOn) {
6992 switch (type) {
6993 case 1:
6994 default:
6995 btdm_2AntSetFw3a(padapter, 0xe3, 0x1a, 0x1a, 0xa1, 0x98);
6996 break;
6997 case 2:
6998 btdm_2AntSetFw3a(padapter, 0xe3, 0x12, 0x12, 0xa1, 0x98);
6999 break;
7000 case 3:
7001 btdm_2AntSetFw3a(padapter, 0xe3, 0xa, 0xa, 0xa1, 0x98);
7002 break;
7003 case 4:
7004 btdm_2AntSetFw3a(padapter, 0xa3, 0x5, 0x5, 0xa1, 0x80);
7005 break;
7006 case 5:
7007 btdm_2AntSetFw3a(padapter, 0xe3, 0x1a, 0x1a, 0x20, 0x98);
7008 break;
7009 case 6:
7010 btdm_2AntSetFw3a(padapter, 0xe3, 0x12, 0x12, 0x20, 0x98);
7011 break;
7012 case 7:
7013 btdm_2AntSetFw3a(padapter, 0xe3, 0xa, 0xa, 0x20, 0x98);
7014 break;
7015 case 8:
7016 btdm_2AntSetFw3a(padapter, 0xa3, 0x5, 0x5, 0x20, 0x80);
7017 break;
7018 case 9:
7019 btdm_2AntSetFw3a(padapter, 0xe3, 0x1a, 0x1a, 0xa1, 0x98);
7020 break;
7021 case 10:
7022 btdm_2AntSetFw3a(padapter, 0xe3, 0x12, 0x12, 0xa1, 0x98);
7023 break;
7024 case 11:
7025 btdm_2AntSetFw3a(padapter, 0xe3, 0xa, 0xa, 0xa1, 0x98);
7026 break;
7027 case 12:
7028 btdm_2AntSetFw3a(padapter, 0xe3, 0x5, 0x5, 0xa1, 0x98);
7029 break;
7030 case 13:
7031 btdm_2AntSetFw3a(padapter, 0xe3, 0x1a, 0x1a, 0x20, 0x98);
7032 break;
7033 case 14:
7034 btdm_2AntSetFw3a(padapter, 0xe3, 0x12, 0x12, 0x20, 0x98);
7035 break;
7036 case 15:
7037 btdm_2AntSetFw3a(padapter, 0xe3, 0xa, 0xa, 0x20, 0x98);
7038 break;
7039 case 16:
7040 btdm_2AntSetFw3a(padapter, 0xe3, 0x5, 0x5, 0x20, 0x98);
7041 break;
7042 case 17:
7043 btdm_2AntSetFw3a(padapter, 0xa3, 0x2f, 0x2f, 0x20, 0x80);
7044 break;
7045 case 18:
7046 btdm_2AntSetFw3a(padapter, 0xe3, 0x5, 0x5, 0xa1, 0x98);
7047 break;
7048 case 19:
7049 btdm_2AntSetFw3a(padapter, 0xe3, 0x25, 0x25, 0xa1, 0x98);
7050 break;
7051 case 20:
7052 btdm_2AntSetFw3a(padapter, 0xe3, 0x25, 0x25, 0x20, 0x98);
7053 break;
7054 }
7055 } else {
7056 /* disable PS tdma */
7057 switch (type) {
7058 case 0:
7059 btdm_2AntSetFw3a(padapter, 0x0, 0x0, 0x0, 0x8, 0x0);
7060 break;
7061 case 1:
7062 btdm_2AntSetFw3a(padapter, 0x0, 0x0, 0x0, 0x0, 0x0);
7063 break;
7064 default:
7065 btdm_2AntSetFw3a(padapter, 0x0, 0x0, 0x0, 0x8, 0x0);
7066 break;
7067 }
7068 }
7069
7070 /* update pre state */
7071 pBtdm8723->bPrePsTdmaOn = pBtdm8723->bCurPsTdmaOn;
7072 pBtdm8723->prePsTdma = pBtdm8723->curPsTdma;
7073}
7074
7075static void btdm_2AntBtInquiryPage(struct rtw_adapter *padapter)
7076{
7077 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7078 btdm_2AntIgnoreWlanAct(padapter, false);
7079 btdm_2AntPsTdma(padapter, true, 8);
7080}
7081
7082static u8 btdm_HoldForBtInqPage(struct rtw_adapter *padapter)
7083{
7084 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
c17416ef 7085 u32 curTime = jiffies;
f7c92d2c
LF		 7086
7087 if (pHalData->bt_coexist.halCoex8723.bC2hBtInquiryPage) {
7088 /* bt inquiry or page is started. */
7089 if (pHalData->bt_coexist.halCoex8723.btInqPageStartTime == 0) {
7090 pHalData->bt_coexist.halCoex8723.btInqPageStartTime = curTime;
c17416ef 7091 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT Inquiry/page is started at time : 0x%lx \n",
f7c92d2c
LF		 7092 pHalData->bt_coexist.halCoex8723.btInqPageStartTime));
7093 }
7094 }
c17416ef 7095 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT Inquiry/page started time : 0x%lx, curTime : 0x%x \n",
f7c92d2c
LF		 7096 pHalData->bt_coexist.halCoex8723.btInqPageStartTime, curTime));
7097
7098 if (pHalData->bt_coexist.halCoex8723.btInqPageStartTime) {
7099 if (((curTime - pHalData->bt_coexist.halCoex8723.btInqPageStartTime)/1000000) >= 10) {
7100 RTPRINT(FBT, BT_TRACE, ("[BTCoex], BT Inquiry/page >= 10sec!!!"));
7101 pHalData->bt_coexist.halCoex8723.btInqPageStartTime = 0;
7102 }
7103 }
7104
7105 if (pHalData->bt_coexist.halCoex8723.btInqPageStartTime) {
7106 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7107 btdm_2AntIgnoreWlanAct(padapter, false);
7108 btdm_2AntPsTdma(padapter, true, 8);
7109 return true;
7110 } else {
7111 return false;
7112 }
7113}
7114
7115static u8 btdm_Is2Ant8723ACommonAction(struct rtw_adapter *padapter)
7116{
7117 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
7118 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
7119 u8 bCommon = false;
7120
7121 RTPRINT(FBT, BT_TRACE, ("%s :BTDM_IsWifiConnectionExist =%x check_fwstate =%x pmlmepriv->fw_state = 0x%x\n", __func__, BTDM_IsWifiConnectionExist(padapter), check_fwstate(&padapter->mlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING)), padapter->mlmepriv.fw_state));
7122
7123 if ((!BTDM_IsWifiConnectionExist(padapter)) &&
7124 (!check_fwstate(&padapter->mlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) &&
7125 (BT_2ANT_BT_STATUS_IDLE == pBtdm8723->btStatus)) {
7126 RTPRINT(FBT, BT_TRACE, ("Wifi idle + Bt idle!!\n"));
7127
7128 btdm_2AntLowPenaltyRa(padapter, false);
7129 btdm_2AntRfShrink(padapter, false);
7130 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7131
7132 btdm_2AntIgnoreWlanAct(padapter, false);
7133 btdm_2AntPsTdma(padapter, false, 0);
7134 btdm_2AntFwDacSwingLvl(padapter, 0x20);
7135 btdm_2AntDecBtPwr(padapter, false);
7136
7137 btdm_2AntAgcTable(padapter, false);
7138 btdm_2AntAdcBackOff(padapter, false);
7139 btdm_2AntDacSwing(padapter, false, 0xc0);
7140
7141 bCommon = true;
7142 } else if (((BTDM_IsWifiConnectionExist(padapter)) ||
7143 (check_fwstate(&padapter->mlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING)))) &&
7144 (BT_2ANT_BT_STATUS_IDLE == pBtdm8723->btStatus)) {
7145 RTPRINT(FBT, BT_TRACE, ("Wifi non-idle + BT idle!!\n"));
7146
7147 btdm_2AntLowPenaltyRa(padapter, true);
7148 btdm_2AntRfShrink(padapter, false);
7149 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7150
7151 btdm_2AntIgnoreWlanAct(padapter, false);
7152 btdm_2AntPsTdma(padapter, false, 0);
7153 btdm_2AntFwDacSwingLvl(padapter, 0x20);
7154 btdm_2AntDecBtPwr(padapter, true);
7155
7156 btdm_2AntAgcTable(padapter, false);
7157 btdm_2AntAdcBackOff(padapter, false);
7158 btdm_2AntDacSwing(padapter, false, 0xc0);
7159
7160 bCommon = true;
7161 } else if ((!BTDM_IsWifiConnectionExist(padapter)) &&
7162 (!check_fwstate(&padapter->mlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) &&
7163 (BT_2ANT_BT_STATUS_CONNECTED_IDLE == pBtdm8723->btStatus)) {
7164 RTPRINT(FBT, BT_TRACE, ("Wifi idle + Bt connected idle!!\n"));
7165
7166 btdm_2AntLowPenaltyRa(padapter, true);
7167 btdm_2AntRfShrink(padapter, true);
7168 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7169
7170 btdm_2AntIgnoreWlanAct(padapter, false);
7171 btdm_2AntPsTdma(padapter, false, 0);
7172 btdm_2AntFwDacSwingLvl(padapter, 0x20);
7173 btdm_2AntDecBtPwr(padapter, false);
7174
7175 btdm_2AntAgcTable(padapter, false);
7176 btdm_2AntAdcBackOff(padapter, false);
7177 btdm_2AntDacSwing(padapter, false, 0xc0);
7178
7179 bCommon = true;
7180 } else if (((BTDM_IsWifiConnectionExist(padapter)) ||
7181 (check_fwstate(&padapter->mlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING)))) &&
7182 (BT_2ANT_BT_STATUS_CONNECTED_IDLE == pBtdm8723->btStatus)) {
7183 RTPRINT(FBT, BT_TRACE, ("Wifi non-idle + Bt connected idle!!\n"));
7184
7185 btdm_2AntLowPenaltyRa(padapter, true);
7186 btdm_2AntRfShrink(padapter, true);
7187 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7188
7189 btdm_2AntIgnoreWlanAct(padapter, false);
7190 btdm_2AntPsTdma(padapter, false, 0);
7191 btdm_2AntFwDacSwingLvl(padapter, 0x20);
7192 btdm_2AntDecBtPwr(padapter, true);
7193
7194 btdm_2AntAgcTable(padapter, false);
7195 btdm_2AntAdcBackOff(padapter, false);
7196 btdm_2AntDacSwing(padapter, false, 0xc0);
7197
7198 bCommon = true;
7199 } else if ((!BTDM_IsWifiConnectionExist(padapter)) &&
7200 (!check_fwstate(&padapter->mlmepriv, (_FW_UNDER_SURVEY|_FW_UNDER_LINKING))) &&
7201 (BT_2ANT_BT_STATUS_NON_IDLE == pBtdm8723->btStatus)) {
7202 RTPRINT(FBT, BT_TRACE, ("Wifi idle + BT non-idle!!\n"));
7203
7204 btdm_2AntLowPenaltyRa(padapter, true);
7205 btdm_2AntRfShrink(padapter, true);
7206 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7207
7208 btdm_2AntIgnoreWlanAct(padapter, false);
7209 btdm_2AntPsTdma(padapter, false, 0);
7210 btdm_2AntFwDacSwingLvl(padapter, 0x20);
7211 btdm_2AntDecBtPwr(padapter, false);
7212
7213 btdm_2AntAgcTable(padapter, false);
7214 btdm_2AntAdcBackOff(padapter, false);
7215 btdm_2AntDacSwing(padapter, false, 0xc0);
7216
7217 bCommon = true;
7218 } else {
7219 RTPRINT(FBT, BT_TRACE, ("Wifi non-idle + BT non-idle!!\n"));
7220 btdm_2AntLowPenaltyRa(padapter, true);
7221 btdm_2AntRfShrink(padapter, true);
7222 btdm_2AntCoexTable(padapter, 0x55555555, 0xffff, 0x3);
7223 btdm_2AntIgnoreWlanAct(padapter, false);
7224 btdm_2AntFwDacSwingLvl(padapter, 0x20);
7225
7226 bCommon = false;
7227 }
7228 return bCommon;
7229}
7230
7231static void
7232btdm_2AntTdmaDurationAdjust(struct rtw_adapter *padapter, u8 bScoHid,
7233 u8 bTxPause, u8 maxInterval)
7234{
7235 struct hal_data_8723a *pHalData = GET_HAL_DATA(padapter);
7236 struct btdm_8723a_2ant *pBtdm8723 = &pHalData->bt_coexist.halCoex8723.btdm2Ant;
7237 static s32 up, dn, m, n, WaitCount;
7238 s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */
7239 u8 retryCount = 0;
7240
7241 RTPRINT(FBT, BT_TRACE, ("[BTCoex], TdmaDurationAdjust()\n"));
7242
7243 if (pBtdm8723->bResetTdmaAdjust) {
7244 pBtdm8723->bResetTdmaAdjust = false;
7245 RTPRINT(FBT, BT_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n"));
7246 if (bScoHid) {
7247 if (bTxPause) {
ceb2f735
NMG		 7248 btdm_2AntPsTdma(padapter, true, 15);
7249 pBtdm8723->psTdmaDuAdjType = 15;
f7c92d2c 7250 } else {
ceb2f735
NMG		 7251 btdm_2AntPsTdma(padapter, true, 11);
7252 pBtdm8723->psTdmaDuAdjType = 11;
f7c92d2c
LF		 7253 }
7254 } else {
7255 if (bTxPause) {
ceb2f735
NMG		 7256 btdm_2AntPsTdma(padapter, true, 7);
7257 pBtdm8723->psTdmaDuAdjType = 7;
f7c92d2c 7258 } else {
ceb2f735
NMG		 7259 btdm_2AntPsTdma(padapter, true, 3);
7260 pBtdm8723->psTdmaDuAdjType = 3;
f7c92d2c
LF		 7261 }
7262 }
7263 up = 0;
7264 dn = 0;
7265 m = 1;
7266 n = 3;
7267 result = 0;
7268 WaitCount = 0;
7269 } else {
7270 /* accquire the BT TRx retry count from BT_Info byte2 */
7271 retryCount = pHalData->bt_coexist.halCoex8723.btRetryCnt;
7272 RTPRINT(FBT, BT_TRACE, ("[BTCoex], retryCount = %d\n", retryCount));
7273 result = 0;
7274 WaitCount++;
7275
7276 if (retryCount == 0) { /* no retry in the last 2-second duration */
7277 up++;
7278 dn--;
7279
7280 if (dn <= 0)
7281 dn = 0;
7282