linux/drivers/net/wireless/intel/iwlwifi/mvm/scan.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
   2/*
   3 * Copyright (C) 2012-2014, 2018-2021 Intel Corporation
   4 * Copyright (C) 2013-2015 Intel Mobile Communications GmbH
   5 * Copyright (C) 2016-2017 Intel Deutschland GmbH
   6 */
   7#include <linux/etherdevice.h>
   8#include <net/mac80211.h>
   9#include <linux/crc32.h>
  10
  11#include "mvm.h"
  12#include "fw/api/scan.h"
  13#include "iwl-io.h"
  14
  15#define IWL_DENSE_EBS_SCAN_RATIO 5
  16#define IWL_SPARSE_EBS_SCAN_RATIO 1
  17
  18#define IWL_SCAN_DWELL_ACTIVE           10
  19#define IWL_SCAN_DWELL_PASSIVE          110
  20#define IWL_SCAN_DWELL_FRAGMENTED       44
  21#define IWL_SCAN_DWELL_EXTENDED         90
  22#define IWL_SCAN_NUM_OF_FRAGS           3
  23#define IWL_SCAN_LAST_2_4_CHN           14
  24
  25/* adaptive dwell max budget time [TU] for full scan */
  26#define IWL_SCAN_ADWELL_MAX_BUDGET_FULL_SCAN 300
  27/* adaptive dwell max budget time [TU] for directed scan */
  28#define IWL_SCAN_ADWELL_MAX_BUDGET_DIRECTED_SCAN 100
  29/* adaptive dwell default high band APs number */
  30#define IWL_SCAN_ADWELL_DEFAULT_HB_N_APS 8
  31/* adaptive dwell default low band APs number */
  32#define IWL_SCAN_ADWELL_DEFAULT_LB_N_APS 2
  33/* adaptive dwell default APs number in social channels (1, 6, 11) */
  34#define IWL_SCAN_ADWELL_DEFAULT_N_APS_SOCIAL 10
  35/* number of scan channels */
  36#define IWL_SCAN_NUM_CHANNELS 112
  37/* adaptive dwell number of APs override mask for p2p friendly GO */
  38#define IWL_SCAN_ADWELL_N_APS_GO_FRIENDLY_BIT BIT(20)
  39/* adaptive dwell number of APs override mask for social channels */
  40#define IWL_SCAN_ADWELL_N_APS_SOCIAL_CHS_BIT BIT(21)
  41/* adaptive dwell number of APs override for p2p friendly GO channels */
  42#define IWL_SCAN_ADWELL_N_APS_GO_FRIENDLY 10
  43/* adaptive dwell number of APs override for social channels */
  44#define IWL_SCAN_ADWELL_N_APS_SOCIAL_CHS 2
  45
  46/* minimal number of 2GHz and 5GHz channels in the regular scan request */
  47#define IWL_MVM_6GHZ_PASSIVE_SCAN_MIN_CHANS 4
  48
  49struct iwl_mvm_scan_timing_params {
  50        u32 suspend_time;
  51        u32 max_out_time;
  52};
  53
  54static struct iwl_mvm_scan_timing_params scan_timing[] = {
  55        [IWL_SCAN_TYPE_UNASSOC] = {
  56                .suspend_time = 0,
  57                .max_out_time = 0,
  58        },
  59        [IWL_SCAN_TYPE_WILD] = {
  60                .suspend_time = 30,
  61                .max_out_time = 120,
  62        },
  63        [IWL_SCAN_TYPE_MILD] = {
  64                .suspend_time = 120,
  65                .max_out_time = 120,
  66        },
  67        [IWL_SCAN_TYPE_FRAGMENTED] = {
  68                .suspend_time = 95,
  69                .max_out_time = 44,
  70        },
  71        [IWL_SCAN_TYPE_FAST_BALANCE] = {
  72                .suspend_time = 30,
  73                .max_out_time = 37,
  74        },
  75};
  76
  77struct iwl_mvm_scan_params {
  78        /* For CDB this is low band scan type, for non-CDB - type. */
  79        enum iwl_mvm_scan_type type;
  80        enum iwl_mvm_scan_type hb_type;
  81        u32 n_channels;
  82        u16 delay;
  83        int n_ssids;
  84        struct cfg80211_ssid *ssids;
  85        struct ieee80211_channel **channels;
  86        u32 flags;
  87        u8 *mac_addr;
  88        u8 *mac_addr_mask;
  89        bool no_cck;
  90        bool pass_all;
  91        int n_match_sets;
  92        struct iwl_scan_probe_req preq;
  93        struct cfg80211_match_set *match_sets;
  94        int n_scan_plans;
  95        struct cfg80211_sched_scan_plan *scan_plans;
  96        bool iter_notif;
  97        struct cfg80211_scan_6ghz_params *scan_6ghz_params;
  98        u32 n_6ghz_params;
  99        bool scan_6ghz;
 100        bool enable_6ghz_passive;
 101};
 102
 103static inline void *iwl_mvm_get_scan_req_umac_data(struct iwl_mvm *mvm)
 104{
 105        struct iwl_scan_req_umac *cmd = mvm->scan_cmd;
 106
 107        if (iwl_mvm_is_adaptive_dwell_v2_supported(mvm))
 108                return (void *)&cmd->v8.data;
 109
 110        if (iwl_mvm_is_adaptive_dwell_supported(mvm))
 111                return (void *)&cmd->v7.data;
 112
 113        if (iwl_mvm_cdb_scan_api(mvm))
 114                return (void *)&cmd->v6.data;
 115
 116        return (void *)&cmd->v1.data;
 117}
 118
 119static inline struct iwl_scan_umac_chan_param *
 120iwl_mvm_get_scan_req_umac_channel(struct iwl_mvm *mvm)
 121{
 122        struct iwl_scan_req_umac *cmd = mvm->scan_cmd;
 123
 124        if (iwl_mvm_is_adaptive_dwell_v2_supported(mvm))
 125                return &cmd->v8.channel;
 126
 127        if (iwl_mvm_is_adaptive_dwell_supported(mvm))
 128                return &cmd->v7.channel;
 129
 130        if (iwl_mvm_cdb_scan_api(mvm))
 131                return &cmd->v6.channel;
 132
 133        return &cmd->v1.channel;
 134}
 135
 136static u8 iwl_mvm_scan_rx_ant(struct iwl_mvm *mvm)
 137{
 138        if (mvm->scan_rx_ant != ANT_NONE)
 139                return mvm->scan_rx_ant;
 140        return iwl_mvm_get_valid_rx_ant(mvm);
 141}
 142
 143static inline __le16 iwl_mvm_scan_rx_chain(struct iwl_mvm *mvm)
 144{
 145        u16 rx_chain;
 146        u8 rx_ant;
 147
 148        rx_ant = iwl_mvm_scan_rx_ant(mvm);
 149        rx_chain = rx_ant << PHY_RX_CHAIN_VALID_POS;
 150        rx_chain |= rx_ant << PHY_RX_CHAIN_FORCE_MIMO_SEL_POS;
 151        rx_chain |= rx_ant << PHY_RX_CHAIN_FORCE_SEL_POS;
 152        rx_chain |= 0x1 << PHY_RX_CHAIN_DRIVER_FORCE_POS;
 153        return cpu_to_le16(rx_chain);
 154}
 155
 156static inline __le32
 157iwl_mvm_scan_rate_n_flags(struct iwl_mvm *mvm, enum nl80211_band band,
 158                          bool no_cck)
 159{
 160        u32 tx_ant;
 161
 162        iwl_mvm_toggle_tx_ant(mvm, &mvm->scan_last_antenna_idx);
 163        tx_ant = BIT(mvm->scan_last_antenna_idx) << RATE_MCS_ANT_POS;
 164
 165        if (band == NL80211_BAND_2GHZ && !no_cck)
 166                return cpu_to_le32(IWL_RATE_1M_PLCP | RATE_MCS_CCK_MSK |
 167                                   tx_ant);
 168        else
 169                return cpu_to_le32(IWL_RATE_6M_PLCP | tx_ant);
 170}
 171
 172static void iwl_mvm_scan_condition_iterator(void *data, u8 *mac,
 173                                            struct ieee80211_vif *vif)
 174{
 175        struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
 176        int *global_cnt = data;
 177
 178        if (vif->type != NL80211_IFTYPE_P2P_DEVICE && mvmvif->phy_ctxt &&
 179            mvmvif->phy_ctxt->id < NUM_PHY_CTX)
 180                *global_cnt += 1;
 181}
 182
 183static enum iwl_mvm_traffic_load iwl_mvm_get_traffic_load(struct iwl_mvm *mvm)
 184{
 185        return mvm->tcm.result.global_load;
 186}
 187
 188static enum iwl_mvm_traffic_load
 189iwl_mvm_get_traffic_load_band(struct iwl_mvm *mvm, enum nl80211_band band)
 190{
 191        return mvm->tcm.result.band_load[band];
 192}
 193
 194struct iwl_is_dcm_with_go_iterator_data {
 195        struct ieee80211_vif *current_vif;
 196        bool is_dcm_with_p2p_go;
 197};
 198
 199static void iwl_mvm_is_dcm_with_go_iterator(void *_data, u8 *mac,
 200                                            struct ieee80211_vif *vif)
 201{
 202        struct iwl_is_dcm_with_go_iterator_data *data = _data;
 203        struct iwl_mvm_vif *other_mvmvif = iwl_mvm_vif_from_mac80211(vif);
 204        struct iwl_mvm_vif *curr_mvmvif =
 205                iwl_mvm_vif_from_mac80211(data->current_vif);
 206
 207        /* exclude the given vif */
 208        if (vif == data->current_vif)
 209                return;
 210
 211        if (vif->type == NL80211_IFTYPE_AP && vif->p2p &&
 212            other_mvmvif->phy_ctxt && curr_mvmvif->phy_ctxt &&
 213            other_mvmvif->phy_ctxt->id != curr_mvmvif->phy_ctxt->id)
 214                data->is_dcm_with_p2p_go = true;
 215}
 216
 217static enum
 218iwl_mvm_scan_type _iwl_mvm_get_scan_type(struct iwl_mvm *mvm,
 219                                         struct ieee80211_vif *vif,
 220                                         enum iwl_mvm_traffic_load load,
 221                                         bool low_latency)
 222{
 223        int global_cnt = 0;
 224
 225        ieee80211_iterate_active_interfaces_atomic(mvm->hw,
 226                                            IEEE80211_IFACE_ITER_NORMAL,
 227                                            iwl_mvm_scan_condition_iterator,
 228                                            &global_cnt);
 229        if (!global_cnt)
 230                return IWL_SCAN_TYPE_UNASSOC;
 231
 232        if (fw_has_api(&mvm->fw->ucode_capa,
 233                       IWL_UCODE_TLV_API_FRAGMENTED_SCAN)) {
 234                if ((load == IWL_MVM_TRAFFIC_HIGH || low_latency) &&
 235                    (!vif || vif->type != NL80211_IFTYPE_P2P_DEVICE))
 236                        return IWL_SCAN_TYPE_FRAGMENTED;
 237
 238                /* in case of DCM with GO where BSS DTIM interval < 220msec
 239                 * set all scan requests as fast-balance scan
 240                 * */
 241                if (vif && vif->type == NL80211_IFTYPE_STATION &&
 242                    vif->bss_conf.dtim_period < 220) {
 243                        struct iwl_is_dcm_with_go_iterator_data data = {
 244                                .current_vif = vif,
 245                                .is_dcm_with_p2p_go = false,
 246                        };
 247
 248                        ieee80211_iterate_active_interfaces_atomic(mvm->hw,
 249                                                IEEE80211_IFACE_ITER_NORMAL,
 250                                                iwl_mvm_is_dcm_with_go_iterator,
 251                                                &data);
 252                        if (data.is_dcm_with_p2p_go)
 253                                return IWL_SCAN_TYPE_FAST_BALANCE;
 254                }
 255        }
 256
 257        if (load >= IWL_MVM_TRAFFIC_MEDIUM || low_latency)
 258                return IWL_SCAN_TYPE_MILD;
 259
 260        return IWL_SCAN_TYPE_WILD;
 261}
 262
 263static enum
 264iwl_mvm_scan_type iwl_mvm_get_scan_type(struct iwl_mvm *mvm,
 265                                        struct ieee80211_vif *vif)
 266{
 267        enum iwl_mvm_traffic_load load;
 268        bool low_latency;
 269
 270        load = iwl_mvm_get_traffic_load(mvm);
 271        low_latency = iwl_mvm_low_latency(mvm);
 272
 273        return _iwl_mvm_get_scan_type(mvm, vif, load, low_latency);
 274}
 275
 276static enum
 277iwl_mvm_scan_type iwl_mvm_get_scan_type_band(struct iwl_mvm *mvm,
 278                                             struct ieee80211_vif *vif,
 279                                             enum nl80211_band band)
 280{
 281        enum iwl_mvm_traffic_load load;
 282        bool low_latency;
 283
 284        load = iwl_mvm_get_traffic_load_band(mvm, band);
 285        low_latency = iwl_mvm_low_latency_band(mvm, band);
 286
 287        return _iwl_mvm_get_scan_type(mvm, vif, load, low_latency);
 288}
 289
 290static inline bool iwl_mvm_rrm_scan_needed(struct iwl_mvm *mvm)
 291{
 292        /* require rrm scan whenever the fw supports it */
 293        return fw_has_capa(&mvm->fw->ucode_capa,
 294                           IWL_UCODE_TLV_CAPA_DS_PARAM_SET_IE_SUPPORT);
 295}
 296
 297static int iwl_mvm_max_scan_ie_fw_cmd_room(struct iwl_mvm *mvm)
 298{
 299        int max_probe_len;
 300
 301        max_probe_len = SCAN_OFFLOAD_PROBE_REQ_SIZE;
 302
 303        /* we create the 802.11 header and SSID element */
 304        max_probe_len -= 24 + 2;
 305
 306        /* DS parameter set element is added on 2.4GHZ band if required */
 307        if (iwl_mvm_rrm_scan_needed(mvm))
 308                max_probe_len -= 3;
 309
 310        return max_probe_len;
 311}
 312
 313int iwl_mvm_max_scan_ie_len(struct iwl_mvm *mvm)
 314{
 315        int max_ie_len = iwl_mvm_max_scan_ie_fw_cmd_room(mvm);
 316
 317        /* TODO: [BUG] This function should return the maximum allowed size of
 318         * scan IEs, however the LMAC scan api contains both 2GHZ and 5GHZ IEs
 319         * in the same command. So the correct implementation of this function
 320         * is just iwl_mvm_max_scan_ie_fw_cmd_room() / 2. Currently the scan
 321         * command has only 512 bytes and it would leave us with about 240
 322         * bytes for scan IEs, which is clearly not enough. So meanwhile
 323         * we will report an incorrect value. This may result in a failure to
 324         * issue a scan in unified_scan_lmac and unified_sched_scan_lmac
 325         * functions with -ENOBUFS, if a large enough probe will be provided.
 326         */
 327        return max_ie_len;
 328}
 329
 330void iwl_mvm_rx_lmac_scan_iter_complete_notif(struct iwl_mvm *mvm,
 331                                              struct iwl_rx_cmd_buffer *rxb)
 332{
 333        struct iwl_rx_packet *pkt = rxb_addr(rxb);
 334        struct iwl_lmac_scan_complete_notif *notif = (void *)pkt->data;
 335
 336        IWL_DEBUG_SCAN(mvm,
 337                       "Scan offload iteration complete: status=0x%x scanned channels=%d\n",
 338                       notif->status, notif->scanned_channels);
 339
 340        if (mvm->sched_scan_pass_all == SCHED_SCAN_PASS_ALL_FOUND) {
 341                IWL_DEBUG_SCAN(mvm, "Pass all scheduled scan results found\n");
 342                ieee80211_sched_scan_results(mvm->hw);
 343                mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_ENABLED;
 344        }
 345}
 346
 347void iwl_mvm_rx_scan_match_found(struct iwl_mvm *mvm,
 348                                 struct iwl_rx_cmd_buffer *rxb)
 349{
 350        IWL_DEBUG_SCAN(mvm, "Scheduled scan results\n");
 351        ieee80211_sched_scan_results(mvm->hw);
 352}
 353
 354static const char *iwl_mvm_ebs_status_str(enum iwl_scan_ebs_status status)
 355{
 356        switch (status) {
 357        case IWL_SCAN_EBS_SUCCESS:
 358                return "successful";
 359        case IWL_SCAN_EBS_INACTIVE:
 360                return "inactive";
 361        case IWL_SCAN_EBS_FAILED:
 362        case IWL_SCAN_EBS_CHAN_NOT_FOUND:
 363        default:
 364                return "failed";
 365        }
 366}
 367
 368void iwl_mvm_rx_lmac_scan_complete_notif(struct iwl_mvm *mvm,
 369                                         struct iwl_rx_cmd_buffer *rxb)
 370{
 371        struct iwl_rx_packet *pkt = rxb_addr(rxb);
 372        struct iwl_periodic_scan_complete *scan_notif = (void *)pkt->data;
 373        bool aborted = (scan_notif->status == IWL_SCAN_OFFLOAD_ABORTED);
 374
 375        /* If this happens, the firmware has mistakenly sent an LMAC
 376         * notification during UMAC scans -- warn and ignore it.
 377         */
 378        if (WARN_ON_ONCE(fw_has_capa(&mvm->fw->ucode_capa,
 379                                     IWL_UCODE_TLV_CAPA_UMAC_SCAN)))
 380                return;
 381
 382        /* scan status must be locked for proper checking */
 383        lockdep_assert_held(&mvm->mutex);
 384
 385        /* We first check if we were stopping a scan, in which case we
 386         * just clear the stopping flag.  Then we check if it was a
 387         * firmware initiated stop, in which case we need to inform
 388         * mac80211.
 389         * Note that we can have a stopping and a running scan
 390         * simultaneously, but we can't have two different types of
 391         * scans stopping or running at the same time (since LMAC
 392         * doesn't support it).
 393         */
 394
 395        if (mvm->scan_status & IWL_MVM_SCAN_STOPPING_SCHED) {
 396                WARN_ON_ONCE(mvm->scan_status & IWL_MVM_SCAN_STOPPING_REGULAR);
 397
 398                IWL_DEBUG_SCAN(mvm, "Scheduled scan %s, EBS status %s\n",
 399                               aborted ? "aborted" : "completed",
 400                               iwl_mvm_ebs_status_str(scan_notif->ebs_status));
 401                IWL_DEBUG_SCAN(mvm,
 402                               "Last line %d, Last iteration %d, Time after last iteration %d\n",
 403                               scan_notif->last_schedule_line,
 404                               scan_notif->last_schedule_iteration,
 405                               __le32_to_cpu(scan_notif->time_after_last_iter));
 406
 407                mvm->scan_status &= ~IWL_MVM_SCAN_STOPPING_SCHED;
 408        } else if (mvm->scan_status & IWL_MVM_SCAN_STOPPING_REGULAR) {
 409                IWL_DEBUG_SCAN(mvm, "Regular scan %s, EBS status %s\n",
 410                               aborted ? "aborted" : "completed",
 411                               iwl_mvm_ebs_status_str(scan_notif->ebs_status));
 412
 413                mvm->scan_status &= ~IWL_MVM_SCAN_STOPPING_REGULAR;
 414        } else if (mvm->scan_status & IWL_MVM_SCAN_SCHED) {
 415                WARN_ON_ONCE(mvm->scan_status & IWL_MVM_SCAN_REGULAR);
 416
 417                IWL_DEBUG_SCAN(mvm, "Scheduled scan %s, EBS status %s\n",
 418                               aborted ? "aborted" : "completed",
 419                               iwl_mvm_ebs_status_str(scan_notif->ebs_status));
 420                IWL_DEBUG_SCAN(mvm,
 421                               "Last line %d, Last iteration %d, Time after last iteration %d (FW)\n",
 422                               scan_notif->last_schedule_line,
 423                               scan_notif->last_schedule_iteration,
 424                               __le32_to_cpu(scan_notif->time_after_last_iter));
 425
 426                mvm->scan_status &= ~IWL_MVM_SCAN_SCHED;
 427                ieee80211_sched_scan_stopped(mvm->hw);
 428                mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_DISABLED;
 429        } else if (mvm->scan_status & IWL_MVM_SCAN_REGULAR) {
 430                struct cfg80211_scan_info info = {
 431                        .aborted = aborted,
 432                };
 433
 434                IWL_DEBUG_SCAN(mvm, "Regular scan %s, EBS status %s (FW)\n",
 435                               aborted ? "aborted" : "completed",
 436                               iwl_mvm_ebs_status_str(scan_notif->ebs_status));
 437
 438                mvm->scan_status &= ~IWL_MVM_SCAN_REGULAR;
 439                ieee80211_scan_completed(mvm->hw, &info);
 440                cancel_delayed_work(&mvm->scan_timeout_dwork);
 441                iwl_mvm_resume_tcm(mvm);
 442        } else {
 443                IWL_ERR(mvm,
 444                        "got scan complete notification but no scan is running\n");
 445        }
 446
 447        mvm->last_ebs_successful =
 448                        scan_notif->ebs_status == IWL_SCAN_EBS_SUCCESS ||
 449                        scan_notif->ebs_status == IWL_SCAN_EBS_INACTIVE;
 450}
 451
 452static int iwl_ssid_exist(u8 *ssid, u8 ssid_len, struct iwl_ssid_ie *ssid_list)
 453{
 454        int i;
 455
 456        for (i = 0; i < PROBE_OPTION_MAX; i++) {
 457                if (!ssid_list[i].len)
 458                        break;
 459                if (ssid_list[i].len == ssid_len &&
 460                    !memcmp(ssid_list->ssid, ssid, ssid_len))
 461                        return i;
 462        }
 463        return -1;
 464}
 465
 466/* We insert the SSIDs in an inverted order, because the FW will
 467 * invert it back.
 468 */
 469static void iwl_scan_build_ssids(struct iwl_mvm_scan_params *params,
 470                                 struct iwl_ssid_ie *ssids,
 471                                 u32 *ssid_bitmap)
 472{
 473        int i, j;
 474        int index;
 475        u32 tmp_bitmap = 0;
 476
 477        /*
 478         * copy SSIDs from match list.
 479         * iwl_config_sched_scan_profiles() uses the order of these ssids to
 480         * config match list.
 481         */
 482        for (i = 0, j = params->n_match_sets - 1;
 483             j >= 0 && i < PROBE_OPTION_MAX;
 484             i++, j--) {
 485                /* skip empty SSID matchsets */
 486                if (!params->match_sets[j].ssid.ssid_len)
 487                        continue;
 488                ssids[i].id = WLAN_EID_SSID;
 489                ssids[i].len = params->match_sets[j].ssid.ssid_len;
 490                memcpy(ssids[i].ssid, params->match_sets[j].ssid.ssid,
 491                       ssids[i].len);
 492        }
 493
 494        /* add SSIDs from scan SSID list */
 495        for (j = params->n_ssids - 1;
 496             j >= 0 && i < PROBE_OPTION_MAX;
 497             i++, j--) {
 498                index = iwl_ssid_exist(params->ssids[j].ssid,
 499                                       params->ssids[j].ssid_len,
 500                                       ssids);
 501                if (index < 0) {
 502                        ssids[i].id = WLAN_EID_SSID;
 503                        ssids[i].len = params->ssids[j].ssid_len;
 504                        memcpy(ssids[i].ssid, params->ssids[j].ssid,
 505                               ssids[i].len);
 506                        tmp_bitmap |= BIT(i);
 507                } else {
 508                        tmp_bitmap |= BIT(index);
 509                }
 510        }
 511        if (ssid_bitmap)
 512                *ssid_bitmap = tmp_bitmap;
 513}
 514
 515static int
 516iwl_mvm_config_sched_scan_profiles(struct iwl_mvm *mvm,
 517                                   struct cfg80211_sched_scan_request *req)
 518{
 519        struct iwl_scan_offload_profile *profile;
 520        struct iwl_scan_offload_profile_cfg_v1 *profile_cfg_v1;
 521        struct iwl_scan_offload_blocklist *blocklist;
 522        struct iwl_scan_offload_profile_cfg_data *data;
 523        int max_profiles = iwl_umac_scan_get_max_profiles(mvm->fw);
 524        int profile_cfg_size = sizeof(*data) +
 525                sizeof(*profile) * max_profiles;
 526        struct iwl_host_cmd cmd = {
 527                .id = SCAN_OFFLOAD_UPDATE_PROFILES_CMD,
 528                .len[1] = profile_cfg_size,
 529                .dataflags[0] = IWL_HCMD_DFL_NOCOPY,
 530                .dataflags[1] = IWL_HCMD_DFL_NOCOPY,
 531        };
 532        int blocklist_len;
 533        int i;
 534        int ret;
 535
 536        if (WARN_ON(req->n_match_sets > max_profiles))
 537                return -EIO;
 538
 539        if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_SHORT_BL)
 540                blocklist_len = IWL_SCAN_SHORT_BLACKLIST_LEN;
 541        else
 542                blocklist_len = IWL_SCAN_MAX_BLACKLIST_LEN;
 543
 544        blocklist = kcalloc(blocklist_len, sizeof(*blocklist), GFP_KERNEL);
 545        if (!blocklist)
 546                return -ENOMEM;
 547
 548        profile_cfg_v1 = kzalloc(profile_cfg_size, GFP_KERNEL);
 549        if (!profile_cfg_v1) {
 550                ret = -ENOMEM;
 551                goto free_blocklist;
 552        }
 553
 554        cmd.data[0] = blocklist;
 555        cmd.len[0] = sizeof(*blocklist) * blocklist_len;
 556        cmd.data[1] = profile_cfg_v1;
 557
 558        /* if max_profile is MAX_PROFILES_V2, we have the new API */
 559        if (max_profiles == IWL_SCAN_MAX_PROFILES_V2) {
 560                struct iwl_scan_offload_profile_cfg *profile_cfg =
 561                        (struct iwl_scan_offload_profile_cfg *)profile_cfg_v1;
 562
 563                data = &profile_cfg->data;
 564        } else {
 565                data = &profile_cfg_v1->data;
 566        }
 567
 568        /* No blocklist configuration */
 569        data->num_profiles = req->n_match_sets;
 570        data->active_clients = SCAN_CLIENT_SCHED_SCAN;
 571        data->pass_match = SCAN_CLIENT_SCHED_SCAN;
 572        data->match_notify = SCAN_CLIENT_SCHED_SCAN;
 573
 574        if (!req->n_match_sets || !req->match_sets[0].ssid.ssid_len)
 575                data->any_beacon_notify = SCAN_CLIENT_SCHED_SCAN;
 576
 577        for (i = 0; i < req->n_match_sets; i++) {
 578                profile = &profile_cfg_v1->profiles[i];
 579                profile->ssid_index = i;
 580                /* Support any cipher and auth algorithm */
 581                profile->unicast_cipher = 0xff;
 582                profile->auth_alg = 0xff;
 583                profile->network_type = IWL_NETWORK_TYPE_ANY;
 584                profile->band_selection = IWL_SCAN_OFFLOAD_SELECT_ANY;
 585                profile->client_bitmap = SCAN_CLIENT_SCHED_SCAN;
 586        }
 587
 588        IWL_DEBUG_SCAN(mvm, "Sending scheduled scan profile config\n");
 589
 590        ret = iwl_mvm_send_cmd(mvm, &cmd);
 591        kfree(profile_cfg_v1);
 592free_blocklist:
 593        kfree(blocklist);
 594
 595        return ret;
 596}
 597
 598static bool iwl_mvm_scan_pass_all(struct iwl_mvm *mvm,
 599                                  struct cfg80211_sched_scan_request *req)
 600{
 601        if (req->n_match_sets && req->match_sets[0].ssid.ssid_len) {
 602                IWL_DEBUG_SCAN(mvm,
 603                               "Sending scheduled scan with filtering, n_match_sets %d\n",
 604                               req->n_match_sets);
 605                mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_DISABLED;
 606                return false;
 607        }
 608
 609        IWL_DEBUG_SCAN(mvm, "Sending Scheduled scan without filtering\n");
 610
 611        mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_ENABLED;
 612        return true;
 613}
 614
 615static int iwl_mvm_lmac_scan_abort(struct iwl_mvm *mvm)
 616{
 617        int ret;
 618        struct iwl_host_cmd cmd = {
 619                .id = SCAN_OFFLOAD_ABORT_CMD,
 620        };
 621        u32 status = CAN_ABORT_STATUS;
 622
 623        ret = iwl_mvm_send_cmd_status(mvm, &cmd, &status);
 624        if (ret)
 625                return ret;
 626
 627        if (status != CAN_ABORT_STATUS) {
 628                /*
 629                 * The scan abort will return 1 for success or
 630                 * 2 for "failure".  A failure condition can be
 631                 * due to simply not being in an active scan which
 632                 * can occur if we send the scan abort before the
 633                 * microcode has notified us that a scan is completed.
 634                 */
 635                IWL_DEBUG_SCAN(mvm, "SCAN OFFLOAD ABORT ret %d.\n", status);
 636                ret = -ENOENT;
 637        }
 638
 639        return ret;
 640}
 641
 642static void iwl_mvm_scan_fill_tx_cmd(struct iwl_mvm *mvm,
 643                                     struct iwl_scan_req_tx_cmd *tx_cmd,
 644                                     bool no_cck)
 645{
 646        tx_cmd[0].tx_flags = cpu_to_le32(TX_CMD_FLG_SEQ_CTL |
 647                                         TX_CMD_FLG_BT_DIS);
 648        tx_cmd[0].rate_n_flags = iwl_mvm_scan_rate_n_flags(mvm,
 649                                                           NL80211_BAND_2GHZ,
 650                                                           no_cck);
 651
 652        if (iwl_fw_lookup_cmd_ver(mvm->fw, LONG_GROUP,
 653                                  ADD_STA,
 654                                  0) < 12) {
 655                tx_cmd[0].sta_id = mvm->aux_sta.sta_id;
 656                tx_cmd[1].sta_id = mvm->aux_sta.sta_id;
 657
 658        /*
 659         * Fw doesn't use this sta anymore, pending deprecation via HOST API
 660         * change
 661         */
 662        } else {
 663                tx_cmd[0].sta_id = 0xff;
 664                tx_cmd[1].sta_id = 0xff;
 665        }
 666
 667        tx_cmd[1].tx_flags = cpu_to_le32(TX_CMD_FLG_SEQ_CTL |
 668                                         TX_CMD_FLG_BT_DIS);
 669
 670        tx_cmd[1].rate_n_flags = iwl_mvm_scan_rate_n_flags(mvm,
 671                                                           NL80211_BAND_5GHZ,
 672                                                           no_cck);
 673}
 674
 675static void
 676iwl_mvm_lmac_scan_cfg_channels(struct iwl_mvm *mvm,
 677                               struct ieee80211_channel **channels,
 678                               int n_channels, u32 ssid_bitmap,
 679                               struct iwl_scan_req_lmac *cmd)
 680{
 681        struct iwl_scan_channel_cfg_lmac *channel_cfg = (void *)&cmd->data;
 682        int i;
 683
 684        for (i = 0; i < n_channels; i++) {
 685                channel_cfg[i].channel_num =
 686                        cpu_to_le16(channels[i]->hw_value);
 687                channel_cfg[i].iter_count = cpu_to_le16(1);
 688                channel_cfg[i].iter_interval = 0;
 689                channel_cfg[i].flags =
 690                        cpu_to_le32(IWL_UNIFIED_SCAN_CHANNEL_PARTIAL |
 691                                    ssid_bitmap);
 692        }
 693}
 694
 695static u8 *iwl_mvm_copy_and_insert_ds_elem(struct iwl_mvm *mvm, const u8 *ies,
 696                                           size_t len, u8 *const pos)
 697{
 698        static const u8 before_ds_params[] = {
 699                        WLAN_EID_SSID,
 700                        WLAN_EID_SUPP_RATES,
 701                        WLAN_EID_REQUEST,
 702                        WLAN_EID_EXT_SUPP_RATES,
 703        };
 704        size_t offs;
 705        u8 *newpos = pos;
 706
 707        if (!iwl_mvm_rrm_scan_needed(mvm)) {
 708                memcpy(newpos, ies, len);
 709                return newpos + len;
 710        }
 711
 712        offs = ieee80211_ie_split(ies, len,
 713                                  before_ds_params,
 714                                  ARRAY_SIZE(before_ds_params),
 715                                  0);
 716
 717        memcpy(newpos, ies, offs);
 718        newpos += offs;
 719
 720        /* Add a placeholder for DS Parameter Set element */
 721        *newpos++ = WLAN_EID_DS_PARAMS;
 722        *newpos++ = 1;
 723        *newpos++ = 0;
 724
 725        memcpy(newpos, ies + offs, len - offs);
 726        newpos += len - offs;
 727
 728        return newpos;
 729}
 730
 731#define WFA_TPC_IE_LEN  9
 732
 733static void iwl_mvm_add_tpc_report_ie(u8 *pos)
 734{
 735        pos[0] = WLAN_EID_VENDOR_SPECIFIC;
 736        pos[1] = WFA_TPC_IE_LEN - 2;
 737        pos[2] = (WLAN_OUI_MICROSOFT >> 16) & 0xff;
 738        pos[3] = (WLAN_OUI_MICROSOFT >> 8) & 0xff;
 739        pos[4] = WLAN_OUI_MICROSOFT & 0xff;
 740        pos[5] = WLAN_OUI_TYPE_MICROSOFT_TPC;
 741        pos[6] = 0;
 742        /* pos[7] - tx power will be inserted by the FW */
 743        pos[7] = 0;
 744        pos[8] = 0;
 745}
 746
 747static void
 748iwl_mvm_build_scan_probe(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
 749                         struct ieee80211_scan_ies *ies,
 750                         struct iwl_mvm_scan_params *params)
 751{
 752        struct ieee80211_mgmt *frame = (void *)params->preq.buf;
 753        u8 *pos, *newpos;
 754        const u8 *mac_addr = params->flags & NL80211_SCAN_FLAG_RANDOM_ADDR ?
 755                params->mac_addr : NULL;
 756
 757        /*
 758         * Unfortunately, right now the offload scan doesn't support randomising
 759         * within the firmware, so until the firmware API is ready we implement
 760         * it in the driver. This means that the scan iterations won't really be
 761         * random, only when it's restarted, but at least that helps a bit.
 762         */
 763        if (mac_addr)
 764                get_random_mask_addr(frame->sa, mac_addr,
 765                                     params->mac_addr_mask);
 766        else
 767                memcpy(frame->sa, vif->addr, ETH_ALEN);
 768
 769        frame->frame_control = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ);
 770        eth_broadcast_addr(frame->da);
 771        eth_broadcast_addr(frame->bssid);
 772        frame->seq_ctrl = 0;
 773
 774        pos = frame->u.probe_req.variable;
 775        *pos++ = WLAN_EID_SSID;
 776        *pos++ = 0;
 777
 778        params->preq.mac_header.offset = 0;
 779        params->preq.mac_header.len = cpu_to_le16(24 + 2);
 780
 781        /* Insert ds parameter set element on 2.4 GHz band */
 782        newpos = iwl_mvm_copy_and_insert_ds_elem(mvm,
 783                                                 ies->ies[NL80211_BAND_2GHZ],
 784                                                 ies->len[NL80211_BAND_2GHZ],
 785                                                 pos);
 786        params->preq.band_data[0].offset = cpu_to_le16(pos - params->preq.buf);
 787        params->preq.band_data[0].len = cpu_to_le16(newpos - pos);
 788        pos = newpos;
 789
 790        memcpy(pos, ies->ies[NL80211_BAND_5GHZ],
 791               ies->len[NL80211_BAND_5GHZ]);
 792        params->preq.band_data[1].offset = cpu_to_le16(pos - params->preq.buf);
 793        params->preq.band_data[1].len =
 794                cpu_to_le16(ies->len[NL80211_BAND_5GHZ]);
 795        pos += ies->len[NL80211_BAND_5GHZ];
 796
 797        memcpy(pos, ies->ies[NL80211_BAND_6GHZ],
 798               ies->len[NL80211_BAND_6GHZ]);
 799        params->preq.band_data[2].offset = cpu_to_le16(pos - params->preq.buf);
 800        params->preq.band_data[2].len =
 801                cpu_to_le16(ies->len[NL80211_BAND_6GHZ]);
 802        pos += ies->len[NL80211_BAND_6GHZ];
 803        memcpy(pos, ies->common_ies, ies->common_ie_len);
 804        params->preq.common_data.offset = cpu_to_le16(pos - params->preq.buf);
 805
 806        if (iwl_mvm_rrm_scan_needed(mvm) &&
 807            !fw_has_capa(&mvm->fw->ucode_capa,
 808                         IWL_UCODE_TLV_CAPA_WFA_TPC_REP_IE_SUPPORT)) {
 809                iwl_mvm_add_tpc_report_ie(pos + ies->common_ie_len);
 810                params->preq.common_data.len = cpu_to_le16(ies->common_ie_len +
 811                                                           WFA_TPC_IE_LEN);
 812        } else {
 813                params->preq.common_data.len = cpu_to_le16(ies->common_ie_len);
 814        }
 815}
 816
 817static void iwl_mvm_scan_lmac_dwell(struct iwl_mvm *mvm,
 818                                    struct iwl_scan_req_lmac *cmd,
 819                                    struct iwl_mvm_scan_params *params)
 820{
 821        cmd->active_dwell = IWL_SCAN_DWELL_ACTIVE;
 822        cmd->passive_dwell = IWL_SCAN_DWELL_PASSIVE;
 823        cmd->fragmented_dwell = IWL_SCAN_DWELL_FRAGMENTED;
 824        cmd->extended_dwell = IWL_SCAN_DWELL_EXTENDED;
 825        cmd->max_out_time = cpu_to_le32(scan_timing[params->type].max_out_time);
 826        cmd->suspend_time = cpu_to_le32(scan_timing[params->type].suspend_time);
 827        cmd->scan_prio = cpu_to_le32(IWL_SCAN_PRIORITY_EXT_6);
 828}
 829
 830static inline bool iwl_mvm_scan_fits(struct iwl_mvm *mvm, int n_ssids,
 831                                     struct ieee80211_scan_ies *ies,
 832                                     int n_channels)
 833{
 834        return ((n_ssids <= PROBE_OPTION_MAX) &&
 835                (n_channels <= mvm->fw->ucode_capa.n_scan_channels) &
 836                (ies->common_ie_len +
 837                 ies->len[NL80211_BAND_2GHZ] +
 838                 ies->len[NL80211_BAND_5GHZ] <=
 839                 iwl_mvm_max_scan_ie_fw_cmd_room(mvm)));
 840}
 841
 842static inline bool iwl_mvm_scan_use_ebs(struct iwl_mvm *mvm,
 843                                        struct ieee80211_vif *vif)
 844{
 845        const struct iwl_ucode_capabilities *capa = &mvm->fw->ucode_capa;
 846        bool low_latency;
 847
 848        if (iwl_mvm_is_cdb_supported(mvm))
 849                low_latency = iwl_mvm_low_latency_band(mvm, NL80211_BAND_5GHZ);
 850        else
 851                low_latency = iwl_mvm_low_latency(mvm);
 852
 853        /* We can only use EBS if:
 854         *      1. the feature is supported;
 855         *      2. the last EBS was successful;
 856         *      3. if only single scan, the single scan EBS API is supported;
 857         *      4. it's not a p2p find operation.
 858         *      5. we are not in low latency mode,
 859         *         or if fragmented ebs is supported by the FW
 860         */
 861        return ((capa->flags & IWL_UCODE_TLV_FLAGS_EBS_SUPPORT) &&
 862                mvm->last_ebs_successful && IWL_MVM_ENABLE_EBS &&
 863                vif->type != NL80211_IFTYPE_P2P_DEVICE &&
 864                (!low_latency || iwl_mvm_is_frag_ebs_supported(mvm)));
 865}
 866
 867static inline bool iwl_mvm_is_regular_scan(struct iwl_mvm_scan_params *params)
 868{
 869        return params->n_scan_plans == 1 &&
 870                params->scan_plans[0].iterations == 1;
 871}
 872
 873static bool iwl_mvm_is_scan_fragmented(enum iwl_mvm_scan_type type)
 874{
 875        return (type == IWL_SCAN_TYPE_FRAGMENTED ||
 876                type == IWL_SCAN_TYPE_FAST_BALANCE);
 877}
 878
 879static int iwl_mvm_scan_lmac_flags(struct iwl_mvm *mvm,
 880                                   struct iwl_mvm_scan_params *params,
 881                                   struct ieee80211_vif *vif)
 882{
 883        int flags = 0;
 884
 885        if (params->n_ssids == 0)
 886                flags |= IWL_MVM_LMAC_SCAN_FLAG_PASSIVE;
 887
 888        if (params->n_ssids == 1 && params->ssids[0].ssid_len != 0)
 889                flags |= IWL_MVM_LMAC_SCAN_FLAG_PRE_CONNECTION;
 890
 891        if (iwl_mvm_is_scan_fragmented(params->type))
 892                flags |= IWL_MVM_LMAC_SCAN_FLAG_FRAGMENTED;
 893
 894        if (iwl_mvm_rrm_scan_needed(mvm) &&
 895            fw_has_capa(&mvm->fw->ucode_capa,
 896                        IWL_UCODE_TLV_CAPA_WFA_TPC_REP_IE_SUPPORT))
 897                flags |= IWL_MVM_LMAC_SCAN_FLAGS_RRM_ENABLED;
 898
 899        if (params->pass_all)
 900                flags |= IWL_MVM_LMAC_SCAN_FLAG_PASS_ALL;
 901        else
 902                flags |= IWL_MVM_LMAC_SCAN_FLAG_MATCH;
 903
 904#ifdef CONFIG_IWLWIFI_DEBUGFS
 905        if (mvm->scan_iter_notif_enabled)
 906                flags |= IWL_MVM_LMAC_SCAN_FLAG_ITER_COMPLETE;
 907#endif
 908
 909        if (mvm->sched_scan_pass_all == SCHED_SCAN_PASS_ALL_ENABLED)
 910                flags |= IWL_MVM_LMAC_SCAN_FLAG_ITER_COMPLETE;
 911
 912        if (iwl_mvm_is_regular_scan(params) &&
 913            vif->type != NL80211_IFTYPE_P2P_DEVICE &&
 914            !iwl_mvm_is_scan_fragmented(params->type))
 915                flags |= IWL_MVM_LMAC_SCAN_FLAG_EXTENDED_DWELL;
 916
 917        return flags;
 918}
 919
 920static void
 921iwl_mvm_scan_set_legacy_probe_req(struct iwl_scan_probe_req_v1 *p_req,
 922                                  struct iwl_scan_probe_req *src_p_req)
 923{
 924        int i;
 925
 926        p_req->mac_header = src_p_req->mac_header;
 927        for (i = 0; i < SCAN_NUM_BAND_PROBE_DATA_V_1; i++)
 928                p_req->band_data[i] = src_p_req->band_data[i];
 929        p_req->common_data = src_p_req->common_data;
 930        memcpy(p_req->buf, src_p_req->buf, sizeof(p_req->buf));
 931}
 932
 933static int iwl_mvm_scan_lmac(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
 934                             struct iwl_mvm_scan_params *params)
 935{
 936        struct iwl_scan_req_lmac *cmd = mvm->scan_cmd;
 937        struct iwl_scan_probe_req_v1 *preq =
 938                (void *)(cmd->data + sizeof(struct iwl_scan_channel_cfg_lmac) *
 939                         mvm->fw->ucode_capa.n_scan_channels);
 940        u32 ssid_bitmap = 0;
 941        int i;
 942        u8 band;
 943
 944        if (WARN_ON(params->n_scan_plans > IWL_MAX_SCHED_SCAN_PLANS))
 945                return -EINVAL;
 946
 947        iwl_mvm_scan_lmac_dwell(mvm, cmd, params);
 948
 949        cmd->rx_chain_select = iwl_mvm_scan_rx_chain(mvm);
 950        cmd->iter_num = cpu_to_le32(1);
 951        cmd->n_channels = (u8)params->n_channels;
 952
 953        cmd->delay = cpu_to_le32(params->delay);
 954
 955        cmd->scan_flags = cpu_to_le32(iwl_mvm_scan_lmac_flags(mvm, params,
 956                                                              vif));
 957
 958        band = iwl_mvm_phy_band_from_nl80211(params->channels[0]->band);
 959        cmd->flags = cpu_to_le32(band);
 960        cmd->filter_flags = cpu_to_le32(MAC_FILTER_ACCEPT_GRP |
 961                                        MAC_FILTER_IN_BEACON);
 962        iwl_mvm_scan_fill_tx_cmd(mvm, cmd->tx_cmd, params->no_cck);
 963        iwl_scan_build_ssids(params, cmd->direct_scan, &ssid_bitmap);
 964
 965        /* this API uses bits 1-20 instead of 0-19 */
 966        ssid_bitmap <<= 1;
 967
 968        for (i = 0; i < params->n_scan_plans; i++) {
 969                struct cfg80211_sched_scan_plan *scan_plan =
 970                        &params->scan_plans[i];
 971
 972                cmd->schedule[i].delay =
 973                        cpu_to_le16(scan_plan->interval);
 974                cmd->schedule[i].iterations = scan_plan->iterations;
 975                cmd->schedule[i].full_scan_mul = 1;
 976        }
 977
 978        /*
 979         * If the number of iterations of the last scan plan is set to
 980         * zero, it should run infinitely. However, this is not always the case.
 981         * For example, when regular scan is requested the driver sets one scan
 982         * plan with one iteration.
 983         */
 984        if (!cmd->schedule[i - 1].iterations)
 985                cmd->schedule[i - 1].iterations = 0xff;
 986
 987        if (iwl_mvm_scan_use_ebs(mvm, vif)) {
 988                cmd->channel_opt[0].flags =
 989                        cpu_to_le16(IWL_SCAN_CHANNEL_FLAG_EBS |
 990                                    IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
 991                                    IWL_SCAN_CHANNEL_FLAG_CACHE_ADD);
 992                cmd->channel_opt[0].non_ebs_ratio =
 993                        cpu_to_le16(IWL_DENSE_EBS_SCAN_RATIO);
 994                cmd->channel_opt[1].flags =
 995                        cpu_to_le16(IWL_SCAN_CHANNEL_FLAG_EBS |
 996                                    IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
 997                                    IWL_SCAN_CHANNEL_FLAG_CACHE_ADD);
 998                cmd->channel_opt[1].non_ebs_ratio =
 999                        cpu_to_le16(IWL_SPARSE_EBS_SCAN_RATIO);
1000        }
1001
1002        iwl_mvm_lmac_scan_cfg_channels(mvm, params->channels,
1003                                       params->n_channels, ssid_bitmap, cmd);
1004
1005        iwl_mvm_scan_set_legacy_probe_req(preq, &params->preq);
1006
1007        return 0;
1008}
1009
1010static int rate_to_scan_rate_flag(unsigned int rate)
1011{
1012        static const int rate_to_scan_rate[IWL_RATE_COUNT] = {
1013                [IWL_RATE_1M_INDEX]     = SCAN_CONFIG_RATE_1M,
1014                [IWL_RATE_2M_INDEX]     = SCAN_CONFIG_RATE_2M,
1015                [IWL_RATE_5M_INDEX]     = SCAN_CONFIG_RATE_5M,
1016                [IWL_RATE_11M_INDEX]    = SCAN_CONFIG_RATE_11M,
1017                [IWL_RATE_6M_INDEX]     = SCAN_CONFIG_RATE_6M,
1018                [IWL_RATE_9M_INDEX]     = SCAN_CONFIG_RATE_9M,
1019                [IWL_RATE_12M_INDEX]    = SCAN_CONFIG_RATE_12M,
1020                [IWL_RATE_18M_INDEX]    = SCAN_CONFIG_RATE_18M,
1021                [IWL_RATE_24M_INDEX]    = SCAN_CONFIG_RATE_24M,
1022                [IWL_RATE_36M_INDEX]    = SCAN_CONFIG_RATE_36M,
1023                [IWL_RATE_48M_INDEX]    = SCAN_CONFIG_RATE_48M,
1024                [IWL_RATE_54M_INDEX]    = SCAN_CONFIG_RATE_54M,
1025        };
1026
1027        return rate_to_scan_rate[rate];
1028}
1029
1030static __le32 iwl_mvm_scan_config_rates(struct iwl_mvm *mvm)
1031{
1032        struct ieee80211_supported_band *band;
1033        unsigned int rates = 0;
1034        int i;
1035
1036        band = &mvm->nvm_data->bands[NL80211_BAND_2GHZ];
1037        for (i = 0; i < band->n_bitrates; i++)
1038                rates |= rate_to_scan_rate_flag(band->bitrates[i].hw_value);
1039        band = &mvm->nvm_data->bands[NL80211_BAND_5GHZ];
1040        for (i = 0; i < band->n_bitrates; i++)
1041                rates |= rate_to_scan_rate_flag(band->bitrates[i].hw_value);
1042
1043        /* Set both basic rates and supported rates */
1044        rates |= SCAN_CONFIG_SUPPORTED_RATE(rates);
1045
1046        return cpu_to_le32(rates);
1047}
1048
1049static void iwl_mvm_fill_scan_dwell(struct iwl_mvm *mvm,
1050                                    struct iwl_scan_dwell *dwell)
1051{
1052        dwell->active = IWL_SCAN_DWELL_ACTIVE;
1053        dwell->passive = IWL_SCAN_DWELL_PASSIVE;
1054        dwell->fragmented = IWL_SCAN_DWELL_FRAGMENTED;
1055        dwell->extended = IWL_SCAN_DWELL_EXTENDED;
1056}
1057
1058static void iwl_mvm_fill_channels(struct iwl_mvm *mvm, u8 *channels,
1059                                  u32 max_channels)
1060{
1061        struct ieee80211_supported_band *band;
1062        int i, j = 0;
1063
1064        band = &mvm->nvm_data->bands[NL80211_BAND_2GHZ];
1065        for (i = 0; i < band->n_channels && j < max_channels; i++, j++)
1066                channels[j] = band->channels[i].hw_value;
1067        band = &mvm->nvm_data->bands[NL80211_BAND_5GHZ];
1068        for (i = 0; i < band->n_channels && j < max_channels; i++, j++)
1069                channels[j] = band->channels[i].hw_value;
1070}
1071
1072static void iwl_mvm_fill_scan_config_v1(struct iwl_mvm *mvm, void *config,
1073                                        u32 flags, u8 channel_flags,
1074                                        u32 max_channels)
1075{
1076        enum iwl_mvm_scan_type type = iwl_mvm_get_scan_type(mvm, NULL);
1077        struct iwl_scan_config_v1 *cfg = config;
1078
1079        cfg->flags = cpu_to_le32(flags);
1080        cfg->tx_chains = cpu_to_le32(iwl_mvm_get_valid_tx_ant(mvm));
1081        cfg->rx_chains = cpu_to_le32(iwl_mvm_scan_rx_ant(mvm));
1082        cfg->legacy_rates = iwl_mvm_scan_config_rates(mvm);
1083        cfg->out_of_channel_time = cpu_to_le32(scan_timing[type].max_out_time);
1084        cfg->suspend_time = cpu_to_le32(scan_timing[type].suspend_time);
1085
1086        iwl_mvm_fill_scan_dwell(mvm, &cfg->dwell);
1087
1088        memcpy(&cfg->mac_addr, &mvm->addresses[0].addr, ETH_ALEN);
1089
1090        /* This function should not be called when using ADD_STA ver >=12 */
1091        WARN_ON_ONCE(iwl_fw_lookup_cmd_ver(mvm->fw, LONG_GROUP,
1092                                           ADD_STA, 0) >= 12);
1093
1094        cfg->bcast_sta_id = mvm->aux_sta.sta_id;
1095        cfg->channel_flags = channel_flags;
1096
1097        iwl_mvm_fill_channels(mvm, cfg->channel_array, max_channels);
1098}
1099
1100static void iwl_mvm_fill_scan_config_v2(struct iwl_mvm *mvm, void *config,
1101                                        u32 flags, u8 channel_flags,
1102                                        u32 max_channels)
1103{
1104        struct iwl_scan_config_v2 *cfg = config;
1105
1106        cfg->flags = cpu_to_le32(flags);
1107        cfg->tx_chains = cpu_to_le32(iwl_mvm_get_valid_tx_ant(mvm));
1108        cfg->rx_chains = cpu_to_le32(iwl_mvm_scan_rx_ant(mvm));
1109        cfg->legacy_rates = iwl_mvm_scan_config_rates(mvm);
1110
1111        if (iwl_mvm_is_cdb_supported(mvm)) {
1112                enum iwl_mvm_scan_type lb_type, hb_type;
1113
1114                lb_type = iwl_mvm_get_scan_type_band(mvm, NULL,
1115                                                     NL80211_BAND_2GHZ);
1116                hb_type = iwl_mvm_get_scan_type_band(mvm, NULL,
1117                                                     NL80211_BAND_5GHZ);
1118
1119                cfg->out_of_channel_time[SCAN_LB_LMAC_IDX] =
1120                        cpu_to_le32(scan_timing[lb_type].max_out_time);
1121                cfg->suspend_time[SCAN_LB_LMAC_IDX] =
1122                        cpu_to_le32(scan_timing[lb_type].suspend_time);
1123
1124                cfg->out_of_channel_time[SCAN_HB_LMAC_IDX] =
1125                        cpu_to_le32(scan_timing[hb_type].max_out_time);
1126                cfg->suspend_time[SCAN_HB_LMAC_IDX] =
1127                        cpu_to_le32(scan_timing[hb_type].suspend_time);
1128        } else {
1129                enum iwl_mvm_scan_type type =
1130                        iwl_mvm_get_scan_type(mvm, NULL);
1131
1132                cfg->out_of_channel_time[SCAN_LB_LMAC_IDX] =
1133                        cpu_to_le32(scan_timing[type].max_out_time);
1134                cfg->suspend_time[SCAN_LB_LMAC_IDX] =
1135                        cpu_to_le32(scan_timing[type].suspend_time);
1136        }
1137
1138        iwl_mvm_fill_scan_dwell(mvm, &cfg->dwell);
1139
1140        memcpy(&cfg->mac_addr, &mvm->addresses[0].addr, ETH_ALEN);
1141
1142        /* This function should not be called when using ADD_STA ver >=12 */
1143        WARN_ON_ONCE(iwl_fw_lookup_cmd_ver(mvm->fw, LONG_GROUP,
1144                                           ADD_STA, 0) >= 12);
1145
1146        cfg->bcast_sta_id = mvm->aux_sta.sta_id;
1147        cfg->channel_flags = channel_flags;
1148
1149        iwl_mvm_fill_channels(mvm, cfg->channel_array, max_channels);
1150}
1151
1152static int iwl_mvm_legacy_config_scan(struct iwl_mvm *mvm)
1153{
1154        void *cfg;
1155        int ret, cmd_size;
1156        struct iwl_host_cmd cmd = {
1157                .id = iwl_cmd_id(SCAN_CFG_CMD, IWL_ALWAYS_LONG_GROUP, 0),
1158        };
1159        enum iwl_mvm_scan_type type;
1160        enum iwl_mvm_scan_type hb_type = IWL_SCAN_TYPE_NOT_SET;
1161        int num_channels =
1162                mvm->nvm_data->bands[NL80211_BAND_2GHZ].n_channels +
1163                mvm->nvm_data->bands[NL80211_BAND_5GHZ].n_channels;
1164        u32 flags;
1165        u8 channel_flags;
1166
1167        if (WARN_ON(num_channels > mvm->fw->ucode_capa.n_scan_channels))
1168                num_channels = mvm->fw->ucode_capa.n_scan_channels;
1169
1170        if (iwl_mvm_is_cdb_supported(mvm)) {
1171                type = iwl_mvm_get_scan_type_band(mvm, NULL,
1172                                                  NL80211_BAND_2GHZ);
1173                hb_type = iwl_mvm_get_scan_type_band(mvm, NULL,
1174                                                     NL80211_BAND_5GHZ);
1175                if (type == mvm->scan_type && hb_type == mvm->hb_scan_type)
1176                        return 0;
1177        } else {
1178                type = iwl_mvm_get_scan_type(mvm, NULL);
1179                if (type == mvm->scan_type)
1180                        return 0;
1181        }
1182
1183        if (iwl_mvm_cdb_scan_api(mvm))
1184                cmd_size = sizeof(struct iwl_scan_config_v2);
1185        else
1186                cmd_size = sizeof(struct iwl_scan_config_v1);
1187        cmd_size += mvm->fw->ucode_capa.n_scan_channels;
1188
1189        cfg = kzalloc(cmd_size, GFP_KERNEL);
1190        if (!cfg)
1191                return -ENOMEM;
1192
1193        flags = SCAN_CONFIG_FLAG_ACTIVATE |
1194                 SCAN_CONFIG_FLAG_ALLOW_CHUB_REQS |
1195                 SCAN_CONFIG_FLAG_SET_TX_CHAINS |
1196                 SCAN_CONFIG_FLAG_SET_RX_CHAINS |
1197                 SCAN_CONFIG_FLAG_SET_AUX_STA_ID |
1198                 SCAN_CONFIG_FLAG_SET_ALL_TIMES |
1199                 SCAN_CONFIG_FLAG_SET_LEGACY_RATES |
1200                 SCAN_CONFIG_FLAG_SET_MAC_ADDR |
1201                 SCAN_CONFIG_FLAG_SET_CHANNEL_FLAGS |
1202                 SCAN_CONFIG_N_CHANNELS(num_channels) |
1203                 (iwl_mvm_is_scan_fragmented(type) ?
1204                  SCAN_CONFIG_FLAG_SET_FRAGMENTED :
1205                  SCAN_CONFIG_FLAG_CLEAR_FRAGMENTED);
1206
1207        channel_flags = IWL_CHANNEL_FLAG_EBS |
1208                        IWL_CHANNEL_FLAG_ACCURATE_EBS |
1209                        IWL_CHANNEL_FLAG_EBS_ADD |
1210                        IWL_CHANNEL_FLAG_PRE_SCAN_PASSIVE2ACTIVE;
1211
1212        /*
1213         * Check for fragmented scan on LMAC2 - high band.
1214         * LMAC1 - low band is checked above.
1215         */
1216        if (iwl_mvm_cdb_scan_api(mvm)) {
1217                if (iwl_mvm_is_cdb_supported(mvm))
1218                        flags |= (iwl_mvm_is_scan_fragmented(hb_type)) ?
1219                                 SCAN_CONFIG_FLAG_SET_LMAC2_FRAGMENTED :
1220                                 SCAN_CONFIG_FLAG_CLEAR_LMAC2_FRAGMENTED;
1221                iwl_mvm_fill_scan_config_v2(mvm, cfg, flags, channel_flags,
1222                                            num_channels);
1223        } else {
1224                iwl_mvm_fill_scan_config_v1(mvm, cfg, flags, channel_flags,
1225                                            num_channels);
1226        }
1227
1228        cmd.data[0] = cfg;
1229        cmd.len[0] = cmd_size;
1230        cmd.dataflags[0] = IWL_HCMD_DFL_NOCOPY;
1231
1232        IWL_DEBUG_SCAN(mvm, "Sending UMAC scan config\n");
1233
1234        ret = iwl_mvm_send_cmd(mvm, &cmd);
1235        if (!ret) {
1236                mvm->scan_type = type;
1237                mvm->hb_scan_type = hb_type;
1238        }
1239
1240        kfree(cfg);
1241        return ret;
1242}
1243
1244int iwl_mvm_config_scan(struct iwl_mvm *mvm)
1245{
1246        struct iwl_scan_config cfg;
1247        struct iwl_host_cmd cmd = {
1248                .id = iwl_cmd_id(SCAN_CFG_CMD, IWL_ALWAYS_LONG_GROUP, 0),
1249                .len[0] = sizeof(cfg),
1250                .data[0] = &cfg,
1251                .dataflags[0] = IWL_HCMD_DFL_NOCOPY,
1252        };
1253
1254        if (!iwl_mvm_is_reduced_config_scan_supported(mvm))
1255                return iwl_mvm_legacy_config_scan(mvm);
1256
1257        memset(&cfg, 0, sizeof(cfg));
1258
1259        if (iwl_fw_lookup_cmd_ver(mvm->fw, LONG_GROUP,
1260                                  ADD_STA, 0) < 12) {
1261                cfg.bcast_sta_id = mvm->aux_sta.sta_id;
1262        } else if (iwl_fw_lookup_cmd_ver(mvm->fw, LONG_GROUP,
1263                                         SCAN_CFG_CMD, 0) < 5) {
1264                /*
1265                 * Fw doesn't use this sta anymore. Deprecated on SCAN_CFG_CMD
1266                 * version 5.
1267                 */
1268                cfg.bcast_sta_id = 0xff;
1269        }
1270
1271        cfg.tx_chains = cpu_to_le32(iwl_mvm_get_valid_tx_ant(mvm));
1272        cfg.rx_chains = cpu_to_le32(iwl_mvm_scan_rx_ant(mvm));
1273
1274        IWL_DEBUG_SCAN(mvm, "Sending UMAC scan config\n");
1275
1276        return iwl_mvm_send_cmd(mvm, &cmd);
1277}
1278
1279static int iwl_mvm_scan_uid_by_status(struct iwl_mvm *mvm, int status)
1280{
1281        int i;
1282
1283        for (i = 0; i < mvm->max_scans; i++)
1284                if (mvm->scan_uid_status[i] == status)
1285                        return i;
1286
1287        return -ENOENT;
1288}
1289
1290static void iwl_mvm_scan_umac_dwell(struct iwl_mvm *mvm,
1291                                    struct iwl_scan_req_umac *cmd,
1292                                    struct iwl_mvm_scan_params *params)
1293{
1294        struct iwl_mvm_scan_timing_params *timing, *hb_timing;
1295        u8 active_dwell, passive_dwell;
1296
1297        timing = &scan_timing[params->type];
1298        active_dwell = IWL_SCAN_DWELL_ACTIVE;
1299        passive_dwell = IWL_SCAN_DWELL_PASSIVE;
1300
1301        if (iwl_mvm_is_adaptive_dwell_supported(mvm)) {
1302                cmd->v7.adwell_default_n_aps_social =
1303                        IWL_SCAN_ADWELL_DEFAULT_N_APS_SOCIAL;
1304                cmd->v7.adwell_default_n_aps =
1305                        IWL_SCAN_ADWELL_DEFAULT_LB_N_APS;
1306
1307                if (iwl_mvm_is_adwell_hb_ap_num_supported(mvm))
1308                        cmd->v9.adwell_default_hb_n_aps =
1309                                IWL_SCAN_ADWELL_DEFAULT_HB_N_APS;
1310
1311                /* if custom max budget was configured with debugfs */
1312                if (IWL_MVM_ADWELL_MAX_BUDGET)
1313                        cmd->v7.adwell_max_budget =
1314                                cpu_to_le16(IWL_MVM_ADWELL_MAX_BUDGET);
1315                else if (params->ssids && params->ssids[0].ssid_len)
1316                        cmd->v7.adwell_max_budget =
1317                                cpu_to_le16(IWL_SCAN_ADWELL_MAX_BUDGET_DIRECTED_SCAN);
1318                else
1319                        cmd->v7.adwell_max_budget =
1320                                cpu_to_le16(IWL_SCAN_ADWELL_MAX_BUDGET_FULL_SCAN);
1321
1322                cmd->v7.scan_priority = cpu_to_le32(IWL_SCAN_PRIORITY_EXT_6);
1323                cmd->v7.max_out_time[SCAN_LB_LMAC_IDX] =
1324                        cpu_to_le32(timing->max_out_time);
1325                cmd->v7.suspend_time[SCAN_LB_LMAC_IDX] =
1326                        cpu_to_le32(timing->suspend_time);
1327
1328                if (iwl_mvm_is_cdb_supported(mvm)) {
1329                        hb_timing = &scan_timing[params->hb_type];
1330
1331                        cmd->v7.max_out_time[SCAN_HB_LMAC_IDX] =
1332                                cpu_to_le32(hb_timing->max_out_time);
1333                        cmd->v7.suspend_time[SCAN_HB_LMAC_IDX] =
1334                                cpu_to_le32(hb_timing->suspend_time);
1335                }
1336
1337                if (!iwl_mvm_is_adaptive_dwell_v2_supported(mvm)) {
1338                        cmd->v7.active_dwell = active_dwell;
1339                        cmd->v7.passive_dwell = passive_dwell;
1340                        cmd->v7.fragmented_dwell = IWL_SCAN_DWELL_FRAGMENTED;
1341                } else {
1342                        cmd->v8.active_dwell[SCAN_LB_LMAC_IDX] = active_dwell;
1343                        cmd->v8.passive_dwell[SCAN_LB_LMAC_IDX] = passive_dwell;
1344                        if (iwl_mvm_is_cdb_supported(mvm)) {
1345                                cmd->v8.active_dwell[SCAN_HB_LMAC_IDX] =
1346                                        active_dwell;
1347                                cmd->v8.passive_dwell[SCAN_HB_LMAC_IDX] =
1348                                        passive_dwell;
1349                        }
1350                }
1351        } else {
1352                cmd->v1.extended_dwell = IWL_SCAN_DWELL_EXTENDED;
1353                cmd->v1.active_dwell = active_dwell;
1354                cmd->v1.passive_dwell = passive_dwell;
1355                cmd->v1.fragmented_dwell = IWL_SCAN_DWELL_FRAGMENTED;
1356
1357                if (iwl_mvm_is_cdb_supported(mvm)) {
1358                        hb_timing = &scan_timing[params->hb_type];
1359
1360                        cmd->v6.max_out_time[SCAN_HB_LMAC_IDX] =
1361                                        cpu_to_le32(hb_timing->max_out_time);
1362                        cmd->v6.suspend_time[SCAN_HB_LMAC_IDX] =
1363                                        cpu_to_le32(hb_timing->suspend_time);
1364                }
1365
1366                if (iwl_mvm_cdb_scan_api(mvm)) {
1367                        cmd->v6.scan_priority =
1368                                cpu_to_le32(IWL_SCAN_PRIORITY_EXT_6);
1369                        cmd->v6.max_out_time[SCAN_LB_LMAC_IDX] =
1370                                cpu_to_le32(timing->max_out_time);
1371                        cmd->v6.suspend_time[SCAN_LB_LMAC_IDX] =
1372                                cpu_to_le32(timing->suspend_time);
1373                } else {
1374                        cmd->v1.scan_priority =
1375                                cpu_to_le32(IWL_SCAN_PRIORITY_EXT_6);
1376                        cmd->v1.max_out_time =
1377                                cpu_to_le32(timing->max_out_time);
1378                        cmd->v1.suspend_time =
1379                                cpu_to_le32(timing->suspend_time);
1380                }
1381        }
1382
1383        if (iwl_mvm_is_regular_scan(params))
1384                cmd->ooc_priority = cpu_to_le32(IWL_SCAN_PRIORITY_EXT_6);
1385        else
1386                cmd->ooc_priority = cpu_to_le32(IWL_SCAN_PRIORITY_EXT_2);
1387}
1388
1389static u32 iwl_mvm_scan_umac_ooc_priority(struct iwl_mvm_scan_params *params)
1390{
1391        return iwl_mvm_is_regular_scan(params) ?
1392                IWL_SCAN_PRIORITY_EXT_6 :
1393                IWL_SCAN_PRIORITY_EXT_2;
1394}
1395
1396static void
1397iwl_mvm_scan_umac_dwell_v10(struct iwl_mvm *mvm,
1398                            struct iwl_scan_general_params_v10 *general_params,
1399                            struct iwl_mvm_scan_params *params)
1400{
1401        struct iwl_mvm_scan_timing_params *timing, *hb_timing;
1402        u8 active_dwell, passive_dwell;
1403
1404        timing = &scan_timing[params->type];
1405        active_dwell = IWL_SCAN_DWELL_ACTIVE;
1406        passive_dwell = IWL_SCAN_DWELL_PASSIVE;
1407
1408        general_params->adwell_default_social_chn =
1409                IWL_SCAN_ADWELL_DEFAULT_N_APS_SOCIAL;
1410        general_params->adwell_default_2g = IWL_SCAN_ADWELL_DEFAULT_LB_N_APS;
1411        general_params->adwell_default_5g = IWL_SCAN_ADWELL_DEFAULT_HB_N_APS;
1412
1413        /* if custom max budget was configured with debugfs */
1414        if (IWL_MVM_ADWELL_MAX_BUDGET)
1415                general_params->adwell_max_budget =
1416                        cpu_to_le16(IWL_MVM_ADWELL_MAX_BUDGET);
1417        else if (params->ssids && params->ssids[0].ssid_len)
1418                general_params->adwell_max_budget =
1419                        cpu_to_le16(IWL_SCAN_ADWELL_MAX_BUDGET_DIRECTED_SCAN);
1420        else
1421                general_params->adwell_max_budget =
1422                        cpu_to_le16(IWL_SCAN_ADWELL_MAX_BUDGET_FULL_SCAN);
1423
1424        general_params->scan_priority = cpu_to_le32(IWL_SCAN_PRIORITY_EXT_6);
1425        general_params->max_out_of_time[SCAN_LB_LMAC_IDX] =
1426                cpu_to_le32(timing->max_out_time);
1427        general_params->suspend_time[SCAN_LB_LMAC_IDX] =
1428                cpu_to_le32(timing->suspend_time);
1429
1430        hb_timing = &scan_timing[params->hb_type];
1431
1432        general_params->max_out_of_time[SCAN_HB_LMAC_IDX] =
1433                cpu_to_le32(hb_timing->max_out_time);
1434        general_params->suspend_time[SCAN_HB_LMAC_IDX] =
1435                cpu_to_le32(hb_timing->suspend_time);
1436
1437        general_params->active_dwell[SCAN_LB_LMAC_IDX] = active_dwell;
1438        general_params->passive_dwell[SCAN_LB_LMAC_IDX] = passive_dwell;
1439        general_params->active_dwell[SCAN_HB_LMAC_IDX] = active_dwell;
1440        general_params->passive_dwell[SCAN_HB_LMAC_IDX] = passive_dwell;
1441}
1442
1443struct iwl_mvm_scan_channel_segment {
1444        u8 start_idx;
1445        u8 end_idx;
1446        u8 first_channel_id;
1447        u8 last_channel_id;
1448        u8 channel_spacing_shift;
1449        u8 band;
1450};
1451
1452static const struct iwl_mvm_scan_channel_segment scan_channel_segments[] = {
1453        {
1454                .start_idx = 0,
1455                .end_idx = 13,
1456                .first_channel_id = 1,
1457                .last_channel_id = 14,
1458                .channel_spacing_shift = 0,
1459                .band = PHY_BAND_24
1460        },
1461        {
1462                .start_idx = 14,
1463                .end_idx = 41,
1464                .first_channel_id = 36,
1465                .last_channel_id = 144,
1466                .channel_spacing_shift = 2,
1467                .band = PHY_BAND_5
1468        },
1469        {
1470                .start_idx = 42,
1471                .end_idx = 50,
1472                .first_channel_id = 149,
1473                .last_channel_id = 181,
1474                .channel_spacing_shift = 2,
1475                .band = PHY_BAND_5
1476        },
1477        {
1478                .start_idx = 51,
1479                .end_idx = 111,
1480                .first_channel_id = 1,
1481                .last_channel_id = 241,
1482                .channel_spacing_shift = 2,
1483                .band = PHY_BAND_6
1484        },
1485};
1486
1487static int iwl_mvm_scan_ch_and_band_to_idx(u8 channel_id, u8 band)
1488{
1489        int i, index;
1490
1491        if (!channel_id)
1492                return -EINVAL;
1493
1494        for (i = 0; i < ARRAY_SIZE(scan_channel_segments); i++) {
1495                const struct iwl_mvm_scan_channel_segment *ch_segment =
1496                        &scan_channel_segments[i];
1497                u32 ch_offset;
1498
1499                if (ch_segment->band != band ||
1500                    ch_segment->first_channel_id > channel_id ||
1501                    ch_segment->last_channel_id < channel_id)
1502                        continue;
1503
1504                ch_offset = (channel_id - ch_segment->first_channel_id) >>
1505                        ch_segment->channel_spacing_shift;
1506
1507                index = scan_channel_segments[i].start_idx + ch_offset;
1508                if (index < IWL_SCAN_NUM_CHANNELS)
1509                        return index;
1510
1511                break;
1512        }
1513
1514        return -EINVAL;
1515}
1516
1517static const u8 p2p_go_friendly_chs[] = {
1518        36, 40, 44, 48, 149, 153, 157, 161, 165,
1519};
1520
1521static const u8 social_chs[] = {
1522        1, 6, 11
1523};
1524
1525static void iwl_mvm_scan_ch_add_n_aps_override(enum nl80211_iftype vif_type,
1526                                               u8 ch_id, u8 band, u8 *ch_bitmap,
1527                                               size_t bitmap_n_entries)
1528{
1529        int i;
1530
1531        if (vif_type != NL80211_IFTYPE_P2P_DEVICE)
1532                return;
1533
1534        for (i = 0; i < ARRAY_SIZE(p2p_go_friendly_chs); i++) {
1535                if (p2p_go_friendly_chs[i] == ch_id) {
1536                        int ch_idx, bitmap_idx;
1537
1538                        ch_idx = iwl_mvm_scan_ch_and_band_to_idx(ch_id, band);
1539                        if (ch_idx < 0)
1540                                return;
1541
1542                        bitmap_idx = ch_idx / 8;
1543                        if (bitmap_idx >= bitmap_n_entries)
1544                                return;
1545
1546                        ch_idx = ch_idx % 8;
1547                        ch_bitmap[bitmap_idx] |= BIT(ch_idx);
1548
1549                        return;
1550                }
1551        }
1552}
1553
1554static u32 iwl_mvm_scan_ch_n_aps_flag(enum nl80211_iftype vif_type, u8 ch_id)
1555{
1556        int i;
1557        u32 flags = 0;
1558
1559        if (vif_type != NL80211_IFTYPE_P2P_DEVICE)
1560                goto out;
1561
1562        for (i = 0; i < ARRAY_SIZE(p2p_go_friendly_chs); i++) {
1563                if (p2p_go_friendly_chs[i] == ch_id) {
1564                        flags |= IWL_SCAN_ADWELL_N_APS_GO_FRIENDLY_BIT;
1565                        break;
1566                }
1567        }
1568
1569        if (flags)
1570                goto out;
1571
1572        for (i = 0; i < ARRAY_SIZE(social_chs); i++) {
1573                if (social_chs[i] == ch_id) {
1574                        flags |= IWL_SCAN_ADWELL_N_APS_SOCIAL_CHS_BIT;
1575                        break;
1576                }
1577        }
1578
1579out:
1580        return flags;
1581}
1582
1583static void
1584iwl_mvm_umac_scan_cfg_channels(struct iwl_mvm *mvm,
1585                               struct ieee80211_channel **channels,
1586                               int n_channels, u32 flags,
1587                               struct iwl_scan_channel_cfg_umac *channel_cfg)
1588{
1589        int i;
1590
1591        for (i = 0; i < n_channels; i++) {
1592                channel_cfg[i].flags = cpu_to_le32(flags);
1593                channel_cfg[i].v1.channel_num = channels[i]->hw_value;
1594                if (iwl_mvm_is_scan_ext_chan_supported(mvm)) {
1595                        enum nl80211_band band = channels[i]->band;
1596
1597                        channel_cfg[i].v2.band =
1598                                iwl_mvm_phy_band_from_nl80211(band);
1599                        channel_cfg[i].v2.iter_count = 1;
1600                        channel_cfg[i].v2.iter_interval = 0;
1601                } else {
1602                        channel_cfg[i].v1.iter_count = 1;
1603                        channel_cfg[i].v1.iter_interval = 0;
1604                }
1605        }
1606}
1607
1608static void
1609iwl_mvm_umac_scan_cfg_channels_v4(struct iwl_mvm *mvm,
1610                                  struct ieee80211_channel **channels,
1611                                  struct iwl_scan_channel_params_v4 *cp,
1612                                  int n_channels, u32 flags,
1613                                  enum nl80211_iftype vif_type)
1614{
1615        u8 *bitmap = cp->adwell_ch_override_bitmap;
1616        size_t bitmap_n_entries = ARRAY_SIZE(cp->adwell_ch_override_bitmap);
1617        int i;
1618
1619        for (i = 0; i < n_channels; i++) {
1620                enum nl80211_band band = channels[i]->band;
1621                struct iwl_scan_channel_cfg_umac *cfg =
1622                        &cp->channel_config[i];
1623
1624                cfg->flags = cpu_to_le32(flags);
1625                cfg->v2.channel_num = channels[i]->hw_value;
1626                cfg->v2.band = iwl_mvm_phy_band_from_nl80211(band);
1627                cfg->v2.iter_count = 1;
1628                cfg->v2.iter_interval = 0;
1629
1630                iwl_mvm_scan_ch_add_n_aps_override(vif_type,
1631                                                   cfg->v2.channel_num,
1632                                                   cfg->v2.band, bitmap,
1633                                                   bitmap_n_entries);
1634        }
1635}
1636
1637static void
1638iwl_mvm_umac_scan_cfg_channels_v6(struct iwl_mvm *mvm,
1639                                  struct ieee80211_channel **channels,
1640                                  struct iwl_scan_channel_params_v6 *cp,
1641                                  int n_channels, u32 flags,
1642                                  enum nl80211_iftype vif_type)
1643{
1644        int i;
1645
1646        for (i = 0; i < n_channels; i++) {
1647                enum nl80211_band band = channels[i]->band;
1648                struct iwl_scan_channel_cfg_umac *cfg = &cp->channel_config[i];
1649                u32 n_aps_flag =
1650                        iwl_mvm_scan_ch_n_aps_flag(vif_type,
1651                                                   channels[i]->hw_value);
1652
1653                cfg->flags = cpu_to_le32(flags | n_aps_flag);
1654                cfg->v2.channel_num = channels[i]->hw_value;
1655                cfg->v2.band = iwl_mvm_phy_band_from_nl80211(band);
1656                if (cfg80211_channel_is_psc(channels[i]))
1657                        cfg->flags = 0;
1658                cfg->v2.iter_count = 1;
1659                cfg->v2.iter_interval = 0;
1660        }
1661}
1662
1663static int
1664iwl_mvm_umac_scan_fill_6g_chan_list(struct iwl_mvm *mvm,
1665                                    struct iwl_mvm_scan_params *params,
1666                                     struct iwl_scan_probe_params_v4 *pp)
1667{
1668        int j, idex_s = 0, idex_b = 0;
1669        struct cfg80211_scan_6ghz_params *scan_6ghz_params =
1670                params->scan_6ghz_params;
1671        bool hidden_supported = fw_has_capa(&mvm->fw->ucode_capa,
1672                                            IWL_UCODE_TLV_CAPA_HIDDEN_6GHZ_SCAN);
1673
1674        for (j = 0; j < params->n_ssids && idex_s < SCAN_SHORT_SSID_MAX_SIZE;
1675             j++) {
1676                if (!params->ssids[j].ssid_len)
1677                        continue;
1678
1679                pp->short_ssid[idex_s] =
1680                        cpu_to_le32(~crc32_le(~0, params->ssids[j].ssid,
1681                                              params->ssids[j].ssid_len));
1682
1683                if (hidden_supported) {
1684                        pp->direct_scan[idex_s].id = WLAN_EID_SSID;
1685                        pp->direct_scan[idex_s].len = params->ssids[j].ssid_len;
1686                        memcpy(pp->direct_scan[idex_s].ssid, params->ssids[j].ssid,
1687                               params->ssids[j].ssid_len);
1688                }
1689                idex_s++;
1690        }
1691
1692        /*
1693         * Populate the arrays of the short SSIDs and the BSSIDs using the 6GHz
1694         * collocated parameters. This might not be optimal, as this processing
1695         * does not (yet) correspond to the actual channels, so it is possible
1696         * that some entries would be left out.
1697         *
1698         * TODO: improve this logic.
1699         */
1700        for (j = 0; j < params->n_6ghz_params; j++) {
1701                int k;
1702
1703                /* First, try to place the short SSID */
1704                if (scan_6ghz_params[j].short_ssid_valid) {
1705                        for (k = 0; k < idex_s; k++) {
1706                                if (pp->short_ssid[k] ==
1707                                    cpu_to_le32(scan_6ghz_params[j].short_ssid))
1708                                        break;
1709                        }
1710
1711                        if (k == idex_s && idex_s < SCAN_SHORT_SSID_MAX_SIZE) {
1712                                pp->short_ssid[idex_s++] =
1713                                        cpu_to_le32(scan_6ghz_params[j].short_ssid);
1714                        }
1715                }
1716
1717                /* try to place BSSID for the same entry */
1718                for (k = 0; k < idex_b; k++) {
1719                        if (!memcmp(&pp->bssid_array[k],
1720                                    scan_6ghz_params[j].bssid, ETH_ALEN))
1721                                break;
1722                }
1723
1724                if (k == idex_b && idex_b < SCAN_BSSID_MAX_SIZE) {
1725                        memcpy(&pp->bssid_array[idex_b++],
1726                               scan_6ghz_params[j].bssid, ETH_ALEN);
1727                }
1728        }
1729
1730        pp->short_ssid_num = idex_s;
1731        pp->bssid_num = idex_b;
1732        return 0;
1733}
1734
1735/* TODO: this function can be merged with iwl_mvm_scan_umac_fill_ch_p_v6 */
1736static void
1737iwl_mvm_umac_scan_cfg_channels_v6_6g(struct iwl_mvm_scan_params *params,
1738                                     u32 n_channels,
1739                                     struct iwl_scan_probe_params_v4 *pp,
1740                                     struct iwl_scan_channel_params_v6 *cp,
1741                                     enum nl80211_iftype vif_type)
1742{
1743        struct iwl_scan_channel_cfg_umac *channel_cfg = cp->channel_config;
1744        int i;
1745        struct cfg80211_scan_6ghz_params *scan_6ghz_params =
1746                params->scan_6ghz_params;
1747
1748        for (i = 0; i < params->n_channels; i++) {
1749                struct iwl_scan_channel_cfg_umac *cfg =
1750                        &cp->channel_config[i];
1751
1752                u32 s_ssid_bitmap = 0, bssid_bitmap = 0, flags = 0;
1753                u8 j, k, s_max = 0, b_max = 0, n_used_bssid_entries;
1754                bool force_passive, found = false, allow_passive = true,
1755                     unsolicited_probe_on_chan = false, psc_no_listen = false;
1756
1757                cfg->v1.channel_num = params->channels[i]->hw_value;
1758                cfg->v2.band = 2;
1759                cfg->v2.iter_count = 1;
1760                cfg->v2.iter_interval = 0;
1761
1762                /*
1763                 * The optimize the scan time, i.e., reduce the scan dwell time
1764                 * on each channel, the below logic tries to set 3 direct BSSID
1765                 * probe requests for each broadcast probe request with a short
1766                 * SSID.
1767                 * TODO: improve this logic
1768                 */
1769                n_used_bssid_entries = 3;
1770                for (j = 0; j < params->n_6ghz_params; j++) {
1771                        if (!(scan_6ghz_params[j].channel_idx == i))
1772                                continue;
1773
1774                        found = false;
1775                        unsolicited_probe_on_chan |=
1776                                scan_6ghz_params[j].unsolicited_probe;
1777                        psc_no_listen |= scan_6ghz_params[j].psc_no_listen;
1778
1779                        for (k = 0; k < pp->short_ssid_num; k++) {
1780                                if (!scan_6ghz_params[j].unsolicited_probe &&
1781                                    le32_to_cpu(pp->short_ssid[k]) ==
1782                                    scan_6ghz_params[j].short_ssid) {
1783                                        /* Relevant short SSID bit set */
1784                                        if (s_ssid_bitmap & BIT(k)) {
1785                                                found = true;
1786                                                break;
1787                                        }
1788
1789                                        /*
1790                                         * Use short SSID only to create a new
1791                                         * iteration during channel dwell or in
1792                                         * case that the short SSID has a
1793                                         * matching SSID, i.e., scan for hidden
1794                                         * APs.
1795                                         */
1796                                        if (n_used_bssid_entries >= 3) {
1797                                                s_ssid_bitmap |= BIT(k);
1798                                                s_max++;
1799                                                n_used_bssid_entries -= 3;
1800                                                found = true;
1801                                                break;
1802                                        } else if (pp->direct_scan[k].len) {
1803                                                s_ssid_bitmap |= BIT(k);
1804                                                s_max++;
1805                                                found = true;
1806                                                allow_passive = false;
1807                                                break;
1808                                        }
1809                                }
1810                        }
1811
1812                        if (found)
1813                                continue;
1814
1815                        for (k = 0; k < pp->bssid_num; k++) {
1816                                if (!memcmp(&pp->bssid_array[k],
1817                                            scan_6ghz_params[j].bssid,
1818                                            ETH_ALEN)) {
1819                                        if (!(bssid_bitmap & BIT(k))) {
1820                                                bssid_bitmap |= BIT(k);
1821                                                b_max++;
1822                                                n_used_bssid_entries++;
1823                                        }
1824                                        break;
1825                                }
1826                        }
1827                }
1828
1829                flags = bssid_bitmap | (s_ssid_bitmap << 16);
1830
1831                if (cfg80211_channel_is_psc(params->channels[i]) &&
1832                    psc_no_listen)
1833                        flags |= IWL_UHB_CHAN_CFG_FLAG_PSC_CHAN_NO_LISTEN;
1834
1835                if (unsolicited_probe_on_chan)
1836                        flags |= IWL_UHB_CHAN_CFG_FLAG_UNSOLICITED_PROBE_RES;
1837
1838                /*
1839                 * In the following cases apply passive scan:
1840                 * 1. Non fragmented scan:
1841                 *      - PSC channel with NO_LISTEN_FLAG on should be treated
1842                 *        like non PSC channel
1843                 *      - Non PSC channel with more than 3 short SSIDs or more
1844                 *        than 9 BSSIDs.
1845                 *      - Non PSC Channel with unsolicited probe response and
1846                 *        more than 2 short SSIDs or more than 6 BSSIDs.
1847                 *      - PSC channel with more than 2 short SSIDs or more than
1848                 *        6 BSSIDs.
1849                 * 3. Fragmented scan:
1850                 *      - PSC channel with more than 1 SSID or 3 BSSIDs.
1851                 *      - Non PSC channel with more than 2 SSIDs or 6 BSSIDs.
1852                 *      - Non PSC channel with unsolicited probe response and
1853                 *        more than 1 SSID or more than 3 BSSIDs.
1854                 */
1855                if (!iwl_mvm_is_scan_fragmented(params->type)) {
1856                        if (!cfg80211_channel_is_psc(params->channels[i]) ||
1857                            flags & IWL_UHB_CHAN_CFG_FLAG_PSC_CHAN_NO_LISTEN) {
1858                                force_passive = (s_max > 3 || b_max > 9);
1859                                force_passive |= (unsolicited_probe_on_chan &&
1860                                                  (s_max > 2 || b_max > 6));
1861                        } else {
1862                                force_passive = (s_max > 2 || b_max > 6);
1863                        }
1864                } else if (cfg80211_channel_is_psc(params->channels[i])) {
1865                        force_passive = (s_max > 1 || b_max > 3);
1866                } else {
1867                        force_passive = (s_max > 2 || b_max > 6);
1868                        force_passive |= (unsolicited_probe_on_chan &&
1869                                          (s_max > 1 || b_max > 3));
1870                }
1871                if ((allow_passive && force_passive) ||
1872                    (!flags && !cfg80211_channel_is_psc(params->channels[i])))
1873                        flags |= IWL_UHB_CHAN_CFG_FLAG_FORCE_PASSIVE;
1874
1875                channel_cfg[i].flags |= cpu_to_le32(flags);
1876        }
1877}
1878
1879static u8 iwl_mvm_scan_umac_chan_flags_v2(struct iwl_mvm *mvm,
1880                                          struct iwl_mvm_scan_params *params,
1881                                          struct ieee80211_vif *vif)
1882{
1883        u8 flags = 0;
1884
1885        flags |= IWL_SCAN_CHANNEL_FLAG_ENABLE_CHAN_ORDER;
1886
1887        if (iwl_mvm_scan_use_ebs(mvm, vif))
1888                flags |= IWL_SCAN_CHANNEL_FLAG_EBS |
1889                        IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
1890                        IWL_SCAN_CHANNEL_FLAG_CACHE_ADD;
1891
1892        /* set fragmented ebs for fragmented scan on HB channels */
1893        if (iwl_mvm_is_scan_fragmented(params->hb_type))
1894                flags |= IWL_SCAN_CHANNEL_FLAG_EBS_FRAG;
1895
1896        return flags;
1897}
1898
1899static void iwl_mvm_scan_6ghz_passive_scan(struct iwl_mvm *mvm,
1900                                           struct iwl_mvm_scan_params *params,
1901                                           struct ieee80211_vif *vif)
1902{
1903        struct ieee80211_supported_band *sband =
1904                &mvm->nvm_data->bands[NL80211_BAND_6GHZ];
1905        u32 n_disabled, i;
1906
1907        params->enable_6ghz_passive = false;
1908
1909        if (params->scan_6ghz)
1910                return;
1911
1912        if (!fw_has_capa(&mvm->fw->ucode_capa,
1913                         IWL_UCODE_TLV_CAPA_PASSIVE_6GHZ_SCAN)) {
1914                IWL_DEBUG_SCAN(mvm,
1915                               "6GHz passive scan: Not supported by FW\n");
1916                return;
1917        }
1918
1919        /* 6GHz passive scan allowed only on station interface  */
1920        if (vif->type != NL80211_IFTYPE_STATION) {
1921                IWL_DEBUG_SCAN(mvm,
1922                               "6GHz passive scan: not station interface\n");
1923                return;
1924        }
1925
1926        /*
1927         * 6GHz passive scan is allowed while associated in a defined time
1928         * interval following HW reset or resume flow
1929         */
1930        if (vif->bss_conf.assoc &&
1931            (time_before(mvm->last_reset_or_resume_time_jiffies +
1932                         (IWL_MVM_6GHZ_PASSIVE_SCAN_ASSOC_TIMEOUT * HZ),
1933                         jiffies))) {
1934                IWL_DEBUG_SCAN(mvm, "6GHz passive scan: associated\n");
1935                return;
1936        }
1937
1938        /* No need for 6GHz passive scan if not enough time elapsed */
1939        if (time_after(mvm->last_6ghz_passive_scan_jiffies +
1940                       (IWL_MVM_6GHZ_PASSIVE_SCAN_TIMEOUT * HZ), jiffies)) {
1941                IWL_DEBUG_SCAN(mvm,
1942                               "6GHz passive scan: timeout did not expire\n");
1943                return;
1944        }
1945
1946        /* not enough channels in the regular scan request */
1947        if (params->n_channels < IWL_MVM_6GHZ_PASSIVE_SCAN_MIN_CHANS) {
1948                IWL_DEBUG_SCAN(mvm,
1949                               "6GHz passive scan: not enough channels\n");
1950                return;
1951        }
1952
1953        for (i = 0; i < params->n_ssids; i++) {
1954                if (!params->ssids[i].ssid_len)
1955                        break;
1956        }
1957
1958        /* not a wildcard scan, so cannot enable passive 6GHz scan */
1959        if (i == params->n_ssids) {
1960                IWL_DEBUG_SCAN(mvm,
1961                               "6GHz passive scan: no wildcard SSID\n");
1962                return;
1963        }
1964
1965        if (!sband || !sband->n_channels) {
1966                IWL_DEBUG_SCAN(mvm,
1967                               "6GHz passive scan: no 6GHz channels\n");
1968                return;
1969        }
1970
1971        for (i = 0, n_disabled = 0; i < sband->n_channels; i++) {
1972                if (sband->channels[i].flags & (IEEE80211_CHAN_DISABLED))
1973                        n_disabled++;
1974        }
1975
1976        /*
1977         * Not all the 6GHz channels are disabled, so no need for 6GHz passive
1978         * scan
1979         */
1980        if (n_disabled != sband->n_channels) {
1981                IWL_DEBUG_SCAN(mvm,
1982                               "6GHz passive scan: 6GHz channels enabled\n");
1983                return;
1984        }
1985
1986        /* all conditions to enable 6ghz passive scan are satisfied */
1987        IWL_DEBUG_SCAN(mvm, "6GHz passive scan: can be enabled\n");
1988        params->enable_6ghz_passive = true;
1989}
1990
1991static u16 iwl_mvm_scan_umac_flags_v2(struct iwl_mvm *mvm,
1992                                      struct iwl_mvm_scan_params *params,
1993                                      struct ieee80211_vif *vif,
1994                                      int type)
1995{
1996        u16 flags = 0;
1997
1998        if (params->n_ssids == 0)
1999                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_FORCE_PASSIVE;
2000
2001        if (iwl_mvm_is_scan_fragmented(params->type))
2002                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_FRAGMENTED_LMAC1;
2003
2004        if (iwl_mvm_is_scan_fragmented(params->hb_type))
2005                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_FRAGMENTED_LMAC2;
2006
2007        if (params->pass_all)
2008                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_PASS_ALL;
2009        else
2010                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_MATCH;
2011
2012        if (!iwl_mvm_is_regular_scan(params))
2013                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_PERIODIC;
2014
2015        if (params->iter_notif ||
2016            mvm->sched_scan_pass_all == SCHED_SCAN_PASS_ALL_ENABLED)
2017                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_NTFY_ITER_COMPLETE;
2018
2019        if (IWL_MVM_ADWELL_ENABLE)
2020                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_ADAPTIVE_DWELL;
2021
2022        if (type == IWL_MVM_SCAN_SCHED || type == IWL_MVM_SCAN_NETDETECT)
2023                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_PREEMPTIVE;
2024
2025        if ((type == IWL_MVM_SCAN_SCHED || type == IWL_MVM_SCAN_NETDETECT) &&
2026            params->flags & NL80211_SCAN_FLAG_COLOCATED_6GHZ)
2027                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_TRIGGER_UHB_SCAN;
2028
2029        if (params->enable_6ghz_passive)
2030                flags |= IWL_UMAC_SCAN_GEN_FLAGS_V2_6GHZ_PASSIVE_SCAN;
2031
2032        return flags;
2033}
2034
2035static u16 iwl_mvm_scan_umac_flags(struct iwl_mvm *mvm,
2036                                   struct iwl_mvm_scan_params *params,
2037                                   struct ieee80211_vif *vif)
2038{
2039        u16 flags = 0;
2040
2041        if (params->n_ssids == 0)
2042                flags = IWL_UMAC_SCAN_GEN_FLAGS_PASSIVE;
2043
2044        if (params->n_ssids == 1 && params->ssids[0].ssid_len != 0)
2045                flags |= IWL_UMAC_SCAN_GEN_FLAGS_PRE_CONNECT;
2046
2047        if (iwl_mvm_is_scan_fragmented(params->type))
2048                flags |= IWL_UMAC_SCAN_GEN_FLAGS_FRAGMENTED;
2049
2050        if (iwl_mvm_is_cdb_supported(mvm) &&
2051            iwl_mvm_is_scan_fragmented(params->hb_type))
2052                flags |= IWL_UMAC_SCAN_GEN_FLAGS_LMAC2_FRAGMENTED;
2053
2054        if (iwl_mvm_rrm_scan_needed(mvm) &&
2055            fw_has_capa(&mvm->fw->ucode_capa,
2056                        IWL_UCODE_TLV_CAPA_WFA_TPC_REP_IE_SUPPORT))
2057                flags |= IWL_UMAC_SCAN_GEN_FLAGS_RRM_ENABLED;
2058
2059        if (params->pass_all)
2060                flags |= IWL_UMAC_SCAN_GEN_FLAGS_PASS_ALL;
2061        else
2062                flags |= IWL_UMAC_SCAN_GEN_FLAGS_MATCH;
2063
2064        if (!iwl_mvm_is_regular_scan(params))
2065                flags |= IWL_UMAC_SCAN_GEN_FLAGS_PERIODIC;
2066
2067        if (params->iter_notif)
2068                flags |= IWL_UMAC_SCAN_GEN_FLAGS_ITER_COMPLETE;
2069
2070#ifdef CONFIG_IWLWIFI_DEBUGFS
2071        if (mvm->scan_iter_notif_enabled)
2072                flags |= IWL_UMAC_SCAN_GEN_FLAGS_ITER_COMPLETE;
2073#endif
2074
2075        if (mvm->sched_scan_pass_all == SCHED_SCAN_PASS_ALL_ENABLED)
2076                flags |= IWL_UMAC_SCAN_GEN_FLAGS_ITER_COMPLETE;
2077
2078        if (iwl_mvm_is_adaptive_dwell_supported(mvm) && IWL_MVM_ADWELL_ENABLE)
2079                flags |= IWL_UMAC_SCAN_GEN_FLAGS_ADAPTIVE_DWELL;
2080
2081        /*
2082         * Extended dwell is relevant only for low band to start with, as it is
2083         * being used for social channles only (1, 6, 11), so we can check
2084         * only scan type on low band also for CDB.
2085         */
2086        if (iwl_mvm_is_regular_scan(params) &&
2087            vif->type != NL80211_IFTYPE_P2P_DEVICE &&
2088            !iwl_mvm_is_scan_fragmented(params->type) &&
2089            !iwl_mvm_is_adaptive_dwell_supported(mvm) &&
2090            !iwl_mvm_is_oce_supported(mvm))
2091                flags |= IWL_UMAC_SCAN_GEN_FLAGS_EXTENDED_DWELL;
2092
2093        if (iwl_mvm_is_oce_supported(mvm)) {
2094                if ((params->flags &
2095                     NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE))
2096                        flags |= IWL_UMAC_SCAN_GEN_FLAGS_PROB_REQ_HIGH_TX_RATE;
2097                /* Since IWL_UMAC_SCAN_GEN_FLAGS_EXTENDED_DWELL and
2098                 * NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION shares
2099                 * the same bit, we need to make sure that we use this bit here
2100                 * only when IWL_UMAC_SCAN_GEN_FLAGS_EXTENDED_DWELL cannot be
2101                 * used. */
2102                if ((params->flags &
2103                     NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) &&
2104                     !WARN_ON_ONCE(!iwl_mvm_is_adaptive_dwell_supported(mvm)))
2105                        flags |= IWL_UMAC_SCAN_GEN_FLAGS_PROB_REQ_DEFER_SUPP;
2106                if ((params->flags & NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME))
2107                        flags |= IWL_UMAC_SCAN_GEN_FLAGS_MAX_CHNL_TIME;
2108        }
2109
2110        return flags;
2111}
2112
2113static int
2114iwl_mvm_fill_scan_sched_params(struct iwl_mvm_scan_params *params,
2115                               struct iwl_scan_umac_schedule *schedule,
2116                               __le16 *delay)
2117{
2118        int i;
2119        if (WARN_ON(!params->n_scan_plans ||
2120                    params->n_scan_plans > IWL_MAX_SCHED_SCAN_PLANS))
2121                return -EINVAL;
2122
2123        for (i = 0; i < params->n_scan_plans; i++) {
2124                struct cfg80211_sched_scan_plan *scan_plan =
2125                        &params->scan_plans[i];
2126
2127                schedule[i].iter_count = scan_plan->iterations;
2128                schedule[i].interval =
2129                        cpu_to_le16(scan_plan->interval);
2130        }
2131
2132        /*
2133         * If the number of iterations of the last scan plan is set to
2134         * zero, it should run infinitely. However, this is not always the case.
2135         * For example, when regular scan is requested the driver sets one scan
2136         * plan with one iteration.
2137         */
2138        if (!schedule[params->n_scan_plans - 1].iter_count)
2139                schedule[params->n_scan_plans - 1].iter_count = 0xff;
2140
2141        *delay = cpu_to_le16(params->delay);
2142
2143        return 0;
2144}
2145
2146static int iwl_mvm_scan_umac(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
2147                             struct iwl_mvm_scan_params *params,
2148                             int type, int uid)
2149{
2150        struct iwl_scan_req_umac *cmd = mvm->scan_cmd;
2151        struct iwl_scan_umac_chan_param *chan_param;
2152        void *cmd_data = iwl_mvm_get_scan_req_umac_data(mvm);
2153        void *sec_part = cmd_data + sizeof(struct iwl_scan_channel_cfg_umac) *
2154                mvm->fw->ucode_capa.n_scan_channels;
2155        struct iwl_scan_req_umac_tail_v2 *tail_v2 =
2156                (struct iwl_scan_req_umac_tail_v2 *)sec_part;
2157        struct iwl_scan_req_umac_tail_v1 *tail_v1;
2158        struct iwl_ssid_ie *direct_scan;
2159        int ret = 0;
2160        u32 ssid_bitmap = 0;
2161        u8 channel_flags = 0;
2162        u16 gen_flags;
2163        struct iwl_mvm_vif *scan_vif = iwl_mvm_vif_from_mac80211(vif);
2164
2165        chan_param = iwl_mvm_get_scan_req_umac_channel(mvm);
2166
2167        iwl_mvm_scan_umac_dwell(mvm, cmd, params);
2168
2169        mvm->scan_uid_status[uid] = type;
2170
2171        cmd->uid = cpu_to_le32(uid);
2172        gen_flags = iwl_mvm_scan_umac_flags(mvm, params, vif);
2173        cmd->general_flags = cpu_to_le16(gen_flags);
2174        if (iwl_mvm_is_adaptive_dwell_v2_supported(mvm)) {
2175                if (gen_flags & IWL_UMAC_SCAN_GEN_FLAGS_FRAGMENTED)
2176                        cmd->v8.num_of_fragments[SCAN_LB_LMAC_IDX] =
2177                                                        IWL_SCAN_NUM_OF_FRAGS;
2178                if (gen_flags & IWL_UMAC_SCAN_GEN_FLAGS_LMAC2_FRAGMENTED)
2179                        cmd->v8.num_of_fragments[SCAN_HB_LMAC_IDX] =
2180                                                        IWL_SCAN_NUM_OF_FRAGS;
2181
2182                cmd->v8.general_flags2 =
2183                        IWL_UMAC_SCAN_GEN_FLAGS2_ALLOW_CHNL_REORDER;
2184        }
2185
2186        cmd->scan_start_mac_id = scan_vif->id;
2187
2188        if (type == IWL_MVM_SCAN_SCHED || type == IWL_MVM_SCAN_NETDETECT)
2189                cmd->flags = cpu_to_le32(IWL_UMAC_SCAN_FLAG_PREEMPTIVE);
2190
2191        if (iwl_mvm_scan_use_ebs(mvm, vif)) {
2192                channel_flags = IWL_SCAN_CHANNEL_FLAG_EBS |
2193                                IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
2194                                IWL_SCAN_CHANNEL_FLAG_CACHE_ADD;
2195
2196                /* set fragmented ebs for fragmented scan on HB channels */
2197                if (iwl_mvm_is_frag_ebs_supported(mvm)) {
2198                        if (gen_flags &
2199                            IWL_UMAC_SCAN_GEN_FLAGS_LMAC2_FRAGMENTED ||
2200                            (!iwl_mvm_is_cdb_supported(mvm) &&
2201                             gen_flags & IWL_UMAC_SCAN_GEN_FLAGS_FRAGMENTED))
2202                                channel_flags |= IWL_SCAN_CHANNEL_FLAG_EBS_FRAG;
2203                }
2204        }
2205
2206        chan_param->flags = channel_flags;
2207        chan_param->count = params->n_channels;
2208
2209        ret = iwl_mvm_fill_scan_sched_params(params, tail_v2->schedule,
2210                                             &tail_v2->delay);
2211        if (ret) {
2212                mvm->scan_uid_status[uid] = 0;
2213                return ret;
2214        }
2215
2216        if (iwl_mvm_is_scan_ext_chan_supported(mvm)) {
2217                tail_v2->preq = params->preq;
2218                direct_scan = tail_v2->direct_scan;
2219        } else {
2220                tail_v1 = (struct iwl_scan_req_umac_tail_v1 *)sec_part;
2221                iwl_mvm_scan_set_legacy_probe_req(&tail_v1->preq,
2222                                                  &params->preq);
2223                direct_scan = tail_v1->direct_scan;
2224        }
2225        iwl_scan_build_ssids(params, direct_scan, &ssid_bitmap);
2226        iwl_mvm_umac_scan_cfg_channels(mvm, params->channels,
2227                                       params->n_channels, ssid_bitmap,
2228                                       cmd_data);
2229        return 0;
2230}
2231
2232static void
2233iwl_mvm_scan_umac_fill_general_p_v10(struct iwl_mvm *mvm,
2234                                     struct iwl_mvm_scan_params *params,
2235                                     struct ieee80211_vif *vif,
2236                                     struct iwl_scan_general_params_v10 *gp,
2237                                     u16 gen_flags)
2238{
2239        struct iwl_mvm_vif *scan_vif = iwl_mvm_vif_from_mac80211(vif);
2240
2241        iwl_mvm_scan_umac_dwell_v10(mvm, gp, params);
2242
2243        gp->flags = cpu_to_le16(gen_flags);
2244
2245        if (gen_flags & IWL_UMAC_SCAN_GEN_FLAGS_V2_FRAGMENTED_LMAC1)
2246                gp->num_of_fragments[SCAN_LB_LMAC_IDX] = IWL_SCAN_NUM_OF_FRAGS;
2247        if (gen_flags & IWL_UMAC_SCAN_GEN_FLAGS_V2_FRAGMENTED_LMAC2)
2248                gp->num_of_fragments[SCAN_HB_LMAC_IDX] = IWL_SCAN_NUM_OF_FRAGS;
2249
2250        gp->scan_start_mac_id = scan_vif->id;
2251}
2252
2253static void
2254iwl_mvm_scan_umac_fill_probe_p_v3(struct iwl_mvm_scan_params *params,
2255                                  struct iwl_scan_probe_params_v3 *pp)
2256{
2257        pp->preq = params->preq;
2258        pp->ssid_num = params->n_ssids;
2259        iwl_scan_build_ssids(params, pp->direct_scan, NULL);
2260}
2261
2262static void
2263iwl_mvm_scan_umac_fill_probe_p_v4(struct iwl_mvm_scan_params *params,
2264                                  struct iwl_scan_probe_params_v4 *pp,
2265                                  u32 *bitmap_ssid)
2266{
2267        pp->preq = params->preq;
2268        iwl_scan_build_ssids(params, pp->direct_scan, bitmap_ssid);
2269}
2270
2271static void
2272iwl_mvm_scan_umac_fill_ch_p_v4(struct iwl_mvm *mvm,
2273                               struct iwl_mvm_scan_params *params,
2274                               struct ieee80211_vif *vif,
2275                               struct iwl_scan_channel_params_v4 *cp,
2276                               u32 channel_cfg_flags)
2277{
2278        cp->flags = iwl_mvm_scan_umac_chan_flags_v2(mvm, params, vif);
2279        cp->count = params->n_channels;
2280        cp->num_of_aps_override = IWL_SCAN_ADWELL_N_APS_GO_FRIENDLY;
2281
2282        iwl_mvm_umac_scan_cfg_channels_v4(mvm, params->channels, cp,
2283                                          params->n_channels,
2284                                          channel_cfg_flags,
2285                                          vif->type);
2286}
2287
2288static void
2289iwl_mvm_scan_umac_fill_ch_p_v6(struct iwl_mvm *mvm,
2290                               struct iwl_mvm_scan_params *params,
2291                               struct ieee80211_vif *vif,
2292                               struct iwl_scan_channel_params_v6 *cp,
2293                               u32 channel_cfg_flags)
2294{
2295        cp->flags = iwl_mvm_scan_umac_chan_flags_v2(mvm, params, vif);
2296        cp->count = params->n_channels;
2297        cp->n_aps_override[0] = IWL_SCAN_ADWELL_N_APS_GO_FRIENDLY;
2298        cp->n_aps_override[1] = IWL_SCAN_ADWELL_N_APS_SOCIAL_CHS;
2299
2300        iwl_mvm_umac_scan_cfg_channels_v6(mvm, params->channels, cp,
2301                                          params->n_channels,
2302                                          channel_cfg_flags,
2303                                          vif->type);
2304
2305        if (params->enable_6ghz_passive) {
2306                struct ieee80211_supported_band *sband =
2307                        &mvm->nvm_data->bands[NL80211_BAND_6GHZ];
2308                u32 i;
2309
2310                for (i = 0; i < sband->n_channels; i++) {
2311                        struct ieee80211_channel *channel =
2312                                &sband->channels[i];
2313
2314                        struct iwl_scan_channel_cfg_umac *cfg =
2315                                &cp->channel_config[cp->count];
2316
2317                        if (!cfg80211_channel_is_psc(channel))
2318                                continue;
2319
2320                        cfg->flags = 0;
2321                        cfg->v2.channel_num = channel->hw_value;
2322                        cfg->v2.band = PHY_BAND_6;
2323                        cfg->v2.iter_count = 1;
2324                        cfg->v2.iter_interval = 0;
2325                        cp->count++;
2326                }
2327        }
2328}
2329
2330static int iwl_mvm_scan_umac_v12(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
2331                                 struct iwl_mvm_scan_params *params, int type,
2332                                 int uid)
2333{
2334        struct iwl_scan_req_umac_v12 *cmd = mvm->scan_cmd;
2335        struct iwl_scan_req_params_v12 *scan_p = &cmd->scan_params;
2336        int ret;
2337        u16 gen_flags;
2338
2339        mvm->scan_uid_status[uid] = type;
2340
2341        cmd->ooc_priority = cpu_to_le32(iwl_mvm_scan_umac_ooc_priority(params));
2342        cmd->uid = cpu_to_le32(uid);
2343
2344        gen_flags = iwl_mvm_scan_umac_flags_v2(mvm, params, vif, type);
2345        iwl_mvm_scan_umac_fill_general_p_v10(mvm, params, vif,
2346                                             &scan_p->general_params,
2347                                             gen_flags);
2348
2349        ret = iwl_mvm_fill_scan_sched_params(params,
2350                                             scan_p->periodic_params.schedule,
2351                                             &scan_p->periodic_params.delay);
2352        if (ret)
2353                return ret;
2354
2355        iwl_mvm_scan_umac_fill_probe_p_v3(params, &scan_p->probe_params);
2356        iwl_mvm_scan_umac_fill_ch_p_v4(mvm, params, vif,
2357                                       &scan_p->channel_params, 0);
2358
2359        return 0;
2360}
2361
2362static int iwl_mvm_scan_umac_v14(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
2363                                 struct iwl_mvm_scan_params *params, int type,
2364                                 int uid)
2365{
2366        struct iwl_scan_req_umac_v14 *cmd = mvm->scan_cmd;
2367        struct iwl_scan_req_params_v14 *scan_p = &cmd->scan_params;
2368        struct iwl_scan_channel_params_v6 *cp = &scan_p->channel_params;
2369        struct iwl_scan_probe_params_v4 *pb = &scan_p->probe_params;
2370        int ret;
2371        u16 gen_flags;
2372        u32 bitmap_ssid = 0;
2373
2374        mvm->scan_uid_status[uid] = type;
2375
2376        cmd->ooc_priority = cpu_to_le32(iwl_mvm_scan_umac_ooc_priority(params));
2377        cmd->uid = cpu_to_le32(uid);
2378
2379        gen_flags = iwl_mvm_scan_umac_flags_v2(mvm, params, vif, type);
2380        iwl_mvm_scan_umac_fill_general_p_v10(mvm, params, vif,
2381                                             &scan_p->general_params,
2382                                             gen_flags);
2383
2384        ret = iwl_mvm_fill_scan_sched_params(params,
2385                                             scan_p->periodic_params.schedule,
2386                                             &scan_p->periodic_params.delay);
2387        if (ret)
2388                return ret;
2389
2390        if (!params->scan_6ghz) {
2391                iwl_mvm_scan_umac_fill_probe_p_v4(params, &scan_p->probe_params,
2392                                          &bitmap_ssid);
2393                iwl_mvm_scan_umac_fill_ch_p_v6(mvm, params, vif,
2394                                       &scan_p->channel_params, bitmap_ssid);
2395
2396                return 0;
2397        } else {
2398                pb->preq = params->preq;
2399        }
2400
2401        cp->flags = iwl_mvm_scan_umac_chan_flags_v2(mvm, params, vif);
2402        cp->n_aps_override[0] = IWL_SCAN_ADWELL_N_APS_GO_FRIENDLY;
2403        cp->n_aps_override[1] = IWL_SCAN_ADWELL_N_APS_SOCIAL_CHS;
2404
2405        ret = iwl_mvm_umac_scan_fill_6g_chan_list(mvm, params, pb);
2406        if (ret)
2407                return ret;
2408
2409        iwl_mvm_umac_scan_cfg_channels_v6_6g(params,
2410                                             params->n_channels,
2411                                             pb, cp, vif->type);
2412        cp->count = params->n_channels;
2413        if (!params->n_ssids ||
2414            (params->n_ssids == 1 && !params->ssids[0].ssid_len))
2415                cp->flags |= IWL_SCAN_CHANNEL_FLAG_6G_PSC_NO_FILTER;
2416
2417        return 0;
2418}
2419
2420static int iwl_mvm_num_scans(struct iwl_mvm *mvm)
2421{
2422        return hweight32(mvm->scan_status & IWL_MVM_SCAN_MASK);
2423}
2424
2425static int iwl_mvm_check_running_scans(struct iwl_mvm *mvm, int type)
2426{
2427        bool unified_image = fw_has_capa(&mvm->fw->ucode_capa,
2428                                         IWL_UCODE_TLV_CAPA_CNSLDTD_D3_D0_IMG);
2429
2430        /* This looks a bit arbitrary, but the idea is that if we run
2431         * out of possible simultaneous scans and the userspace is
2432         * trying to run a scan type that is already running, we
2433         * return -EBUSY.  But if the userspace wants to start a
2434         * different type of scan, we stop the opposite type to make
2435         * space for the new request.  The reason is backwards
2436         * compatibility with old wpa_supplicant that wouldn't stop a
2437         * scheduled scan before starting a normal scan.
2438         */
2439
2440        /* FW supports only a single periodic scan */
2441        if ((type == IWL_MVM_SCAN_SCHED || type == IWL_MVM_SCAN_NETDETECT) &&
2442            mvm->scan_status & (IWL_MVM_SCAN_SCHED | IWL_MVM_SCAN_NETDETECT))
2443                return -EBUSY;
2444
2445        if (iwl_mvm_num_scans(mvm) < mvm->max_scans)
2446                return 0;
2447
2448        /* Use a switch, even though this is a bitmask, so that more
2449         * than one bits set will fall in default and we will warn.
2450         */
2451        switch (type) {
2452        case IWL_MVM_SCAN_REGULAR:
2453                if (mvm->scan_status & IWL_MVM_SCAN_REGULAR_MASK)
2454                        return -EBUSY;
2455                return iwl_mvm_scan_stop(mvm, IWL_MVM_SCAN_SCHED, true);
2456        case IWL_MVM_SCAN_SCHED:
2457                if (mvm->scan_status & IWL_MVM_SCAN_SCHED_MASK)
2458                        return -EBUSY;
2459                return iwl_mvm_scan_stop(mvm, IWL_MVM_SCAN_REGULAR, true);
2460        case IWL_MVM_SCAN_NETDETECT:
2461                /* For non-unified images, there's no need to stop
2462                 * anything for net-detect since the firmware is
2463                 * restarted anyway.  This way, any sched scans that
2464                 * were running will be restarted when we resume.
2465                 */
2466                if (!unified_image)
2467                        return 0;
2468
2469                /* If this is a unified image and we ran out of scans,
2470                 * we need to stop something.  Prefer stopping regular
2471                 * scans, because the results are useless at this
2472                 * point, and we should be able to keep running
2473                 * another scheduled scan while suspended.
2474                 */
2475                if (mvm->scan_status & IWL_MVM_SCAN_REGULAR_MASK)
2476                        return iwl_mvm_scan_stop(mvm, IWL_MVM_SCAN_REGULAR,
2477                                                 true);
2478                if (mvm->scan_status & IWL_MVM_SCAN_SCHED_MASK)
2479                        return iwl_mvm_scan_stop(mvm, IWL_MVM_SCAN_SCHED,
2480                                                 true);
2481                /* Something is wrong if no scan was running but we
2482                 * ran out of scans.
2483                 */
2484                fallthrough;
2485        default:
2486                WARN_ON(1);
2487                break;
2488        }
2489
2490        return -EIO;
2491}
2492
2493#define SCAN_TIMEOUT 20000
2494
2495void iwl_mvm_scan_timeout_wk(struct work_struct *work)
2496{
2497        struct delayed_work *delayed_work = to_delayed_work(work);
2498        struct iwl_mvm *mvm = container_of(delayed_work, struct iwl_mvm,
2499                                           scan_timeout_dwork);
2500
2501        IWL_ERR(mvm, "regular scan timed out\n");
2502
2503        iwl_force_nmi(mvm->trans);
2504}
2505
2506static void iwl_mvm_fill_scan_type(struct iwl_mvm *mvm,
2507                                   struct iwl_mvm_scan_params *params,
2508                                   struct ieee80211_vif *vif)
2509{
2510        if (iwl_mvm_is_cdb_supported(mvm)) {
2511                params->type =
2512                        iwl_mvm_get_scan_type_band(mvm, vif,
2513                                                   NL80211_BAND_2GHZ);
2514                params->hb_type =
2515                        iwl_mvm_get_scan_type_band(mvm, vif,
2516                                                   NL80211_BAND_5GHZ);
2517        } else {
2518                params->type = iwl_mvm_get_scan_type(mvm, vif);
2519        }
2520}
2521
2522struct iwl_scan_umac_handler {
2523        u8 version;
2524        int (*handler)(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
2525                       struct iwl_mvm_scan_params *params, int type, int uid);
2526};
2527
2528#define IWL_SCAN_UMAC_HANDLER(_ver) {           \
2529        .version = _ver,                        \
2530        .handler = iwl_mvm_scan_umac_v##_ver,   \
2531}
2532
2533static const struct iwl_scan_umac_handler iwl_scan_umac_handlers[] = {
2534        /* set the newest version first to shorten the list traverse time */
2535        IWL_SCAN_UMAC_HANDLER(14),
2536        IWL_SCAN_UMAC_HANDLER(12),
2537};
2538
2539static int iwl_mvm_build_scan_cmd(struct iwl_mvm *mvm,
2540                                  struct ieee80211_vif *vif,
2541                                  struct iwl_host_cmd *hcmd,
2542                                  struct iwl_mvm_scan_params *params,
2543                                  int type)
2544{
2545        int uid, i, err;
2546        u8 scan_ver;
2547
2548        lockdep_assert_held(&mvm->mutex);
2549        memset(mvm->scan_cmd, 0, ksize(mvm->scan_cmd));
2550
2551        if (!fw_has_capa(&mvm->fw->ucode_capa, IWL_UCODE_TLV_CAPA_UMAC_SCAN)) {
2552                hcmd->id = SCAN_OFFLOAD_REQUEST_CMD;
2553
2554                return iwl_mvm_scan_lmac(mvm, vif, params);
2555        }
2556
2557        uid = iwl_mvm_scan_uid_by_status(mvm, 0);
2558        if (uid < 0)
2559                return uid;
2560
2561        hcmd->id = iwl_cmd_id(SCAN_REQ_UMAC, IWL_ALWAYS_LONG_GROUP, 0);
2562
2563        scan_ver = iwl_fw_lookup_cmd_ver(mvm->fw, IWL_ALWAYS_LONG_GROUP,
2564                                         SCAN_REQ_UMAC,
2565                                         IWL_FW_CMD_VER_UNKNOWN);
2566
2567        for (i = 0; i < ARRAY_SIZE(iwl_scan_umac_handlers); i++) {
2568                const struct iwl_scan_umac_handler *ver_handler =
2569                        &iwl_scan_umac_handlers[i];
2570
2571                if (ver_handler->version != scan_ver)
2572                        continue;
2573
2574                return ver_handler->handler(mvm, vif, params, type, uid);
2575        }
2576
2577        err = iwl_mvm_scan_umac(mvm, vif, params, type, uid);
2578        if (err)
2579                return err;
2580
2581        return uid;
2582}
2583
2584int iwl_mvm_reg_scan_start(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
2585                           struct cfg80211_scan_request *req,
2586                           struct ieee80211_scan_ies *ies)
2587{
2588        struct iwl_host_cmd hcmd = {
2589                .len = { iwl_mvm_scan_size(mvm), },
2590                .data = { mvm->scan_cmd, },
2591                .dataflags = { IWL_HCMD_DFL_NOCOPY, },
2592        };
2593        struct iwl_mvm_scan_params params = {};
2594        int ret, uid;
2595        struct cfg80211_sched_scan_plan scan_plan = { .iterations = 1 };
2596
2597        lockdep_assert_held(&mvm->mutex);
2598
2599        if (iwl_mvm_is_lar_supported(mvm) && !mvm->lar_regdom_set) {
2600                IWL_ERR(mvm, "scan while LAR regdomain is not set\n");
2601                return -EBUSY;
2602        }
2603
2604        ret = iwl_mvm_check_running_scans(mvm, IWL_MVM_SCAN_REGULAR);
2605        if (ret)
2606                return ret;
2607
2608        /* we should have failed registration if scan_cmd was NULL */
2609        if (WARN_ON(!mvm->scan_cmd))
2610                return -ENOMEM;
2611
2612        if (!iwl_mvm_scan_fits(mvm, req->n_ssids, ies, req->n_channels))
2613                return -ENOBUFS;
2614
2615        params.n_ssids = req->n_ssids;
2616        params.flags = req->flags;
2617        params.n_channels = req->n_channels;
2618        params.delay = 0;
2619        params.ssids = req->ssids;
2620        params.channels = req->channels;
2621        params.mac_addr = req->mac_addr;
2622        params.mac_addr_mask = req->mac_addr_mask;
2623        params.no_cck = req->no_cck;
2624        params.pass_all = true;
2625        params.n_match_sets = 0;
2626        params.match_sets = NULL;
2627
2628        params.scan_plans = &scan_plan;
2629        params.n_scan_plans = 1;
2630
2631        params.n_6ghz_params = req->n_6ghz_params;
2632        params.scan_6ghz_params = req->scan_6ghz_params;
2633        params.scan_6ghz = req->scan_6ghz;
2634        iwl_mvm_fill_scan_type(mvm, &params, vif);
2635
2636        if (req->duration)
2637                params.iter_notif = true;
2638
2639        iwl_mvm_build_scan_probe(mvm, vif, ies, &params);
2640
2641        iwl_mvm_scan_6ghz_passive_scan(mvm, &params, vif);
2642
2643        uid = iwl_mvm_build_scan_cmd(mvm, vif, &hcmd, &params,
2644                                     IWL_MVM_SCAN_REGULAR);
2645
2646        if (uid < 0)
2647                return uid;
2648
2649        iwl_mvm_pause_tcm(mvm, false);
2650
2651        ret = iwl_mvm_send_cmd(mvm, &hcmd);
2652        if (ret) {
2653                /* If the scan failed, it usually means that the FW was unable
2654                 * to allocate the time events. Warn on it, but maybe we
2655                 * should try to send the command again with different params.
2656                 */
2657                IWL_ERR(mvm, "Scan failed! ret %d\n", ret);
2658                iwl_mvm_resume_tcm(mvm);
2659                mvm->scan_uid_status[uid] = 0;
2660                return ret;
2661        }
2662
2663        IWL_DEBUG_SCAN(mvm, "Scan request was sent successfully\n");
2664        mvm->scan_status |= IWL_MVM_SCAN_REGULAR;
2665        mvm->scan_vif = iwl_mvm_vif_from_mac80211(vif);
2666
2667        if (params.enable_6ghz_passive)
2668                mvm->last_6ghz_passive_scan_jiffies = jiffies;
2669
2670        schedule_delayed_work(&mvm->scan_timeout_dwork,
2671                              msecs_to_jiffies(SCAN_TIMEOUT));
2672
2673        return 0;
2674}
2675
2676int iwl_mvm_sched_scan_start(struct iwl_mvm *mvm,
2677                             struct ieee80211_vif *vif,
2678                             struct cfg80211_sched_scan_request *req,
2679                             struct ieee80211_scan_ies *ies,
2680                             int type)
2681{
2682        struct iwl_host_cmd hcmd = {
2683                .len = { iwl_mvm_scan_size(mvm), },
2684                .data = { mvm->scan_cmd, },
2685                .dataflags = { IWL_HCMD_DFL_NOCOPY, },
2686        };
2687        struct iwl_mvm_scan_params params = {};
2688        int ret, uid;
2689        int i, j;
2690        bool non_psc_included = false;
2691
2692        lockdep_assert_held(&mvm->mutex);
2693
2694        if (iwl_mvm_is_lar_supported(mvm) && !mvm->lar_regdom_set) {
2695                IWL_ERR(mvm, "sched-scan while LAR regdomain is not set\n");
2696                return -EBUSY;
2697        }
2698
2699        ret = iwl_mvm_check_running_scans(mvm, type);
2700        if (ret)
2701                return ret;
2702
2703        /* we should have failed registration if scan_cmd was NULL */
2704        if (WARN_ON(!mvm->scan_cmd))
2705                return -ENOMEM;
2706
2707
2708        params.n_ssids = req->n_ssids;
2709        params.flags = req->flags;
2710        params.n_channels = req->n_channels;
2711        params.ssids = req->ssids;
2712        params.channels = req->channels;
2713        params.mac_addr = req->mac_addr;
2714        params.mac_addr_mask = req->mac_addr_mask;
2715        params.no_cck = false;
2716        params.pass_all =  iwl_mvm_scan_pass_all(mvm, req);
2717        params.n_match_sets = req->n_match_sets;
2718        params.match_sets = req->match_sets;
2719        if (!req->n_scan_plans)
2720                return -EINVAL;
2721
2722        params.n_scan_plans = req->n_scan_plans;
2723        params.scan_plans = req->scan_plans;
2724
2725        iwl_mvm_fill_scan_type(mvm, &params, vif);
2726
2727        /* In theory, LMAC scans can handle a 32-bit delay, but since
2728         * waiting for over 18 hours to start the scan is a bit silly
2729         * and to keep it aligned with UMAC scans (which only support
2730         * 16-bit delays), trim it down to 16-bits.
2731         */
2732        if (req->delay > U16_MAX) {
2733                IWL_DEBUG_SCAN(mvm,
2734                               "delay value is > 16-bits, set to max possible\n");
2735                params.delay = U16_MAX;
2736        } else {
2737                params.delay = req->delay;
2738        }
2739
2740        ret = iwl_mvm_config_sched_scan_profiles(mvm, req);
2741        if (ret)
2742                return ret;
2743
2744        iwl_mvm_build_scan_probe(mvm, vif, ies, &params);
2745
2746        /* for 6 GHZ band only PSC channels need to be added */
2747        for (i = 0; i < params.n_channels; i++) {
2748                struct ieee80211_channel *channel = params.channels[i];
2749
2750                if (channel->band == NL80211_BAND_6GHZ &&
2751                    !cfg80211_channel_is_psc(channel)) {
2752                        non_psc_included = true;
2753                        break;
2754                }
2755        }
2756
2757        if (non_psc_included) {
2758                params.channels = kmemdup(params.channels,
2759                                          sizeof(params.channels[0]) *
2760                                          params.n_channels,
2761                                          GFP_KERNEL);
2762                if (!params.channels)
2763                        return -ENOMEM;
2764
2765                for (i = j = 0; i < params.n_channels; i++) {
2766                        if (params.channels[i]->band == NL80211_BAND_6GHZ &&
2767                            !cfg80211_channel_is_psc(params.channels[i]))
2768                                continue;
2769                        params.channels[j++] = params.channels[i];
2770                }
2771                params.n_channels = j;
2772        }
2773
2774        if (non_psc_included &&
2775            !iwl_mvm_scan_fits(mvm, req->n_ssids, ies, params.n_channels)) {
2776                kfree(params.channels);
2777                return -ENOBUFS;
2778        }
2779
2780        uid = iwl_mvm_build_scan_cmd(mvm, vif, &hcmd, &params, type);
2781
2782        if (non_psc_included)
2783                kfree(params.channels);
2784        if (uid < 0)
2785                return uid;
2786
2787        ret = iwl_mvm_send_cmd(mvm, &hcmd);
2788        if (!ret) {
2789                IWL_DEBUG_SCAN(mvm,
2790                               "Sched scan request was sent successfully\n");
2791                mvm->scan_status |= type;
2792        } else {
2793                /* If the scan failed, it usually means that the FW was unable
2794                 * to allocate the time events. Warn on it, but maybe we
2795                 * should try to send the command again with different params.
2796                 */
2797                IWL_ERR(mvm, "Sched scan failed! ret %d\n", ret);
2798                mvm->scan_uid_status[uid] = 0;
2799                mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_DISABLED;
2800        }
2801
2802        return ret;
2803}
2804
2805void iwl_mvm_rx_umac_scan_complete_notif(struct iwl_mvm *mvm,
2806                                         struct iwl_rx_cmd_buffer *rxb)
2807{
2808        struct iwl_rx_packet *pkt = rxb_addr(rxb);
2809        struct iwl_umac_scan_complete *notif = (void *)pkt->data;
2810        u32 uid = __le32_to_cpu(notif->uid);
2811        bool aborted = (notif->status == IWL_SCAN_OFFLOAD_ABORTED);
2812
2813        if (WARN_ON(!(mvm->scan_uid_status[uid] & mvm->scan_status)))
2814                return;
2815
2816        /* if the scan is already stopping, we don't need to notify mac80211 */
2817        if (mvm->scan_uid_status[uid] == IWL_MVM_SCAN_REGULAR) {
2818                struct cfg80211_scan_info info = {
2819                        .aborted = aborted,
2820                        .scan_start_tsf = mvm->scan_start,
2821                };
2822
2823                memcpy(info.tsf_bssid, mvm->scan_vif->bssid, ETH_ALEN);
2824                ieee80211_scan_completed(mvm->hw, &info);
2825                mvm->scan_vif = NULL;
2826                cancel_delayed_work(&mvm->scan_timeout_dwork);
2827                iwl_mvm_resume_tcm(mvm);
2828        } else if (mvm->scan_uid_status[uid] == IWL_MVM_SCAN_SCHED) {
2829                ieee80211_sched_scan_stopped(mvm->hw);
2830                mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_DISABLED;
2831        }
2832
2833        mvm->scan_status &= ~mvm->scan_uid_status[uid];
2834        IWL_DEBUG_SCAN(mvm,
2835                       "Scan completed, uid %u type %u, status %s, EBS status %s\n",
2836                       uid, mvm->scan_uid_status[uid],
2837                       notif->status == IWL_SCAN_OFFLOAD_COMPLETED ?
2838                                "completed" : "aborted",
2839                       iwl_mvm_ebs_status_str(notif->ebs_status));
2840        IWL_DEBUG_SCAN(mvm,
2841                       "Last line %d, Last iteration %d, Time from last iteration %d\n",
2842                       notif->last_schedule, notif->last_iter,
2843                       __le32_to_cpu(notif->time_from_last_iter));
2844
2845        if (notif->ebs_status != IWL_SCAN_EBS_SUCCESS &&
2846            notif->ebs_status != IWL_SCAN_EBS_INACTIVE)
2847                mvm->last_ebs_successful = false;
2848
2849        mvm->scan_uid_status[uid] = 0;
2850}
2851
2852void iwl_mvm_rx_umac_scan_iter_complete_notif(struct iwl_mvm *mvm,
2853                                              struct iwl_rx_cmd_buffer *rxb)
2854{
2855        struct iwl_rx_packet *pkt = rxb_addr(rxb);
2856        struct iwl_umac_scan_iter_complete_notif *notif = (void *)pkt->data;
2857
2858        mvm->scan_start = le64_to_cpu(notif->start_tsf);
2859
2860        IWL_DEBUG_SCAN(mvm,
2861                       "UMAC Scan iteration complete: status=0x%x scanned_channels=%d\n",
2862                       notif->status, notif->scanned_channels);
2863
2864        if (mvm->sched_scan_pass_all == SCHED_SCAN_PASS_ALL_FOUND) {
2865                IWL_DEBUG_SCAN(mvm, "Pass all scheduled scan results found\n");
2866                ieee80211_sched_scan_results(mvm->hw);
2867                mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_ENABLED;
2868        }
2869
2870        IWL_DEBUG_SCAN(mvm,
2871                       "UMAC Scan iteration complete: scan started at %llu (TSF)\n",
2872                       mvm->scan_start);
2873}
2874
2875static int iwl_mvm_umac_scan_abort(struct iwl_mvm *mvm, int type)
2876{
2877        struct iwl_umac_scan_abort cmd = {};
2878        int uid, ret;
2879
2880        lockdep_assert_held(&mvm->mutex);
2881
2882        /* We should always get a valid index here, because we already
2883         * checked that this type of scan was running in the generic
2884         * code.
2885         */
2886        uid = iwl_mvm_scan_uid_by_status(mvm, type);
2887        if (WARN_ON_ONCE(uid < 0))
2888                return uid;
2889
2890        cmd.uid = cpu_to_le32(uid);
2891
2892        IWL_DEBUG_SCAN(mvm, "Sending scan abort, uid %u\n", uid);
2893
2894        ret = iwl_mvm_send_cmd_pdu(mvm,
2895                                   iwl_cmd_id(SCAN_ABORT_UMAC,
2896                                              IWL_ALWAYS_LONG_GROUP, 0),
2897                                   0, sizeof(cmd), &cmd);
2898        if (!ret)
2899                mvm->scan_uid_status[uid] = type << IWL_MVM_SCAN_STOPPING_SHIFT;
2900
2901        return ret;
2902}
2903
2904static int iwl_mvm_scan_stop_wait(struct iwl_mvm *mvm, int type)
2905{
2906        struct iwl_notification_wait wait_scan_done;
2907        static const u16 scan_done_notif[] = { SCAN_COMPLETE_UMAC,
2908                                              SCAN_OFFLOAD_COMPLETE, };
2909        int ret;
2910
2911        lockdep_assert_held(&mvm->mutex);
2912
2913        iwl_init_notification_wait(&mvm->notif_wait, &wait_scan_done,
2914                                   scan_done_notif,
2915                                   ARRAY_SIZE(scan_done_notif),
2916                                   NULL, NULL);
2917
2918        IWL_DEBUG_SCAN(mvm, "Preparing to stop scan, type %x\n", type);
2919
2920        if (fw_has_capa(&mvm->fw->ucode_capa, IWL_UCODE_TLV_CAPA_UMAC_SCAN))
2921                ret = iwl_mvm_umac_scan_abort(mvm, type);
2922        else
2923                ret = iwl_mvm_lmac_scan_abort(mvm);
2924
2925        if (ret) {
2926                IWL_DEBUG_SCAN(mvm, "couldn't stop scan type %d\n", type);
2927                iwl_remove_notification(&mvm->notif_wait, &wait_scan_done);
2928                return ret;
2929        }
2930
2931        return iwl_wait_notification(&mvm->notif_wait, &wait_scan_done,
2932                                     1 * HZ);
2933}
2934
2935#define IWL_SCAN_REQ_UMAC_HANDLE_SIZE(_ver) {                           \
2936        case (_ver): return sizeof(struct iwl_scan_req_umac_v##_ver);   \
2937}
2938
2939static int iwl_scan_req_umac_get_size(u8 scan_ver)
2940{
2941        switch (scan_ver) {
2942                IWL_SCAN_REQ_UMAC_HANDLE_SIZE(14);
2943                IWL_SCAN_REQ_UMAC_HANDLE_SIZE(12);
2944        }
2945
2946        return 0;
2947}
2948
2949int iwl_mvm_scan_size(struct iwl_mvm *mvm)
2950{
2951        int base_size, tail_size;
2952        u8 scan_ver = iwl_fw_lookup_cmd_ver(mvm->fw, IWL_ALWAYS_LONG_GROUP,
2953                                            SCAN_REQ_UMAC,
2954                                            IWL_FW_CMD_VER_UNKNOWN);
2955
2956        base_size = iwl_scan_req_umac_get_size(scan_ver);
2957        if (base_size)
2958                return base_size;
2959
2960
2961        if (iwl_mvm_is_adaptive_dwell_v2_supported(mvm))
2962                base_size = IWL_SCAN_REQ_UMAC_SIZE_V8;
2963        else if (iwl_mvm_is_adaptive_dwell_supported(mvm))
2964                base_size = IWL_SCAN_REQ_UMAC_SIZE_V7;
2965        else if (iwl_mvm_cdb_scan_api(mvm))
2966                base_size = IWL_SCAN_REQ_UMAC_SIZE_V6;
2967        else
2968                base_size = IWL_SCAN_REQ_UMAC_SIZE_V1;
2969
2970        if (fw_has_capa(&mvm->fw->ucode_capa, IWL_UCODE_TLV_CAPA_UMAC_SCAN)) {
2971                if (iwl_mvm_is_scan_ext_chan_supported(mvm))
2972                        tail_size = sizeof(struct iwl_scan_req_umac_tail_v2);
2973                else
2974                        tail_size = sizeof(struct iwl_scan_req_umac_tail_v1);
2975
2976                return base_size +
2977                        sizeof(struct iwl_scan_channel_cfg_umac) *
2978                                mvm->fw->ucode_capa.n_scan_channels +
2979                        tail_size;
2980        }
2981        return sizeof(struct iwl_scan_req_lmac) +
2982                sizeof(struct iwl_scan_channel_cfg_lmac) *
2983                mvm->fw->ucode_capa.n_scan_channels +
2984                sizeof(struct iwl_scan_probe_req_v1);
2985}
2986
2987/*
2988 * This function is used in nic restart flow, to inform mac80211 about scans
2989 * that was aborted by restart flow or by an assert.
2990 */
2991void iwl_mvm_report_scan_aborted(struct iwl_mvm *mvm)
2992{
2993        if (fw_has_capa(&mvm->fw->ucode_capa, IWL_UCODE_TLV_CAPA_UMAC_SCAN)) {
2994                int uid, i;
2995
2996                uid = iwl_mvm_scan_uid_by_status(mvm, IWL_MVM_SCAN_REGULAR);
2997                if (uid >= 0) {
2998                        struct cfg80211_scan_info info = {
2999                                .aborted = true,
3000                        };
3001
3002                        cancel_delayed_work(&mvm->scan_timeout_dwork);
3003
3004                        ieee80211_scan_completed(mvm->hw, &info);
3005                        mvm->scan_uid_status[uid] = 0;
3006                }
3007                uid = iwl_mvm_scan_uid_by_status(mvm, IWL_MVM_SCAN_SCHED);
3008                if (uid >= 0) {
3009                        /* Sched scan will be restarted by mac80211 in
3010                         * restart_hw, so do not report if FW is about to be
3011                         * restarted.
3012                         */
3013                        if (!mvm->fw_restart)
3014                                ieee80211_sched_scan_stopped(mvm->hw);
3015                        mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_DISABLED;
3016                        mvm->scan_uid_status[uid] = 0;
3017                }
3018                uid = iwl_mvm_scan_uid_by_status(mvm,
3019                                                 IWL_MVM_SCAN_STOPPING_REGULAR);
3020                if (uid >= 0)
3021                        mvm->scan_uid_status[uid] = 0;
3022
3023                uid = iwl_mvm_scan_uid_by_status(mvm,
3024                                                 IWL_MVM_SCAN_STOPPING_SCHED);
3025                if (uid >= 0)
3026                        mvm->scan_uid_status[uid] = 0;
3027
3028                /* We shouldn't have any UIDs still set.  Loop over all the
3029                 * UIDs to make sure there's nothing left there and warn if
3030                 * any is found.
3031                 */
3032                for (i = 0; i < mvm->max_scans; i++) {
3033                        if (WARN_ONCE(mvm->scan_uid_status[i],
3034                                      "UMAC scan UID %d status was not cleaned\n",
3035                                      i))
3036                                mvm->scan_uid_status[i] = 0;
3037                }
3038        } else {
3039                if (mvm->scan_status & IWL_MVM_SCAN_REGULAR) {
3040                        struct cfg80211_scan_info info = {
3041                                .aborted = true,
3042                        };
3043
3044                        cancel_delayed_work(&mvm->scan_timeout_dwork);
3045                        ieee80211_scan_completed(mvm->hw, &info);
3046                }
3047
3048                /* Sched scan will be restarted by mac80211 in
3049                 * restart_hw, so do not report if FW is about to be
3050                 * restarted.
3051                 */
3052                if ((mvm->scan_status & IWL_MVM_SCAN_SCHED) &&
3053                    !mvm->fw_restart) {
3054                        ieee80211_sched_scan_stopped(mvm->hw);
3055                        mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_DISABLED;
3056                }
3057        }
3058}
3059
3060int iwl_mvm_scan_stop(struct iwl_mvm *mvm, int type, bool notify)
3061{
3062        int ret;
3063
3064        if (!(mvm->scan_status & type))
3065                return 0;
3066
3067        if (iwl_mvm_is_radio_killed(mvm)) {
3068                ret = 0;
3069                goto out;
3070        }
3071
3072        ret = iwl_mvm_scan_stop_wait(mvm, type);
3073        if (!ret)
3074                mvm->scan_status |= type << IWL_MVM_SCAN_STOPPING_SHIFT;
3075out:
3076        /* Clear the scan status so the next scan requests will
3077         * succeed and mark the scan as stopping, so that the Rx
3078         * handler doesn't do anything, as the scan was stopped from
3079         * above.
3080         */
3081        mvm->scan_status &= ~type;
3082
3083        if (type == IWL_MVM_SCAN_REGULAR) {
3084                cancel_delayed_work(&mvm->scan_timeout_dwork);
3085                if (notify) {
3086                        struct cfg80211_scan_info info = {
3087                                .aborted = true,
3088                        };
3089
3090                        ieee80211_scan_completed(mvm->hw, &info);
3091                }
3092        } else if (notify) {
3093                ieee80211_sched_scan_stopped(mvm->hw);
3094                mvm->sched_scan_pass_all = SCHED_SCAN_PASS_ALL_DISABLED;
3095        }
3096
3097        return ret;
3098}
3099