drivers/net/wireless/wl12xx/scan.c

   1 /*
   2  * This file is part of wl1271
   3  *
   4  * Copyright (C) 2009-2010 Nokia Corporation
   5  *
   6  * Contact: Luciano Coelho <luciano.coelho@nokia.com>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License
  10  * version 2 as published by the Free Software Foundation.
  11  *
  12  * This program is distributed in the hope that it will be useful, but
  13  * WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  20  * 02110-1301 USA
  21  *
  22  */
  23
  24 #include <linux/ieee80211.h>
  25
  26 #include "wl12xx.h"
  27 #include "cmd.h"
  28 #include "scan.h"
  29 #include "acx.h"
  30 #include "ps.h"
  31
  32 void wl1271_scan_complete_work(struct work_struct *work)
  33 {
  34         struct delayed_work *dwork;
  35         struct wl1271 *wl;
  36
  37         dwork = container_of(work, struct delayed_work, work);
  38         wl = container_of(dwork, struct wl1271, scan_complete_work);
  39
  40         wl1271_debug(DEBUG_SCAN, "Scanning complete");
  41
  42         mutex_lock(&wl->mutex);
  43
  44         if (wl->state == WL1271_STATE_OFF)
  45                 goto out;
  46
  47         if (wl->scan.state == WL1271_SCAN_STATE_IDLE)
  48                 goto out;
  49
  50         wl->scan.state = WL1271_SCAN_STATE_IDLE;
  51         memset(wl->scan.scanned_ch, 0, sizeof(wl->scan.scanned_ch));
  52         wl->scan.req = NULL;
  53         ieee80211_scan_completed(wl->hw, false);
  54
  55         /* restore hardware connection monitoring template */
  56         if (test_bit(WL1271_FLAG_STA_ASSOCIATED, &wl->flags)) {
  57                 if (wl1271_ps_elp_wakeup(wl) == 0) {
  58                         wl1271_cmd_build_ap_probe_req(wl, wl->probereq);
  59                         wl1271_ps_elp_sleep(wl);
  60                 }
  61         }
  62
  63         if (wl->scan.failed) {
  64                 wl1271_info("Scan completed due to error.");
  65                 ieee80211_queue_work(wl->hw, &wl->recovery_work);
  66         }
  67
  68 out:
  69         mutex_unlock(&wl->mutex);
  70
  71 }
  72
  73
  74 static int wl1271_get_scan_channels(struct wl1271 *wl,
  75                                     struct cfg80211_scan_request *req,
  76                                     struct basic_scan_channel_params *channels,
  77                                     enum ieee80211_band band, bool passive)
  78 {
  79         struct conf_scan_settings *c = &wl->conf.scan;
  80         int i, j;
  81         u32 flags;
  82
  83         for (i = 0, j = 0;
  84              i < req->n_channels && j < WL1271_SCAN_MAX_CHANNELS;
  85              i++) {
  86
  87                 flags = req->channels[i]->flags;
  88
  89                 if (!test_bit(i, wl->scan.scanned_ch) &&
  90                     !(flags & IEEE80211_CHAN_DISABLED) &&
  91                     ((!!(flags & IEEE80211_CHAN_PASSIVE_SCAN)) == passive) &&
  92                     (req->channels[i]->band == band)) {
  93
  94                         wl1271_debug(DEBUG_SCAN, "band %d, center_freq %d ",
  95                                      req->channels[i]->band,
  96                                      req->channels[i]->center_freq);
  97                         wl1271_debug(DEBUG_SCAN, "hw_value %d, flags %X",
  98                                      req->channels[i]->hw_value,
  99                                      req->channels[i]->flags);
 100                         wl1271_debug(DEBUG_SCAN,
 101                                      "max_antenna_gain %d, max_power %d",
 102                                      req->channels[i]->max_antenna_gain,
 103                                      req->channels[i]->max_power);
 104                         wl1271_debug(DEBUG_SCAN, "beacon_found %d",
 105                                      req->channels[i]->beacon_found);
 106
 107                         if (!passive) {
 108                                 channels[j].min_duration =
 109                                         cpu_to_le32(c->min_dwell_time_active);
 110                                 channels[j].max_duration =
 111                                         cpu_to_le32(c->max_dwell_time_active);
 112                         } else {
 113                                 channels[j].min_duration =
 114                                         cpu_to_le32(c->min_dwell_time_passive);
 115                                 channels[j].max_duration =
 116                                         cpu_to_le32(c->max_dwell_time_passive);
 117                         }
 118                         channels[j].early_termination = 0;
 119                         channels[j].tx_power_att = req->channels[i]->max_power;
 120                         channels[j].channel = req->channels[i]->hw_value;
 121
 122                         memset(&channels[j].bssid_lsb, 0xff, 4);
 123                         memset(&channels[j].bssid_msb, 0xff, 2);
 124
 125                         /* Mark the channels we already used */
 126                         set_bit(i, wl->scan.scanned_ch);
 127
 128                         j++;
 129                 }
 130         }
 131
 132         return j;
 133 }
 134
 135 #define WL1271_NOTHING_TO_SCAN 1
 136
 137 static int wl1271_scan_send(struct wl1271 *wl, enum ieee80211_band band,
 138                              bool passive, u32 basic_rate)
 139 {
 140         struct wl1271_cmd_scan *cmd;
 141         struct wl1271_cmd_trigger_scan_to *trigger;
 142         int ret;
 143         u16 scan_options = 0;
 144
 145         cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
 146         trigger = kzalloc(sizeof(*trigger), GFP_KERNEL);
 147         if (!cmd || !trigger) {
 148                 ret = -ENOMEM;
 149                 goto out;
 150         }
 151
 152         /* We always use high priority scans */
 153         scan_options = WL1271_SCAN_OPT_PRIORITY_HIGH;
 154
 155         /* No SSIDs means that we have a forced passive scan */
 156         if (passive || wl->scan.req->n_ssids == 0)
 157                 scan_options |= WL1271_SCAN_OPT_PASSIVE;
 158
 159         cmd->params.scan_options = cpu_to_le16(scan_options);
 160
 161         cmd->params.n_ch = wl1271_get_scan_channels(wl, wl->scan.req,
 162                                                     cmd->channels,
 163                                                     band, passive);
 164         if (cmd->params.n_ch == 0) {
 165                 ret = WL1271_NOTHING_TO_SCAN;
 166                 goto out;
 167         }
 168
 169         cmd->params.tx_rate = cpu_to_le32(basic_rate);
 170         cmd->params.rx_config_options = cpu_to_le32(CFG_RX_ALL_GOOD);
 171         cmd->params.rx_filter_options =
 172                 cpu_to_le32(CFG_RX_PRSP_EN | CFG_RX_MGMT_EN | CFG_RX_BCN_EN);
 173
 174         cmd->params.n_probe_reqs = wl->conf.scan.num_probe_reqs;
 175         cmd->params.tx_rate = cpu_to_le32(basic_rate);
 176         cmd->params.tid_trigger = 0;
 177         cmd->params.scan_tag = WL1271_SCAN_DEFAULT_TAG;
 178
 179         if (band == IEEE80211_BAND_2GHZ)
 180                 cmd->params.band = WL1271_SCAN_BAND_2_4_GHZ;
 181         else
 182                 cmd->params.band = WL1271_SCAN_BAND_5_GHZ;
 183
 184         if (wl->scan.ssid_len && wl->scan.ssid) {
 185                 cmd->params.ssid_len = wl->scan.ssid_len;
 186                 memcpy(cmd->params.ssid, wl->scan.ssid, wl->scan.ssid_len);
 187         }
 188
 189         ret = wl1271_cmd_build_probe_req(wl, wl->scan.ssid, wl->scan.ssid_len,
 190                                          wl->scan.req->ie, wl->scan.req->ie_len,
 191                                          band);
 192         if (ret < 0) {
 193                 wl1271_error("PROBE request template failed");
 194                 goto out;
 195         }
 196
 197         /* disable the timeout */
 198         trigger->timeout = 0;
 199         ret = wl1271_cmd_send(wl, CMD_TRIGGER_SCAN_TO, trigger,
 200                               sizeof(*trigger), 0);
 201         if (ret < 0) {
 202                 wl1271_error("trigger scan to failed for hw scan");
 203                 goto out;
 204         }
 205
 206         wl1271_dump(DEBUG_SCAN, "SCAN: ", cmd, sizeof(*cmd));
 207
 208         ret = wl1271_cmd_send(wl, CMD_SCAN, cmd, sizeof(*cmd), 0);
 209         if (ret < 0) {
 210                 wl1271_error("SCAN failed");
 211                 goto out;
 212         }
 213
 214 out:
 215         kfree(cmd);
 216         kfree(trigger);
 217         return ret;
 218 }
 219
 220 void wl1271_scan_stm(struct wl1271 *wl)
 221 {
 222         int ret = 0;
 223
 224         switch (wl->scan.state) {
 225         case WL1271_SCAN_STATE_IDLE:
 226                 break;
 227
 228         case WL1271_SCAN_STATE_2GHZ_ACTIVE:
 229                 ret = wl1271_scan_send(wl, IEEE80211_BAND_2GHZ, false,
 230                                        wl->conf.tx.basic_rate);
 231                 if (ret == WL1271_NOTHING_TO_SCAN) {
 232                         wl->scan.state = WL1271_SCAN_STATE_2GHZ_PASSIVE;
 233                         wl1271_scan_stm(wl);
 234                 }
 235
 236                 break;
 237
 238         case WL1271_SCAN_STATE_2GHZ_PASSIVE:
 239                 ret = wl1271_scan_send(wl, IEEE80211_BAND_2GHZ, true,
 240                                        wl->conf.tx.basic_rate);
 241                 if (ret == WL1271_NOTHING_TO_SCAN) {
 242                         if (wl->enable_11a)
 243                                 wl->scan.state = WL1271_SCAN_STATE_5GHZ_ACTIVE;
 244                         else
 245                                 wl->scan.state = WL1271_SCAN_STATE_DONE;
 246                         wl1271_scan_stm(wl);
 247                 }
 248
 249                 break;
 250
 251         case WL1271_SCAN_STATE_5GHZ_ACTIVE:
 252                 ret = wl1271_scan_send(wl, IEEE80211_BAND_5GHZ, false,
 253                                        wl->conf.tx.basic_rate_5);
 254                 if (ret == WL1271_NOTHING_TO_SCAN) {
 255                         wl->scan.state = WL1271_SCAN_STATE_5GHZ_PASSIVE;
 256                         wl1271_scan_stm(wl);
 257                 }
 258
 259                 break;
 260
 261         case WL1271_SCAN_STATE_5GHZ_PASSIVE:
 262                 ret = wl1271_scan_send(wl, IEEE80211_BAND_5GHZ, true,
 263                                        wl->conf.tx.basic_rate_5);
 264                 if (ret == WL1271_NOTHING_TO_SCAN) {
 265                         wl->scan.state = WL1271_SCAN_STATE_DONE;
 266                         wl1271_scan_stm(wl);
 267                 }
 268
 269                 break;
 270
 271         case WL1271_SCAN_STATE_DONE:
 272                 wl->scan.failed = false;
 273                 cancel_delayed_work(&wl->scan_complete_work);
 274                 ieee80211_queue_delayed_work(wl->hw, &wl->scan_complete_work,
 275                                              msecs_to_jiffies(0));
 276                 break;
 277
 278         default:
 279                 wl1271_error("invalid scan state");
 280                 break;
 281         }
 282
 283         if (ret < 0) {
 284                 cancel_delayed_work(&wl->scan_complete_work);
 285                 ieee80211_queue_delayed_work(wl->hw, &wl->scan_complete_work,
 286                                              msecs_to_jiffies(0));
 287         }
 288 }
 289
 290 int wl1271_scan(struct wl1271 *wl, const u8 *ssid, size_t ssid_len,
 291                 struct cfg80211_scan_request *req)
 292 {
 293         /*
 294          * cfg80211 should guarantee that we don't get more channels
 295          * than what we have registered.
 296          */
 297         BUG_ON(req->n_channels > WL1271_MAX_CHANNELS);
 298
 299         if (wl->scan.state != WL1271_SCAN_STATE_IDLE)
 300                 return -EBUSY;
 301
 302         wl->scan.state = WL1271_SCAN_STATE_2GHZ_ACTIVE;
 303
 304         if (ssid_len && ssid) {
 305                 wl->scan.ssid_len = ssid_len;
 306                 memcpy(wl->scan.ssid, ssid, ssid_len);
 307         } else {
 308                 wl->scan.ssid_len = 0;
 309         }
 310
 311         wl->scan.req = req;
 312         memset(wl->scan.scanned_ch, 0, sizeof(wl->scan.scanned_ch));
 313
 314         /* we assume failure so that timeout scenarios are handled correctly */
 315         wl->scan.failed = true;
 316         ieee80211_queue_delayed_work(wl->hw, &wl->scan_complete_work,
 317                                      msecs_to_jiffies(WL1271_SCAN_TIMEOUT));
 318
 319         wl1271_scan_stm(wl);
 320
 321         return 0;
 322 }
 323
 324 static int
 325 wl1271_scan_get_sched_scan_channels(struct wl1271 *wl,
 326                                     struct cfg80211_sched_scan_request *req,
 327                                     struct conn_scan_ch_params *channels,
 328                                     u32 band, bool radar, bool passive,
 329                                     int start)
 330 {
 331         struct conf_sched_scan_settings *c = &wl->conf.sched_scan;
 332         int i, j;
 333         u32 flags;
 334
 335         for (i = 0, j = start;
 336              i < req->n_channels && j < MAX_CHANNELS_ALL_BANDS;
 337              i++) {
 338                 flags = req->channels[i]->flags;
 339
 340                 if (!(flags & IEEE80211_CHAN_DISABLED) &&
 341                     ((flags & IEEE80211_CHAN_PASSIVE_SCAN) == passive) &&
 342                     ((flags & IEEE80211_CHAN_RADAR) == radar) &&
 343                     (req->channels[i]->band == band)) {
 344                         wl1271_debug(DEBUG_SCAN, "band %d, center_freq %d ",
 345                                      req->channels[i]->band,
 346                                      req->channels[i]->center_freq);
 347                         wl1271_debug(DEBUG_SCAN, "hw_value %d, flags %X",
 348                                      req->channels[i]->hw_value,
 349                                      req->channels[i]->flags);
 350                         wl1271_debug(DEBUG_SCAN, "max_power %d",
 351                                      req->channels[i]->max_power);
 352
 353                         if (flags & IEEE80211_CHAN_PASSIVE_SCAN) {
 354                                 channels[j].passive_duration =
 355                                         cpu_to_le16(c->dwell_time_passive);
 356                         } else {
 357                                 channels[j].min_duration =
 358                                         cpu_to_le16(c->min_dwell_time_active);
 359                                 channels[j].max_duration =
 360                                         cpu_to_le16(c->max_dwell_time_active);
 361                         }
 362                         channels[j].tx_power_att = req->channels[j]->max_power;
 363                         channels[j].channel = req->channels[i]->hw_value;
 364
 365                         j++;
 366                 }
 367         }
 368
 369         return j - start;
 370 }
 371
 372 static int
 373 wl1271_scan_sched_scan_channels(struct wl1271 *wl,
 374                                 struct cfg80211_sched_scan_request *req,
 375                                 struct wl1271_cmd_sched_scan_config *cfg)
 376 {
 377         int idx = 0;
 378
 379         cfg->passive[0] =
 380                 wl1271_scan_get_sched_scan_channels(wl, req, cfg->channels,
 381                                                     IEEE80211_BAND_2GHZ,
 382                                                     false, true, idx);
 383         idx += cfg->passive[0];
 384
 385         cfg->active[0] =
 386                 wl1271_scan_get_sched_scan_channels(wl, req, cfg->channels,
 387                                                     IEEE80211_BAND_2GHZ,
 388                                                     false, false, idx);
 389         idx += cfg->active[0];
 390
 391         cfg->passive[1] =
 392                 wl1271_scan_get_sched_scan_channels(wl, req, cfg->channels,
 393                                                     IEEE80211_BAND_5GHZ,
 394                                                     false, true, idx);
 395         idx += cfg->passive[1];
 396
 397         cfg->active[1] =
 398                 wl1271_scan_get_sched_scan_channels(wl, req, cfg->channels,
 399                                                     IEEE80211_BAND_5GHZ,
 400                                                     false, false, 14);
 401         idx += cfg->active[1];
 402
 403         cfg->dfs =
 404                 wl1271_scan_get_sched_scan_channels(wl, req, cfg->channels,
 405                                                     IEEE80211_BAND_5GHZ,
 406                                                     true, false, idx);
 407         idx += cfg->dfs;
 408
 409         wl1271_debug(DEBUG_SCAN, "    2.4GHz: active %d passive %d",
 410                      cfg->active[0], cfg->passive[0]);
 411         wl1271_debug(DEBUG_SCAN, "    5GHz: active %d passive %d",
 412                      cfg->active[1], cfg->passive[1]);
 413
 414         return idx;
 415 }
 416
 417 int wl1271_scan_sched_scan_config(struct wl1271 *wl,
 418                                   struct cfg80211_sched_scan_request *req,
 419                                   struct ieee80211_sched_scan_ies *ies)
 420 {
 421         struct wl1271_cmd_sched_scan_config *cfg = NULL;
 422         struct conf_sched_scan_settings *c = &wl->conf.sched_scan;
 423         int i, total_channels, ret;
 424
 425         wl1271_debug(DEBUG_CMD, "cmd sched_scan scan config");
 426
 427         cfg = kzalloc(sizeof(*cfg), GFP_KERNEL);
 428         if (!cfg)
 429                 return -ENOMEM;
 430
 431         cfg->rssi_threshold = c->rssi_threshold;
 432         cfg->snr_threshold  = c->snr_threshold;
 433         cfg->n_probe_reqs = c->num_probe_reqs;
 434         /* cycles set to 0 it means infinite (until manually stopped) */
 435         cfg->cycles = 0;
 436         /* report APs when at least 1 is found */
 437         cfg->report_after = 1;
 438         /* don't stop scanning automatically when something is found */
 439         cfg->terminate = 0;
 440         cfg->tag = WL1271_SCAN_DEFAULT_TAG;
 441         /* don't filter on BSS type */
 442         cfg->bss_type = SCAN_BSS_TYPE_ANY;
 443         /* currently NL80211 supports only a single interval */
 444         for (i = 0; i < SCAN_MAX_CYCLE_INTERVALS; i++)
 445                 cfg->intervals[i] = cpu_to_le32(req->interval);
 446
 447         if (req->ssids[0].ssid_len && req->ssids[0].ssid) {
 448                 cfg->filter_type = SCAN_SSID_FILTER_SPECIFIC;
 449                 cfg->ssid_len = req->ssids[0].ssid_len;
 450                 memcpy(cfg->ssid, req->ssids[0].ssid,
 451                        req->ssids[0].ssid_len);
 452         } else {
 453                 cfg->filter_type = SCAN_SSID_FILTER_ANY;
 454                 cfg->ssid_len = 0;
 455         }
 456
 457         total_channels = wl1271_scan_sched_scan_channels(wl, req, cfg);
 458         if (total_channels == 0) {
 459                 wl1271_error("scan channel list is empty");
 460                 ret = -EINVAL;
 461                 goto out;
 462         }
 463
 464         if (cfg->active[0]) {
 465                 ret = wl1271_cmd_build_probe_req(wl, req->ssids[0].ssid,
 466                                                  req->ssids[0].ssid_len,
 467                                                  ies->ie[IEEE80211_BAND_2GHZ],
 468                                                  ies->len[IEEE80211_BAND_2GHZ],
 469                                                  IEEE80211_BAND_2GHZ);
 470                 if (ret < 0) {
 471                         wl1271_error("2.4GHz PROBE request template failed");
 472                         goto out;
 473                 }
 474         }
 475
 476         if (cfg->active[1]) {
 477                 ret = wl1271_cmd_build_probe_req(wl,  req->ssids[0].ssid,
 478                                                  req->ssids[0].ssid_len,
 479                                                  ies->ie[IEEE80211_BAND_5GHZ],
 480                                                  ies->len[IEEE80211_BAND_5GHZ],
 481                                                  IEEE80211_BAND_5GHZ);
 482                 if (ret < 0) {
 483                         wl1271_error("5GHz PROBE request template failed");
 484                         goto out;
 485                 }
 486         }
 487
 488         wl1271_dump(DEBUG_SCAN, "SCAN_CFG: ", cfg, sizeof(*cfg));
 489
 490         ret = wl1271_cmd_send(wl, CMD_CONNECTION_SCAN_CFG, cfg,
 491                               sizeof(*cfg), 0);
 492         if (ret < 0) {
 493                 wl1271_error("SCAN configuration failed");
 494                 goto out;
 495         }
 496 out:
 497         kfree(cfg);
 498         return ret;
 499 }
 500
 501 int wl1271_scan_sched_scan_start(struct wl1271 *wl)
 502 {
 503         struct wl1271_cmd_sched_scan_start *start;
 504         int ret = 0;
 505
 506         wl1271_debug(DEBUG_CMD, "cmd periodic scan start");
 507
 508         if (wl->bss_type != BSS_TYPE_STA_BSS)
 509                 return -EOPNOTSUPP;
 510
 511         if (!test_bit(WL1271_FLAG_IDLE, &wl->flags))
 512                 return -EBUSY;
 513
 514         start = kzalloc(sizeof(*start), GFP_KERNEL);
 515         if (!start)
 516                 return -ENOMEM;
 517
 518         start->tag = WL1271_SCAN_DEFAULT_TAG;
 519
 520         ret = wl1271_cmd_send(wl, CMD_START_PERIODIC_SCAN, start,
 521                               sizeof(*start), 0);
 522         if (ret < 0) {
 523                 wl1271_error("failed to send scan start command");
 524                 goto out_free;
 525         }
 526
 527 out_free:
 528         kfree(start);
 529         return ret;
 530 }
 531
 532 void wl1271_scan_sched_scan_results(struct wl1271 *wl)
 533 {
 534         wl1271_debug(DEBUG_SCAN, "got periodic scan results");
 535
 536         ieee80211_sched_scan_results(wl->hw);
 537 }
 538
 539 void wl1271_scan_sched_scan_stop(struct wl1271 *wl)
 540 {
 541         struct wl1271_cmd_sched_scan_stop *stop;
 542         int ret = 0;
 543
 544         wl1271_debug(DEBUG_CMD, "cmd periodic scan stop");
 545
 546         /* FIXME: what to do if alloc'ing to stop fails? */
 547         stop = kzalloc(sizeof(*stop), GFP_KERNEL);
 548         if (!stop) {
 549                 wl1271_error("failed to alloc memory to send sched scan stop");
 550                 return;
 551         }
 552
 553         stop->tag = WL1271_SCAN_DEFAULT_TAG;
 554
 555         ret = wl1271_cmd_send(wl, CMD_STOP_PERIODIC_SCAN, stop,
 556                               sizeof(*stop), 0);
 557         if (ret < 0) {
 558                 wl1271_error("failed to send sched scan stop command");
 559                 goto out_free;
 560         }
 561         wl->sched_scanning = false;
 562
 563 out_free:
 564         kfree(stop);
 565 }