aca9015079d62b6d54589d5fc7a5729c12186376
[cascardo/linux.git] / drivers / net / wireless / ath / ath9k / ar9003_mci.c
1 /*
2  * Copyright (c) 2008-2011 Atheros Communications Inc.
3  *
4  * Permission to use, copy, modify, and/or distribute this software for any
5  * purpose with or without fee is hereby granted, provided that the above
6  * copyright notice and this permission notice appear in all copies.
7  *
8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15  */
16
17 #include <linux/export.h>
18 #include "hw.h"
19 #include "hw-ops.h"
20 #include "ar9003_phy.h"
21 #include "ar9003_mci.h"
22
23 static void ar9003_mci_reset_req_wakeup(struct ath_hw *ah)
24 {
25         REG_RMW_FIELD(ah, AR_MCI_COMMAND2,
26                       AR_MCI_COMMAND2_RESET_REQ_WAKEUP, 1);
27         udelay(1);
28         REG_RMW_FIELD(ah, AR_MCI_COMMAND2,
29                       AR_MCI_COMMAND2_RESET_REQ_WAKEUP, 0);
30 }
31
32 static int ar9003_mci_wait_for_interrupt(struct ath_hw *ah, u32 address,
33                                         u32 bit_position, int time_out)
34 {
35         struct ath_common *common = ath9k_hw_common(ah);
36
37         while (time_out) {
38                 if (!(REG_READ(ah, address) & bit_position)) {
39                         udelay(10);
40                         time_out -= 10;
41
42                         if (time_out < 0)
43                                 break;
44                         else
45                                 continue;
46                 }
47                 REG_WRITE(ah, address, bit_position);
48
49                 if (address != AR_MCI_INTERRUPT_RX_MSG_RAW)
50                         break;
51
52                 if (bit_position & AR_MCI_INTERRUPT_RX_MSG_REQ_WAKE)
53                         ar9003_mci_reset_req_wakeup(ah);
54
55                 if (bit_position & (AR_MCI_INTERRUPT_RX_MSG_SYS_SLEEPING |
56                                     AR_MCI_INTERRUPT_RX_MSG_SYS_WAKING))
57                         REG_WRITE(ah, AR_MCI_INTERRUPT_RAW,
58                                   AR_MCI_INTERRUPT_REMOTE_SLEEP_UPDATE);
59
60                 REG_WRITE(ah, AR_MCI_INTERRUPT_RAW, AR_MCI_INTERRUPT_RX_MSG);
61                 break;
62         }
63
64         if (time_out <= 0) {
65                 ath_dbg(common, MCI,
66                         "MCI Wait for Reg 0x%08x = 0x%08x timeout\n",
67                         address, bit_position);
68                 ath_dbg(common, MCI,
69                         "MCI INT_RAW = 0x%08x, RX_MSG_RAW = 0x%08x\n",
70                         REG_READ(ah, AR_MCI_INTERRUPT_RAW),
71                         REG_READ(ah, AR_MCI_INTERRUPT_RX_MSG_RAW));
72                 time_out = 0;
73         }
74
75         return time_out;
76 }
77
78 static void ar9003_mci_remote_reset(struct ath_hw *ah, bool wait_done)
79 {
80         u32 payload[4] = { 0xffffffff, 0xffffffff, 0xffffffff, 0xffffff00};
81
82         ar9003_mci_send_message(ah, MCI_REMOTE_RESET, 0, payload, 16,
83                                 wait_done, false);
84         udelay(5);
85 }
86
87 static void ar9003_mci_send_lna_transfer(struct ath_hw *ah, bool wait_done)
88 {
89         u32 payload = 0x00000000;
90
91         ar9003_mci_send_message(ah, MCI_LNA_TRANS, 0, &payload, 1,
92                                 wait_done, false);
93 }
94
95 static void ar9003_mci_send_req_wake(struct ath_hw *ah, bool wait_done)
96 {
97         ar9003_mci_send_message(ah, MCI_REQ_WAKE, MCI_FLAG_DISABLE_TIMESTAMP,
98                                 NULL, 0, wait_done, false);
99         udelay(5);
100 }
101
102 static void ar9003_mci_send_sys_waking(struct ath_hw *ah, bool wait_done)
103 {
104         ar9003_mci_send_message(ah, MCI_SYS_WAKING, MCI_FLAG_DISABLE_TIMESTAMP,
105                                 NULL, 0, wait_done, false);
106 }
107
108 static void ar9003_mci_send_lna_take(struct ath_hw *ah, bool wait_done)
109 {
110         u32 payload = 0x70000000;
111
112         ar9003_mci_send_message(ah, MCI_LNA_TAKE, 0, &payload, 1,
113                                 wait_done, false);
114 }
115
116 static void ar9003_mci_send_sys_sleeping(struct ath_hw *ah, bool wait_done)
117 {
118         ar9003_mci_send_message(ah, MCI_SYS_SLEEPING,
119                                 MCI_FLAG_DISABLE_TIMESTAMP,
120                                 NULL, 0, wait_done, false);
121 }
122
123 static void ar9003_mci_send_coex_version_query(struct ath_hw *ah,
124                                                bool wait_done)
125 {
126         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
127         u32 payload[4] = {0, 0, 0, 0};
128
129         if (mci->bt_version_known ||
130             (mci->bt_state == MCI_BT_SLEEP))
131                 return;
132
133         MCI_GPM_SET_TYPE_OPCODE(payload, MCI_GPM_COEX_AGENT,
134                                 MCI_GPM_COEX_VERSION_QUERY);
135         ar9003_mci_send_message(ah, MCI_GPM, 0, payload, 16, wait_done, true);
136 }
137
138 static void ar9003_mci_send_coex_version_response(struct ath_hw *ah,
139                                                   bool wait_done)
140 {
141         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
142         u32 payload[4] = {0, 0, 0, 0};
143
144         MCI_GPM_SET_TYPE_OPCODE(payload, MCI_GPM_COEX_AGENT,
145                                 MCI_GPM_COEX_VERSION_RESPONSE);
146         *(((u8 *)payload) + MCI_GPM_COEX_B_MAJOR_VERSION) =
147                 mci->wlan_ver_major;
148         *(((u8 *)payload) + MCI_GPM_COEX_B_MINOR_VERSION) =
149                 mci->wlan_ver_minor;
150         ar9003_mci_send_message(ah, MCI_GPM, 0, payload, 16, wait_done, true);
151 }
152
153 static void ar9003_mci_send_coex_wlan_channels(struct ath_hw *ah,
154                                                bool wait_done)
155 {
156         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
157         u32 *payload = &mci->wlan_channels[0];
158
159         if (!mci->wlan_channels_update ||
160             (mci->bt_state == MCI_BT_SLEEP))
161                 return;
162
163         MCI_GPM_SET_TYPE_OPCODE(payload, MCI_GPM_COEX_AGENT,
164                                 MCI_GPM_COEX_WLAN_CHANNELS);
165         ar9003_mci_send_message(ah, MCI_GPM, 0, payload, 16, wait_done, true);
166         MCI_GPM_SET_TYPE_OPCODE(payload, 0xff, 0xff);
167 }
168
169 static void ar9003_mci_send_coex_bt_status_query(struct ath_hw *ah,
170                                                 bool wait_done, u8 query_type)
171 {
172         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
173         u32 payload[4] = {0, 0, 0, 0};
174         bool query_btinfo;
175
176         if (mci->bt_state == MCI_BT_SLEEP)
177                 return;
178
179         query_btinfo = !!(query_type & (MCI_GPM_COEX_QUERY_BT_ALL_INFO |
180                                         MCI_GPM_COEX_QUERY_BT_TOPOLOGY));
181         MCI_GPM_SET_TYPE_OPCODE(payload, MCI_GPM_COEX_AGENT,
182                                 MCI_GPM_COEX_STATUS_QUERY);
183
184         *(((u8 *)payload) + MCI_GPM_COEX_B_BT_BITMAP) = query_type;
185
186         /*
187          * If bt_status_query message is  not sent successfully,
188          * then need_flush_btinfo should be set again.
189          */
190         if (!ar9003_mci_send_message(ah, MCI_GPM, 0, payload, 16,
191                                 wait_done, true)) {
192                 if (query_btinfo)
193                         mci->need_flush_btinfo = true;
194         }
195
196         if (query_btinfo)
197                 mci->query_bt = false;
198 }
199
200 static void ar9003_mci_send_coex_halt_bt_gpm(struct ath_hw *ah, bool halt,
201                                              bool wait_done)
202 {
203         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
204         u32 payload[4] = {0, 0, 0, 0};
205
206         MCI_GPM_SET_TYPE_OPCODE(payload, MCI_GPM_COEX_AGENT,
207                                 MCI_GPM_COEX_HALT_BT_GPM);
208
209         if (halt) {
210                 mci->query_bt = true;
211                 /* Send next unhalt no matter halt sent or not */
212                 mci->unhalt_bt_gpm = true;
213                 mci->need_flush_btinfo = true;
214                 *(((u8 *)payload) + MCI_GPM_COEX_B_HALT_STATE) =
215                         MCI_GPM_COEX_BT_GPM_HALT;
216         } else
217                 *(((u8 *)payload) + MCI_GPM_COEX_B_HALT_STATE) =
218                         MCI_GPM_COEX_BT_GPM_UNHALT;
219
220         ar9003_mci_send_message(ah, MCI_GPM, 0, payload, 16, wait_done, true);
221 }
222
223 static void ar9003_mci_prep_interface(struct ath_hw *ah)
224 {
225         struct ath_common *common = ath9k_hw_common(ah);
226         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
227         u32 saved_mci_int_en;
228         u32 mci_timeout = 150;
229
230         mci->bt_state = MCI_BT_SLEEP;
231         saved_mci_int_en = REG_READ(ah, AR_MCI_INTERRUPT_EN);
232
233         REG_WRITE(ah, AR_MCI_INTERRUPT_EN, 0);
234         REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
235                   REG_READ(ah, AR_MCI_INTERRUPT_RX_MSG_RAW));
236         REG_WRITE(ah, AR_MCI_INTERRUPT_RAW,
237                   REG_READ(ah, AR_MCI_INTERRUPT_RAW));
238
239         ar9003_mci_remote_reset(ah, true);
240         ar9003_mci_send_req_wake(ah, true);
241
242         if (!ar9003_mci_wait_for_interrupt(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
243                                   AR_MCI_INTERRUPT_RX_MSG_SYS_WAKING, 500))
244                 goto clear_redunt;
245
246         mci->bt_state = MCI_BT_AWAKE;
247
248         /*
249          * we don't need to send more remote_reset at this moment.
250          * If BT receive first remote_reset, then BT HW will
251          * be cleaned up and will be able to receive req_wake
252          * and BT HW will respond sys_waking.
253          * In this case, WLAN will receive BT's HW sys_waking.
254          * Otherwise, if BT SW missed initial remote_reset,
255          * that remote_reset will still clean up BT MCI RX,
256          * and the req_wake will wake BT up,
257          * and BT SW will respond this req_wake with a remote_reset and
258          * sys_waking. In this case, WLAN will receive BT's SW
259          * sys_waking. In either case, BT's RX is cleaned up. So we
260          * don't need to reply BT's remote_reset now, if any.
261          * Similarly, if in any case, WLAN can receive BT's sys_waking,
262          * that means WLAN's RX is also fine.
263          */
264         ar9003_mci_send_sys_waking(ah, true);
265         udelay(10);
266
267         /*
268          * Set BT priority interrupt value to be 0xff to
269          * avoid having too many BT PRIORITY interrupts.
270          */
271         REG_WRITE(ah, AR_MCI_BT_PRI0, 0xFFFFFFFF);
272         REG_WRITE(ah, AR_MCI_BT_PRI1, 0xFFFFFFFF);
273         REG_WRITE(ah, AR_MCI_BT_PRI2, 0xFFFFFFFF);
274         REG_WRITE(ah, AR_MCI_BT_PRI3, 0xFFFFFFFF);
275         REG_WRITE(ah, AR_MCI_BT_PRI, 0X000000FF);
276
277         /*
278          * A contention reset will be received after send out
279          * sys_waking. Also BT priority interrupt bits will be set.
280          * Clear those bits before the next step.
281          */
282
283         REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
284                   AR_MCI_INTERRUPT_RX_MSG_CONT_RST);
285         REG_WRITE(ah, AR_MCI_INTERRUPT_RAW, AR_MCI_INTERRUPT_BT_PRI);
286
287         if (mci->is_2g) {
288                 ar9003_mci_send_lna_transfer(ah, true);
289                 udelay(5);
290         }
291
292         if ((mci->is_2g && !mci->update_2g5g)) {
293                 if (ar9003_mci_wait_for_interrupt(ah,
294                                         AR_MCI_INTERRUPT_RX_MSG_RAW,
295                                         AR_MCI_INTERRUPT_RX_MSG_LNA_INFO,
296                                         mci_timeout))
297                         ath_dbg(common, MCI,
298                                 "MCI WLAN has control over the LNA & BT obeys it\n");
299                 else
300                         ath_dbg(common, MCI,
301                                 "MCI BT didn't respond to LNA_TRANS\n");
302         }
303
304 clear_redunt:
305         /* Clear the extra redundant SYS_WAKING from BT */
306         if ((mci->bt_state == MCI_BT_AWAKE) &&
307             (REG_READ_FIELD(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
308                             AR_MCI_INTERRUPT_RX_MSG_SYS_WAKING)) &&
309             (REG_READ_FIELD(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
310                             AR_MCI_INTERRUPT_RX_MSG_SYS_SLEEPING) == 0)) {
311                 REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
312                           AR_MCI_INTERRUPT_RX_MSG_SYS_WAKING);
313                 REG_WRITE(ah, AR_MCI_INTERRUPT_RAW,
314                           AR_MCI_INTERRUPT_REMOTE_SLEEP_UPDATE);
315         }
316
317         REG_WRITE(ah, AR_MCI_INTERRUPT_EN, saved_mci_int_en);
318 }
319
320 void ar9003_mci_set_full_sleep(struct ath_hw *ah)
321 {
322         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
323
324         if (ar9003_mci_state(ah, MCI_STATE_ENABLE) &&
325             (mci->bt_state != MCI_BT_SLEEP) &&
326             !mci->halted_bt_gpm) {
327                 ar9003_mci_send_coex_halt_bt_gpm(ah, true, true);
328         }
329
330         mci->ready = false;
331 }
332
333 static void ar9003_mci_disable_interrupt(struct ath_hw *ah)
334 {
335         REG_WRITE(ah, AR_MCI_INTERRUPT_EN, 0);
336         REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_EN, 0);
337 }
338
339 static void ar9003_mci_enable_interrupt(struct ath_hw *ah)
340 {
341         REG_WRITE(ah, AR_MCI_INTERRUPT_EN, AR_MCI_INTERRUPT_DEFAULT);
342         REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_EN,
343                   AR_MCI_INTERRUPT_RX_MSG_DEFAULT);
344 }
345
346 static bool ar9003_mci_check_int(struct ath_hw *ah, u32 ints)
347 {
348         u32 intr;
349
350         intr = REG_READ(ah, AR_MCI_INTERRUPT_RX_MSG_RAW);
351         return ((intr & ints) == ints);
352 }
353
354 void ar9003_mci_get_interrupt(struct ath_hw *ah, u32 *raw_intr,
355                               u32 *rx_msg_intr)
356 {
357         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
358
359         *raw_intr = mci->raw_intr;
360         *rx_msg_intr = mci->rx_msg_intr;
361
362         /* Clean int bits after the values are read. */
363         mci->raw_intr = 0;
364         mci->rx_msg_intr = 0;
365 }
366 EXPORT_SYMBOL(ar9003_mci_get_interrupt);
367
368 void ar9003_mci_get_isr(struct ath_hw *ah, enum ath9k_int *masked)
369 {
370         struct ath_common *common = ath9k_hw_common(ah);
371         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
372         u32 raw_intr, rx_msg_intr;
373
374         rx_msg_intr = REG_READ(ah, AR_MCI_INTERRUPT_RX_MSG_RAW);
375         raw_intr = REG_READ(ah, AR_MCI_INTERRUPT_RAW);
376
377         if ((raw_intr == 0xdeadbeef) || (rx_msg_intr == 0xdeadbeef)) {
378                 ath_dbg(common, MCI,
379                         "MCI gets 0xdeadbeef during int processing\n");
380         } else {
381                 mci->rx_msg_intr |= rx_msg_intr;
382                 mci->raw_intr |= raw_intr;
383                 *masked |= ATH9K_INT_MCI;
384
385                 if (rx_msg_intr & AR_MCI_INTERRUPT_RX_MSG_CONT_INFO)
386                         mci->cont_status = REG_READ(ah, AR_MCI_CONT_STATUS);
387
388                 REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_RAW, rx_msg_intr);
389                 REG_WRITE(ah, AR_MCI_INTERRUPT_RAW, raw_intr);
390         }
391 }
392
393 static void ar9003_mci_2g5g_changed(struct ath_hw *ah, bool is_2g)
394 {
395         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
396
397         if (!mci->update_2g5g &&
398             (mci->is_2g != is_2g))
399                 mci->update_2g5g = true;
400
401         mci->is_2g = is_2g;
402 }
403
404 static bool ar9003_mci_is_gpm_valid(struct ath_hw *ah, u32 msg_index)
405 {
406         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
407         u32 *payload;
408         u32 recv_type, offset;
409
410         if (msg_index == MCI_GPM_INVALID)
411                 return false;
412
413         offset = msg_index << 4;
414
415         payload = (u32 *)(mci->gpm_buf + offset);
416         recv_type = MCI_GPM_TYPE(payload);
417
418         if (recv_type == MCI_GPM_RSVD_PATTERN)
419                 return false;
420
421         return true;
422 }
423
424 static void ar9003_mci_observation_set_up(struct ath_hw *ah)
425 {
426         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
427
428         if (mci->config & ATH_MCI_CONFIG_MCI_OBS_MCI) {
429                 ath9k_hw_cfg_output(ah, 3, AR_GPIO_OUTPUT_MUX_AS_MCI_WLAN_DATA);
430                 ath9k_hw_cfg_output(ah, 2, AR_GPIO_OUTPUT_MUX_AS_MCI_WLAN_CLK);
431                 ath9k_hw_cfg_output(ah, 1, AR_GPIO_OUTPUT_MUX_AS_MCI_BT_DATA);
432                 ath9k_hw_cfg_output(ah, 0, AR_GPIO_OUTPUT_MUX_AS_MCI_BT_CLK);
433         } else if (mci->config & ATH_MCI_CONFIG_MCI_OBS_TXRX) {
434                 ath9k_hw_cfg_output(ah, 3, AR_GPIO_OUTPUT_MUX_AS_WL_IN_TX);
435                 ath9k_hw_cfg_output(ah, 2, AR_GPIO_OUTPUT_MUX_AS_WL_IN_RX);
436                 ath9k_hw_cfg_output(ah, 1, AR_GPIO_OUTPUT_MUX_AS_BT_IN_TX);
437                 ath9k_hw_cfg_output(ah, 0, AR_GPIO_OUTPUT_MUX_AS_BT_IN_RX);
438                 ath9k_hw_cfg_output(ah, 5, AR_GPIO_OUTPUT_MUX_AS_OUTPUT);
439         } else if (mci->config & ATH_MCI_CONFIG_MCI_OBS_BT) {
440                 ath9k_hw_cfg_output(ah, 3, AR_GPIO_OUTPUT_MUX_AS_BT_IN_TX);
441                 ath9k_hw_cfg_output(ah, 2, AR_GPIO_OUTPUT_MUX_AS_BT_IN_RX);
442                 ath9k_hw_cfg_output(ah, 1, AR_GPIO_OUTPUT_MUX_AS_MCI_BT_DATA);
443                 ath9k_hw_cfg_output(ah, 0, AR_GPIO_OUTPUT_MUX_AS_MCI_BT_CLK);
444         } else
445                 return;
446
447         REG_SET_BIT(ah, AR_GPIO_INPUT_EN_VAL, AR_GPIO_JTAG_DISABLE);
448
449         REG_RMW_FIELD(ah, AR_PHY_GLB_CONTROL, AR_GLB_DS_JTAG_DISABLE, 1);
450         REG_RMW_FIELD(ah, AR_PHY_GLB_CONTROL, AR_GLB_WLAN_UART_INTF_EN, 0);
451         REG_SET_BIT(ah, AR_GLB_GPIO_CONTROL, ATH_MCI_CONFIG_MCI_OBS_GPIO);
452
453         REG_RMW_FIELD(ah, AR_BTCOEX_CTRL2, AR_BTCOEX_CTRL2_GPIO_OBS_SEL, 0);
454         REG_RMW_FIELD(ah, AR_BTCOEX_CTRL2, AR_BTCOEX_CTRL2_MAC_BB_OBS_SEL, 1);
455         REG_WRITE(ah, AR_OBS, 0x4b);
456         REG_RMW_FIELD(ah, AR_DIAG_SW, AR_DIAG_OBS_PT_SEL1, 0x03);
457         REG_RMW_FIELD(ah, AR_DIAG_SW, AR_DIAG_OBS_PT_SEL2, 0x01);
458         REG_RMW_FIELD(ah, AR_MACMISC, AR_MACMISC_MISC_OBS_BUS_LSB, 0x02);
459         REG_RMW_FIELD(ah, AR_MACMISC, AR_MACMISC_MISC_OBS_BUS_MSB, 0x03);
460         REG_RMW_FIELD(ah, AR_PHY_TEST_CTL_STATUS,
461                       AR_PHY_TEST_CTL_DEBUGPORT_SEL, 0x07);
462 }
463
464 static bool ar9003_mci_send_coex_bt_flags(struct ath_hw *ah, bool wait_done,
465                                           u8 opcode, u32 bt_flags)
466 {
467         u32 pld[4] = {0, 0, 0, 0};
468
469         MCI_GPM_SET_TYPE_OPCODE(pld, MCI_GPM_COEX_AGENT,
470                                 MCI_GPM_COEX_BT_UPDATE_FLAGS);
471
472         *(((u8 *)pld) + MCI_GPM_COEX_B_BT_FLAGS_OP)  = opcode;
473         *(((u8 *)pld) + MCI_GPM_COEX_W_BT_FLAGS + 0) = bt_flags & 0xFF;
474         *(((u8 *)pld) + MCI_GPM_COEX_W_BT_FLAGS + 1) = (bt_flags >> 8) & 0xFF;
475         *(((u8 *)pld) + MCI_GPM_COEX_W_BT_FLAGS + 2) = (bt_flags >> 16) & 0xFF;
476         *(((u8 *)pld) + MCI_GPM_COEX_W_BT_FLAGS + 3) = (bt_flags >> 24) & 0xFF;
477
478         return ar9003_mci_send_message(ah, MCI_GPM, 0, pld, 16,
479                                        wait_done, true);
480 }
481
482 static void ar9003_mci_sync_bt_state(struct ath_hw *ah)
483 {
484         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
485         u32 cur_bt_state;
486
487         cur_bt_state = ar9003_mci_state(ah, MCI_STATE_REMOTE_SLEEP);
488
489         if (mci->bt_state != cur_bt_state)
490                 mci->bt_state = cur_bt_state;
491
492         if (mci->bt_state != MCI_BT_SLEEP) {
493
494                 ar9003_mci_send_coex_version_query(ah, true);
495                 ar9003_mci_send_coex_wlan_channels(ah, true);
496
497                 if (mci->unhalt_bt_gpm == true)
498                         ar9003_mci_send_coex_halt_bt_gpm(ah, false, true);
499         }
500 }
501
502 void ar9003_mci_check_bt(struct ath_hw *ah)
503 {
504         struct ath9k_hw_mci *mci_hw = &ah->btcoex_hw.mci;
505
506         if (!mci_hw->ready)
507                 return;
508
509         /*
510          * check BT state again to make
511          * sure it's not changed.
512          */
513         ar9003_mci_sync_bt_state(ah);
514         ar9003_mci_2g5g_switch(ah, true);
515
516         if ((mci_hw->bt_state == MCI_BT_AWAKE) &&
517             (mci_hw->query_bt == true)) {
518                 mci_hw->need_flush_btinfo = true;
519         }
520 }
521
522 static void ar9003_mci_process_gpm_extra(struct ath_hw *ah, u8 gpm_type,
523                                          u8 gpm_opcode, u32 *p_gpm)
524 {
525         struct ath_common *common = ath9k_hw_common(ah);
526         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
527         u8 *p_data = (u8 *) p_gpm;
528
529         if (gpm_type != MCI_GPM_COEX_AGENT)
530                 return;
531
532         switch (gpm_opcode) {
533         case MCI_GPM_COEX_VERSION_QUERY:
534                 ath_dbg(common, MCI, "MCI Recv GPM COEX Version Query\n");
535                 ar9003_mci_send_coex_version_response(ah, true);
536                 break;
537         case MCI_GPM_COEX_VERSION_RESPONSE:
538                 ath_dbg(common, MCI, "MCI Recv GPM COEX Version Response\n");
539                 mci->bt_ver_major =
540                         *(p_data + MCI_GPM_COEX_B_MAJOR_VERSION);
541                 mci->bt_ver_minor =
542                         *(p_data + MCI_GPM_COEX_B_MINOR_VERSION);
543                 mci->bt_version_known = true;
544                 ath_dbg(common, MCI, "MCI BT Coex version: %d.%d\n",
545                         mci->bt_ver_major, mci->bt_ver_minor);
546                 break;
547         case MCI_GPM_COEX_STATUS_QUERY:
548                 ath_dbg(common, MCI,
549                         "MCI Recv GPM COEX Status Query = 0x%02X\n",
550                         *(p_data + MCI_GPM_COEX_B_WLAN_BITMAP));
551                 mci->wlan_channels_update = true;
552                 ar9003_mci_send_coex_wlan_channels(ah, true);
553                 break;
554         case MCI_GPM_COEX_BT_PROFILE_INFO:
555                 mci->query_bt = true;
556                 ath_dbg(common, MCI, "MCI Recv GPM COEX BT_Profile_Info\n");
557                 break;
558         case MCI_GPM_COEX_BT_STATUS_UPDATE:
559                 mci->query_bt = true;
560                 ath_dbg(common, MCI,
561                         "MCI Recv GPM COEX BT_Status_Update SEQ=%d (drop&query)\n",
562                         *(p_gpm + 3));
563                 break;
564         default:
565                 break;
566         }
567 }
568
569 static u32 ar9003_mci_wait_for_gpm(struct ath_hw *ah, u8 gpm_type,
570                                    u8 gpm_opcode, int time_out)
571 {
572         struct ath_common *common = ath9k_hw_common(ah);
573         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
574         u32 *p_gpm = NULL, mismatch = 0, more_data;
575         u32 offset;
576         u8 recv_type = 0, recv_opcode = 0;
577         bool b_is_bt_cal_done = (gpm_type == MCI_GPM_BT_CAL_DONE);
578
579         more_data = time_out ? MCI_GPM_NOMORE : MCI_GPM_MORE;
580
581         while (time_out > 0) {
582                 if (p_gpm) {
583                         MCI_GPM_RECYCLE(p_gpm);
584                         p_gpm = NULL;
585                 }
586
587                 if (more_data != MCI_GPM_MORE)
588                         time_out = ar9003_mci_wait_for_interrupt(ah,
589                                         AR_MCI_INTERRUPT_RX_MSG_RAW,
590                                         AR_MCI_INTERRUPT_RX_MSG_GPM,
591                                         time_out);
592
593                 if (!time_out)
594                         break;
595
596                 offset = ar9003_mci_get_next_gpm_offset(ah, false, &more_data);
597
598                 if (offset == MCI_GPM_INVALID)
599                         continue;
600
601                 p_gpm = (u32 *) (mci->gpm_buf + offset);
602                 recv_type = MCI_GPM_TYPE(p_gpm);
603                 recv_opcode = MCI_GPM_OPCODE(p_gpm);
604
605                 if (MCI_GPM_IS_CAL_TYPE(recv_type)) {
606                         if (recv_type == gpm_type) {
607                                 if ((gpm_type == MCI_GPM_BT_CAL_DONE) &&
608                                     !b_is_bt_cal_done) {
609                                         gpm_type = MCI_GPM_BT_CAL_GRANT;
610                                         continue;
611                                 }
612                                 break;
613                         }
614                 } else if ((recv_type == gpm_type) &&
615                            (recv_opcode == gpm_opcode))
616                         break;
617
618                 /*
619                  * check if it's cal_grant
620                  *
621                  * When we're waiting for cal_grant in reset routine,
622                  * it's possible that BT sends out cal_request at the
623                  * same time. Since BT's calibration doesn't happen
624                  * that often, we'll let BT completes calibration then
625                  * we continue to wait for cal_grant from BT.
626                  * Orginal: Wait BT_CAL_GRANT.
627                  * New: Receive BT_CAL_REQ -> send WLAN_CAL_GRANT->wait
628                  * BT_CAL_DONE -> Wait BT_CAL_GRANT.
629                  */
630
631                 if ((gpm_type == MCI_GPM_BT_CAL_GRANT) &&
632                     (recv_type == MCI_GPM_BT_CAL_REQ)) {
633
634                         u32 payload[4] = {0, 0, 0, 0};
635
636                         gpm_type = MCI_GPM_BT_CAL_DONE;
637                         MCI_GPM_SET_CAL_TYPE(payload,
638                                              MCI_GPM_WLAN_CAL_GRANT);
639                         ar9003_mci_send_message(ah, MCI_GPM, 0, payload, 16,
640                                                 false, false);
641                         continue;
642                 } else {
643                         ath_dbg(common, MCI, "MCI GPM subtype not match 0x%x\n",
644                                 *(p_gpm + 1));
645                         mismatch++;
646                         ar9003_mci_process_gpm_extra(ah, recv_type,
647                                                      recv_opcode, p_gpm);
648                 }
649         }
650
651         if (p_gpm) {
652                 MCI_GPM_RECYCLE(p_gpm);
653                 p_gpm = NULL;
654         }
655
656         if (time_out <= 0)
657                 time_out = 0;
658
659         while (more_data == MCI_GPM_MORE) {
660                 offset = ar9003_mci_get_next_gpm_offset(ah, false, &more_data);
661                 if (offset == MCI_GPM_INVALID)
662                         break;
663
664                 p_gpm = (u32 *) (mci->gpm_buf + offset);
665                 recv_type = MCI_GPM_TYPE(p_gpm);
666                 recv_opcode = MCI_GPM_OPCODE(p_gpm);
667
668                 if (!MCI_GPM_IS_CAL_TYPE(recv_type))
669                         ar9003_mci_process_gpm_extra(ah, recv_type,
670                                                      recv_opcode, p_gpm);
671
672                 MCI_GPM_RECYCLE(p_gpm);
673         }
674
675         return time_out;
676 }
677
678 bool ar9003_mci_start_reset(struct ath_hw *ah, struct ath9k_channel *chan)
679 {
680         struct ath_common *common = ath9k_hw_common(ah);
681         struct ath9k_hw_mci *mci_hw = &ah->btcoex_hw.mci;
682         u32 payload[4] = {0, 0, 0, 0};
683
684         ar9003_mci_2g5g_changed(ah, IS_CHAN_2GHZ(chan));
685
686         if (mci_hw->bt_state != MCI_BT_CAL_START)
687                 return false;
688
689         mci_hw->bt_state = MCI_BT_CAL;
690
691         /*
692          * MCI FIX: disable mci interrupt here. This is to avoid
693          * SW_MSG_DONE or RX_MSG bits to trigger MCI_INT and
694          * lead to mci_intr reentry.
695          */
696         ar9003_mci_disable_interrupt(ah);
697
698         MCI_GPM_SET_CAL_TYPE(payload, MCI_GPM_WLAN_CAL_GRANT);
699         ar9003_mci_send_message(ah, MCI_GPM, 0, payload,
700                                 16, true, false);
701
702         /* Wait BT calibration to be completed for 25ms */
703
704         if (ar9003_mci_wait_for_gpm(ah, MCI_GPM_BT_CAL_DONE,
705                                     0, 25000))
706                 ath_dbg(common, MCI, "MCI BT_CAL_DONE received\n");
707         else
708                 ath_dbg(common, MCI,
709                         "MCI BT_CAL_DONE not received\n");
710
711         mci_hw->bt_state = MCI_BT_AWAKE;
712         /* MCI FIX: enable mci interrupt here */
713         ar9003_mci_enable_interrupt(ah);
714
715         return true;
716 }
717
718 int ar9003_mci_end_reset(struct ath_hw *ah, struct ath9k_channel *chan,
719                          struct ath9k_hw_cal_data *caldata)
720 {
721         struct ath9k_hw_mci *mci_hw = &ah->btcoex_hw.mci;
722
723         if (!mci_hw->ready)
724                 return 0;
725
726         if (!IS_CHAN_2GHZ(chan) || (mci_hw->bt_state != MCI_BT_SLEEP))
727                 goto exit;
728
729         if (!ar9003_mci_check_int(ah, AR_MCI_INTERRUPT_RX_MSG_REMOTE_RESET) &&
730             !ar9003_mci_check_int(ah, AR_MCI_INTERRUPT_RX_MSG_REQ_WAKE))
731                 goto exit;
732
733         /*
734          * BT is sleeping. Check if BT wakes up during
735          * WLAN calibration. If BT wakes up during
736          * WLAN calibration, need to go through all
737          * message exchanges again and recal.
738          */
739         REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
740                   (AR_MCI_INTERRUPT_RX_MSG_REMOTE_RESET |
741                    AR_MCI_INTERRUPT_RX_MSG_REQ_WAKE));
742
743         ar9003_mci_remote_reset(ah, true);
744         ar9003_mci_send_sys_waking(ah, true);
745         udelay(1);
746
747         if (IS_CHAN_2GHZ(chan))
748                 ar9003_mci_send_lna_transfer(ah, true);
749
750         mci_hw->bt_state = MCI_BT_AWAKE;
751
752         REG_CLR_BIT(ah, AR_PHY_TIMING4,
753                     1 << AR_PHY_TIMING_CONTROL4_DO_GAIN_DC_IQ_CAL_SHIFT);
754
755         if (caldata) {
756                 clear_bit(TXIQCAL_DONE, &caldata->cal_flags);
757                 clear_bit(TXCLCAL_DONE, &caldata->cal_flags);
758                 clear_bit(RTT_DONE, &caldata->cal_flags);
759         }
760
761         if (!ath9k_hw_init_cal(ah, chan))
762                 return -EIO;
763
764         REG_SET_BIT(ah, AR_PHY_TIMING4,
765                     1 << AR_PHY_TIMING_CONTROL4_DO_GAIN_DC_IQ_CAL_SHIFT);
766
767 exit:
768         ar9003_mci_enable_interrupt(ah);
769         return 0;
770 }
771
772 static void ar9003_mci_mute_bt(struct ath_hw *ah)
773 {
774         /* disable all MCI messages */
775         REG_WRITE(ah, AR_MCI_MSG_ATTRIBUTES_TABLE, 0xffff0000);
776         REG_SET_BIT(ah, AR_MCI_TX_CTRL, AR_MCI_TX_CTRL_DISABLE_LNA_UPDATE);
777
778         /* wait pending HW messages to flush out */
779         udelay(10);
780
781         /*
782          * Send LNA_TAKE and SYS_SLEEPING when
783          * 1. reset not after resuming from full sleep
784          * 2. before reset MCI RX, to quiet BT and avoid MCI RX misalignment
785          */
786         ar9003_mci_send_lna_take(ah, true);
787
788         udelay(5);
789
790         ar9003_mci_send_sys_sleeping(ah, true);
791 }
792
793 static void ar9003_mci_osla_setup(struct ath_hw *ah, bool enable)
794 {
795         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
796         u32 thresh;
797
798         if (!enable) {
799                 REG_CLR_BIT(ah, AR_BTCOEX_CTRL,
800                             AR_BTCOEX_CTRL_ONE_STEP_LOOK_AHEAD_EN);
801                 return;
802         }
803         REG_RMW_FIELD(ah, AR_MCI_SCHD_TABLE_2, AR_MCI_SCHD_TABLE_2_HW_BASED, 1);
804         REG_RMW_FIELD(ah, AR_MCI_SCHD_TABLE_2,
805                       AR_MCI_SCHD_TABLE_2_MEM_BASED, 1);
806
807         if (AR_SREV_9565(ah))
808                 REG_RMW_FIELD(ah, AR_MCI_MISC, AR_MCI_MISC_HW_FIX_EN, 1);
809
810         if (!(mci->config & ATH_MCI_CONFIG_DISABLE_AGGR_THRESH)) {
811                 thresh = MS(mci->config, ATH_MCI_CONFIG_AGGR_THRESH);
812                 REG_RMW_FIELD(ah, AR_BTCOEX_CTRL,
813                               AR_BTCOEX_CTRL_AGGR_THRESH, thresh);
814                 REG_RMW_FIELD(ah, AR_BTCOEX_CTRL,
815                               AR_BTCOEX_CTRL_TIME_TO_NEXT_BT_THRESH_EN, 1);
816         } else
817                 REG_RMW_FIELD(ah, AR_BTCOEX_CTRL,
818                               AR_BTCOEX_CTRL_TIME_TO_NEXT_BT_THRESH_EN, 0);
819
820         REG_RMW_FIELD(ah, AR_BTCOEX_CTRL,
821                       AR_BTCOEX_CTRL_ONE_STEP_LOOK_AHEAD_EN, 1);
822 }
823
824 static void ar9003_mci_set_btcoex_ctrl_9565_1ANT(struct ath_hw *ah)
825 {
826         u32 regval;
827
828         regval = SM(1, AR_BTCOEX_CTRL_AR9462_MODE) |
829                  SM(1, AR_BTCOEX_CTRL_WBTIMER_EN) |
830                  SM(1, AR_BTCOEX_CTRL_PA_SHARED) |
831                  SM(1, AR_BTCOEX_CTRL_LNA_SHARED) |
832                  SM(1, AR_BTCOEX_CTRL_NUM_ANTENNAS) |
833                  SM(1, AR_BTCOEX_CTRL_RX_CHAIN_MASK) |
834                  SM(0, AR_BTCOEX_CTRL_1_CHAIN_ACK) |
835                  SM(0, AR_BTCOEX_CTRL_1_CHAIN_BCN) |
836                  SM(0, AR_BTCOEX_CTRL_ONE_STEP_LOOK_AHEAD_EN);
837
838         REG_RMW_FIELD(ah, AR_BTCOEX_CTRL2,
839                       AR_BTCOEX_CTRL2_TX_CHAIN_MASK, 0x1);
840         REG_WRITE(ah, AR_BTCOEX_CTRL, regval);
841 }
842
843 static void ar9003_mci_set_btcoex_ctrl_9565_2ANT(struct ath_hw *ah)
844 {
845         u32 regval;
846
847         regval = SM(1, AR_BTCOEX_CTRL_AR9462_MODE) |
848                  SM(1, AR_BTCOEX_CTRL_WBTIMER_EN) |
849                  SM(0, AR_BTCOEX_CTRL_PA_SHARED) |
850                  SM(0, AR_BTCOEX_CTRL_LNA_SHARED) |
851                  SM(2, AR_BTCOEX_CTRL_NUM_ANTENNAS) |
852                  SM(1, AR_BTCOEX_CTRL_RX_CHAIN_MASK) |
853                  SM(0, AR_BTCOEX_CTRL_1_CHAIN_ACK) |
854                  SM(0, AR_BTCOEX_CTRL_1_CHAIN_BCN) |
855                  SM(0, AR_BTCOEX_CTRL_ONE_STEP_LOOK_AHEAD_EN);
856
857         REG_RMW_FIELD(ah, AR_BTCOEX_CTRL2,
858                       AR_BTCOEX_CTRL2_TX_CHAIN_MASK, 0x0);
859         REG_WRITE(ah, AR_BTCOEX_CTRL, regval);
860 }
861
862 static void ar9003_mci_set_btcoex_ctrl_9462(struct ath_hw *ah)
863 {
864         u32 regval;
865
866         regval = SM(1, AR_BTCOEX_CTRL_AR9462_MODE) |
867                  SM(1, AR_BTCOEX_CTRL_WBTIMER_EN) |
868                  SM(1, AR_BTCOEX_CTRL_PA_SHARED) |
869                  SM(1, AR_BTCOEX_CTRL_LNA_SHARED) |
870                  SM(2, AR_BTCOEX_CTRL_NUM_ANTENNAS) |
871                  SM(3, AR_BTCOEX_CTRL_RX_CHAIN_MASK) |
872                  SM(0, AR_BTCOEX_CTRL_1_CHAIN_ACK) |
873                  SM(0, AR_BTCOEX_CTRL_1_CHAIN_BCN) |
874                  SM(0, AR_BTCOEX_CTRL_ONE_STEP_LOOK_AHEAD_EN);
875
876         REG_WRITE(ah, AR_BTCOEX_CTRL, regval);
877 }
878
879 int ar9003_mci_reset(struct ath_hw *ah, bool en_int, bool is_2g,
880                      bool is_full_sleep)
881 {
882         struct ath_common *common = ath9k_hw_common(ah);
883         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
884         u32 regval, i;
885
886         ath_dbg(common, MCI, "MCI Reset (full_sleep = %d, is_2g = %d)\n",
887                 is_full_sleep, is_2g);
888
889         if (REG_READ(ah, AR_BTCOEX_CTRL) == 0xdeadbeef) {
890                 ath_err(common, "BTCOEX control register is dead\n");
891                 return -EINVAL;
892         }
893
894         /* Program MCI DMA related registers */
895         REG_WRITE(ah, AR_MCI_GPM_0, mci->gpm_addr);
896         REG_WRITE(ah, AR_MCI_GPM_1, mci->gpm_len);
897         REG_WRITE(ah, AR_MCI_SCHD_TABLE_0, mci->sched_addr);
898
899         /*
900         * To avoid MCI state machine be affected by incoming remote MCI msgs,
901         * MCI mode will be enabled later, right before reset the MCI TX and RX.
902         */
903         if (AR_SREV_9565(ah)) {
904                 u8 ant = MS(mci->config, ATH_MCI_CONFIG_ANT_ARCH);
905
906                 if (ant == ATH_MCI_ANT_ARCH_1_ANT_PA_LNA_SHARED)
907                         ar9003_mci_set_btcoex_ctrl_9565_1ANT(ah);
908                 else
909                         ar9003_mci_set_btcoex_ctrl_9565_2ANT(ah);
910         } else {
911                 ar9003_mci_set_btcoex_ctrl_9462(ah);
912         }
913
914         if (is_2g && !(mci->config & ATH_MCI_CONFIG_DISABLE_OSLA))
915                 ar9003_mci_osla_setup(ah, true);
916         else
917                 ar9003_mci_osla_setup(ah, false);
918
919         REG_SET_BIT(ah, AR_PHY_GLB_CONTROL,
920                     AR_BTCOEX_CTRL_SPDT_ENABLE);
921         REG_RMW_FIELD(ah, AR_BTCOEX_CTRL3,
922                       AR_BTCOEX_CTRL3_CONT_INFO_TIMEOUT, 20);
923
924         REG_RMW_FIELD(ah, AR_BTCOEX_CTRL2, AR_BTCOEX_CTRL2_RX_DEWEIGHT, 0);
925         REG_RMW_FIELD(ah, AR_PCU_MISC, AR_PCU_BT_ANT_PREVENT_RX, 0);
926
927         /* Set the time out to 3.125ms (5 BT slots) */
928         REG_RMW_FIELD(ah, AR_BTCOEX_WL_LNA, AR_BTCOEX_WL_LNA_TIMEOUT, 0x3D090);
929
930         /* concurrent tx priority */
931         if (mci->config & ATH_MCI_CONFIG_CONCUR_TX) {
932                 REG_RMW_FIELD(ah, AR_BTCOEX_CTRL2,
933                               AR_BTCOEX_CTRL2_DESC_BASED_TXPWR_ENABLE, 0);
934                 REG_RMW_FIELD(ah, AR_BTCOEX_CTRL2,
935                               AR_BTCOEX_CTRL2_TXPWR_THRESH, 0x7f);
936                 REG_RMW_FIELD(ah, AR_BTCOEX_CTRL,
937                               AR_BTCOEX_CTRL_REDUCE_TXPWR, 0);
938                 for (i = 0; i < 8; i++)
939                         REG_WRITE(ah, AR_BTCOEX_MAX_TXPWR(i), 0x7f7f7f7f);
940         }
941
942         regval = MS(mci->config, ATH_MCI_CONFIG_CLK_DIV);
943         REG_RMW_FIELD(ah, AR_MCI_TX_CTRL, AR_MCI_TX_CTRL_CLK_DIV, regval);
944         REG_SET_BIT(ah, AR_BTCOEX_CTRL, AR_BTCOEX_CTRL_MCI_MODE_EN);
945
946         /* Resetting the Rx and Tx paths of MCI */
947         regval = REG_READ(ah, AR_MCI_COMMAND2);
948         regval |= SM(1, AR_MCI_COMMAND2_RESET_TX);
949         REG_WRITE(ah, AR_MCI_COMMAND2, regval);
950
951         udelay(1);
952
953         regval &= ~SM(1, AR_MCI_COMMAND2_RESET_TX);
954         REG_WRITE(ah, AR_MCI_COMMAND2, regval);
955
956         if (is_full_sleep) {
957                 ar9003_mci_mute_bt(ah);
958                 udelay(100);
959         }
960
961         /* Check pending GPM msg before MCI Reset Rx */
962         ar9003_mci_check_gpm_offset(ah);
963
964         regval |= SM(1, AR_MCI_COMMAND2_RESET_RX);
965         REG_WRITE(ah, AR_MCI_COMMAND2, regval);
966         udelay(1);
967         regval &= ~SM(1, AR_MCI_COMMAND2_RESET_RX);
968         REG_WRITE(ah, AR_MCI_COMMAND2, regval);
969
970         ar9003_mci_get_next_gpm_offset(ah, true, NULL);
971
972         REG_WRITE(ah, AR_MCI_MSG_ATTRIBUTES_TABLE,
973                   (SM(0xe801, AR_MCI_MSG_ATTRIBUTES_TABLE_INVALID_HDR) |
974                    SM(0x0000, AR_MCI_MSG_ATTRIBUTES_TABLE_CHECKSUM)));
975
976         if (MCI_ANT_ARCH_PA_LNA_SHARED(mci))
977                 REG_CLR_BIT(ah, AR_MCI_TX_CTRL,
978                             AR_MCI_TX_CTRL_DISABLE_LNA_UPDATE);
979         else
980                 REG_SET_BIT(ah, AR_MCI_TX_CTRL,
981                             AR_MCI_TX_CTRL_DISABLE_LNA_UPDATE);
982
983         ar9003_mci_observation_set_up(ah);
984
985         mci->ready = true;
986         ar9003_mci_prep_interface(ah);
987
988         if (AR_SREV_9565(ah))
989                 REG_RMW_FIELD(ah, AR_MCI_DBG_CNT_CTRL,
990                               AR_MCI_DBG_CNT_CTRL_ENABLE, 0);
991         if (en_int)
992                 ar9003_mci_enable_interrupt(ah);
993
994         return 0;
995 }
996
997 void ar9003_mci_stop_bt(struct ath_hw *ah, bool save_fullsleep)
998 {
999         struct ath9k_hw_mci *mci_hw = &ah->btcoex_hw.mci;
1000
1001         ar9003_mci_disable_interrupt(ah);
1002
1003         if (mci_hw->ready && !save_fullsleep) {
1004                 ar9003_mci_mute_bt(ah);
1005                 udelay(20);
1006                 REG_WRITE(ah, AR_BTCOEX_CTRL, 0);
1007         }
1008
1009         mci_hw->bt_state = MCI_BT_SLEEP;
1010         mci_hw->ready = false;
1011 }
1012
1013 static void ar9003_mci_send_2g5g_status(struct ath_hw *ah, bool wait_done)
1014 {
1015         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1016         u32 new_flags, to_set, to_clear;
1017
1018         if (!mci->update_2g5g || (mci->bt_state == MCI_BT_SLEEP))
1019                 return;
1020
1021         if (mci->is_2g) {
1022                 new_flags = MCI_2G_FLAGS;
1023                 to_clear = MCI_2G_FLAGS_CLEAR_MASK;
1024                 to_set = MCI_2G_FLAGS_SET_MASK;
1025         } else {
1026                 new_flags = MCI_5G_FLAGS;
1027                 to_clear = MCI_5G_FLAGS_CLEAR_MASK;
1028                 to_set = MCI_5G_FLAGS_SET_MASK;
1029         }
1030
1031         if (to_clear)
1032                 ar9003_mci_send_coex_bt_flags(ah, wait_done,
1033                                               MCI_GPM_COEX_BT_FLAGS_CLEAR,
1034                                               to_clear);
1035         if (to_set)
1036                 ar9003_mci_send_coex_bt_flags(ah, wait_done,
1037                                               MCI_GPM_COEX_BT_FLAGS_SET,
1038                                               to_set);
1039 }
1040
1041 static void ar9003_mci_queue_unsent_gpm(struct ath_hw *ah, u8 header,
1042                                         u32 *payload, bool queue)
1043 {
1044         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1045         u8 type, opcode;
1046
1047         /* check if the message is to be queued */
1048         if (header != MCI_GPM)
1049                 return;
1050
1051         type = MCI_GPM_TYPE(payload);
1052         opcode = MCI_GPM_OPCODE(payload);
1053
1054         if (type != MCI_GPM_COEX_AGENT)
1055                 return;
1056
1057         switch (opcode) {
1058         case MCI_GPM_COEX_BT_UPDATE_FLAGS:
1059                 if (*(((u8 *)payload) + MCI_GPM_COEX_B_BT_FLAGS_OP) ==
1060                     MCI_GPM_COEX_BT_FLAGS_READ)
1061                         break;
1062
1063                 mci->update_2g5g = queue;
1064
1065                 break;
1066         case MCI_GPM_COEX_WLAN_CHANNELS:
1067                 mci->wlan_channels_update = queue;
1068                 break;
1069         case MCI_GPM_COEX_HALT_BT_GPM:
1070                 if (*(((u8 *)payload) + MCI_GPM_COEX_B_HALT_STATE) ==
1071                     MCI_GPM_COEX_BT_GPM_UNHALT) {
1072                         mci->unhalt_bt_gpm = queue;
1073
1074                         if (!queue)
1075                                 mci->halted_bt_gpm = false;
1076                 }
1077
1078                 if (*(((u8 *)payload) + MCI_GPM_COEX_B_HALT_STATE) ==
1079                                 MCI_GPM_COEX_BT_GPM_HALT) {
1080
1081                         mci->halted_bt_gpm = !queue;
1082                 }
1083
1084                 break;
1085         default:
1086                 break;
1087         }
1088 }
1089
1090 void ar9003_mci_2g5g_switch(struct ath_hw *ah, bool force)
1091 {
1092         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1093
1094         if (!mci->update_2g5g && !force)
1095                 return;
1096
1097         if (mci->is_2g) {
1098                 ar9003_mci_send_2g5g_status(ah, true);
1099                 ar9003_mci_send_lna_transfer(ah, true);
1100                 udelay(5);
1101
1102                 REG_CLR_BIT(ah, AR_MCI_TX_CTRL,
1103                             AR_MCI_TX_CTRL_DISABLE_LNA_UPDATE);
1104                 REG_CLR_BIT(ah, AR_PHY_GLB_CONTROL,
1105                             AR_BTCOEX_CTRL_BT_OWN_SPDT_CTRL);
1106
1107                 if (!(mci->config & ATH_MCI_CONFIG_DISABLE_OSLA))
1108                         ar9003_mci_osla_setup(ah, true);
1109
1110                 if (AR_SREV_9462(ah))
1111                         REG_WRITE(ah, AR_SELFGEN_MASK, 0x02);
1112         } else {
1113                 ar9003_mci_send_lna_take(ah, true);
1114                 udelay(5);
1115
1116                 REG_SET_BIT(ah, AR_MCI_TX_CTRL,
1117                             AR_MCI_TX_CTRL_DISABLE_LNA_UPDATE);
1118                 REG_SET_BIT(ah, AR_PHY_GLB_CONTROL,
1119                             AR_BTCOEX_CTRL_BT_OWN_SPDT_CTRL);
1120
1121                 ar9003_mci_osla_setup(ah, false);
1122                 ar9003_mci_send_2g5g_status(ah, true);
1123         }
1124 }
1125
1126 bool ar9003_mci_send_message(struct ath_hw *ah, u8 header, u32 flag,
1127                              u32 *payload, u8 len, bool wait_done,
1128                              bool check_bt)
1129 {
1130         struct ath_common *common = ath9k_hw_common(ah);
1131         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1132         bool msg_sent = false;
1133         u32 regval;
1134         u32 saved_mci_int_en;
1135         int i;
1136
1137         saved_mci_int_en = REG_READ(ah, AR_MCI_INTERRUPT_EN);
1138         regval = REG_READ(ah, AR_BTCOEX_CTRL);
1139
1140         if ((regval == 0xdeadbeef) || !(regval & AR_BTCOEX_CTRL_MCI_MODE_EN)) {
1141                 ath_dbg(common, MCI,
1142                         "MCI Not sending 0x%x. MCI is not enabled. full_sleep = %d\n",
1143                         header, (ah->power_mode == ATH9K_PM_FULL_SLEEP) ? 1 : 0);
1144                 ar9003_mci_queue_unsent_gpm(ah, header, payload, true);
1145                 return false;
1146         } else if (check_bt && (mci->bt_state == MCI_BT_SLEEP)) {
1147                 ath_dbg(common, MCI,
1148                         "MCI Don't send message 0x%x. BT is in sleep state\n",
1149                         header);
1150                 ar9003_mci_queue_unsent_gpm(ah, header, payload, true);
1151                 return false;
1152         }
1153
1154         if (wait_done)
1155                 REG_WRITE(ah, AR_MCI_INTERRUPT_EN, 0);
1156
1157         /* Need to clear SW_MSG_DONE raw bit before wait */
1158
1159         REG_WRITE(ah, AR_MCI_INTERRUPT_RAW,
1160                   (AR_MCI_INTERRUPT_SW_MSG_DONE |
1161                    AR_MCI_INTERRUPT_MSG_FAIL_MASK));
1162
1163         if (payload) {
1164                 for (i = 0; (i * 4) < len; i++)
1165                         REG_WRITE(ah, (AR_MCI_TX_PAYLOAD0 + i * 4),
1166                                   *(payload + i));
1167         }
1168
1169         REG_WRITE(ah, AR_MCI_COMMAND0,
1170                   (SM((flag & MCI_FLAG_DISABLE_TIMESTAMP),
1171                       AR_MCI_COMMAND0_DISABLE_TIMESTAMP) |
1172                    SM(len, AR_MCI_COMMAND0_LEN) |
1173                    SM(header, AR_MCI_COMMAND0_HEADER)));
1174
1175         if (wait_done &&
1176             !(ar9003_mci_wait_for_interrupt(ah, AR_MCI_INTERRUPT_RAW,
1177                                             AR_MCI_INTERRUPT_SW_MSG_DONE, 500)))
1178                 ar9003_mci_queue_unsent_gpm(ah, header, payload, true);
1179         else {
1180                 ar9003_mci_queue_unsent_gpm(ah, header, payload, false);
1181                 msg_sent = true;
1182         }
1183
1184         if (wait_done)
1185                 REG_WRITE(ah, AR_MCI_INTERRUPT_EN, saved_mci_int_en);
1186
1187         return msg_sent;
1188 }
1189 EXPORT_SYMBOL(ar9003_mci_send_message);
1190
1191 void ar9003_mci_init_cal_req(struct ath_hw *ah, bool *is_reusable)
1192 {
1193         struct ath_common *common = ath9k_hw_common(ah);
1194         struct ath9k_hw_mci *mci_hw = &ah->btcoex_hw.mci;
1195         u32 pld[4] = {0, 0, 0, 0};
1196
1197         if ((mci_hw->bt_state != MCI_BT_AWAKE) ||
1198             (mci_hw->config & ATH_MCI_CONFIG_DISABLE_MCI_CAL))
1199                 return;
1200
1201         MCI_GPM_SET_CAL_TYPE(pld, MCI_GPM_WLAN_CAL_REQ);
1202         pld[MCI_GPM_WLAN_CAL_W_SEQUENCE] = mci_hw->wlan_cal_seq++;
1203
1204         ar9003_mci_send_message(ah, MCI_GPM, 0, pld, 16, true, false);
1205
1206         if (ar9003_mci_wait_for_gpm(ah, MCI_GPM_BT_CAL_GRANT, 0, 50000)) {
1207                 ath_dbg(common, MCI, "MCI BT_CAL_GRANT received\n");
1208         } else {
1209                 *is_reusable = false;
1210                 ath_dbg(common, MCI, "MCI BT_CAL_GRANT not received\n");
1211         }
1212 }
1213
1214 void ar9003_mci_init_cal_done(struct ath_hw *ah)
1215 {
1216         struct ath9k_hw_mci *mci_hw = &ah->btcoex_hw.mci;
1217         u32 pld[4] = {0, 0, 0, 0};
1218
1219         if ((mci_hw->bt_state != MCI_BT_AWAKE) ||
1220             (mci_hw->config & ATH_MCI_CONFIG_DISABLE_MCI_CAL))
1221                 return;
1222
1223         MCI_GPM_SET_CAL_TYPE(pld, MCI_GPM_WLAN_CAL_DONE);
1224         pld[MCI_GPM_WLAN_CAL_W_SEQUENCE] = mci_hw->wlan_cal_done++;
1225         ar9003_mci_send_message(ah, MCI_GPM, 0, pld, 16, true, false);
1226 }
1227
1228 int ar9003_mci_setup(struct ath_hw *ah, u32 gpm_addr, void *gpm_buf,
1229                      u16 len, u32 sched_addr)
1230 {
1231         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1232
1233         mci->gpm_addr = gpm_addr;
1234         mci->gpm_buf = gpm_buf;
1235         mci->gpm_len = len;
1236         mci->sched_addr = sched_addr;
1237
1238         return ar9003_mci_reset(ah, true, true, true);
1239 }
1240 EXPORT_SYMBOL(ar9003_mci_setup);
1241
1242 void ar9003_mci_cleanup(struct ath_hw *ah)
1243 {
1244         /* Turn off MCI and Jupiter mode. */
1245         REG_WRITE(ah, AR_BTCOEX_CTRL, 0x00);
1246         ar9003_mci_disable_interrupt(ah);
1247 }
1248 EXPORT_SYMBOL(ar9003_mci_cleanup);
1249
1250 u32 ar9003_mci_state(struct ath_hw *ah, u32 state_type)
1251 {
1252         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1253         u32 value = 0, tsf;
1254         u8 query_type;
1255
1256         switch (state_type) {
1257         case MCI_STATE_ENABLE:
1258                 if (mci->ready) {
1259                         value = REG_READ(ah, AR_BTCOEX_CTRL);
1260
1261                         if ((value == 0xdeadbeef) || (value == 0xffffffff))
1262                                 value = 0;
1263                 }
1264                 value &= AR_BTCOEX_CTRL_MCI_MODE_EN;
1265                 break;
1266         case MCI_STATE_LAST_SCHD_MSG_OFFSET:
1267                 value = MS(REG_READ(ah, AR_MCI_RX_STATUS),
1268                                     AR_MCI_RX_LAST_SCHD_MSG_INDEX);
1269                 /* Make it in bytes */
1270                 value <<= 4;
1271                 break;
1272         case MCI_STATE_REMOTE_SLEEP:
1273                 value = MS(REG_READ(ah, AR_MCI_RX_STATUS),
1274                            AR_MCI_RX_REMOTE_SLEEP) ?
1275                         MCI_BT_SLEEP : MCI_BT_AWAKE;
1276                 break;
1277         case MCI_STATE_SET_BT_AWAKE:
1278                 mci->bt_state = MCI_BT_AWAKE;
1279                 ar9003_mci_send_coex_version_query(ah, true);
1280                 ar9003_mci_send_coex_wlan_channels(ah, true);
1281
1282                 if (mci->unhalt_bt_gpm)
1283                         ar9003_mci_send_coex_halt_bt_gpm(ah, false, true);
1284
1285                 ar9003_mci_2g5g_switch(ah, false);
1286                 break;
1287         case MCI_STATE_RESET_REQ_WAKE:
1288                 ar9003_mci_reset_req_wakeup(ah);
1289                 mci->update_2g5g = true;
1290
1291                 if (mci->config & ATH_MCI_CONFIG_MCI_OBS_MASK) {
1292                         /* Check if we still have control of the GPIOs */
1293                         if ((REG_READ(ah, AR_GLB_GPIO_CONTROL) &
1294                              ATH_MCI_CONFIG_MCI_OBS_GPIO) !=
1295                             ATH_MCI_CONFIG_MCI_OBS_GPIO) {
1296                                 ar9003_mci_observation_set_up(ah);
1297                         }
1298                 }
1299                 break;
1300         case MCI_STATE_SEND_WLAN_COEX_VERSION:
1301                 ar9003_mci_send_coex_version_response(ah, true);
1302                 break;
1303         case MCI_STATE_SEND_VERSION_QUERY:
1304                 ar9003_mci_send_coex_version_query(ah, true);
1305                 break;
1306         case MCI_STATE_SEND_STATUS_QUERY:
1307                 query_type = MCI_GPM_COEX_QUERY_BT_TOPOLOGY;
1308                 ar9003_mci_send_coex_bt_status_query(ah, true, query_type);
1309                 break;
1310         case MCI_STATE_RECOVER_RX:
1311                 tsf = ath9k_hw_gettsf32(ah);
1312                 if ((tsf - mci->last_recovery) <= MCI_RECOVERY_DUR_TSF) {
1313                         ath_dbg(ath9k_hw_common(ah), MCI,
1314                                 "(MCI) ignore Rx recovery\n");
1315                         break;
1316                 }
1317                 ath_dbg(ath9k_hw_common(ah), MCI, "(MCI) RECOVER RX\n");
1318                 mci->last_recovery = tsf;
1319                 ar9003_mci_prep_interface(ah);
1320                 mci->query_bt = true;
1321                 mci->need_flush_btinfo = true;
1322                 ar9003_mci_send_coex_wlan_channels(ah, true);
1323                 ar9003_mci_2g5g_switch(ah, false);
1324                 break;
1325         case MCI_STATE_NEED_FTP_STOMP:
1326                 value = !(mci->config & ATH_MCI_CONFIG_DISABLE_FTP_STOMP);
1327                 break;
1328         case MCI_STATE_NEED_FLUSH_BT_INFO:
1329                 value = (!mci->unhalt_bt_gpm && mci->need_flush_btinfo) ? 1 : 0;
1330                 mci->need_flush_btinfo = false;
1331                 break;
1332         default:
1333                 break;
1334         }
1335
1336         return value;
1337 }
1338 EXPORT_SYMBOL(ar9003_mci_state);
1339
1340 void ar9003_mci_bt_gain_ctrl(struct ath_hw *ah)
1341 {
1342         struct ath_common *common = ath9k_hw_common(ah);
1343         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1344
1345         ath_dbg(common, MCI, "Give LNA and SPDT control to BT\n");
1346
1347         ar9003_mci_send_lna_take(ah, true);
1348         udelay(50);
1349
1350         REG_SET_BIT(ah, AR_PHY_GLB_CONTROL, AR_BTCOEX_CTRL_BT_OWN_SPDT_CTRL);
1351         mci->is_2g = false;
1352         mci->update_2g5g = true;
1353         ar9003_mci_send_2g5g_status(ah, true);
1354
1355         /* Force another 2g5g update at next scanning */
1356         mci->update_2g5g = true;
1357 }
1358
1359 void ar9003_mci_set_power_awake(struct ath_hw *ah)
1360 {
1361         u32 btcoex_ctrl2, diag_sw;
1362         int i;
1363         u8 lna_ctrl, bt_sleep;
1364
1365         for (i = 0; i < AH_WAIT_TIMEOUT; i++) {
1366                 btcoex_ctrl2 = REG_READ(ah, AR_BTCOEX_CTRL2);
1367                 if (btcoex_ctrl2 != 0xdeadbeef)
1368                         break;
1369                 udelay(AH_TIME_QUANTUM);
1370         }
1371         REG_WRITE(ah, AR_BTCOEX_CTRL2, (btcoex_ctrl2 | BIT(23)));
1372
1373         for (i = 0; i < AH_WAIT_TIMEOUT; i++) {
1374                 diag_sw = REG_READ(ah, AR_DIAG_SW);
1375                 if (diag_sw != 0xdeadbeef)
1376                         break;
1377                 udelay(AH_TIME_QUANTUM);
1378         }
1379         REG_WRITE(ah, AR_DIAG_SW, (diag_sw | BIT(27) | BIT(19) | BIT(18)));
1380         lna_ctrl = REG_READ(ah, AR_OBS_BUS_CTRL) & 0x3;
1381         bt_sleep = MS(REG_READ(ah, AR_MCI_RX_STATUS), AR_MCI_RX_REMOTE_SLEEP);
1382
1383         REG_WRITE(ah, AR_BTCOEX_CTRL2, btcoex_ctrl2);
1384         REG_WRITE(ah, AR_DIAG_SW, diag_sw);
1385
1386         if (bt_sleep && (lna_ctrl == 2)) {
1387                 REG_SET_BIT(ah, AR_BTCOEX_RC, 0x1);
1388                 REG_CLR_BIT(ah, AR_BTCOEX_RC, 0x1);
1389                 udelay(50);
1390         }
1391 }
1392
1393 void ar9003_mci_check_gpm_offset(struct ath_hw *ah)
1394 {
1395         struct ath_common *common = ath9k_hw_common(ah);
1396         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1397         u32 offset;
1398
1399         /*
1400          * This should only be called before "MAC Warm Reset" or "MCI Reset Rx".
1401          */
1402         offset = MS(REG_READ(ah, AR_MCI_GPM_1), AR_MCI_GPM_WRITE_PTR);
1403         if (mci->gpm_idx == offset)
1404                 return;
1405         ath_dbg(common, MCI, "GPM cached write pointer mismatch %d %d\n",
1406                 mci->gpm_idx, offset);
1407         mci->query_bt = true;
1408         mci->need_flush_btinfo = true;
1409         mci->gpm_idx = 0;
1410 }
1411
1412 u32 ar9003_mci_get_next_gpm_offset(struct ath_hw *ah, bool first, u32 *more)
1413 {
1414         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1415         u32 offset, more_gpm = 0, gpm_ptr;
1416
1417         if (first) {
1418                 gpm_ptr = MS(REG_READ(ah, AR_MCI_GPM_1), AR_MCI_GPM_WRITE_PTR);
1419
1420                 if (gpm_ptr >= mci->gpm_len)
1421                         gpm_ptr = 0;
1422
1423                 mci->gpm_idx = gpm_ptr;
1424                 return gpm_ptr;
1425         }
1426
1427         /*
1428          * This could be useful to avoid new GPM message interrupt which
1429          * may lead to spurious interrupt after power sleep, or multiple
1430          * entry of ath_mci_intr().
1431          * Adding empty GPM check by returning HAL_MCI_GPM_INVALID can
1432          * alleviate this effect, but clearing GPM RX interrupt bit is
1433          * safe, because whether this is called from hw or driver code
1434          * there must be an interrupt bit set/triggered initially
1435          */
1436         REG_WRITE(ah, AR_MCI_INTERRUPT_RX_MSG_RAW,
1437                         AR_MCI_INTERRUPT_RX_MSG_GPM);
1438
1439         gpm_ptr = MS(REG_READ(ah, AR_MCI_GPM_1), AR_MCI_GPM_WRITE_PTR);
1440         offset = gpm_ptr;
1441
1442         if (!offset)
1443                 offset = mci->gpm_len - 1;
1444         else if (offset >= mci->gpm_len) {
1445                 if (offset != 0xFFFF)
1446                         offset = 0;
1447         } else {
1448                 offset--;
1449         }
1450
1451         if ((offset == 0xFFFF) || (gpm_ptr == mci->gpm_idx)) {
1452                 offset = MCI_GPM_INVALID;
1453                 more_gpm = MCI_GPM_NOMORE;
1454                 goto out;
1455         }
1456         for (;;) {
1457                 u32 temp_index;
1458
1459                 /* skip reserved GPM if any */
1460
1461                 if (offset != mci->gpm_idx)
1462                         more_gpm = MCI_GPM_MORE;
1463                 else
1464                         more_gpm = MCI_GPM_NOMORE;
1465
1466                 temp_index = mci->gpm_idx;
1467
1468                 if (temp_index >= mci->gpm_len)
1469                         temp_index = 0;
1470
1471                 mci->gpm_idx++;
1472
1473                 if (mci->gpm_idx >= mci->gpm_len)
1474                         mci->gpm_idx = 0;
1475
1476                 if (ar9003_mci_is_gpm_valid(ah, temp_index)) {
1477                         offset = temp_index;
1478                         break;
1479                 }
1480
1481                 if (more_gpm == MCI_GPM_NOMORE) {
1482                         offset = MCI_GPM_INVALID;
1483                         break;
1484                 }
1485         }
1486
1487         if (offset != MCI_GPM_INVALID)
1488                 offset <<= 4;
1489 out:
1490         if (more)
1491                 *more = more_gpm;
1492
1493         return offset;
1494 }
1495 EXPORT_SYMBOL(ar9003_mci_get_next_gpm_offset);
1496
1497 void ar9003_mci_set_bt_version(struct ath_hw *ah, u8 major, u8 minor)
1498 {
1499         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1500
1501         mci->bt_ver_major = major;
1502         mci->bt_ver_minor = minor;
1503         mci->bt_version_known = true;
1504         ath_dbg(ath9k_hw_common(ah), MCI, "MCI BT version set: %d.%d\n",
1505                 mci->bt_ver_major, mci->bt_ver_minor);
1506 }
1507 EXPORT_SYMBOL(ar9003_mci_set_bt_version);
1508
1509 void ar9003_mci_send_wlan_channels(struct ath_hw *ah)
1510 {
1511         struct ath9k_hw_mci *mci = &ah->btcoex_hw.mci;
1512
1513         mci->wlan_channels_update = true;
1514         ar9003_mci_send_coex_wlan_channels(ah, true);
1515 }
1516 EXPORT_SYMBOL(ar9003_mci_send_wlan_channels);
1517
1518 u16 ar9003_mci_get_max_txpower(struct ath_hw *ah, u8 ctlmode)
1519 {
1520         if (!ah->btcoex_hw.mci.concur_tx)
1521                 goto out;
1522
1523         if (ctlmode == CTL_2GHT20)
1524                 return ATH_BTCOEX_HT20_MAX_TXPOWER;
1525         else if (ctlmode == CTL_2GHT40)
1526                 return ATH_BTCOEX_HT40_MAX_TXPOWER;
1527
1528 out:
1529         return -1;
1530 }