1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Scan implementation for ST-Ericsson CW1200 mac80211 drivers 4 * 5 * Copyright (c) 2010, ST-Ericsson 6 * Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no> 7 */ 8 9 #include <linux/sched.h> 10 #include "cw1200.h" 11 #include "scan.h" 12 #include "sta.h" 13 #include "pm.h" 14 15 static void cw1200_scan_restart_delayed(struct cw1200_common *priv); 16 17 static int cw1200_scan_start(struct cw1200_common *priv, struct wsm_scan *scan) 18 { 19 int ret, i; 20 int tmo = 2000; 21 22 switch (priv->join_status) { 23 case CW1200_JOIN_STATUS_PRE_STA: 24 case CW1200_JOIN_STATUS_JOINING: 25 return -EBUSY; 26 default: 27 break; 28 } 29 30 wiphy_dbg(priv->hw->wiphy, "[SCAN] hw req, type %d, %d channels, flags: 0x%x.\n", 31 scan->type, scan->num_channels, scan->flags); 32 33 for (i = 0; i < scan->num_channels; ++i) 34 tmo += scan->ch[i].max_chan_time + 10; 35 36 cancel_delayed_work_sync(&priv->clear_recent_scan_work); 37 atomic_set(&priv->scan.in_progress, 1); 38 atomic_set(&priv->recent_scan, 1); 39 cw1200_pm_stay_awake(&priv->pm_state, msecs_to_jiffies(tmo)); 40 queue_delayed_work(priv->workqueue, &priv->scan.timeout, 41 msecs_to_jiffies(tmo)); 42 ret = wsm_scan(priv, scan); 43 if (ret) { 44 atomic_set(&priv->scan.in_progress, 0); 45 cancel_delayed_work_sync(&priv->scan.timeout); 46 cw1200_scan_restart_delayed(priv); 47 } 48 return ret; 49 } 50 51 int cw1200_hw_scan(struct ieee80211_hw *hw, 52 struct ieee80211_vif *vif, 53 struct ieee80211_scan_request *hw_req) 54 { 55 struct cw1200_common *priv = hw->priv; 56 struct cfg80211_scan_request *req = &hw_req->req; 57 struct wsm_template_frame frame = { 58 .frame_type = WSM_FRAME_TYPE_PROBE_REQUEST, 59 }; 60 int i, ret; 61 62 if (!priv->vif) 63 return -EINVAL; 64 65 /* Scan when P2P_GO corrupt firmware MiniAP mode */ 66 if (priv->join_status == CW1200_JOIN_STATUS_AP) 67 return -EOPNOTSUPP; 68 69 if (req->n_ssids == 1 && !req->ssids[0].ssid_len) 70 req->n_ssids = 0; 71 72 wiphy_dbg(hw->wiphy, "[SCAN] Scan request for %d SSIDs.\n", 73 req->n_ssids); 74 75 if (req->n_ssids > WSM_SCAN_MAX_NUM_OF_SSIDS) 76 return -EINVAL; 77 78 /* will be unlocked in cw1200_scan_work() */ 79 down(&priv->scan.lock); 80 mutex_lock(&priv->conf_mutex); 81 82 frame.skb = ieee80211_probereq_get(hw, priv->vif->addr, NULL, 0, 83 req->ie_len); 84 if (!frame.skb) { 85 mutex_unlock(&priv->conf_mutex); 86 up(&priv->scan.lock); 87 return -ENOMEM; 88 } 89 90 if (req->ie_len) 91 skb_put_data(frame.skb, req->ie, req->ie_len); 92 93 ret = wsm_set_template_frame(priv, &frame); 94 if (!ret) { 95 /* Host want to be the probe responder. */ 96 ret = wsm_set_probe_responder(priv, true); 97 } 98 if (ret) { 99 dev_kfree_skb(frame.skb); 100 mutex_unlock(&priv->conf_mutex); 101 up(&priv->scan.lock); 102 return ret; 103 } 104 105 wsm_lock_tx(priv); 106 107 BUG_ON(priv->scan.req); 108 priv->scan.req = req; 109 priv->scan.n_ssids = 0; 110 priv->scan.status = 0; 111 priv->scan.begin = &req->channels[0]; 112 priv->scan.curr = priv->scan.begin; 113 priv->scan.end = &req->channels[req->n_channels]; 114 priv->scan.output_power = priv->output_power; 115 116 for (i = 0; i < req->n_ssids; ++i) { 117 struct wsm_ssid *dst = &priv->scan.ssids[priv->scan.n_ssids]; 118 memcpy(&dst->ssid[0], req->ssids[i].ssid, sizeof(dst->ssid)); 119 dst->length = req->ssids[i].ssid_len; 120 ++priv->scan.n_ssids; 121 } 122 123 if (frame.skb) 124 dev_kfree_skb(frame.skb); 125 mutex_unlock(&priv->conf_mutex); 126 queue_work(priv->workqueue, &priv->scan.work); 127 return 0; 128 } 129 130 void cw1200_scan_work(struct work_struct *work) 131 { 132 struct cw1200_common *priv = container_of(work, struct cw1200_common, 133 scan.work); 134 struct ieee80211_channel **it; 135 struct wsm_scan scan = { 136 .type = WSM_SCAN_TYPE_FOREGROUND, 137 .flags = WSM_SCAN_FLAG_SPLIT_METHOD, 138 }; 139 bool first_run = (priv->scan.begin == priv->scan.curr && 140 priv->scan.begin != priv->scan.end); 141 int i; 142 143 if (first_run) { 144 /* Firmware gets crazy if scan request is sent 145 * when STA is joined but not yet associated. 146 * Force unjoin in this case. 147 */ 148 if (cancel_delayed_work_sync(&priv->join_timeout) > 0) 149 cw1200_join_timeout(&priv->join_timeout.work); 150 } 151 152 mutex_lock(&priv->conf_mutex); 153 154 if (first_run) { 155 if (priv->join_status == CW1200_JOIN_STATUS_STA && 156 !(priv->powersave_mode.mode & WSM_PSM_PS)) { 157 struct wsm_set_pm pm = priv->powersave_mode; 158 pm.mode = WSM_PSM_PS; 159 cw1200_set_pm(priv, &pm); 160 } else if (priv->join_status == CW1200_JOIN_STATUS_MONITOR) { 161 /* FW bug: driver has to restart p2p-dev mode 162 * after scan 163 */ 164 cw1200_disable_listening(priv); 165 } 166 } 167 168 if (!priv->scan.req || (priv->scan.curr == priv->scan.end)) { 169 struct cfg80211_scan_info info = { 170 .aborted = priv->scan.status ? 1 : 0, 171 }; 172 173 if (priv->scan.output_power != priv->output_power) 174 wsm_set_output_power(priv, priv->output_power * 10); 175 if (priv->join_status == CW1200_JOIN_STATUS_STA && 176 !(priv->powersave_mode.mode & WSM_PSM_PS)) 177 cw1200_set_pm(priv, &priv->powersave_mode); 178 179 if (priv->scan.status < 0) 180 wiphy_warn(priv->hw->wiphy, 181 "[SCAN] Scan failed (%d).\n", 182 priv->scan.status); 183 else if (priv->scan.req) 184 wiphy_dbg(priv->hw->wiphy, 185 "[SCAN] Scan completed.\n"); 186 else 187 wiphy_dbg(priv->hw->wiphy, 188 "[SCAN] Scan canceled.\n"); 189 190 priv->scan.req = NULL; 191 cw1200_scan_restart_delayed(priv); 192 wsm_unlock_tx(priv); 193 mutex_unlock(&priv->conf_mutex); 194 ieee80211_scan_completed(priv->hw, &info); 195 up(&priv->scan.lock); 196 return; 197 } else { 198 struct ieee80211_channel *first = *priv->scan.curr; 199 for (it = priv->scan.curr + 1, i = 1; 200 it != priv->scan.end && i < WSM_SCAN_MAX_NUM_OF_CHANNELS; 201 ++it, ++i) { 202 if ((*it)->band != first->band) 203 break; 204 if (((*it)->flags ^ first->flags) & 205 IEEE80211_CHAN_NO_IR) 206 break; 207 if (!(first->flags & IEEE80211_CHAN_NO_IR) && 208 (*it)->max_power != first->max_power) 209 break; 210 } 211 scan.band = first->band; 212 213 if (priv->scan.req->no_cck) 214 scan.max_tx_rate = WSM_TRANSMIT_RATE_6; 215 else 216 scan.max_tx_rate = WSM_TRANSMIT_RATE_1; 217 scan.num_probes = 218 (first->flags & IEEE80211_CHAN_NO_IR) ? 0 : 2; 219 scan.num_ssids = priv->scan.n_ssids; 220 scan.ssids = &priv->scan.ssids[0]; 221 scan.num_channels = it - priv->scan.curr; 222 /* TODO: Is it optimal? */ 223 scan.probe_delay = 100; 224 /* It is not stated in WSM specification, however 225 * FW team says that driver may not use FG scan 226 * when joined. 227 */ 228 if (priv->join_status == CW1200_JOIN_STATUS_STA) { 229 scan.type = WSM_SCAN_TYPE_BACKGROUND; 230 scan.flags = WSM_SCAN_FLAG_FORCE_BACKGROUND; 231 } 232 scan.ch = kcalloc(it - priv->scan.curr, 233 sizeof(struct wsm_scan_ch), 234 GFP_KERNEL); 235 if (!scan.ch) { 236 priv->scan.status = -ENOMEM; 237 goto fail; 238 } 239 for (i = 0; i < scan.num_channels; ++i) { 240 scan.ch[i].number = priv->scan.curr[i]->hw_value; 241 if (priv->scan.curr[i]->flags & IEEE80211_CHAN_NO_IR) { 242 scan.ch[i].min_chan_time = 50; 243 scan.ch[i].max_chan_time = 100; 244 } else { 245 scan.ch[i].min_chan_time = 10; 246 scan.ch[i].max_chan_time = 25; 247 } 248 } 249 if (!(first->flags & IEEE80211_CHAN_NO_IR) && 250 priv->scan.output_power != first->max_power) { 251 priv->scan.output_power = first->max_power; 252 wsm_set_output_power(priv, 253 priv->scan.output_power * 10); 254 } 255 priv->scan.status = cw1200_scan_start(priv, &scan); 256 kfree(scan.ch); 257 if (priv->scan.status) 258 goto fail; 259 priv->scan.curr = it; 260 } 261 mutex_unlock(&priv->conf_mutex); 262 return; 263 264 fail: 265 priv->scan.curr = priv->scan.end; 266 mutex_unlock(&priv->conf_mutex); 267 queue_work(priv->workqueue, &priv->scan.work); 268 return; 269 } 270 271 static void cw1200_scan_restart_delayed(struct cw1200_common *priv) 272 { 273 /* FW bug: driver has to restart p2p-dev mode after scan. */ 274 if (priv->join_status == CW1200_JOIN_STATUS_MONITOR) { 275 cw1200_enable_listening(priv); 276 cw1200_update_filtering(priv); 277 } 278 279 if (priv->delayed_unjoin) { 280 priv->delayed_unjoin = false; 281 if (queue_work(priv->workqueue, &priv->unjoin_work) <= 0) 282 wsm_unlock_tx(priv); 283 } else if (priv->delayed_link_loss) { 284 wiphy_dbg(priv->hw->wiphy, "[CQM] Requeue BSS loss.\n"); 285 priv->delayed_link_loss = 0; 286 cw1200_cqm_bssloss_sm(priv, 1, 0, 0); 287 } 288 } 289 290 static void cw1200_scan_complete(struct cw1200_common *priv) 291 { 292 queue_delayed_work(priv->workqueue, &priv->clear_recent_scan_work, HZ); 293 if (priv->scan.direct_probe) { 294 wiphy_dbg(priv->hw->wiphy, "[SCAN] Direct probe complete.\n"); 295 cw1200_scan_restart_delayed(priv); 296 priv->scan.direct_probe = 0; 297 up(&priv->scan.lock); 298 wsm_unlock_tx(priv); 299 } else { 300 cw1200_scan_work(&priv->scan.work); 301 } 302 } 303 304 void cw1200_scan_failed_cb(struct cw1200_common *priv) 305 { 306 if (priv->mode == NL80211_IFTYPE_UNSPECIFIED) 307 /* STA is stopped. */ 308 return; 309 310 if (cancel_delayed_work_sync(&priv->scan.timeout) > 0) { 311 priv->scan.status = -EIO; 312 queue_delayed_work(priv->workqueue, &priv->scan.timeout, 0); 313 } 314 } 315 316 317 void cw1200_scan_complete_cb(struct cw1200_common *priv, 318 struct wsm_scan_complete *arg) 319 { 320 if (priv->mode == NL80211_IFTYPE_UNSPECIFIED) 321 /* STA is stopped. */ 322 return; 323 324 if (cancel_delayed_work_sync(&priv->scan.timeout) > 0) { 325 priv->scan.status = 1; 326 queue_delayed_work(priv->workqueue, &priv->scan.timeout, 0); 327 } 328 } 329 330 void cw1200_clear_recent_scan_work(struct work_struct *work) 331 { 332 struct cw1200_common *priv = 333 container_of(work, struct cw1200_common, 334 clear_recent_scan_work.work); 335 atomic_xchg(&priv->recent_scan, 0); 336 } 337 338 void cw1200_scan_timeout(struct work_struct *work) 339 { 340 struct cw1200_common *priv = 341 container_of(work, struct cw1200_common, scan.timeout.work); 342 if (atomic_xchg(&priv->scan.in_progress, 0)) { 343 if (priv->scan.status > 0) { 344 priv->scan.status = 0; 345 } else if (!priv->scan.status) { 346 wiphy_warn(priv->hw->wiphy, 347 "Timeout waiting for scan complete notification.\n"); 348 priv->scan.status = -ETIMEDOUT; 349 priv->scan.curr = priv->scan.end; 350 wsm_stop_scan(priv); 351 } 352 cw1200_scan_complete(priv); 353 } 354 } 355 356 void cw1200_probe_work(struct work_struct *work) 357 { 358 struct cw1200_common *priv = 359 container_of(work, struct cw1200_common, scan.probe_work.work); 360 u8 queue_id = cw1200_queue_get_queue_id(priv->pending_frame_id); 361 struct cw1200_queue *queue = &priv->tx_queue[queue_id]; 362 const struct cw1200_txpriv *txpriv; 363 struct wsm_tx *wsm; 364 struct wsm_template_frame frame = { 365 .frame_type = WSM_FRAME_TYPE_PROBE_REQUEST, 366 }; 367 struct wsm_ssid ssids[1] = {{ 368 .length = 0, 369 } }; 370 struct wsm_scan_ch ch[1] = {{ 371 .min_chan_time = 0, 372 .max_chan_time = 10, 373 } }; 374 struct wsm_scan scan = { 375 .type = WSM_SCAN_TYPE_FOREGROUND, 376 .num_probes = 1, 377 .probe_delay = 0, 378 .num_channels = 1, 379 .ssids = ssids, 380 .ch = ch, 381 }; 382 u8 *ies; 383 size_t ies_len; 384 int ret; 385 386 wiphy_dbg(priv->hw->wiphy, "[SCAN] Direct probe work.\n"); 387 388 mutex_lock(&priv->conf_mutex); 389 if (down_trylock(&priv->scan.lock)) { 390 /* Scan is already in progress. Requeue self. */ 391 schedule(); 392 queue_delayed_work(priv->workqueue, &priv->scan.probe_work, 393 msecs_to_jiffies(100)); 394 mutex_unlock(&priv->conf_mutex); 395 return; 396 } 397 398 /* Make sure we still have a pending probe req */ 399 if (cw1200_queue_get_skb(queue, priv->pending_frame_id, 400 &frame.skb, &txpriv)) { 401 up(&priv->scan.lock); 402 mutex_unlock(&priv->conf_mutex); 403 wsm_unlock_tx(priv); 404 return; 405 } 406 wsm = (struct wsm_tx *)frame.skb->data; 407 scan.max_tx_rate = wsm->max_tx_rate; 408 scan.band = (priv->channel->band == NL80211_BAND_5GHZ) ? 409 WSM_PHY_BAND_5G : WSM_PHY_BAND_2_4G; 410 if (priv->join_status == CW1200_JOIN_STATUS_STA || 411 priv->join_status == CW1200_JOIN_STATUS_IBSS) { 412 scan.type = WSM_SCAN_TYPE_BACKGROUND; 413 scan.flags = WSM_SCAN_FLAG_FORCE_BACKGROUND; 414 } 415 ch[0].number = priv->channel->hw_value; 416 417 skb_pull(frame.skb, txpriv->offset); 418 419 ies = &frame.skb->data[sizeof(struct ieee80211_hdr_3addr)]; 420 ies_len = frame.skb->len - sizeof(struct ieee80211_hdr_3addr); 421 422 if (ies_len) { 423 u8 *ssidie = 424 (u8 *)cfg80211_find_ie(WLAN_EID_SSID, ies, ies_len); 425 if (ssidie && ssidie[1] && ssidie[1] <= sizeof(ssids[0].ssid)) { 426 u8 *nextie = &ssidie[2 + ssidie[1]]; 427 /* Remove SSID from the IE list. It has to be provided 428 * as a separate argument in cw1200_scan_start call 429 */ 430 431 /* Store SSID localy */ 432 ssids[0].length = ssidie[1]; 433 memcpy(ssids[0].ssid, &ssidie[2], ssids[0].length); 434 scan.num_ssids = 1; 435 436 /* Remove SSID from IE list */ 437 ssidie[1] = 0; 438 memmove(&ssidie[2], nextie, &ies[ies_len] - nextie); 439 skb_trim(frame.skb, frame.skb->len - ssids[0].length); 440 } 441 } 442 443 /* FW bug: driver has to restart p2p-dev mode after scan */ 444 if (priv->join_status == CW1200_JOIN_STATUS_MONITOR) 445 cw1200_disable_listening(priv); 446 ret = wsm_set_template_frame(priv, &frame); 447 priv->scan.direct_probe = 1; 448 if (!ret) { 449 wsm_flush_tx(priv); 450 ret = cw1200_scan_start(priv, &scan); 451 } 452 mutex_unlock(&priv->conf_mutex); 453 454 skb_push(frame.skb, txpriv->offset); 455 if (!ret) 456 IEEE80211_SKB_CB(frame.skb)->flags |= IEEE80211_TX_STAT_ACK; 457 BUG_ON(cw1200_queue_remove(queue, priv->pending_frame_id)); 458 459 if (ret) { 460 priv->scan.direct_probe = 0; 461 up(&priv->scan.lock); 462 wsm_unlock_tx(priv); 463 } 464 465 return; 466 } 467