1 /* 2 * Copyright (c) 2010 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 "htc.h" 18 19 #ifdef CONFIG_ATH9K_HTC_DEBUGFS 20 static struct dentry *ath9k_debugfs_root; 21 #endif 22 23 /*************/ 24 /* Utilities */ 25 /*************/ 26 27 void ath_update_txpow(struct ath9k_htc_priv *priv) 28 { 29 struct ath_hw *ah = priv->ah; 30 31 if (priv->curtxpow != priv->txpowlimit) { 32 ath9k_hw_set_txpowerlimit(ah, priv->txpowlimit, false); 33 /* read back in case value is clamped */ 34 priv->curtxpow = ath9k_hw_regulatory(ah)->power_limit; 35 } 36 } 37 38 /* HACK Alert: Use 11NG for 2.4, use 11NA for 5 */ 39 static enum htc_phymode ath9k_htc_get_curmode(struct ath9k_htc_priv *priv, 40 struct ath9k_channel *ichan) 41 { 42 enum htc_phymode mode; 43 44 mode = HTC_MODE_AUTO; 45 46 switch (ichan->chanmode) { 47 case CHANNEL_G: 48 case CHANNEL_G_HT20: 49 case CHANNEL_G_HT40PLUS: 50 case CHANNEL_G_HT40MINUS: 51 mode = HTC_MODE_11NG; 52 break; 53 case CHANNEL_A: 54 case CHANNEL_A_HT20: 55 case CHANNEL_A_HT40PLUS: 56 case CHANNEL_A_HT40MINUS: 57 mode = HTC_MODE_11NA; 58 break; 59 default: 60 break; 61 } 62 63 return mode; 64 } 65 66 bool ath9k_htc_setpower(struct ath9k_htc_priv *priv, 67 enum ath9k_power_mode mode) 68 { 69 bool ret; 70 71 mutex_lock(&priv->htc_pm_lock); 72 ret = ath9k_hw_setpower(priv->ah, mode); 73 mutex_unlock(&priv->htc_pm_lock); 74 75 return ret; 76 } 77 78 void ath9k_htc_ps_wakeup(struct ath9k_htc_priv *priv) 79 { 80 mutex_lock(&priv->htc_pm_lock); 81 if (++priv->ps_usecount != 1) 82 goto unlock; 83 ath9k_hw_setpower(priv->ah, ATH9K_PM_AWAKE); 84 85 unlock: 86 mutex_unlock(&priv->htc_pm_lock); 87 } 88 89 void ath9k_htc_ps_restore(struct ath9k_htc_priv *priv) 90 { 91 mutex_lock(&priv->htc_pm_lock); 92 if (--priv->ps_usecount != 0) 93 goto unlock; 94 95 if (priv->ps_idle) 96 ath9k_hw_setpower(priv->ah, ATH9K_PM_FULL_SLEEP); 97 else if (priv->ps_enabled) 98 ath9k_hw_setpower(priv->ah, ATH9K_PM_NETWORK_SLEEP); 99 100 unlock: 101 mutex_unlock(&priv->htc_pm_lock); 102 } 103 104 void ath9k_ps_work(struct work_struct *work) 105 { 106 struct ath9k_htc_priv *priv = 107 container_of(work, struct ath9k_htc_priv, 108 ps_work); 109 ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); 110 111 /* The chip wakes up after receiving the first beacon 112 while network sleep is enabled. For the driver to 113 be in sync with the hw, set the chip to awake and 114 only then set it to sleep. 115 */ 116 ath9k_htc_setpower(priv, ATH9K_PM_NETWORK_SLEEP); 117 } 118 119 void ath9k_htc_reset(struct ath9k_htc_priv *priv) 120 { 121 struct ath_hw *ah = priv->ah; 122 struct ath_common *common = ath9k_hw_common(ah); 123 struct ieee80211_channel *channel = priv->hw->conf.channel; 124 struct ath9k_hw_cal_data *caldata; 125 enum htc_phymode mode; 126 __be16 htc_mode; 127 u8 cmd_rsp; 128 int ret; 129 130 mutex_lock(&priv->mutex); 131 ath9k_htc_ps_wakeup(priv); 132 133 if (priv->op_flags & OP_ASSOCIATED) 134 cancel_delayed_work_sync(&priv->ath9k_ani_work); 135 136 ieee80211_stop_queues(priv->hw); 137 htc_stop(priv->htc); 138 WMI_CMD(WMI_DISABLE_INTR_CMDID); 139 WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID); 140 WMI_CMD(WMI_STOP_RECV_CMDID); 141 142 caldata = &priv->caldata[channel->hw_value]; 143 ret = ath9k_hw_reset(ah, ah->curchan, caldata, false); 144 if (ret) { 145 ath_err(common, 146 "Unable to reset device (%u Mhz) reset status %d\n", 147 channel->center_freq, ret); 148 } 149 150 ath_update_txpow(priv); 151 152 WMI_CMD(WMI_START_RECV_CMDID); 153 ath9k_host_rx_init(priv); 154 155 mode = ath9k_htc_get_curmode(priv, ah->curchan); 156 htc_mode = cpu_to_be16(mode); 157 WMI_CMD_BUF(WMI_SET_MODE_CMDID, &htc_mode); 158 159 WMI_CMD(WMI_ENABLE_INTR_CMDID); 160 htc_start(priv->htc); 161 162 if (priv->op_flags & OP_ASSOCIATED) { 163 ath9k_htc_beacon_config(priv, priv->vif); 164 ath_start_ani(priv); 165 } 166 167 ieee80211_wake_queues(priv->hw); 168 169 ath9k_htc_ps_restore(priv); 170 mutex_unlock(&priv->mutex); 171 } 172 173 static int ath9k_htc_set_channel(struct ath9k_htc_priv *priv, 174 struct ieee80211_hw *hw, 175 struct ath9k_channel *hchan) 176 { 177 struct ath_hw *ah = priv->ah; 178 struct ath_common *common = ath9k_hw_common(ah); 179 struct ieee80211_conf *conf = &common->hw->conf; 180 bool fastcc; 181 struct ieee80211_channel *channel = hw->conf.channel; 182 struct ath9k_hw_cal_data *caldata; 183 enum htc_phymode mode; 184 __be16 htc_mode; 185 u8 cmd_rsp; 186 int ret; 187 188 if (priv->op_flags & OP_INVALID) 189 return -EIO; 190 191 fastcc = !!(hw->conf.flags & IEEE80211_CONF_OFFCHANNEL); 192 193 ath9k_htc_ps_wakeup(priv); 194 htc_stop(priv->htc); 195 WMI_CMD(WMI_DISABLE_INTR_CMDID); 196 WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID); 197 WMI_CMD(WMI_STOP_RECV_CMDID); 198 199 ath_dbg(common, ATH_DBG_CONFIG, 200 "(%u MHz) -> (%u MHz), HT: %d, HT40: %d fastcc: %d\n", 201 priv->ah->curchan->channel, 202 channel->center_freq, conf_is_ht(conf), conf_is_ht40(conf), 203 fastcc); 204 205 caldata = &priv->caldata[channel->hw_value]; 206 ret = ath9k_hw_reset(ah, hchan, caldata, fastcc); 207 if (ret) { 208 ath_err(common, 209 "Unable to reset channel (%u Mhz) reset status %d\n", 210 channel->center_freq, ret); 211 goto err; 212 } 213 214 ath_update_txpow(priv); 215 216 WMI_CMD(WMI_START_RECV_CMDID); 217 if (ret) 218 goto err; 219 220 ath9k_host_rx_init(priv); 221 222 mode = ath9k_htc_get_curmode(priv, hchan); 223 htc_mode = cpu_to_be16(mode); 224 WMI_CMD_BUF(WMI_SET_MODE_CMDID, &htc_mode); 225 if (ret) 226 goto err; 227 228 WMI_CMD(WMI_ENABLE_INTR_CMDID); 229 if (ret) 230 goto err; 231 232 htc_start(priv->htc); 233 err: 234 ath9k_htc_ps_restore(priv); 235 return ret; 236 } 237 238 static void __ath9k_htc_remove_monitor_interface(struct ath9k_htc_priv *priv) 239 { 240 struct ath_common *common = ath9k_hw_common(priv->ah); 241 struct ath9k_htc_target_vif hvif; 242 int ret = 0; 243 u8 cmd_rsp; 244 245 memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); 246 memcpy(&hvif.myaddr, common->macaddr, ETH_ALEN); 247 hvif.index = 0; /* Should do for now */ 248 WMI_CMD_BUF(WMI_VAP_REMOVE_CMDID, &hvif); 249 priv->nvifs--; 250 } 251 252 static int ath9k_htc_add_monitor_interface(struct ath9k_htc_priv *priv) 253 { 254 struct ath_common *common = ath9k_hw_common(priv->ah); 255 struct ath9k_htc_target_vif hvif; 256 struct ath9k_htc_target_sta tsta; 257 int ret = 0; 258 u8 cmd_rsp; 259 260 if (priv->nvifs > 0) 261 return -ENOBUFS; 262 263 if (priv->nstations >= ATH9K_HTC_MAX_STA) 264 return -ENOBUFS; 265 266 /* 267 * Add an interface. 268 */ 269 270 memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); 271 memcpy(&hvif.myaddr, common->macaddr, ETH_ALEN); 272 273 hvif.opmode = cpu_to_be32(HTC_M_MONITOR); 274 priv->ah->opmode = NL80211_IFTYPE_MONITOR; 275 hvif.index = priv->nvifs; 276 277 WMI_CMD_BUF(WMI_VAP_CREATE_CMDID, &hvif); 278 if (ret) 279 return ret; 280 281 priv->nvifs++; 282 283 /* 284 * Associate a station with the interface for packet injection. 285 */ 286 287 memset(&tsta, 0, sizeof(struct ath9k_htc_target_sta)); 288 289 memcpy(&tsta.macaddr, common->macaddr, ETH_ALEN); 290 291 tsta.is_vif_sta = 1; 292 tsta.sta_index = priv->nstations; 293 tsta.vif_index = hvif.index; 294 tsta.maxampdu = 0xffff; 295 296 WMI_CMD_BUF(WMI_NODE_CREATE_CMDID, &tsta); 297 if (ret) { 298 ath_err(common, "Unable to add station entry for monitor mode\n"); 299 goto err_vif; 300 } 301 302 priv->nstations++; 303 304 /* 305 * Set chainmask etc. on the target. 306 */ 307 ret = ath9k_htc_update_cap_target(priv); 308 if (ret) 309 ath_dbg(common, ATH_DBG_CONFIG, 310 "Failed to update capability in target\n"); 311 312 priv->ah->is_monitoring = true; 313 314 return 0; 315 316 err_vif: 317 /* 318 * Remove the interface from the target. 319 */ 320 __ath9k_htc_remove_monitor_interface(priv); 321 return ret; 322 } 323 324 static int ath9k_htc_remove_monitor_interface(struct ath9k_htc_priv *priv) 325 { 326 struct ath_common *common = ath9k_hw_common(priv->ah); 327 int ret = 0; 328 u8 cmd_rsp, sta_idx; 329 330 __ath9k_htc_remove_monitor_interface(priv); 331 332 sta_idx = 0; /* Only single interface, for now */ 333 334 WMI_CMD_BUF(WMI_NODE_REMOVE_CMDID, &sta_idx); 335 if (ret) { 336 ath_err(common, "Unable to remove station entry for monitor mode\n"); 337 return ret; 338 } 339 340 priv->nstations--; 341 priv->ah->is_monitoring = false; 342 343 return 0; 344 } 345 346 static int ath9k_htc_add_station(struct ath9k_htc_priv *priv, 347 struct ieee80211_vif *vif, 348 struct ieee80211_sta *sta) 349 { 350 struct ath_common *common = ath9k_hw_common(priv->ah); 351 struct ath9k_htc_target_sta tsta; 352 struct ath9k_htc_vif *avp = (struct ath9k_htc_vif *) vif->drv_priv; 353 struct ath9k_htc_sta *ista; 354 int ret; 355 u8 cmd_rsp; 356 357 if (priv->nstations >= ATH9K_HTC_MAX_STA) 358 return -ENOBUFS; 359 360 memset(&tsta, 0, sizeof(struct ath9k_htc_target_sta)); 361 362 if (sta) { 363 ista = (struct ath9k_htc_sta *) sta->drv_priv; 364 memcpy(&tsta.macaddr, sta->addr, ETH_ALEN); 365 memcpy(&tsta.bssid, common->curbssid, ETH_ALEN); 366 tsta.associd = common->curaid; 367 tsta.is_vif_sta = 0; 368 tsta.valid = true; 369 ista->index = priv->nstations; 370 } else { 371 memcpy(&tsta.macaddr, vif->addr, ETH_ALEN); 372 tsta.is_vif_sta = 1; 373 } 374 375 tsta.sta_index = priv->nstations; 376 tsta.vif_index = avp->index; 377 tsta.maxampdu = 0xffff; 378 if (sta && sta->ht_cap.ht_supported) 379 tsta.flags = cpu_to_be16(ATH_HTC_STA_HT); 380 381 WMI_CMD_BUF(WMI_NODE_CREATE_CMDID, &tsta); 382 if (ret) { 383 if (sta) 384 ath_err(common, 385 "Unable to add station entry for: %pM\n", 386 sta->addr); 387 return ret; 388 } 389 390 if (sta) 391 ath_dbg(common, ATH_DBG_CONFIG, 392 "Added a station entry for: %pM (idx: %d)\n", 393 sta->addr, tsta.sta_index); 394 395 priv->nstations++; 396 return 0; 397 } 398 399 static int ath9k_htc_remove_station(struct ath9k_htc_priv *priv, 400 struct ieee80211_vif *vif, 401 struct ieee80211_sta *sta) 402 { 403 struct ath_common *common = ath9k_hw_common(priv->ah); 404 struct ath9k_htc_sta *ista; 405 int ret; 406 u8 cmd_rsp, sta_idx; 407 408 if (sta) { 409 ista = (struct ath9k_htc_sta *) sta->drv_priv; 410 sta_idx = ista->index; 411 } else { 412 sta_idx = 0; 413 } 414 415 WMI_CMD_BUF(WMI_NODE_REMOVE_CMDID, &sta_idx); 416 if (ret) { 417 if (sta) 418 ath_err(common, 419 "Unable to remove station entry for: %pM\n", 420 sta->addr); 421 return ret; 422 } 423 424 if (sta) 425 ath_dbg(common, ATH_DBG_CONFIG, 426 "Removed a station entry for: %pM (idx: %d)\n", 427 sta->addr, sta_idx); 428 429 priv->nstations--; 430 return 0; 431 } 432 433 int ath9k_htc_update_cap_target(struct ath9k_htc_priv *priv) 434 { 435 struct ath9k_htc_cap_target tcap; 436 int ret; 437 u8 cmd_rsp; 438 439 memset(&tcap, 0, sizeof(struct ath9k_htc_cap_target)); 440 441 /* FIXME: Values are hardcoded */ 442 tcap.flags = 0x240c40; 443 tcap.flags_ext = 0x80601000; 444 tcap.ampdu_limit = 0xffff0000; 445 tcap.ampdu_subframes = 20; 446 tcap.tx_chainmask_legacy = priv->ah->caps.tx_chainmask; 447 tcap.protmode = 1; 448 tcap.tx_chainmask = priv->ah->caps.tx_chainmask; 449 450 WMI_CMD_BUF(WMI_TARGET_IC_UPDATE_CMDID, &tcap); 451 452 return ret; 453 } 454 455 static void ath9k_htc_setup_rate(struct ath9k_htc_priv *priv, 456 struct ieee80211_sta *sta, 457 struct ath9k_htc_target_rate *trate) 458 { 459 struct ath9k_htc_sta *ista = (struct ath9k_htc_sta *) sta->drv_priv; 460 struct ieee80211_supported_band *sband; 461 u32 caps = 0; 462 int i, j; 463 464 sband = priv->hw->wiphy->bands[priv->hw->conf.channel->band]; 465 466 for (i = 0, j = 0; i < sband->n_bitrates; i++) { 467 if (sta->supp_rates[sband->band] & BIT(i)) { 468 trate->rates.legacy_rates.rs_rates[j] 469 = (sband->bitrates[i].bitrate * 2) / 10; 470 j++; 471 } 472 } 473 trate->rates.legacy_rates.rs_nrates = j; 474 475 if (sta->ht_cap.ht_supported) { 476 for (i = 0, j = 0; i < 77; i++) { 477 if (sta->ht_cap.mcs.rx_mask[i/8] & (1<<(i%8))) 478 trate->rates.ht_rates.rs_rates[j++] = i; 479 if (j == ATH_HTC_RATE_MAX) 480 break; 481 } 482 trate->rates.ht_rates.rs_nrates = j; 483 484 caps = WLAN_RC_HT_FLAG; 485 if (sta->ht_cap.mcs.rx_mask[1]) 486 caps |= WLAN_RC_DS_FLAG; 487 if ((sta->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) && 488 (conf_is_ht40(&priv->hw->conf))) 489 caps |= WLAN_RC_40_FLAG; 490 if (conf_is_ht40(&priv->hw->conf) && 491 (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40)) 492 caps |= WLAN_RC_SGI_FLAG; 493 else if (conf_is_ht20(&priv->hw->conf) && 494 (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20)) 495 caps |= WLAN_RC_SGI_FLAG; 496 } 497 498 trate->sta_index = ista->index; 499 trate->isnew = 1; 500 trate->capflags = cpu_to_be32(caps); 501 } 502 503 static int ath9k_htc_send_rate_cmd(struct ath9k_htc_priv *priv, 504 struct ath9k_htc_target_rate *trate) 505 { 506 struct ath_common *common = ath9k_hw_common(priv->ah); 507 int ret; 508 u8 cmd_rsp; 509 510 WMI_CMD_BUF(WMI_RC_RATE_UPDATE_CMDID, trate); 511 if (ret) { 512 ath_err(common, 513 "Unable to initialize Rate information on target\n"); 514 } 515 516 return ret; 517 } 518 519 static void ath9k_htc_init_rate(struct ath9k_htc_priv *priv, 520 struct ieee80211_sta *sta) 521 { 522 struct ath_common *common = ath9k_hw_common(priv->ah); 523 struct ath9k_htc_target_rate trate; 524 int ret; 525 526 memset(&trate, 0, sizeof(struct ath9k_htc_target_rate)); 527 ath9k_htc_setup_rate(priv, sta, &trate); 528 ret = ath9k_htc_send_rate_cmd(priv, &trate); 529 if (!ret) 530 ath_dbg(common, ATH_DBG_CONFIG, 531 "Updated target sta: %pM, rate caps: 0x%X\n", 532 sta->addr, be32_to_cpu(trate.capflags)); 533 } 534 535 static void ath9k_htc_update_rate(struct ath9k_htc_priv *priv, 536 struct ieee80211_vif *vif, 537 struct ieee80211_bss_conf *bss_conf) 538 { 539 struct ath_common *common = ath9k_hw_common(priv->ah); 540 struct ath9k_htc_target_rate trate; 541 struct ieee80211_sta *sta; 542 int ret; 543 544 memset(&trate, 0, sizeof(struct ath9k_htc_target_rate)); 545 546 rcu_read_lock(); 547 sta = ieee80211_find_sta(vif, bss_conf->bssid); 548 if (!sta) { 549 rcu_read_unlock(); 550 return; 551 } 552 ath9k_htc_setup_rate(priv, sta, &trate); 553 rcu_read_unlock(); 554 555 ret = ath9k_htc_send_rate_cmd(priv, &trate); 556 if (!ret) 557 ath_dbg(common, ATH_DBG_CONFIG, 558 "Updated target sta: %pM, rate caps: 0x%X\n", 559 bss_conf->bssid, be32_to_cpu(trate.capflags)); 560 } 561 562 static int ath9k_htc_tx_aggr_oper(struct ath9k_htc_priv *priv, 563 struct ieee80211_vif *vif, 564 struct ieee80211_sta *sta, 565 enum ieee80211_ampdu_mlme_action action, 566 u16 tid) 567 { 568 struct ath_common *common = ath9k_hw_common(priv->ah); 569 struct ath9k_htc_target_aggr aggr; 570 struct ath9k_htc_sta *ista; 571 int ret = 0; 572 u8 cmd_rsp; 573 574 if (tid >= ATH9K_HTC_MAX_TID) 575 return -EINVAL; 576 577 memset(&aggr, 0, sizeof(struct ath9k_htc_target_aggr)); 578 ista = (struct ath9k_htc_sta *) sta->drv_priv; 579 580 aggr.sta_index = ista->index; 581 aggr.tidno = tid & 0xf; 582 aggr.aggr_enable = (action == IEEE80211_AMPDU_TX_START) ? true : false; 583 584 WMI_CMD_BUF(WMI_TX_AGGR_ENABLE_CMDID, &aggr); 585 if (ret) 586 ath_dbg(common, ATH_DBG_CONFIG, 587 "Unable to %s TX aggregation for (%pM, %d)\n", 588 (aggr.aggr_enable) ? "start" : "stop", sta->addr, tid); 589 else 590 ath_dbg(common, ATH_DBG_CONFIG, 591 "%s TX aggregation for (%pM, %d)\n", 592 (aggr.aggr_enable) ? "Starting" : "Stopping", 593 sta->addr, tid); 594 595 spin_lock_bh(&priv->tx_lock); 596 ista->tid_state[tid] = (aggr.aggr_enable && !ret) ? AGGR_START : AGGR_STOP; 597 spin_unlock_bh(&priv->tx_lock); 598 599 return ret; 600 } 601 602 /*********/ 603 /* DEBUG */ 604 /*********/ 605 606 #ifdef CONFIG_ATH9K_HTC_DEBUGFS 607 608 static int ath9k_debugfs_open(struct inode *inode, struct file *file) 609 { 610 file->private_data = inode->i_private; 611 return 0; 612 } 613 614 static ssize_t read_file_tgt_stats(struct file *file, char __user *user_buf, 615 size_t count, loff_t *ppos) 616 { 617 struct ath9k_htc_priv *priv = file->private_data; 618 struct ath9k_htc_target_stats cmd_rsp; 619 char buf[512]; 620 unsigned int len = 0; 621 int ret = 0; 622 623 memset(&cmd_rsp, 0, sizeof(cmd_rsp)); 624 625 WMI_CMD(WMI_TGT_STATS_CMDID); 626 if (ret) 627 return -EINVAL; 628 629 630 len += snprintf(buf + len, sizeof(buf) - len, 631 "%19s : %10u\n", "TX Short Retries", 632 be32_to_cpu(cmd_rsp.tx_shortretry)); 633 len += snprintf(buf + len, sizeof(buf) - len, 634 "%19s : %10u\n", "TX Long Retries", 635 be32_to_cpu(cmd_rsp.tx_longretry)); 636 len += snprintf(buf + len, sizeof(buf) - len, 637 "%19s : %10u\n", "TX Xretries", 638 be32_to_cpu(cmd_rsp.tx_xretries)); 639 len += snprintf(buf + len, sizeof(buf) - len, 640 "%19s : %10u\n", "TX Unaggr. Xretries", 641 be32_to_cpu(cmd_rsp.ht_txunaggr_xretry)); 642 len += snprintf(buf + len, sizeof(buf) - len, 643 "%19s : %10u\n", "TX Xretries (HT)", 644 be32_to_cpu(cmd_rsp.ht_tx_xretries)); 645 len += snprintf(buf + len, sizeof(buf) - len, 646 "%19s : %10u\n", "TX Rate", priv->debug.txrate); 647 648 if (len > sizeof(buf)) 649 len = sizeof(buf); 650 651 return simple_read_from_buffer(user_buf, count, ppos, buf, len); 652 } 653 654 static const struct file_operations fops_tgt_stats = { 655 .read = read_file_tgt_stats, 656 .open = ath9k_debugfs_open, 657 .owner = THIS_MODULE, 658 .llseek = default_llseek, 659 }; 660 661 static ssize_t read_file_xmit(struct file *file, char __user *user_buf, 662 size_t count, loff_t *ppos) 663 { 664 struct ath9k_htc_priv *priv = file->private_data; 665 char buf[512]; 666 unsigned int len = 0; 667 668 len += snprintf(buf + len, sizeof(buf) - len, 669 "%20s : %10u\n", "Buffers queued", 670 priv->debug.tx_stats.buf_queued); 671 len += snprintf(buf + len, sizeof(buf) - len, 672 "%20s : %10u\n", "Buffers completed", 673 priv->debug.tx_stats.buf_completed); 674 len += snprintf(buf + len, sizeof(buf) - len, 675 "%20s : %10u\n", "SKBs queued", 676 priv->debug.tx_stats.skb_queued); 677 len += snprintf(buf + len, sizeof(buf) - len, 678 "%20s : %10u\n", "SKBs completed", 679 priv->debug.tx_stats.skb_completed); 680 len += snprintf(buf + len, sizeof(buf) - len, 681 "%20s : %10u\n", "SKBs dropped", 682 priv->debug.tx_stats.skb_dropped); 683 684 len += snprintf(buf + len, sizeof(buf) - len, 685 "%20s : %10u\n", "BE queued", 686 priv->debug.tx_stats.queue_stats[WME_AC_BE]); 687 len += snprintf(buf + len, sizeof(buf) - len, 688 "%20s : %10u\n", "BK queued", 689 priv->debug.tx_stats.queue_stats[WME_AC_BK]); 690 len += snprintf(buf + len, sizeof(buf) - len, 691 "%20s : %10u\n", "VI queued", 692 priv->debug.tx_stats.queue_stats[WME_AC_VI]); 693 len += snprintf(buf + len, sizeof(buf) - len, 694 "%20s : %10u\n", "VO queued", 695 priv->debug.tx_stats.queue_stats[WME_AC_VO]); 696 697 if (len > sizeof(buf)) 698 len = sizeof(buf); 699 700 return simple_read_from_buffer(user_buf, count, ppos, buf, len); 701 } 702 703 static const struct file_operations fops_xmit = { 704 .read = read_file_xmit, 705 .open = ath9k_debugfs_open, 706 .owner = THIS_MODULE, 707 .llseek = default_llseek, 708 }; 709 710 static ssize_t read_file_recv(struct file *file, char __user *user_buf, 711 size_t count, loff_t *ppos) 712 { 713 struct ath9k_htc_priv *priv = file->private_data; 714 char buf[512]; 715 unsigned int len = 0; 716 717 len += snprintf(buf + len, sizeof(buf) - len, 718 "%20s : %10u\n", "SKBs allocated", 719 priv->debug.rx_stats.skb_allocated); 720 len += snprintf(buf + len, sizeof(buf) - len, 721 "%20s : %10u\n", "SKBs completed", 722 priv->debug.rx_stats.skb_completed); 723 len += snprintf(buf + len, sizeof(buf) - len, 724 "%20s : %10u\n", "SKBs Dropped", 725 priv->debug.rx_stats.skb_dropped); 726 727 if (len > sizeof(buf)) 728 len = sizeof(buf); 729 730 return simple_read_from_buffer(user_buf, count, ppos, buf, len); 731 } 732 733 static const struct file_operations fops_recv = { 734 .read = read_file_recv, 735 .open = ath9k_debugfs_open, 736 .owner = THIS_MODULE, 737 .llseek = default_llseek, 738 }; 739 740 int ath9k_htc_init_debug(struct ath_hw *ah) 741 { 742 struct ath_common *common = ath9k_hw_common(ah); 743 struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv; 744 745 if (!ath9k_debugfs_root) 746 return -ENOENT; 747 748 priv->debug.debugfs_phy = debugfs_create_dir(wiphy_name(priv->hw->wiphy), 749 ath9k_debugfs_root); 750 if (!priv->debug.debugfs_phy) 751 goto err; 752 753 priv->debug.debugfs_tgt_stats = debugfs_create_file("tgt_stats", S_IRUSR, 754 priv->debug.debugfs_phy, 755 priv, &fops_tgt_stats); 756 if (!priv->debug.debugfs_tgt_stats) 757 goto err; 758 759 760 priv->debug.debugfs_xmit = debugfs_create_file("xmit", S_IRUSR, 761 priv->debug.debugfs_phy, 762 priv, &fops_xmit); 763 if (!priv->debug.debugfs_xmit) 764 goto err; 765 766 priv->debug.debugfs_recv = debugfs_create_file("recv", S_IRUSR, 767 priv->debug.debugfs_phy, 768 priv, &fops_recv); 769 if (!priv->debug.debugfs_recv) 770 goto err; 771 772 return 0; 773 774 err: 775 ath9k_htc_exit_debug(ah); 776 return -ENOMEM; 777 } 778 779 void ath9k_htc_exit_debug(struct ath_hw *ah) 780 { 781 struct ath_common *common = ath9k_hw_common(ah); 782 struct ath9k_htc_priv *priv = (struct ath9k_htc_priv *) common->priv; 783 784 debugfs_remove(priv->debug.debugfs_recv); 785 debugfs_remove(priv->debug.debugfs_xmit); 786 debugfs_remove(priv->debug.debugfs_tgt_stats); 787 debugfs_remove(priv->debug.debugfs_phy); 788 } 789 790 int ath9k_htc_debug_create_root(void) 791 { 792 ath9k_debugfs_root = debugfs_create_dir(KBUILD_MODNAME, NULL); 793 if (!ath9k_debugfs_root) 794 return -ENOENT; 795 796 return 0; 797 } 798 799 void ath9k_htc_debug_remove_root(void) 800 { 801 debugfs_remove(ath9k_debugfs_root); 802 ath9k_debugfs_root = NULL; 803 } 804 805 #endif /* CONFIG_ATH9K_HTC_DEBUGFS */ 806 807 /*******/ 808 /* ANI */ 809 /*******/ 810 811 void ath_start_ani(struct ath9k_htc_priv *priv) 812 { 813 struct ath_common *common = ath9k_hw_common(priv->ah); 814 unsigned long timestamp = jiffies_to_msecs(jiffies); 815 816 common->ani.longcal_timer = timestamp; 817 common->ani.shortcal_timer = timestamp; 818 common->ani.checkani_timer = timestamp; 819 820 ieee80211_queue_delayed_work(common->hw, &priv->ath9k_ani_work, 821 msecs_to_jiffies(ATH_ANI_POLLINTERVAL)); 822 } 823 824 void ath9k_ani_work(struct work_struct *work) 825 { 826 struct ath9k_htc_priv *priv = 827 container_of(work, struct ath9k_htc_priv, 828 ath9k_ani_work.work); 829 struct ath_hw *ah = priv->ah; 830 struct ath_common *common = ath9k_hw_common(ah); 831 bool longcal = false; 832 bool shortcal = false; 833 bool aniflag = false; 834 unsigned int timestamp = jiffies_to_msecs(jiffies); 835 u32 cal_interval, short_cal_interval; 836 837 short_cal_interval = ATH_STA_SHORT_CALINTERVAL; 838 839 /* Only calibrate if awake */ 840 if (ah->power_mode != ATH9K_PM_AWAKE) 841 goto set_timer; 842 843 /* Long calibration runs independently of short calibration. */ 844 if ((timestamp - common->ani.longcal_timer) >= ATH_LONG_CALINTERVAL) { 845 longcal = true; 846 ath_dbg(common, ATH_DBG_ANI, "longcal @%lu\n", jiffies); 847 common->ani.longcal_timer = timestamp; 848 } 849 850 /* Short calibration applies only while caldone is false */ 851 if (!common->ani.caldone) { 852 if ((timestamp - common->ani.shortcal_timer) >= 853 short_cal_interval) { 854 shortcal = true; 855 ath_dbg(common, ATH_DBG_ANI, 856 "shortcal @%lu\n", jiffies); 857 common->ani.shortcal_timer = timestamp; 858 common->ani.resetcal_timer = timestamp; 859 } 860 } else { 861 if ((timestamp - common->ani.resetcal_timer) >= 862 ATH_RESTART_CALINTERVAL) { 863 common->ani.caldone = ath9k_hw_reset_calvalid(ah); 864 if (common->ani.caldone) 865 common->ani.resetcal_timer = timestamp; 866 } 867 } 868 869 /* Verify whether we must check ANI */ 870 if ((timestamp - common->ani.checkani_timer) >= ATH_ANI_POLLINTERVAL) { 871 aniflag = true; 872 common->ani.checkani_timer = timestamp; 873 } 874 875 /* Skip all processing if there's nothing to do. */ 876 if (longcal || shortcal || aniflag) { 877 878 ath9k_htc_ps_wakeup(priv); 879 880 /* Call ANI routine if necessary */ 881 if (aniflag) 882 ath9k_hw_ani_monitor(ah, ah->curchan); 883 884 /* Perform calibration if necessary */ 885 if (longcal || shortcal) 886 common->ani.caldone = 887 ath9k_hw_calibrate(ah, ah->curchan, 888 common->rx_chainmask, 889 longcal); 890 891 ath9k_htc_ps_restore(priv); 892 } 893 894 set_timer: 895 /* 896 * Set timer interval based on previous results. 897 * The interval must be the shortest necessary to satisfy ANI, 898 * short calibration and long calibration. 899 */ 900 cal_interval = ATH_LONG_CALINTERVAL; 901 if (priv->ah->config.enable_ani) 902 cal_interval = min(cal_interval, (u32)ATH_ANI_POLLINTERVAL); 903 if (!common->ani.caldone) 904 cal_interval = min(cal_interval, (u32)short_cal_interval); 905 906 ieee80211_queue_delayed_work(common->hw, &priv->ath9k_ani_work, 907 msecs_to_jiffies(cal_interval)); 908 } 909 910 /**********************/ 911 /* mac80211 Callbacks */ 912 /**********************/ 913 914 static int ath9k_htc_tx(struct ieee80211_hw *hw, struct sk_buff *skb) 915 { 916 struct ieee80211_hdr *hdr; 917 struct ath9k_htc_priv *priv = hw->priv; 918 int padpos, padsize, ret; 919 920 hdr = (struct ieee80211_hdr *) skb->data; 921 922 /* Add the padding after the header if this is not already done */ 923 padpos = ath9k_cmn_padpos(hdr->frame_control); 924 padsize = padpos & 3; 925 if (padsize && skb->len > padpos) { 926 if (skb_headroom(skb) < padsize) 927 return -1; 928 skb_push(skb, padsize); 929 memmove(skb->data, skb->data + padsize, padpos); 930 } 931 932 ret = ath9k_htc_tx_start(priv, skb); 933 if (ret != 0) { 934 if (ret == -ENOMEM) { 935 ath_dbg(ath9k_hw_common(priv->ah), ATH_DBG_XMIT, 936 "Stopping TX queues\n"); 937 ieee80211_stop_queues(hw); 938 spin_lock_bh(&priv->tx_lock); 939 priv->tx_queues_stop = true; 940 spin_unlock_bh(&priv->tx_lock); 941 } else { 942 ath_dbg(ath9k_hw_common(priv->ah), ATH_DBG_XMIT, 943 "Tx failed\n"); 944 } 945 goto fail_tx; 946 } 947 948 return 0; 949 950 fail_tx: 951 dev_kfree_skb_any(skb); 952 return 0; 953 } 954 955 static int ath9k_htc_start(struct ieee80211_hw *hw) 956 { 957 struct ath9k_htc_priv *priv = hw->priv; 958 struct ath_hw *ah = priv->ah; 959 struct ath_common *common = ath9k_hw_common(ah); 960 struct ieee80211_channel *curchan = hw->conf.channel; 961 struct ath9k_channel *init_channel; 962 int ret = 0; 963 enum htc_phymode mode; 964 __be16 htc_mode; 965 u8 cmd_rsp; 966 967 mutex_lock(&priv->mutex); 968 969 ath_dbg(common, ATH_DBG_CONFIG, 970 "Starting driver with initial channel: %d MHz\n", 971 curchan->center_freq); 972 973 /* Ensure that HW is awake before flushing RX */ 974 ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); 975 WMI_CMD(WMI_FLUSH_RECV_CMDID); 976 977 /* setup initial channel */ 978 init_channel = ath9k_cmn_get_curchannel(hw, ah); 979 980 ath9k_hw_htc_resetinit(ah); 981 ret = ath9k_hw_reset(ah, init_channel, ah->caldata, false); 982 if (ret) { 983 ath_err(common, 984 "Unable to reset hardware; reset status %d (freq %u MHz)\n", 985 ret, curchan->center_freq); 986 mutex_unlock(&priv->mutex); 987 return ret; 988 } 989 990 ath_update_txpow(priv); 991 992 mode = ath9k_htc_get_curmode(priv, init_channel); 993 htc_mode = cpu_to_be16(mode); 994 WMI_CMD_BUF(WMI_SET_MODE_CMDID, &htc_mode); 995 WMI_CMD(WMI_ATH_INIT_CMDID); 996 WMI_CMD(WMI_START_RECV_CMDID); 997 998 ath9k_host_rx_init(priv); 999 1000 priv->op_flags &= ~OP_INVALID; 1001 htc_start(priv->htc); 1002 1003 spin_lock_bh(&priv->tx_lock); 1004 priv->tx_queues_stop = false; 1005 spin_unlock_bh(&priv->tx_lock); 1006 1007 ieee80211_wake_queues(hw); 1008 1009 if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE) { 1010 ath9k_hw_btcoex_set_weight(ah, AR_BT_COEX_WGHT, 1011 AR_STOMP_LOW_WLAN_WGHT); 1012 ath9k_hw_btcoex_enable(ah); 1013 ath_htc_resume_btcoex_work(priv); 1014 } 1015 mutex_unlock(&priv->mutex); 1016 1017 return ret; 1018 } 1019 1020 static void ath9k_htc_stop(struct ieee80211_hw *hw) 1021 { 1022 struct ath9k_htc_priv *priv = hw->priv; 1023 struct ath_hw *ah = priv->ah; 1024 struct ath_common *common = ath9k_hw_common(ah); 1025 int ret = 0; 1026 u8 cmd_rsp; 1027 1028 mutex_lock(&priv->mutex); 1029 1030 if (priv->op_flags & OP_INVALID) { 1031 ath_dbg(common, ATH_DBG_ANY, "Device not present\n"); 1032 mutex_unlock(&priv->mutex); 1033 return; 1034 } 1035 1036 ath9k_htc_ps_wakeup(priv); 1037 htc_stop(priv->htc); 1038 WMI_CMD(WMI_DISABLE_INTR_CMDID); 1039 WMI_CMD(WMI_DRAIN_TXQ_ALL_CMDID); 1040 WMI_CMD(WMI_STOP_RECV_CMDID); 1041 1042 tasklet_kill(&priv->swba_tasklet); 1043 tasklet_kill(&priv->rx_tasklet); 1044 tasklet_kill(&priv->tx_tasklet); 1045 1046 skb_queue_purge(&priv->tx_queue); 1047 1048 mutex_unlock(&priv->mutex); 1049 1050 /* Cancel all the running timers/work .. */ 1051 cancel_work_sync(&priv->fatal_work); 1052 cancel_work_sync(&priv->ps_work); 1053 cancel_delayed_work_sync(&priv->ath9k_led_blink_work); 1054 ath9k_led_stop_brightness(priv); 1055 1056 mutex_lock(&priv->mutex); 1057 1058 /* Remove monitor interface here */ 1059 if (ah->opmode == NL80211_IFTYPE_MONITOR) { 1060 if (ath9k_htc_remove_monitor_interface(priv)) 1061 ath_err(common, "Unable to remove monitor interface\n"); 1062 else 1063 ath_dbg(common, ATH_DBG_CONFIG, 1064 "Monitor interface removed\n"); 1065 } 1066 1067 if (ah->btcoex_hw.enabled) { 1068 ath9k_hw_btcoex_disable(ah); 1069 if (ah->btcoex_hw.scheme == ATH_BTCOEX_CFG_3WIRE) 1070 ath_htc_cancel_btcoex_work(priv); 1071 } 1072 1073 ath9k_hw_phy_disable(ah); 1074 ath9k_hw_disable(ah); 1075 ath9k_htc_ps_restore(priv); 1076 ath9k_htc_setpower(priv, ATH9K_PM_FULL_SLEEP); 1077 1078 priv->op_flags |= OP_INVALID; 1079 1080 ath_dbg(common, ATH_DBG_CONFIG, "Driver halt\n"); 1081 mutex_unlock(&priv->mutex); 1082 } 1083 1084 static int ath9k_htc_add_interface(struct ieee80211_hw *hw, 1085 struct ieee80211_vif *vif) 1086 { 1087 struct ath9k_htc_priv *priv = hw->priv; 1088 struct ath9k_htc_vif *avp = (void *)vif->drv_priv; 1089 struct ath_common *common = ath9k_hw_common(priv->ah); 1090 struct ath9k_htc_target_vif hvif; 1091 int ret = 0; 1092 u8 cmd_rsp; 1093 1094 mutex_lock(&priv->mutex); 1095 1096 /* Only one interface for now */ 1097 if (priv->nvifs > 0) { 1098 ret = -ENOBUFS; 1099 goto out; 1100 } 1101 1102 ath9k_htc_ps_wakeup(priv); 1103 memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); 1104 memcpy(&hvif.myaddr, vif->addr, ETH_ALEN); 1105 1106 switch (vif->type) { 1107 case NL80211_IFTYPE_STATION: 1108 hvif.opmode = cpu_to_be32(HTC_M_STA); 1109 break; 1110 case NL80211_IFTYPE_ADHOC: 1111 hvif.opmode = cpu_to_be32(HTC_M_IBSS); 1112 break; 1113 default: 1114 ath_err(common, 1115 "Interface type %d not yet supported\n", vif->type); 1116 ret = -EOPNOTSUPP; 1117 goto out; 1118 } 1119 1120 ath_dbg(common, ATH_DBG_CONFIG, 1121 "Attach a VIF of type: %d\n", vif->type); 1122 1123 priv->ah->opmode = vif->type; 1124 1125 /* Index starts from zero on the target */ 1126 avp->index = hvif.index = priv->nvifs; 1127 hvif.rtsthreshold = cpu_to_be16(2304); 1128 WMI_CMD_BUF(WMI_VAP_CREATE_CMDID, &hvif); 1129 if (ret) 1130 goto out; 1131 1132 priv->nvifs++; 1133 1134 /* 1135 * We need a node in target to tx mgmt frames 1136 * before association. 1137 */ 1138 ret = ath9k_htc_add_station(priv, vif, NULL); 1139 if (ret) 1140 goto out; 1141 1142 ret = ath9k_htc_update_cap_target(priv); 1143 if (ret) 1144 ath_dbg(common, ATH_DBG_CONFIG, 1145 "Failed to update capability in target\n"); 1146 1147 priv->vif = vif; 1148 out: 1149 ath9k_htc_ps_restore(priv); 1150 mutex_unlock(&priv->mutex); 1151 1152 return ret; 1153 } 1154 1155 static void ath9k_htc_remove_interface(struct ieee80211_hw *hw, 1156 struct ieee80211_vif *vif) 1157 { 1158 struct ath9k_htc_priv *priv = hw->priv; 1159 struct ath_common *common = ath9k_hw_common(priv->ah); 1160 struct ath9k_htc_vif *avp = (void *)vif->drv_priv; 1161 struct ath9k_htc_target_vif hvif; 1162 int ret = 0; 1163 u8 cmd_rsp; 1164 1165 ath_dbg(common, ATH_DBG_CONFIG, "Detach Interface\n"); 1166 1167 mutex_lock(&priv->mutex); 1168 ath9k_htc_ps_wakeup(priv); 1169 1170 memset(&hvif, 0, sizeof(struct ath9k_htc_target_vif)); 1171 memcpy(&hvif.myaddr, vif->addr, ETH_ALEN); 1172 hvif.index = avp->index; 1173 WMI_CMD_BUF(WMI_VAP_REMOVE_CMDID, &hvif); 1174 priv->nvifs--; 1175 1176 ath9k_htc_remove_station(priv, vif, NULL); 1177 priv->vif = NULL; 1178 1179 ath9k_htc_ps_restore(priv); 1180 mutex_unlock(&priv->mutex); 1181 } 1182 1183 static int ath9k_htc_config(struct ieee80211_hw *hw, u32 changed) 1184 { 1185 struct ath9k_htc_priv *priv = hw->priv; 1186 struct ath_common *common = ath9k_hw_common(priv->ah); 1187 struct ieee80211_conf *conf = &hw->conf; 1188 1189 mutex_lock(&priv->mutex); 1190 1191 if (changed & IEEE80211_CONF_CHANGE_IDLE) { 1192 bool enable_radio = false; 1193 bool idle = !!(conf->flags & IEEE80211_CONF_IDLE); 1194 1195 mutex_lock(&priv->htc_pm_lock); 1196 if (!idle && priv->ps_idle) 1197 enable_radio = true; 1198 priv->ps_idle = idle; 1199 mutex_unlock(&priv->htc_pm_lock); 1200 1201 if (enable_radio) { 1202 ath_dbg(common, ATH_DBG_CONFIG, 1203 "not-idle: enabling radio\n"); 1204 ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); 1205 ath9k_htc_radio_enable(hw); 1206 } 1207 } 1208 1209 /* 1210 * Monitor interface should be added before 1211 * IEEE80211_CONF_CHANGE_CHANNEL is handled. 1212 */ 1213 if (changed & IEEE80211_CONF_CHANGE_MONITOR) { 1214 if (conf->flags & IEEE80211_CONF_MONITOR) { 1215 if (ath9k_htc_add_monitor_interface(priv)) 1216 ath_err(common, "Failed to set monitor mode\n"); 1217 else 1218 ath_dbg(common, ATH_DBG_CONFIG, 1219 "HW opmode set to Monitor mode\n"); 1220 } 1221 } 1222 1223 if (changed & IEEE80211_CONF_CHANGE_CHANNEL) { 1224 struct ieee80211_channel *curchan = hw->conf.channel; 1225 int pos = curchan->hw_value; 1226 1227 ath_dbg(common, ATH_DBG_CONFIG, "Set channel: %d MHz\n", 1228 curchan->center_freq); 1229 1230 ath9k_cmn_update_ichannel(&priv->ah->channels[pos], 1231 hw->conf.channel, 1232 hw->conf.channel_type); 1233 1234 if (ath9k_htc_set_channel(priv, hw, &priv->ah->channels[pos]) < 0) { 1235 ath_err(common, "Unable to set channel\n"); 1236 mutex_unlock(&priv->mutex); 1237 return -EINVAL; 1238 } 1239 1240 } 1241 1242 if (changed & IEEE80211_CONF_CHANGE_PS) { 1243 if (conf->flags & IEEE80211_CONF_PS) { 1244 ath9k_htc_setpower(priv, ATH9K_PM_NETWORK_SLEEP); 1245 priv->ps_enabled = true; 1246 } else { 1247 priv->ps_enabled = false; 1248 cancel_work_sync(&priv->ps_work); 1249 ath9k_htc_setpower(priv, ATH9K_PM_AWAKE); 1250 } 1251 } 1252 1253 if (changed & IEEE80211_CONF_CHANGE_POWER) { 1254 priv->txpowlimit = 2 * conf->power_level; 1255 ath_update_txpow(priv); 1256 } 1257 1258 if (changed & IEEE80211_CONF_CHANGE_IDLE) { 1259 mutex_lock(&priv->htc_pm_lock); 1260 if (!priv->ps_idle) { 1261 mutex_unlock(&priv->htc_pm_lock); 1262 goto out; 1263 } 1264 mutex_unlock(&priv->htc_pm_lock); 1265 1266 ath_dbg(common, ATH_DBG_CONFIG, 1267 "idle: disabling radio\n"); 1268 ath9k_htc_radio_disable(hw); 1269 } 1270 1271 out: 1272 mutex_unlock(&priv->mutex); 1273 return 0; 1274 } 1275 1276 #define SUPPORTED_FILTERS \ 1277 (FIF_PROMISC_IN_BSS | \ 1278 FIF_ALLMULTI | \ 1279 FIF_CONTROL | \ 1280 FIF_PSPOLL | \ 1281 FIF_OTHER_BSS | \ 1282 FIF_BCN_PRBRESP_PROMISC | \ 1283 FIF_PROBE_REQ | \ 1284 FIF_FCSFAIL) 1285 1286 static void ath9k_htc_configure_filter(struct ieee80211_hw *hw, 1287 unsigned int changed_flags, 1288 unsigned int *total_flags, 1289 u64 multicast) 1290 { 1291 struct ath9k_htc_priv *priv = hw->priv; 1292 u32 rfilt; 1293 1294 mutex_lock(&priv->mutex); 1295 ath9k_htc_ps_wakeup(priv); 1296 1297 changed_flags &= SUPPORTED_FILTERS; 1298 *total_flags &= SUPPORTED_FILTERS; 1299 1300 priv->rxfilter = *total_flags; 1301 rfilt = ath9k_htc_calcrxfilter(priv); 1302 ath9k_hw_setrxfilter(priv->ah, rfilt); 1303 1304 ath_dbg(ath9k_hw_common(priv->ah), ATH_DBG_CONFIG, 1305 "Set HW RX filter: 0x%x\n", rfilt); 1306 1307 ath9k_htc_ps_restore(priv); 1308 mutex_unlock(&priv->mutex); 1309 } 1310 1311 static int ath9k_htc_sta_add(struct ieee80211_hw *hw, 1312 struct ieee80211_vif *vif, 1313 struct ieee80211_sta *sta) 1314 { 1315 struct ath9k_htc_priv *priv = hw->priv; 1316 int ret; 1317 1318 mutex_lock(&priv->mutex); 1319 ath9k_htc_ps_wakeup(priv); 1320 ret = ath9k_htc_add_station(priv, vif, sta); 1321 if (!ret) 1322 ath9k_htc_init_rate(priv, sta); 1323 ath9k_htc_ps_restore(priv); 1324 mutex_unlock(&priv->mutex); 1325 1326 return ret; 1327 } 1328 1329 static int ath9k_htc_sta_remove(struct ieee80211_hw *hw, 1330 struct ieee80211_vif *vif, 1331 struct ieee80211_sta *sta) 1332 { 1333 struct ath9k_htc_priv *priv = hw->priv; 1334 int ret; 1335 1336 mutex_lock(&priv->mutex); 1337 ath9k_htc_ps_wakeup(priv); 1338 ret = ath9k_htc_remove_station(priv, vif, sta); 1339 ath9k_htc_ps_restore(priv); 1340 mutex_unlock(&priv->mutex); 1341 1342 return ret; 1343 } 1344 1345 static int ath9k_htc_conf_tx(struct ieee80211_hw *hw, u16 queue, 1346 const struct ieee80211_tx_queue_params *params) 1347 { 1348 struct ath9k_htc_priv *priv = hw->priv; 1349 struct ath_common *common = ath9k_hw_common(priv->ah); 1350 struct ath9k_tx_queue_info qi; 1351 int ret = 0, qnum; 1352 1353 if (queue >= WME_NUM_AC) 1354 return 0; 1355 1356 mutex_lock(&priv->mutex); 1357 ath9k_htc_ps_wakeup(priv); 1358 1359 memset(&qi, 0, sizeof(struct ath9k_tx_queue_info)); 1360 1361 qi.tqi_aifs = params->aifs; 1362 qi.tqi_cwmin = params->cw_min; 1363 qi.tqi_cwmax = params->cw_max; 1364 qi.tqi_burstTime = params->txop; 1365 1366 qnum = get_hw_qnum(queue, priv->hwq_map); 1367 1368 ath_dbg(common, ATH_DBG_CONFIG, 1369 "Configure tx [queue/hwq] [%d/%d], aifs: %d, cw_min: %d, cw_max: %d, txop: %d\n", 1370 queue, qnum, params->aifs, params->cw_min, 1371 params->cw_max, params->txop); 1372 1373 ret = ath_htc_txq_update(priv, qnum, &qi); 1374 if (ret) { 1375 ath_err(common, "TXQ Update failed\n"); 1376 goto out; 1377 } 1378 1379 if ((priv->ah->opmode == NL80211_IFTYPE_ADHOC) && 1380 (qnum == priv->hwq_map[WME_AC_BE])) 1381 ath9k_htc_beaconq_config(priv); 1382 out: 1383 ath9k_htc_ps_restore(priv); 1384 mutex_unlock(&priv->mutex); 1385 1386 return ret; 1387 } 1388 1389 static int ath9k_htc_set_key(struct ieee80211_hw *hw, 1390 enum set_key_cmd cmd, 1391 struct ieee80211_vif *vif, 1392 struct ieee80211_sta *sta, 1393 struct ieee80211_key_conf *key) 1394 { 1395 struct ath9k_htc_priv *priv = hw->priv; 1396 struct ath_common *common = ath9k_hw_common(priv->ah); 1397 int ret = 0; 1398 1399 if (htc_modparam_nohwcrypt) 1400 return -ENOSPC; 1401 1402 mutex_lock(&priv->mutex); 1403 ath_dbg(common, ATH_DBG_CONFIG, "Set HW Key\n"); 1404 ath9k_htc_ps_wakeup(priv); 1405 1406 switch (cmd) { 1407 case SET_KEY: 1408 ret = ath_key_config(common, vif, sta, key); 1409 if (ret >= 0) { 1410 key->hw_key_idx = ret; 1411 /* push IV and Michael MIC generation to stack */ 1412 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; 1413 if (key->cipher == WLAN_CIPHER_SUITE_TKIP) 1414 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC; 1415 if (priv->ah->sw_mgmt_crypto && 1416 key->cipher == WLAN_CIPHER_SUITE_CCMP) 1417 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT; 1418 ret = 0; 1419 } 1420 break; 1421 case DISABLE_KEY: 1422 ath_key_delete(common, key); 1423 break; 1424 default: 1425 ret = -EINVAL; 1426 } 1427 1428 ath9k_htc_ps_restore(priv); 1429 mutex_unlock(&priv->mutex); 1430 1431 return ret; 1432 } 1433 1434 static void ath9k_htc_bss_info_changed(struct ieee80211_hw *hw, 1435 struct ieee80211_vif *vif, 1436 struct ieee80211_bss_conf *bss_conf, 1437 u32 changed) 1438 { 1439 struct ath9k_htc_priv *priv = hw->priv; 1440 struct ath_hw *ah = priv->ah; 1441 struct ath_common *common = ath9k_hw_common(ah); 1442 1443 mutex_lock(&priv->mutex); 1444 ath9k_htc_ps_wakeup(priv); 1445 1446 if (changed & BSS_CHANGED_ASSOC) { 1447 common->curaid = bss_conf->assoc ? 1448 bss_conf->aid : 0; 1449 ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed ASSOC %d\n", 1450 bss_conf->assoc); 1451 1452 if (bss_conf->assoc) { 1453 priv->op_flags |= OP_ASSOCIATED; 1454 ath_start_ani(priv); 1455 } else { 1456 priv->op_flags &= ~OP_ASSOCIATED; 1457 cancel_delayed_work_sync(&priv->ath9k_ani_work); 1458 } 1459 } 1460 1461 if (changed & BSS_CHANGED_BSSID) { 1462 /* Set BSSID */ 1463 memcpy(common->curbssid, bss_conf->bssid, ETH_ALEN); 1464 ath9k_hw_write_associd(ah); 1465 1466 ath_dbg(common, ATH_DBG_CONFIG, 1467 "BSSID: %pM aid: 0x%x\n", 1468 common->curbssid, common->curaid); 1469 } 1470 1471 if ((changed & BSS_CHANGED_BEACON_INT) || 1472 (changed & BSS_CHANGED_BEACON) || 1473 ((changed & BSS_CHANGED_BEACON_ENABLED) && 1474 bss_conf->enable_beacon)) { 1475 priv->op_flags |= OP_ENABLE_BEACON; 1476 ath9k_htc_beacon_config(priv, vif); 1477 } 1478 1479 if ((changed & BSS_CHANGED_BEACON_ENABLED) && 1480 !bss_conf->enable_beacon) { 1481 priv->op_flags &= ~OP_ENABLE_BEACON; 1482 ath9k_htc_beacon_config(priv, vif); 1483 } 1484 1485 if (changed & BSS_CHANGED_ERP_PREAMBLE) { 1486 ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed PREAMBLE %d\n", 1487 bss_conf->use_short_preamble); 1488 if (bss_conf->use_short_preamble) 1489 priv->op_flags |= OP_PREAMBLE_SHORT; 1490 else 1491 priv->op_flags &= ~OP_PREAMBLE_SHORT; 1492 } 1493 1494 if (changed & BSS_CHANGED_ERP_CTS_PROT) { 1495 ath_dbg(common, ATH_DBG_CONFIG, "BSS Changed CTS PROT %d\n", 1496 bss_conf->use_cts_prot); 1497 if (bss_conf->use_cts_prot && 1498 hw->conf.channel->band != IEEE80211_BAND_5GHZ) 1499 priv->op_flags |= OP_PROTECT_ENABLE; 1500 else 1501 priv->op_flags &= ~OP_PROTECT_ENABLE; 1502 } 1503 1504 if (changed & BSS_CHANGED_ERP_SLOT) { 1505 if (bss_conf->use_short_slot) 1506 ah->slottime = 9; 1507 else 1508 ah->slottime = 20; 1509 1510 ath9k_hw_init_global_settings(ah); 1511 } 1512 1513 if (changed & BSS_CHANGED_HT) 1514 ath9k_htc_update_rate(priv, vif, bss_conf); 1515 1516 ath9k_htc_ps_restore(priv); 1517 mutex_unlock(&priv->mutex); 1518 } 1519 1520 static u64 ath9k_htc_get_tsf(struct ieee80211_hw *hw) 1521 { 1522 struct ath9k_htc_priv *priv = hw->priv; 1523 u64 tsf; 1524 1525 mutex_lock(&priv->mutex); 1526 ath9k_htc_ps_wakeup(priv); 1527 tsf = ath9k_hw_gettsf64(priv->ah); 1528 ath9k_htc_ps_restore(priv); 1529 mutex_unlock(&priv->mutex); 1530 1531 return tsf; 1532 } 1533 1534 static void ath9k_htc_set_tsf(struct ieee80211_hw *hw, u64 tsf) 1535 { 1536 struct ath9k_htc_priv *priv = hw->priv; 1537 1538 mutex_lock(&priv->mutex); 1539 ath9k_htc_ps_wakeup(priv); 1540 ath9k_hw_settsf64(priv->ah, tsf); 1541 ath9k_htc_ps_restore(priv); 1542 mutex_unlock(&priv->mutex); 1543 } 1544 1545 static void ath9k_htc_reset_tsf(struct ieee80211_hw *hw) 1546 { 1547 struct ath9k_htc_priv *priv = hw->priv; 1548 1549 mutex_lock(&priv->mutex); 1550 ath9k_htc_ps_wakeup(priv); 1551 ath9k_hw_reset_tsf(priv->ah); 1552 ath9k_htc_ps_restore(priv); 1553 mutex_unlock(&priv->mutex); 1554 } 1555 1556 static int ath9k_htc_ampdu_action(struct ieee80211_hw *hw, 1557 struct ieee80211_vif *vif, 1558 enum ieee80211_ampdu_mlme_action action, 1559 struct ieee80211_sta *sta, 1560 u16 tid, u16 *ssn) 1561 { 1562 struct ath9k_htc_priv *priv = hw->priv; 1563 struct ath9k_htc_sta *ista; 1564 int ret = 0; 1565 1566 switch (action) { 1567 case IEEE80211_AMPDU_RX_START: 1568 break; 1569 case IEEE80211_AMPDU_RX_STOP: 1570 break; 1571 case IEEE80211_AMPDU_TX_START: 1572 ret = ath9k_htc_tx_aggr_oper(priv, vif, sta, action, tid); 1573 if (!ret) 1574 ieee80211_start_tx_ba_cb_irqsafe(vif, sta->addr, tid); 1575 break; 1576 case IEEE80211_AMPDU_TX_STOP: 1577 ath9k_htc_tx_aggr_oper(priv, vif, sta, action, tid); 1578 ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); 1579 break; 1580 case IEEE80211_AMPDU_TX_OPERATIONAL: 1581 ista = (struct ath9k_htc_sta *) sta->drv_priv; 1582 spin_lock_bh(&priv->tx_lock); 1583 ista->tid_state[tid] = AGGR_OPERATIONAL; 1584 spin_unlock_bh(&priv->tx_lock); 1585 break; 1586 default: 1587 ath_err(ath9k_hw_common(priv->ah), "Unknown AMPDU action\n"); 1588 } 1589 1590 return ret; 1591 } 1592 1593 static void ath9k_htc_sw_scan_start(struct ieee80211_hw *hw) 1594 { 1595 struct ath9k_htc_priv *priv = hw->priv; 1596 1597 mutex_lock(&priv->mutex); 1598 spin_lock_bh(&priv->beacon_lock); 1599 priv->op_flags |= OP_SCANNING; 1600 spin_unlock_bh(&priv->beacon_lock); 1601 cancel_work_sync(&priv->ps_work); 1602 if (priv->op_flags & OP_ASSOCIATED) 1603 cancel_delayed_work_sync(&priv->ath9k_ani_work); 1604 mutex_unlock(&priv->mutex); 1605 } 1606 1607 static void ath9k_htc_sw_scan_complete(struct ieee80211_hw *hw) 1608 { 1609 struct ath9k_htc_priv *priv = hw->priv; 1610 1611 mutex_lock(&priv->mutex); 1612 ath9k_htc_ps_wakeup(priv); 1613 spin_lock_bh(&priv->beacon_lock); 1614 priv->op_flags &= ~OP_SCANNING; 1615 spin_unlock_bh(&priv->beacon_lock); 1616 if (priv->op_flags & OP_ASSOCIATED) { 1617 ath9k_htc_beacon_config(priv, priv->vif); 1618 ath_start_ani(priv); 1619 } 1620 ath9k_htc_ps_restore(priv); 1621 mutex_unlock(&priv->mutex); 1622 } 1623 1624 static int ath9k_htc_set_rts_threshold(struct ieee80211_hw *hw, u32 value) 1625 { 1626 return 0; 1627 } 1628 1629 static void ath9k_htc_set_coverage_class(struct ieee80211_hw *hw, 1630 u8 coverage_class) 1631 { 1632 struct ath9k_htc_priv *priv = hw->priv; 1633 1634 mutex_lock(&priv->mutex); 1635 ath9k_htc_ps_wakeup(priv); 1636 priv->ah->coverage_class = coverage_class; 1637 ath9k_hw_init_global_settings(priv->ah); 1638 ath9k_htc_ps_restore(priv); 1639 mutex_unlock(&priv->mutex); 1640 } 1641 1642 struct ieee80211_ops ath9k_htc_ops = { 1643 .tx = ath9k_htc_tx, 1644 .start = ath9k_htc_start, 1645 .stop = ath9k_htc_stop, 1646 .add_interface = ath9k_htc_add_interface, 1647 .remove_interface = ath9k_htc_remove_interface, 1648 .config = ath9k_htc_config, 1649 .configure_filter = ath9k_htc_configure_filter, 1650 .sta_add = ath9k_htc_sta_add, 1651 .sta_remove = ath9k_htc_sta_remove, 1652 .conf_tx = ath9k_htc_conf_tx, 1653 .bss_info_changed = ath9k_htc_bss_info_changed, 1654 .set_key = ath9k_htc_set_key, 1655 .get_tsf = ath9k_htc_get_tsf, 1656 .set_tsf = ath9k_htc_set_tsf, 1657 .reset_tsf = ath9k_htc_reset_tsf, 1658 .ampdu_action = ath9k_htc_ampdu_action, 1659 .sw_scan_start = ath9k_htc_sw_scan_start, 1660 .sw_scan_complete = ath9k_htc_sw_scan_complete, 1661 .set_rts_threshold = ath9k_htc_set_rts_threshold, 1662 .rfkill_poll = ath9k_htc_rfkill_poll_state, 1663 .set_coverage_class = ath9k_htc_set_coverage_class, 1664 }; 1665