src/drivers/driver_nl80211_event.c

   1 /*
   2  * Driver interaction with Linux nl80211/cfg80211 - Event processing
   3  * Copyright (c) 2002-2014, Jouni Malinen <j@w1.fi>
   4  * Copyright (c) 2007, Johannes Berg <johannes@sipsolutions.net>
   5  * Copyright (c) 2009-2010, Atheros Communications
   6  *
   7  * This software may be distributed under the terms of the BSD license.
   8  * See README for more details.
   9  */
  10
  11 #include "includes.h"
  12 #include <netlink/genl/genl.h>
  13
  14 #include "utils/common.h"
  15 #include "utils/eloop.h"
  16 #include "common/qca-vendor.h"
  17 #include "common/qca-vendor-attr.h"
  18 #include "common/ieee802_11_defs.h"
  19 #include "common/ieee802_11_common.h"
  20 #include "driver_nl80211.h"
  21
  22
  23 static const char * nl80211_command_to_string(enum nl80211_commands cmd)
  24 {
  25 #define C2S(x) case x: return #x;
  26         switch (cmd) {
  27         C2S(NL80211_CMD_UNSPEC)
  28         C2S(NL80211_CMD_GET_WIPHY)
  29         C2S(NL80211_CMD_SET_WIPHY)
  30         C2S(NL80211_CMD_NEW_WIPHY)
  31         C2S(NL80211_CMD_DEL_WIPHY)
  32         C2S(NL80211_CMD_GET_INTERFACE)
  33         C2S(NL80211_CMD_SET_INTERFACE)
  34         C2S(NL80211_CMD_NEW_INTERFACE)
  35         C2S(NL80211_CMD_DEL_INTERFACE)
  36         C2S(NL80211_CMD_GET_KEY)
  37         C2S(NL80211_CMD_SET_KEY)
  38         C2S(NL80211_CMD_NEW_KEY)
  39         C2S(NL80211_CMD_DEL_KEY)
  40         C2S(NL80211_CMD_GET_BEACON)
  41         C2S(NL80211_CMD_SET_BEACON)
  42         C2S(NL80211_CMD_START_AP)
  43         C2S(NL80211_CMD_STOP_AP)
  44         C2S(NL80211_CMD_GET_STATION)
  45         C2S(NL80211_CMD_SET_STATION)
  46         C2S(NL80211_CMD_NEW_STATION)
  47         C2S(NL80211_CMD_DEL_STATION)
  48         C2S(NL80211_CMD_GET_MPATH)
  49         C2S(NL80211_CMD_SET_MPATH)
  50         C2S(NL80211_CMD_NEW_MPATH)
  51         C2S(NL80211_CMD_DEL_MPATH)
  52         C2S(NL80211_CMD_SET_BSS)
  53         C2S(NL80211_CMD_SET_REG)
  54         C2S(NL80211_CMD_REQ_SET_REG)
  55         C2S(NL80211_CMD_GET_MESH_CONFIG)
  56         C2S(NL80211_CMD_SET_MESH_CONFIG)
  57         C2S(NL80211_CMD_SET_MGMT_EXTRA_IE)
  58         C2S(NL80211_CMD_GET_REG)
  59         C2S(NL80211_CMD_GET_SCAN)
  60         C2S(NL80211_CMD_TRIGGER_SCAN)
  61         C2S(NL80211_CMD_NEW_SCAN_RESULTS)
  62         C2S(NL80211_CMD_SCAN_ABORTED)
  63         C2S(NL80211_CMD_REG_CHANGE)
  64         C2S(NL80211_CMD_AUTHENTICATE)
  65         C2S(NL80211_CMD_ASSOCIATE)
  66         C2S(NL80211_CMD_DEAUTHENTICATE)
  67         C2S(NL80211_CMD_DISASSOCIATE)
  68         C2S(NL80211_CMD_MICHAEL_MIC_FAILURE)
  69         C2S(NL80211_CMD_REG_BEACON_HINT)
  70         C2S(NL80211_CMD_JOIN_IBSS)
  71         C2S(NL80211_CMD_LEAVE_IBSS)
  72         C2S(NL80211_CMD_TESTMODE)
  73         C2S(NL80211_CMD_CONNECT)
  74         C2S(NL80211_CMD_ROAM)
  75         C2S(NL80211_CMD_DISCONNECT)
  76         C2S(NL80211_CMD_SET_WIPHY_NETNS)
  77         C2S(NL80211_CMD_GET_SURVEY)
  78         C2S(NL80211_CMD_NEW_SURVEY_RESULTS)
  79         C2S(NL80211_CMD_SET_PMKSA)
  80         C2S(NL80211_CMD_DEL_PMKSA)
  81         C2S(NL80211_CMD_FLUSH_PMKSA)
  82         C2S(NL80211_CMD_REMAIN_ON_CHANNEL)
  83         C2S(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL)
  84         C2S(NL80211_CMD_SET_TX_BITRATE_MASK)
  85         C2S(NL80211_CMD_REGISTER_FRAME)
  86         C2S(NL80211_CMD_FRAME)
  87         C2S(NL80211_CMD_FRAME_TX_STATUS)
  88         C2S(NL80211_CMD_SET_POWER_SAVE)
  89         C2S(NL80211_CMD_GET_POWER_SAVE)
  90         C2S(NL80211_CMD_SET_CQM)
  91         C2S(NL80211_CMD_NOTIFY_CQM)
  92         C2S(NL80211_CMD_SET_CHANNEL)
  93         C2S(NL80211_CMD_SET_WDS_PEER)
  94         C2S(NL80211_CMD_FRAME_WAIT_CANCEL)
  95         C2S(NL80211_CMD_JOIN_MESH)
  96         C2S(NL80211_CMD_LEAVE_MESH)
  97         C2S(NL80211_CMD_UNPROT_DEAUTHENTICATE)
  98         C2S(NL80211_CMD_UNPROT_DISASSOCIATE)
  99         C2S(NL80211_CMD_NEW_PEER_CANDIDATE)
 100         C2S(NL80211_CMD_GET_WOWLAN)
 101         C2S(NL80211_CMD_SET_WOWLAN)
 102         C2S(NL80211_CMD_START_SCHED_SCAN)
 103         C2S(NL80211_CMD_STOP_SCHED_SCAN)
 104         C2S(NL80211_CMD_SCHED_SCAN_RESULTS)
 105         C2S(NL80211_CMD_SCHED_SCAN_STOPPED)
 106         C2S(NL80211_CMD_SET_REKEY_OFFLOAD)
 107         C2S(NL80211_CMD_PMKSA_CANDIDATE)
 108         C2S(NL80211_CMD_TDLS_OPER)
 109         C2S(NL80211_CMD_TDLS_MGMT)
 110         C2S(NL80211_CMD_UNEXPECTED_FRAME)
 111         C2S(NL80211_CMD_PROBE_CLIENT)
 112         C2S(NL80211_CMD_REGISTER_BEACONS)
 113         C2S(NL80211_CMD_UNEXPECTED_4ADDR_FRAME)
 114         C2S(NL80211_CMD_SET_NOACK_MAP)
 115         C2S(NL80211_CMD_CH_SWITCH_NOTIFY)
 116         C2S(NL80211_CMD_START_P2P_DEVICE)
 117         C2S(NL80211_CMD_STOP_P2P_DEVICE)
 118         C2S(NL80211_CMD_CONN_FAILED)
 119         C2S(NL80211_CMD_SET_MCAST_RATE)
 120         C2S(NL80211_CMD_SET_MAC_ACL)
 121         C2S(NL80211_CMD_RADAR_DETECT)
 122         C2S(NL80211_CMD_GET_PROTOCOL_FEATURES)
 123         C2S(NL80211_CMD_UPDATE_FT_IES)
 124         C2S(NL80211_CMD_FT_EVENT)
 125         C2S(NL80211_CMD_CRIT_PROTOCOL_START)
 126         C2S(NL80211_CMD_CRIT_PROTOCOL_STOP)
 127         C2S(NL80211_CMD_GET_COALESCE)
 128         C2S(NL80211_CMD_SET_COALESCE)
 129         C2S(NL80211_CMD_CHANNEL_SWITCH)
 130         C2S(NL80211_CMD_VENDOR)
 131         C2S(NL80211_CMD_SET_QOS_MAP)
 132         C2S(NL80211_CMD_ADD_TX_TS)
 133         C2S(NL80211_CMD_DEL_TX_TS)
 134         default:
 135                 return "NL80211_CMD_UNKNOWN";
 136         }
 137 #undef C2S
 138 }
 139
 140
 141 static void mlme_event_auth(struct wpa_driver_nl80211_data *drv,
 142                             const u8 *frame, size_t len)
 143 {
 144         const struct ieee80211_mgmt *mgmt;
 145         union wpa_event_data event;
 146
 147         if (!(drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
 148             drv->force_connect_cmd) {
 149                 /*
 150                  * Avoid reporting two association events that would confuse
 151                  * the core code.
 152                  */
 153                 wpa_printf(MSG_DEBUG,
 154                            "nl80211: Ignore auth event when using driver SME");
 155                 return;
 156         }
 157
 158         wpa_printf(MSG_DEBUG, "nl80211: Authenticate event");
 159         mgmt = (const struct ieee80211_mgmt *) frame;
 160         if (len < 24 + sizeof(mgmt->u.auth)) {
 161                 wpa_printf(MSG_DEBUG, "nl80211: Too short association event "
 162                            "frame");
 163                 return;
 164         }
 165
 166         os_memcpy(drv->auth_bssid, mgmt->sa, ETH_ALEN);
 167         os_memset(drv->auth_attempt_bssid, 0, ETH_ALEN);
 168         os_memset(&event, 0, sizeof(event));
 169         os_memcpy(event.auth.peer, mgmt->sa, ETH_ALEN);
 170         event.auth.auth_type = le_to_host16(mgmt->u.auth.auth_alg);
 171         event.auth.auth_transaction =
 172                 le_to_host16(mgmt->u.auth.auth_transaction);
 173         event.auth.status_code = le_to_host16(mgmt->u.auth.status_code);
 174         if (len > 24 + sizeof(mgmt->u.auth)) {
 175                 event.auth.ies = mgmt->u.auth.variable;
 176                 event.auth.ies_len = len - 24 - sizeof(mgmt->u.auth);
 177         }
 178
 179         wpa_supplicant_event(drv->ctx, EVENT_AUTH, &event);
 180 }
 181
 182
 183 static void nl80211_parse_wmm_params(struct nlattr *wmm_attr,
 184                                      struct wmm_params *wmm_params)
 185 {
 186         struct nlattr *wmm_info[NL80211_STA_WME_MAX + 1];
 187         static struct nla_policy wme_policy[NL80211_STA_WME_MAX + 1] = {
 188                 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
 189         };
 190
 191         if (!wmm_attr ||
 192             nla_parse_nested(wmm_info, NL80211_STA_WME_MAX, wmm_attr,
 193                              wme_policy) ||
 194             !wmm_info[NL80211_STA_WME_UAPSD_QUEUES])
 195                 return;
 196
 197         wmm_params->uapsd_queues =
 198                 nla_get_u8(wmm_info[NL80211_STA_WME_UAPSD_QUEUES]);
 199         wmm_params->info_bitmap |= WMM_PARAMS_UAPSD_QUEUES_INFO;
 200 }
 201
 202
 203 static void mlme_event_assoc(struct wpa_driver_nl80211_data *drv,
 204                             const u8 *frame, size_t len, struct nlattr *wmm)
 205 {
 206         const struct ieee80211_mgmt *mgmt;
 207         union wpa_event_data event;
 208         u16 status;
 209
 210         if (!(drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
 211             drv->force_connect_cmd) {
 212                 /*
 213                  * Avoid reporting two association events that would confuse
 214                  * the core code.
 215                  */
 216                 wpa_printf(MSG_DEBUG,
 217                            "nl80211: Ignore assoc event when using driver SME");
 218                 return;
 219         }
 220
 221         wpa_printf(MSG_DEBUG, "nl80211: Associate event");
 222         mgmt = (const struct ieee80211_mgmt *) frame;
 223         if (len < 24 + sizeof(mgmt->u.assoc_resp)) {
 224                 wpa_printf(MSG_DEBUG, "nl80211: Too short association event "
 225                            "frame");
 226                 return;
 227         }
 228
 229         status = le_to_host16(mgmt->u.assoc_resp.status_code);
 230         if (status != WLAN_STATUS_SUCCESS) {
 231                 os_memset(&event, 0, sizeof(event));
 232                 event.assoc_reject.bssid = mgmt->bssid;
 233                 if (len > 24 + sizeof(mgmt->u.assoc_resp)) {
 234                         event.assoc_reject.resp_ies =
 235                                 (u8 *) mgmt->u.assoc_resp.variable;
 236                         event.assoc_reject.resp_ies_len =
 237                                 len - 24 - sizeof(mgmt->u.assoc_resp);
 238                 }
 239                 event.assoc_reject.status_code = status;
 240
 241                 wpa_supplicant_event(drv->ctx, EVENT_ASSOC_REJECT, &event);
 242                 return;
 243         }
 244
 245         drv->associated = 1;
 246         os_memcpy(drv->bssid, mgmt->sa, ETH_ALEN);
 247         os_memcpy(drv->prev_bssid, mgmt->sa, ETH_ALEN);
 248
 249         os_memset(&event, 0, sizeof(event));
 250         if (len > 24 + sizeof(mgmt->u.assoc_resp)) {
 251                 event.assoc_info.resp_ies = (u8 *) mgmt->u.assoc_resp.variable;
 252                 event.assoc_info.resp_ies_len =
 253                         len - 24 - sizeof(mgmt->u.assoc_resp);
 254         }
 255
 256         event.assoc_info.freq = drv->assoc_freq;
 257
 258         nl80211_parse_wmm_params(wmm, &event.assoc_info.wmm_params);
 259
 260         wpa_supplicant_event(drv->ctx, EVENT_ASSOC, &event);
 261 }
 262
 263
 264 static void mlme_event_connect(struct wpa_driver_nl80211_data *drv,
 265                                enum nl80211_commands cmd, struct nlattr *status,
 266                                struct nlattr *addr, struct nlattr *req_ie,
 267                                struct nlattr *resp_ie,
 268                                struct nlattr *authorized,
 269                                struct nlattr *key_replay_ctr,
 270                                struct nlattr *ptk_kck,
 271                                struct nlattr *ptk_kek,
 272                                struct nlattr *subnet_status)
 273 {
 274         union wpa_event_data event;
 275         const u8 *ssid;
 276         u16 status_code;
 277
 278         if (drv->capa.flags & WPA_DRIVER_FLAGS_SME) {
 279                 /*
 280                  * Avoid reporting two association events that would confuse
 281                  * the core code.
 282                  */
 283                 wpa_printf(MSG_DEBUG, "nl80211: Ignore connect event (cmd=%d) "
 284                            "when using userspace SME", cmd);
 285                 return;
 286         }
 287
 288         status_code = status ? nla_get_u16(status) : WLAN_STATUS_SUCCESS;
 289
 290         if (cmd == NL80211_CMD_CONNECT) {
 291                 wpa_printf(MSG_DEBUG,
 292                            "nl80211: Connect event (status=%u ignore_next_local_disconnect=%d)",
 293                            status_code, drv->ignore_next_local_disconnect);
 294         } else if (cmd == NL80211_CMD_ROAM) {
 295                 wpa_printf(MSG_DEBUG, "nl80211: Roam event");
 296         }
 297
 298         os_memset(&event, 0, sizeof(event));
 299         if (cmd == NL80211_CMD_CONNECT && status_code != WLAN_STATUS_SUCCESS) {
 300                 if (addr)
 301                         event.assoc_reject.bssid = nla_data(addr);
 302                 if (drv->ignore_next_local_disconnect) {
 303                         drv->ignore_next_local_disconnect = 0;
 304                         if (!event.assoc_reject.bssid ||
 305                             (os_memcmp(event.assoc_reject.bssid,
 306                                        drv->auth_attempt_bssid,
 307                                        ETH_ALEN) != 0)) {
 308                                 /*
 309                                  * Ignore the event that came without a BSSID or
 310                                  * for the old connection since this is likely
 311                                  * not relevant to the new Connect command.
 312                                  */
 313                                 wpa_printf(MSG_DEBUG,
 314                                            "nl80211: Ignore connection failure event triggered during reassociation");
 315                                 return;
 316                         }
 317                 }
 318                 if (resp_ie) {
 319                         event.assoc_reject.resp_ies = nla_data(resp_ie);
 320                         event.assoc_reject.resp_ies_len = nla_len(resp_ie);
 321                 }
 322                 event.assoc_reject.status_code = status_code;
 323                 wpa_supplicant_event(drv->ctx, EVENT_ASSOC_REJECT, &event);
 324                 return;
 325         }
 326
 327         drv->associated = 1;
 328         if (addr) {
 329                 os_memcpy(drv->bssid, nla_data(addr), ETH_ALEN);
 330                 os_memcpy(drv->prev_bssid, drv->bssid, ETH_ALEN);
 331         }
 332
 333         if (req_ie) {
 334                 event.assoc_info.req_ies = nla_data(req_ie);
 335                 event.assoc_info.req_ies_len = nla_len(req_ie);
 336
 337                 if (cmd == NL80211_CMD_ROAM) {
 338                         ssid = get_ie(event.assoc_info.req_ies,
 339                                       event.assoc_info.req_ies_len,
 340                                       WLAN_EID_SSID);
 341                         if (ssid && ssid[1] > 0 && ssid[1] <= 32) {
 342                                 drv->ssid_len = ssid[1];
 343                                 os_memcpy(drv->ssid, ssid + 2, ssid[1]);
 344                         }
 345                 }
 346         }
 347         if (resp_ie) {
 348                 event.assoc_info.resp_ies = nla_data(resp_ie);
 349                 event.assoc_info.resp_ies_len = nla_len(resp_ie);
 350         }
 351
 352         event.assoc_info.freq = nl80211_get_assoc_freq(drv);
 353
 354         if (authorized && nla_get_u8(authorized)) {
 355                 event.assoc_info.authorized = 1;
 356                 wpa_printf(MSG_DEBUG, "nl80211: connection authorized");
 357         }
 358         if (key_replay_ctr) {
 359                 event.assoc_info.key_replay_ctr = nla_data(key_replay_ctr);
 360                 event.assoc_info.key_replay_ctr_len = nla_len(key_replay_ctr);
 361         }
 362         if (ptk_kck) {
 363                 event.assoc_info.ptk_kck = nla_data(ptk_kck);
 364                 event.assoc_info.ptk_kck_len = nla_len(ptk_kck);
 365         }
 366         if (ptk_kek) {
 367                 event.assoc_info.ptk_kek = nla_data(ptk_kek);
 368                 event.assoc_info.ptk_kek_len = nla_len(ptk_kek);
 369         }
 370
 371         if (subnet_status) {
 372                 /*
 373                  * At least for now, this is only available from
 374                  * QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_SUBNET_STATUS and that
 375                  * attribute has the same values 0, 1, 2 as are used in the
 376                  * variable here, so no mapping between different values are
 377                  * needed.
 378                  */
 379                 event.assoc_info.subnet_status = nla_get_u8(subnet_status);
 380         }
 381
 382         wpa_supplicant_event(drv->ctx, EVENT_ASSOC, &event);
 383 }
 384
 385
 386 static void mlme_event_disconnect(struct wpa_driver_nl80211_data *drv,
 387                                   struct nlattr *reason, struct nlattr *addr,
 388                                   struct nlattr *by_ap)
 389 {
 390         union wpa_event_data data;
 391         unsigned int locally_generated = by_ap == NULL;
 392
 393         if (drv->capa.flags & WPA_DRIVER_FLAGS_SME) {
 394                 /*
 395                  * Avoid reporting two disassociation events that could
 396                  * confuse the core code.
 397                  */
 398                 wpa_printf(MSG_DEBUG, "nl80211: Ignore disconnect "
 399                            "event when using userspace SME");
 400                 return;
 401         }
 402
 403         if (drv->ignore_next_local_disconnect) {
 404                 drv->ignore_next_local_disconnect = 0;
 405                 if (locally_generated) {
 406                         wpa_printf(MSG_DEBUG, "nl80211: Ignore disconnect "
 407                                    "event triggered during reassociation");
 408                         return;
 409                 }
 410                 wpa_printf(MSG_WARNING, "nl80211: Was expecting local "
 411                            "disconnect but got another disconnect "
 412                            "event first");
 413         }
 414
 415         wpa_printf(MSG_DEBUG, "nl80211: Disconnect event");
 416         nl80211_mark_disconnected(drv);
 417         os_memset(&data, 0, sizeof(data));
 418         if (reason)
 419                 data.deauth_info.reason_code = nla_get_u16(reason);
 420         data.deauth_info.locally_generated = by_ap == NULL;
 421         wpa_supplicant_event(drv->ctx, EVENT_DEAUTH, &data);
 422 }
 423
 424
 425 static int calculate_chan_offset(int width, int freq, int cf1, int cf2)
 426 {
 427         int freq1 = 0;
 428
 429         switch (convert2width(width)) {
 430         case CHAN_WIDTH_20_NOHT:
 431         case CHAN_WIDTH_20:
 432                 return 0;
 433         case CHAN_WIDTH_40:
 434                 freq1 = cf1 - 10;
 435                 break;
 436         case CHAN_WIDTH_80:
 437                 freq1 = cf1 - 30;
 438                 break;
 439         case CHAN_WIDTH_160:
 440                 freq1 = cf1 - 70;
 441                 break;
 442         case CHAN_WIDTH_UNKNOWN:
 443         case CHAN_WIDTH_80P80:
 444                 /* FIXME: implement this */
 445                 return 0;
 446         }
 447
 448         return (abs(freq - freq1) / 20) % 2 == 0 ? 1 : -1;
 449 }
 450
 451
 452 static void mlme_event_ch_switch(struct wpa_driver_nl80211_data *drv,
 453                                  struct nlattr *ifindex, struct nlattr *freq,
 454                                  struct nlattr *type, struct nlattr *bw,
 455                                  struct nlattr *cf1, struct nlattr *cf2)
 456 {
 457         struct i802_bss *bss;
 458         union wpa_event_data data;
 459         int ht_enabled = 1;
 460         int chan_offset = 0;
 461         int ifidx;
 462
 463         wpa_printf(MSG_DEBUG, "nl80211: Channel switch event");
 464
 465         if (!freq)
 466                 return;
 467
 468         ifidx = nla_get_u32(ifindex);
 469         bss = get_bss_ifindex(drv, ifidx);
 470         if (bss == NULL) {
 471                 wpa_printf(MSG_WARNING, "nl80211: Unknown ifindex (%d) for channel switch, ignoring",
 472                            ifidx);
 473                 return;
 474         }
 475
 476         if (type) {
 477                 enum nl80211_channel_type ch_type = nla_get_u32(type);
 478
 479                 wpa_printf(MSG_DEBUG, "nl80211: Channel type: %d", ch_type);
 480                 switch (ch_type) {
 481                 case NL80211_CHAN_NO_HT:
 482                         ht_enabled = 0;
 483                         break;
 484                 case NL80211_CHAN_HT20:
 485                         break;
 486                 case NL80211_CHAN_HT40PLUS:
 487                         chan_offset = 1;
 488                         break;
 489                 case NL80211_CHAN_HT40MINUS:
 490                         chan_offset = -1;
 491                         break;
 492                 }
 493         } else if (bw && cf1) {
 494                 /* This can happen for example with VHT80 ch switch */
 495                 chan_offset = calculate_chan_offset(nla_get_u32(bw),
 496                                                     nla_get_u32(freq),
 497                                                     nla_get_u32(cf1),
 498                                                     cf2 ? nla_get_u32(cf2) : 0);
 499         } else {
 500                 wpa_printf(MSG_WARNING, "nl80211: Unknown secondary channel information - following channel definition calculations may fail");
 501         }
 502
 503         os_memset(&data, 0, sizeof(data));
 504         data.ch_switch.freq = nla_get_u32(freq);
 505         data.ch_switch.ht_enabled = ht_enabled;
 506         data.ch_switch.ch_offset = chan_offset;
 507         if (bw)
 508                 data.ch_switch.ch_width = convert2width(nla_get_u32(bw));
 509         if (cf1)
 510                 data.ch_switch.cf1 = nla_get_u32(cf1);
 511         if (cf2)
 512                 data.ch_switch.cf2 = nla_get_u32(cf2);
 513
 514         bss->freq = data.ch_switch.freq;
 515
 516         wpa_supplicant_event(bss->ctx, EVENT_CH_SWITCH, &data);
 517 }
 518
 519
 520 static void mlme_timeout_event(struct wpa_driver_nl80211_data *drv,
 521                                enum nl80211_commands cmd, struct nlattr *addr)
 522 {
 523         union wpa_event_data event;
 524         enum wpa_event_type ev;
 525
 526         if (nla_len(addr) != ETH_ALEN)
 527                 return;
 528
 529         wpa_printf(MSG_DEBUG, "nl80211: MLME event %d; timeout with " MACSTR,
 530                    cmd, MAC2STR((u8 *) nla_data(addr)));
 531
 532         if (cmd == NL80211_CMD_AUTHENTICATE)
 533                 ev = EVENT_AUTH_TIMED_OUT;
 534         else if (cmd == NL80211_CMD_ASSOCIATE)
 535                 ev = EVENT_ASSOC_TIMED_OUT;
 536         else
 537                 return;
 538
 539         os_memset(&event, 0, sizeof(event));
 540         os_memcpy(event.timeout_event.addr, nla_data(addr), ETH_ALEN);
 541         wpa_supplicant_event(drv->ctx, ev, &event);
 542 }
 543
 544
 545 static void mlme_event_mgmt(struct i802_bss *bss,
 546                             struct nlattr *freq, struct nlattr *sig,
 547                             const u8 *frame, size_t len)
 548 {
 549         struct wpa_driver_nl80211_data *drv = bss->drv;
 550         const struct ieee80211_mgmt *mgmt;
 551         union wpa_event_data event;
 552         u16 fc, stype;
 553         int ssi_signal = 0;
 554         int rx_freq = 0;
 555
 556         wpa_printf(MSG_MSGDUMP, "nl80211: Frame event");
 557         mgmt = (const struct ieee80211_mgmt *) frame;
 558         if (len < 24) {
 559                 wpa_printf(MSG_DEBUG, "nl80211: Too short management frame");
 560                 return;
 561         }
 562
 563         fc = le_to_host16(mgmt->frame_control);
 564         stype = WLAN_FC_GET_STYPE(fc);
 565
 566         if (sig)
 567                 ssi_signal = (s32) nla_get_u32(sig);
 568
 569         os_memset(&event, 0, sizeof(event));
 570         if (freq) {
 571                 event.rx_mgmt.freq = nla_get_u32(freq);
 572                 rx_freq = drv->last_mgmt_freq = event.rx_mgmt.freq;
 573         }
 574         wpa_printf(MSG_DEBUG,
 575                    "nl80211: RX frame sa=" MACSTR
 576                    " freq=%d ssi_signal=%d fc=0x%x seq_ctrl=0x%x stype=%u (%s) len=%u",
 577                    MAC2STR(mgmt->sa), rx_freq, ssi_signal, fc,
 578                    le_to_host16(mgmt->seq_ctrl), stype, fc2str(fc),
 579                    (unsigned int) len);
 580         event.rx_mgmt.frame = frame;
 581         event.rx_mgmt.frame_len = len;
 582         event.rx_mgmt.ssi_signal = ssi_signal;
 583         event.rx_mgmt.drv_priv = bss;
 584         wpa_supplicant_event(drv->ctx, EVENT_RX_MGMT, &event);
 585 }
 586
 587
 588 static void mlme_event_mgmt_tx_status(struct wpa_driver_nl80211_data *drv,
 589                                       struct nlattr *cookie, const u8 *frame,
 590                                       size_t len, struct nlattr *ack)
 591 {
 592         union wpa_event_data event;
 593         const struct ieee80211_hdr *hdr;
 594         u16 fc;
 595
 596         wpa_printf(MSG_DEBUG, "nl80211: Frame TX status event");
 597         if (!is_ap_interface(drv->nlmode)) {
 598                 u64 cookie_val;
 599
 600                 if (!cookie)
 601                         return;
 602
 603                 cookie_val = nla_get_u64(cookie);
 604                 wpa_printf(MSG_DEBUG, "nl80211: Action TX status:"
 605                            " cookie=0%llx%s (ack=%d)",
 606                            (long long unsigned int) cookie_val,
 607                            cookie_val == drv->send_action_cookie ?
 608                            " (match)" : " (unknown)", ack != NULL);
 609                 if (cookie_val != drv->send_action_cookie)
 610                         return;
 611         }
 612
 613         hdr = (const struct ieee80211_hdr *) frame;
 614         fc = le_to_host16(hdr->frame_control);
 615
 616         os_memset(&event, 0, sizeof(event));
 617         event.tx_status.type = WLAN_FC_GET_TYPE(fc);
 618         event.tx_status.stype = WLAN_FC_GET_STYPE(fc);
 619         event.tx_status.dst = hdr->addr1;
 620         event.tx_status.data = frame;
 621         event.tx_status.data_len = len;
 622         event.tx_status.ack = ack != NULL;
 623         wpa_supplicant_event(drv->ctx, EVENT_TX_STATUS, &event);
 624 }
 625
 626
 627 static void mlme_event_deauth_disassoc(struct wpa_driver_nl80211_data *drv,
 628                                        enum wpa_event_type type,
 629                                        const u8 *frame, size_t len)
 630 {
 631         const struct ieee80211_mgmt *mgmt;
 632         union wpa_event_data event;
 633         const u8 *bssid = NULL;
 634         u16 reason_code = 0;
 635
 636         if (type == EVENT_DEAUTH)
 637                 wpa_printf(MSG_DEBUG, "nl80211: Deauthenticate event");
 638         else
 639                 wpa_printf(MSG_DEBUG, "nl80211: Disassociate event");
 640
 641         mgmt = (const struct ieee80211_mgmt *) frame;
 642         if (len >= 24) {
 643                 bssid = mgmt->bssid;
 644
 645                 if ((drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
 646                     !drv->associated &&
 647                     os_memcmp(bssid, drv->auth_bssid, ETH_ALEN) != 0 &&
 648                     os_memcmp(bssid, drv->auth_attempt_bssid, ETH_ALEN) != 0 &&
 649                     os_memcmp(bssid, drv->prev_bssid, ETH_ALEN) == 0) {
 650                         /*
 651                          * Avoid issues with some roaming cases where
 652                          * disconnection event for the old AP may show up after
 653                          * we have started connection with the new AP.
 654                          * In case of locally generated event clear
 655                          * ignore_next_local_deauth as well, to avoid next local
 656                          * deauth event be wrongly ignored.
 657                          */
 658                         if (!os_memcmp(mgmt->sa, drv->first_bss->addr,
 659                                        ETH_ALEN)) {
 660                                 wpa_printf(MSG_DEBUG,
 661                                            "nl80211: Received a locally generated deauth event. Clear ignore_next_local_deauth flag");
 662                                 drv->ignore_next_local_deauth = 0;
 663                         } else {
 664                                 wpa_printf(MSG_DEBUG,
 665                                            "nl80211: Ignore deauth/disassoc event from old AP " MACSTR " when already authenticating with " MACSTR,
 666                                            MAC2STR(bssid),
 667                                            MAC2STR(drv->auth_attempt_bssid));
 668                         }
 669                         return;
 670                 }
 671
 672                 if (drv->associated != 0 &&
 673                     os_memcmp(bssid, drv->bssid, ETH_ALEN) != 0 &&
 674                     os_memcmp(bssid, drv->auth_bssid, ETH_ALEN) != 0) {
 675                         /*
 676                          * We have presumably received this deauth as a
 677                          * response to a clear_state_mismatch() outgoing
 678                          * deauth.  Don't let it take us offline!
 679                          */
 680                         wpa_printf(MSG_DEBUG, "nl80211: Deauth received "
 681                                    "from Unknown BSSID " MACSTR " -- ignoring",
 682                                    MAC2STR(bssid));
 683                         return;
 684                 }
 685         }
 686
 687         nl80211_mark_disconnected(drv);
 688         os_memset(&event, 0, sizeof(event));
 689
 690         /* Note: Same offset for Reason Code in both frame subtypes */
 691         if (len >= 24 + sizeof(mgmt->u.deauth))
 692                 reason_code = le_to_host16(mgmt->u.deauth.reason_code);
 693
 694         if (type == EVENT_DISASSOC) {
 695                 event.disassoc_info.locally_generated =
 696                         !os_memcmp(mgmt->sa, drv->first_bss->addr, ETH_ALEN);
 697                 event.disassoc_info.addr = bssid;
 698                 event.disassoc_info.reason_code = reason_code;
 699                 if (frame + len > mgmt->u.disassoc.variable) {
 700                         event.disassoc_info.ie = mgmt->u.disassoc.variable;
 701                         event.disassoc_info.ie_len = frame + len -
 702                                 mgmt->u.disassoc.variable;
 703                 }
 704         } else {
 705                 event.deauth_info.locally_generated =
 706                         !os_memcmp(mgmt->sa, drv->first_bss->addr, ETH_ALEN);
 707                 if (drv->ignore_deauth_event) {
 708                         wpa_printf(MSG_DEBUG, "nl80211: Ignore deauth event due to previous forced deauth-during-auth");
 709                         drv->ignore_deauth_event = 0;
 710                         if (event.deauth_info.locally_generated)
 711                                 drv->ignore_next_local_deauth = 0;
 712                         return;
 713                 }
 714                 if (drv->ignore_next_local_deauth) {
 715                         drv->ignore_next_local_deauth = 0;
 716                         if (event.deauth_info.locally_generated) {
 717                                 wpa_printf(MSG_DEBUG, "nl80211: Ignore deauth event triggered due to own deauth request");
 718                                 return;
 719                         }
 720                         wpa_printf(MSG_WARNING, "nl80211: Was expecting local deauth but got another disconnect event first");
 721                 }
 722                 event.deauth_info.addr = bssid;
 723                 event.deauth_info.reason_code = reason_code;
 724                 if (frame + len > mgmt->u.deauth.variable) {
 725                         event.deauth_info.ie = mgmt->u.deauth.variable;
 726                         event.deauth_info.ie_len = frame + len -
 727                                 mgmt->u.deauth.variable;
 728                 }
 729         }
 730
 731         wpa_supplicant_event(drv->ctx, type, &event);
 732 }
 733
 734
 735 static void mlme_event_unprot_disconnect(struct wpa_driver_nl80211_data *drv,
 736                                          enum wpa_event_type type,
 737                                          const u8 *frame, size_t len)
 738 {
 739         const struct ieee80211_mgmt *mgmt;
 740         union wpa_event_data event;
 741         u16 reason_code = 0;
 742
 743         if (type == EVENT_UNPROT_DEAUTH)
 744                 wpa_printf(MSG_DEBUG, "nl80211: Unprot Deauthenticate event");
 745         else
 746                 wpa_printf(MSG_DEBUG, "nl80211: Unprot Disassociate event");
 747
 748         if (len < 24)
 749                 return;
 750
 751         mgmt = (const struct ieee80211_mgmt *) frame;
 752
 753         os_memset(&event, 0, sizeof(event));
 754         /* Note: Same offset for Reason Code in both frame subtypes */
 755         if (len >= 24 + sizeof(mgmt->u.deauth))
 756                 reason_code = le_to_host16(mgmt->u.deauth.reason_code);
 757
 758         if (type == EVENT_UNPROT_DISASSOC) {
 759                 event.unprot_disassoc.sa = mgmt->sa;
 760                 event.unprot_disassoc.da = mgmt->da;
 761                 event.unprot_disassoc.reason_code = reason_code;
 762         } else {
 763                 event.unprot_deauth.sa = mgmt->sa;
 764                 event.unprot_deauth.da = mgmt->da;
 765                 event.unprot_deauth.reason_code = reason_code;
 766         }
 767
 768         wpa_supplicant_event(drv->ctx, type, &event);
 769 }
 770
 771
 772 static void mlme_event(struct i802_bss *bss,
 773                        enum nl80211_commands cmd, struct nlattr *frame,
 774                        struct nlattr *addr, struct nlattr *timed_out,
 775                        struct nlattr *freq, struct nlattr *ack,
 776                        struct nlattr *cookie, struct nlattr *sig,
 777                        struct nlattr *wmm)
 778 {
 779         struct wpa_driver_nl80211_data *drv = bss->drv;
 780         const u8 *data;
 781         size_t len;
 782
 783         if (timed_out && addr) {
 784                 mlme_timeout_event(drv, cmd, addr);
 785                 return;
 786         }
 787
 788         if (frame == NULL) {
 789                 wpa_printf(MSG_DEBUG,
 790                            "nl80211: MLME event %d (%s) without frame data",
 791                            cmd, nl80211_command_to_string(cmd));
 792                 return;
 793         }
 794
 795         data = nla_data(frame);
 796         len = nla_len(frame);
 797         if (len < 4 + 2 * ETH_ALEN) {
 798                 wpa_printf(MSG_MSGDUMP, "nl80211: MLME event %d (%s) on %s("
 799                            MACSTR ") - too short",
 800                            cmd, nl80211_command_to_string(cmd), bss->ifname,
 801                            MAC2STR(bss->addr));
 802                 return;
 803         }
 804         wpa_printf(MSG_MSGDUMP, "nl80211: MLME event %d (%s) on %s(" MACSTR
 805                    ") A1=" MACSTR " A2=" MACSTR, cmd,
 806                    nl80211_command_to_string(cmd), bss->ifname,
 807                    MAC2STR(bss->addr), MAC2STR(data + 4),
 808                    MAC2STR(data + 4 + ETH_ALEN));
 809         if (cmd != NL80211_CMD_FRAME_TX_STATUS && !(data[4] & 0x01) &&
 810             os_memcmp(bss->addr, data + 4, ETH_ALEN) != 0 &&
 811             os_memcmp(bss->addr, data + 4 + ETH_ALEN, ETH_ALEN) != 0) {
 812                 wpa_printf(MSG_MSGDUMP, "nl80211: %s: Ignore MLME frame event "
 813                            "for foreign address", bss->ifname);
 814                 return;
 815         }
 816         wpa_hexdump(MSG_MSGDUMP, "nl80211: MLME event frame",
 817                     nla_data(frame), nla_len(frame));
 818
 819         switch (cmd) {
 820         case NL80211_CMD_AUTHENTICATE:
 821                 mlme_event_auth(drv, nla_data(frame), nla_len(frame));
 822                 break;
 823         case NL80211_CMD_ASSOCIATE:
 824                 mlme_event_assoc(drv, nla_data(frame), nla_len(frame), wmm);
 825                 break;
 826         case NL80211_CMD_DEAUTHENTICATE:
 827                 mlme_event_deauth_disassoc(drv, EVENT_DEAUTH,
 828                                            nla_data(frame), nla_len(frame));
 829                 break;
 830         case NL80211_CMD_DISASSOCIATE:
 831                 mlme_event_deauth_disassoc(drv, EVENT_DISASSOC,
 832                                            nla_data(frame), nla_len(frame));
 833                 break;
 834         case NL80211_CMD_FRAME:
 835                 mlme_event_mgmt(bss, freq, sig, nla_data(frame),
 836                                 nla_len(frame));
 837                 break;
 838         case NL80211_CMD_FRAME_TX_STATUS:
 839                 mlme_event_mgmt_tx_status(drv, cookie, nla_data(frame),
 840                                           nla_len(frame), ack);
 841                 break;
 842         case NL80211_CMD_UNPROT_DEAUTHENTICATE:
 843                 mlme_event_unprot_disconnect(drv, EVENT_UNPROT_DEAUTH,
 844                                              nla_data(frame), nla_len(frame));
 845                 break;
 846         case NL80211_CMD_UNPROT_DISASSOCIATE:
 847                 mlme_event_unprot_disconnect(drv, EVENT_UNPROT_DISASSOC,
 848                                              nla_data(frame), nla_len(frame));
 849                 break;
 850         default:
 851                 break;
 852         }
 853 }
 854
 855
 856 static void mlme_event_michael_mic_failure(struct i802_bss *bss,
 857                                            struct nlattr *tb[])
 858 {
 859         union wpa_event_data data;
 860
 861         wpa_printf(MSG_DEBUG, "nl80211: MLME event Michael MIC failure");
 862         os_memset(&data, 0, sizeof(data));
 863         if (tb[NL80211_ATTR_MAC]) {
 864                 wpa_hexdump(MSG_DEBUG, "nl80211: Source MAC address",
 865                             nla_data(tb[NL80211_ATTR_MAC]),
 866                             nla_len(tb[NL80211_ATTR_MAC]));
 867                 data.michael_mic_failure.src = nla_data(tb[NL80211_ATTR_MAC]);
 868         }
 869         if (tb[NL80211_ATTR_KEY_SEQ]) {
 870                 wpa_hexdump(MSG_DEBUG, "nl80211: TSC",
 871                             nla_data(tb[NL80211_ATTR_KEY_SEQ]),
 872                             nla_len(tb[NL80211_ATTR_KEY_SEQ]));
 873         }
 874         if (tb[NL80211_ATTR_KEY_TYPE]) {
 875                 enum nl80211_key_type key_type =
 876                         nla_get_u32(tb[NL80211_ATTR_KEY_TYPE]);
 877                 wpa_printf(MSG_DEBUG, "nl80211: Key Type %d", key_type);
 878                 if (key_type == NL80211_KEYTYPE_PAIRWISE)
 879                         data.michael_mic_failure.unicast = 1;
 880         } else
 881                 data.michael_mic_failure.unicast = 1;
 882
 883         if (tb[NL80211_ATTR_KEY_IDX]) {
 884                 u8 key_id = nla_get_u8(tb[NL80211_ATTR_KEY_IDX]);
 885                 wpa_printf(MSG_DEBUG, "nl80211: Key Id %d", key_id);
 886         }
 887
 888         wpa_supplicant_event(bss->ctx, EVENT_MICHAEL_MIC_FAILURE, &data);
 889 }
 890
 891
 892 static void mlme_event_join_ibss(struct wpa_driver_nl80211_data *drv,
 893                                  struct nlattr *tb[])
 894 {
 895         unsigned int freq;
 896
 897         if (tb[NL80211_ATTR_MAC] == NULL) {
 898                 wpa_printf(MSG_DEBUG, "nl80211: No address in IBSS joined "
 899                            "event");
 900                 return;
 901         }
 902         os_memcpy(drv->bssid, nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
 903
 904         drv->associated = 1;
 905         wpa_printf(MSG_DEBUG, "nl80211: IBSS " MACSTR " joined",
 906                    MAC2STR(drv->bssid));
 907
 908         freq = nl80211_get_assoc_freq(drv);
 909         if (freq) {
 910                 wpa_printf(MSG_DEBUG, "nl80211: IBSS on frequency %u MHz",
 911                            freq);
 912                 drv->first_bss->freq = freq;
 913         }
 914
 915         wpa_supplicant_event(drv->ctx, EVENT_ASSOC, NULL);
 916 }
 917
 918
 919 static void mlme_event_remain_on_channel(struct wpa_driver_nl80211_data *drv,
 920                                          int cancel_event, struct nlattr *tb[])
 921 {
 922         unsigned int freq, chan_type, duration;
 923         union wpa_event_data data;
 924         u64 cookie;
 925
 926         if (tb[NL80211_ATTR_WIPHY_FREQ])
 927                 freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
 928         else
 929                 freq = 0;
 930
 931         if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])
 932                 chan_type = nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
 933         else
 934                 chan_type = 0;
 935
 936         if (tb[NL80211_ATTR_DURATION])
 937                 duration = nla_get_u32(tb[NL80211_ATTR_DURATION]);
 938         else
 939                 duration = 0;
 940
 941         if (tb[NL80211_ATTR_COOKIE])
 942                 cookie = nla_get_u64(tb[NL80211_ATTR_COOKIE]);
 943         else
 944                 cookie = 0;
 945
 946         wpa_printf(MSG_DEBUG, "nl80211: Remain-on-channel event (cancel=%d "
 947                    "freq=%u channel_type=%u duration=%u cookie=0x%llx (%s))",
 948                    cancel_event, freq, chan_type, duration,
 949                    (long long unsigned int) cookie,
 950                    cookie == drv->remain_on_chan_cookie ? "match" : "unknown");
 951
 952         if (cookie != drv->remain_on_chan_cookie)
 953                 return; /* not for us */
 954
 955         if (cancel_event)
 956                 drv->pending_remain_on_chan = 0;
 957
 958         os_memset(&data, 0, sizeof(data));
 959         data.remain_on_channel.freq = freq;
 960         data.remain_on_channel.duration = duration;
 961         wpa_supplicant_event(drv->ctx, cancel_event ?
 962                              EVENT_CANCEL_REMAIN_ON_CHANNEL :
 963                              EVENT_REMAIN_ON_CHANNEL, &data);
 964 }
 965
 966
 967 static void mlme_event_ft_event(struct wpa_driver_nl80211_data *drv,
 968                                 struct nlattr *tb[])
 969 {
 970         union wpa_event_data data;
 971
 972         os_memset(&data, 0, sizeof(data));
 973
 974         if (tb[NL80211_ATTR_IE]) {
 975                 data.ft_ies.ies = nla_data(tb[NL80211_ATTR_IE]);
 976                 data.ft_ies.ies_len = nla_len(tb[NL80211_ATTR_IE]);
 977         }
 978
 979         if (tb[NL80211_ATTR_IE_RIC]) {
 980                 data.ft_ies.ric_ies = nla_data(tb[NL80211_ATTR_IE_RIC]);
 981                 data.ft_ies.ric_ies_len = nla_len(tb[NL80211_ATTR_IE_RIC]);
 982         }
 983
 984         if (tb[NL80211_ATTR_MAC])
 985                 os_memcpy(data.ft_ies.target_ap,
 986                           nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
 987
 988         wpa_printf(MSG_DEBUG, "nl80211: FT event target_ap " MACSTR,
 989                    MAC2STR(data.ft_ies.target_ap));
 990
 991         wpa_supplicant_event(drv->ctx, EVENT_FT_RESPONSE, &data);
 992 }
 993
 994
 995 static void send_scan_event(struct wpa_driver_nl80211_data *drv, int aborted,
 996                             struct nlattr *tb[], int external_scan)
 997 {
 998         union wpa_event_data event;
 999         struct nlattr *nl;
1000         int rem;
1001         struct scan_info *info;
1002 #define MAX_REPORT_FREQS 50
1003         int freqs[MAX_REPORT_FREQS];
1004         int num_freqs = 0;
1005
1006         if (!external_scan && drv->scan_for_auth) {
1007                 drv->scan_for_auth = 0;
1008                 wpa_printf(MSG_DEBUG, "nl80211: Scan results for missing "
1009                            "cfg80211 BSS entry");
1010                 wpa_driver_nl80211_authenticate_retry(drv);
1011                 return;
1012         }
1013
1014         os_memset(&event, 0, sizeof(event));
1015         info = &event.scan_info;
1016         info->aborted = aborted;
1017         info->external_scan = external_scan;
1018         info->nl_scan_event = 1;
1019
1020         if (tb[NL80211_ATTR_SCAN_SSIDS]) {
1021                 nla_for_each_nested(nl, tb[NL80211_ATTR_SCAN_SSIDS], rem) {
1022                         struct wpa_driver_scan_ssid *s =
1023                                 &info->ssids[info->num_ssids];
1024                         s->ssid = nla_data(nl);
1025                         s->ssid_len = nla_len(nl);
1026                         wpa_printf(MSG_DEBUG, "nl80211: Scan probed for SSID '%s'",
1027                                    wpa_ssid_txt(s->ssid, s->ssid_len));
1028                         info->num_ssids++;
1029                         if (info->num_ssids == WPAS_MAX_SCAN_SSIDS)
1030                                 break;
1031                 }
1032         }
1033         if (tb[NL80211_ATTR_SCAN_FREQUENCIES]) {
1034                 char msg[300], *pos, *end;
1035                 int res;
1036
1037                 pos = msg;
1038                 end = pos + sizeof(msg);
1039                 *pos = '\0';
1040
1041                 nla_for_each_nested(nl, tb[NL80211_ATTR_SCAN_FREQUENCIES], rem)
1042                 {
1043                         freqs[num_freqs] = nla_get_u32(nl);
1044                         res = os_snprintf(pos, end - pos, " %d",
1045                                           freqs[num_freqs]);
1046                         if (!os_snprintf_error(end - pos, res))
1047                                 pos += res;
1048                         num_freqs++;
1049                         if (num_freqs == MAX_REPORT_FREQS - 1)
1050                                 break;
1051                 }
1052                 info->freqs = freqs;
1053                 info->num_freqs = num_freqs;
1054                 wpa_printf(MSG_DEBUG, "nl80211: Scan included frequencies:%s",
1055                            msg);
1056         }
1057         wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS, &event);
1058 }
1059
1060
1061 static void nl80211_cqm_event(struct wpa_driver_nl80211_data *drv,
1062                               struct nlattr *tb[])
1063 {
1064         static struct nla_policy cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
1065                 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
1066                 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U8 },
1067                 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
1068                 [NL80211_ATTR_CQM_PKT_LOSS_EVENT] = { .type = NLA_U32 },
1069         };
1070         struct nlattr *cqm[NL80211_ATTR_CQM_MAX + 1];
1071         enum nl80211_cqm_rssi_threshold_event event;
1072         union wpa_event_data ed;
1073         struct wpa_signal_info sig;
1074         int res;
1075
1076         if (tb[NL80211_ATTR_CQM] == NULL ||
1077             nla_parse_nested(cqm, NL80211_ATTR_CQM_MAX, tb[NL80211_ATTR_CQM],
1078                              cqm_policy)) {
1079                 wpa_printf(MSG_DEBUG, "nl80211: Ignore invalid CQM event");
1080                 return;
1081         }
1082
1083         os_memset(&ed, 0, sizeof(ed));
1084
1085         if (cqm[NL80211_ATTR_CQM_PKT_LOSS_EVENT]) {
1086                 if (!tb[NL80211_ATTR_MAC])
1087                         return;
1088                 os_memcpy(ed.low_ack.addr, nla_data(tb[NL80211_ATTR_MAC]),
1089                           ETH_ALEN);
1090                 wpa_supplicant_event(drv->ctx, EVENT_STATION_LOW_ACK, &ed);
1091                 return;
1092         }
1093
1094         if (cqm[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] == NULL)
1095                 return;
1096         event = nla_get_u32(cqm[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT]);
1097
1098         if (event == NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH) {
1099                 wpa_printf(MSG_DEBUG, "nl80211: Connection quality monitor "
1100                            "event: RSSI high");
1101                 ed.signal_change.above_threshold = 1;
1102         } else if (event == NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW) {
1103                 wpa_printf(MSG_DEBUG, "nl80211: Connection quality monitor "
1104                            "event: RSSI low");
1105                 ed.signal_change.above_threshold = 0;
1106         } else
1107                 return;
1108
1109         res = nl80211_get_link_signal(drv, &sig);
1110         if (res == 0) {
1111                 ed.signal_change.current_signal = sig.current_signal;
1112                 ed.signal_change.current_txrate = sig.current_txrate;
1113                 wpa_printf(MSG_DEBUG, "nl80211: Signal: %d dBm  txrate: %d",
1114                            sig.current_signal, sig.current_txrate);
1115         }
1116
1117         res = nl80211_get_link_noise(drv, &sig);
1118         if (res == 0) {
1119                 ed.signal_change.current_noise = sig.current_noise;
1120                 wpa_printf(MSG_DEBUG, "nl80211: Noise: %d dBm",
1121                            sig.current_noise);
1122         }
1123
1124         wpa_supplicant_event(drv->ctx, EVENT_SIGNAL_CHANGE, &ed);
1125 }
1126
1127
1128 static void nl80211_new_peer_candidate(struct wpa_driver_nl80211_data *drv,
1129                                        struct nlattr **tb)
1130 {
1131         const u8 *addr;
1132         union wpa_event_data data;
1133
1134         if (drv->nlmode != NL80211_IFTYPE_MESH_POINT ||
1135             !tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_IE])
1136                 return;
1137
1138         addr = nla_data(tb[NL80211_ATTR_MAC]);
1139         wpa_printf(MSG_DEBUG, "nl80211: New peer candidate " MACSTR,
1140                    MAC2STR(addr));
1141
1142         os_memset(&data, 0, sizeof(data));
1143         data.mesh_peer.peer = addr;
1144         data.mesh_peer.ies = nla_data(tb[NL80211_ATTR_IE]);
1145         data.mesh_peer.ie_len = nla_len(tb[NL80211_ATTR_IE]);
1146         wpa_supplicant_event(drv->ctx, EVENT_NEW_PEER_CANDIDATE, &data);
1147 }
1148
1149
1150 static void nl80211_new_station_event(struct wpa_driver_nl80211_data *drv,
1151                                       struct i802_bss *bss,
1152                                       struct nlattr **tb)
1153 {
1154         u8 *addr;
1155         union wpa_event_data data;
1156
1157         if (tb[NL80211_ATTR_MAC] == NULL)
1158                 return;
1159         addr = nla_data(tb[NL80211_ATTR_MAC]);
1160         wpa_printf(MSG_DEBUG, "nl80211: New station " MACSTR, MAC2STR(addr));
1161
1162         if (is_ap_interface(drv->nlmode) && drv->device_ap_sme) {
1163                 u8 *ies = NULL;
1164                 size_t ies_len = 0;
1165                 if (tb[NL80211_ATTR_IE]) {
1166                         ies = nla_data(tb[NL80211_ATTR_IE]);
1167                         ies_len = nla_len(tb[NL80211_ATTR_IE]);
1168                 }
1169                 wpa_hexdump(MSG_DEBUG, "nl80211: Assoc Req IEs", ies, ies_len);
1170                 drv_event_assoc(bss->ctx, addr, ies, ies_len, 0);
1171                 return;
1172         }
1173
1174         if (drv->nlmode != NL80211_IFTYPE_ADHOC)
1175                 return;
1176
1177         os_memset(&data, 0, sizeof(data));
1178         os_memcpy(data.ibss_rsn_start.peer, addr, ETH_ALEN);
1179         wpa_supplicant_event(bss->ctx, EVENT_IBSS_RSN_START, &data);
1180 }
1181
1182
1183 static void nl80211_del_station_event(struct wpa_driver_nl80211_data *drv,
1184                                       struct i802_bss *bss,
1185                                       struct nlattr **tb)
1186 {
1187         u8 *addr;
1188         union wpa_event_data data;
1189
1190         if (tb[NL80211_ATTR_MAC] == NULL)
1191                 return;
1192         addr = nla_data(tb[NL80211_ATTR_MAC]);
1193         wpa_printf(MSG_DEBUG, "nl80211: Delete station " MACSTR,
1194                    MAC2STR(addr));
1195
1196         if (is_ap_interface(drv->nlmode) && drv->device_ap_sme) {
1197                 drv_event_disassoc(bss->ctx, addr);
1198                 return;
1199         }
1200
1201         if (drv->nlmode != NL80211_IFTYPE_ADHOC)
1202                 return;
1203
1204         os_memset(&data, 0, sizeof(data));
1205         os_memcpy(data.ibss_peer_lost.peer, addr, ETH_ALEN);
1206         wpa_supplicant_event(bss->ctx, EVENT_IBSS_PEER_LOST, &data);
1207 }
1208
1209
1210 static void nl80211_rekey_offload_event(struct wpa_driver_nl80211_data *drv,
1211                                         struct nlattr **tb)
1212 {
1213         struct nlattr *rekey_info[NUM_NL80211_REKEY_DATA];
1214         static struct nla_policy rekey_policy[NUM_NL80211_REKEY_DATA] = {
1215                 [NL80211_REKEY_DATA_KEK] = {
1216                         .minlen = NL80211_KEK_LEN,
1217                         .maxlen = NL80211_KEK_LEN,
1218                 },
1219                 [NL80211_REKEY_DATA_KCK] = {
1220                         .minlen = NL80211_KCK_LEN,
1221                         .maxlen = NL80211_KCK_LEN,
1222                 },
1223                 [NL80211_REKEY_DATA_REPLAY_CTR] = {
1224                         .minlen = NL80211_REPLAY_CTR_LEN,
1225                         .maxlen = NL80211_REPLAY_CTR_LEN,
1226                 },
1227         };
1228         union wpa_event_data data;
1229
1230         if (!tb[NL80211_ATTR_MAC] ||
1231             !tb[NL80211_ATTR_REKEY_DATA] ||
1232             nla_parse_nested(rekey_info, MAX_NL80211_REKEY_DATA,
1233                              tb[NL80211_ATTR_REKEY_DATA], rekey_policy) ||
1234             !rekey_info[NL80211_REKEY_DATA_REPLAY_CTR])
1235                 return;
1236
1237         os_memset(&data, 0, sizeof(data));
1238         data.driver_gtk_rekey.bssid = nla_data(tb[NL80211_ATTR_MAC]);
1239         wpa_printf(MSG_DEBUG, "nl80211: Rekey offload event for BSSID " MACSTR,
1240                    MAC2STR(data.driver_gtk_rekey.bssid));
1241         data.driver_gtk_rekey.replay_ctr =
1242                 nla_data(rekey_info[NL80211_REKEY_DATA_REPLAY_CTR]);
1243         wpa_hexdump(MSG_DEBUG, "nl80211: Rekey offload - Replay Counter",
1244                     data.driver_gtk_rekey.replay_ctr, NL80211_REPLAY_CTR_LEN);
1245         wpa_supplicant_event(drv->ctx, EVENT_DRIVER_GTK_REKEY, &data);
1246 }
1247
1248
1249 static void nl80211_pmksa_candidate_event(struct wpa_driver_nl80211_data *drv,
1250                                           struct nlattr **tb)
1251 {
1252         struct nlattr *cand[NUM_NL80211_PMKSA_CANDIDATE];
1253         static struct nla_policy cand_policy[NUM_NL80211_PMKSA_CANDIDATE] = {
1254                 [NL80211_PMKSA_CANDIDATE_INDEX] = { .type = NLA_U32 },
1255                 [NL80211_PMKSA_CANDIDATE_BSSID] = {
1256                         .minlen = ETH_ALEN,
1257                         .maxlen = ETH_ALEN,
1258                 },
1259                 [NL80211_PMKSA_CANDIDATE_PREAUTH] = { .type = NLA_FLAG },
1260         };
1261         union wpa_event_data data;
1262
1263         wpa_printf(MSG_DEBUG, "nl80211: PMKSA candidate event");
1264
1265         if (!tb[NL80211_ATTR_PMKSA_CANDIDATE] ||
1266             nla_parse_nested(cand, MAX_NL80211_PMKSA_CANDIDATE,
1267                              tb[NL80211_ATTR_PMKSA_CANDIDATE], cand_policy) ||
1268             !cand[NL80211_PMKSA_CANDIDATE_INDEX] ||
1269             !cand[NL80211_PMKSA_CANDIDATE_BSSID])
1270                 return;
1271
1272         os_memset(&data, 0, sizeof(data));
1273         os_memcpy(data.pmkid_candidate.bssid,
1274                   nla_data(cand[NL80211_PMKSA_CANDIDATE_BSSID]), ETH_ALEN);
1275         data.pmkid_candidate.index =
1276                 nla_get_u32(cand[NL80211_PMKSA_CANDIDATE_INDEX]);
1277         data.pmkid_candidate.preauth =
1278                 cand[NL80211_PMKSA_CANDIDATE_PREAUTH] != NULL;
1279         wpa_supplicant_event(drv->ctx, EVENT_PMKID_CANDIDATE, &data);
1280 }
1281
1282
1283 static void nl80211_client_probe_event(struct wpa_driver_nl80211_data *drv,
1284                                        struct nlattr **tb)
1285 {
1286         union wpa_event_data data;
1287
1288         wpa_printf(MSG_DEBUG, "nl80211: Probe client event");
1289
1290         if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_ACK])
1291                 return;
1292
1293         os_memset(&data, 0, sizeof(data));
1294         os_memcpy(data.client_poll.addr,
1295                   nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1296
1297         wpa_supplicant_event(drv->ctx, EVENT_DRIVER_CLIENT_POLL_OK, &data);
1298 }
1299
1300
1301 static void nl80211_tdls_oper_event(struct wpa_driver_nl80211_data *drv,
1302                                     struct nlattr **tb)
1303 {
1304         union wpa_event_data data;
1305
1306         wpa_printf(MSG_DEBUG, "nl80211: TDLS operation event");
1307
1308         if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_TDLS_OPERATION])
1309                 return;
1310
1311         os_memset(&data, 0, sizeof(data));
1312         os_memcpy(data.tdls.peer, nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1313         switch (nla_get_u8(tb[NL80211_ATTR_TDLS_OPERATION])) {
1314         case NL80211_TDLS_SETUP:
1315                 wpa_printf(MSG_DEBUG, "nl80211: TDLS setup request for peer "
1316                            MACSTR, MAC2STR(data.tdls.peer));
1317                 data.tdls.oper = TDLS_REQUEST_SETUP;
1318                 break;
1319         case NL80211_TDLS_TEARDOWN:
1320                 wpa_printf(MSG_DEBUG, "nl80211: TDLS teardown request for peer "
1321                            MACSTR, MAC2STR(data.tdls.peer));
1322                 data.tdls.oper = TDLS_REQUEST_TEARDOWN;
1323                 break;
1324         case NL80211_TDLS_DISCOVERY_REQ:
1325                 wpa_printf(MSG_DEBUG,
1326                            "nl80211: TDLS discovery request for peer " MACSTR,
1327                            MAC2STR(data.tdls.peer));
1328                 data.tdls.oper = TDLS_REQUEST_DISCOVER;
1329                 break;
1330         default:
1331                 wpa_printf(MSG_DEBUG, "nl80211: Unsupported TDLS operatione "
1332                            "event");
1333                 return;
1334         }
1335         if (tb[NL80211_ATTR_REASON_CODE]) {
1336                 data.tdls.reason_code =
1337                         nla_get_u16(tb[NL80211_ATTR_REASON_CODE]);
1338         }
1339
1340         wpa_supplicant_event(drv->ctx, EVENT_TDLS, &data);
1341 }
1342
1343
1344 static void nl80211_stop_ap(struct wpa_driver_nl80211_data *drv,
1345                             struct nlattr **tb)
1346 {
1347         wpa_supplicant_event(drv->ctx, EVENT_INTERFACE_UNAVAILABLE, NULL);
1348 }
1349
1350
1351 static void nl80211_connect_failed_event(struct wpa_driver_nl80211_data *drv,
1352                                          struct nlattr **tb)
1353 {
1354         union wpa_event_data data;
1355         u32 reason;
1356
1357         wpa_printf(MSG_DEBUG, "nl80211: Connect failed event");
1358
1359         if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_CONN_FAILED_REASON])
1360                 return;
1361
1362         os_memset(&data, 0, sizeof(data));
1363         os_memcpy(data.connect_failed_reason.addr,
1364                   nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1365
1366         reason = nla_get_u32(tb[NL80211_ATTR_CONN_FAILED_REASON]);
1367         switch (reason) {
1368         case NL80211_CONN_FAIL_MAX_CLIENTS:
1369                 wpa_printf(MSG_DEBUG, "nl80211: Max client reached");
1370                 data.connect_failed_reason.code = MAX_CLIENT_REACHED;
1371                 break;
1372         case NL80211_CONN_FAIL_BLOCKED_CLIENT:
1373                 wpa_printf(MSG_DEBUG, "nl80211: Blocked client " MACSTR
1374                            " tried to connect",
1375                            MAC2STR(data.connect_failed_reason.addr));
1376                 data.connect_failed_reason.code = BLOCKED_CLIENT;
1377                 break;
1378         default:
1379                 wpa_printf(MSG_DEBUG, "nl8021l: Unknown connect failed reason "
1380                            "%u", reason);
1381                 return;
1382         }
1383
1384         wpa_supplicant_event(drv->ctx, EVENT_CONNECT_FAILED_REASON, &data);
1385 }
1386
1387
1388 static void nl80211_radar_event(struct wpa_driver_nl80211_data *drv,
1389                                 struct nlattr **tb)
1390 {
1391         union wpa_event_data data;
1392         enum nl80211_radar_event event_type;
1393
1394         if (!tb[NL80211_ATTR_WIPHY_FREQ] || !tb[NL80211_ATTR_RADAR_EVENT])
1395                 return;
1396
1397         os_memset(&data, 0, sizeof(data));
1398         data.dfs_event.freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
1399         event_type = nla_get_u32(tb[NL80211_ATTR_RADAR_EVENT]);
1400
1401         /* Check HT params */
1402         if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
1403                 data.dfs_event.ht_enabled = 1;
1404                 data.dfs_event.chan_offset = 0;
1405
1406                 switch (nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])) {
1407                 case NL80211_CHAN_NO_HT:
1408                         data.dfs_event.ht_enabled = 0;
1409                         break;
1410                 case NL80211_CHAN_HT20:
1411                         break;
1412                 case NL80211_CHAN_HT40PLUS:
1413                         data.dfs_event.chan_offset = 1;
1414                         break;
1415                 case NL80211_CHAN_HT40MINUS:
1416                         data.dfs_event.chan_offset = -1;
1417                         break;
1418                 }
1419         }
1420
1421         /* Get VHT params */
1422         if (tb[NL80211_ATTR_CHANNEL_WIDTH])
1423                 data.dfs_event.chan_width =
1424                         convert2width(nla_get_u32(
1425                                               tb[NL80211_ATTR_CHANNEL_WIDTH]));
1426         if (tb[NL80211_ATTR_CENTER_FREQ1])
1427                 data.dfs_event.cf1 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ1]);
1428         if (tb[NL80211_ATTR_CENTER_FREQ2])
1429                 data.dfs_event.cf2 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ2]);
1430
1431         wpa_printf(MSG_DEBUG, "nl80211: DFS event on freq %d MHz, ht: %d, offset: %d, width: %d, cf1: %dMHz, cf2: %dMHz",
1432                    data.dfs_event.freq, data.dfs_event.ht_enabled,
1433                    data.dfs_event.chan_offset, data.dfs_event.chan_width,
1434                    data.dfs_event.cf1, data.dfs_event.cf2);
1435
1436         switch (event_type) {
1437         case NL80211_RADAR_DETECTED:
1438                 wpa_supplicant_event(drv->ctx, EVENT_DFS_RADAR_DETECTED, &data);
1439                 break;
1440         case NL80211_RADAR_CAC_FINISHED:
1441                 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_FINISHED, &data);
1442                 break;
1443         case NL80211_RADAR_CAC_ABORTED:
1444                 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_ABORTED, &data);
1445                 break;
1446         case NL80211_RADAR_NOP_FINISHED:
1447                 wpa_supplicant_event(drv->ctx, EVENT_DFS_NOP_FINISHED, &data);
1448                 break;
1449         default:
1450                 wpa_printf(MSG_DEBUG, "nl80211: Unknown radar event %d "
1451                            "received", event_type);
1452                 break;
1453         }
1454 }
1455
1456
1457 static void nl80211_spurious_frame(struct i802_bss *bss, struct nlattr **tb,
1458                                    int wds)
1459 {
1460         struct wpa_driver_nl80211_data *drv = bss->drv;
1461         union wpa_event_data event;
1462
1463         if (!tb[NL80211_ATTR_MAC])
1464                 return;
1465
1466         os_memset(&event, 0, sizeof(event));
1467         event.rx_from_unknown.bssid = bss->addr;
1468         event.rx_from_unknown.addr = nla_data(tb[NL80211_ATTR_MAC]);
1469         event.rx_from_unknown.wds = wds;
1470
1471         wpa_supplicant_event(drv->ctx, EVENT_RX_FROM_UNKNOWN, &event);
1472 }
1473
1474
1475 #ifdef CONFIG_DRIVER_NL80211_QCA
1476
1477 static void qca_nl80211_avoid_freq(struct wpa_driver_nl80211_data *drv,
1478                                    const u8 *data, size_t len)
1479 {
1480         u32 i, count;
1481         union wpa_event_data event;
1482         struct wpa_freq_range *range = NULL;
1483         const struct qca_avoid_freq_list *freq_range;
1484
1485         freq_range = (const struct qca_avoid_freq_list *) data;
1486         if (len < sizeof(freq_range->count))
1487                 return;
1488
1489         count = freq_range->count;
1490         if (len < sizeof(freq_range->count) +
1491             count * sizeof(struct qca_avoid_freq_range)) {
1492                 wpa_printf(MSG_DEBUG, "nl80211: Ignored too short avoid frequency list (len=%u)",
1493                            (unsigned int) len);
1494                 return;
1495         }
1496
1497         if (count > 0) {
1498                 range = os_calloc(count, sizeof(struct wpa_freq_range));
1499                 if (range == NULL)
1500                         return;
1501         }
1502
1503         os_memset(&event, 0, sizeof(event));
1504         for (i = 0; i < count; i++) {
1505                 unsigned int idx = event.freq_range.num;
1506                 range[idx].min = freq_range->range[i].start_freq;
1507                 range[idx].max = freq_range->range[i].end_freq;
1508                 wpa_printf(MSG_DEBUG, "nl80211: Avoid frequency range: %u-%u",
1509                            range[idx].min, range[idx].max);
1510                 if (range[idx].min > range[idx].max) {
1511                         wpa_printf(MSG_DEBUG, "nl80211: Ignore invalid frequency range");
1512                         continue;
1513                 }
1514                 event.freq_range.num++;
1515         }
1516         event.freq_range.range = range;
1517
1518         wpa_supplicant_event(drv->ctx, EVENT_AVOID_FREQUENCIES, &event);
1519
1520         os_free(range);
1521 }
1522
1523
1524 static enum hostapd_hw_mode get_qca_hw_mode(u8 hw_mode)
1525 {
1526         switch (hw_mode) {
1527         case QCA_ACS_MODE_IEEE80211B:
1528                 return HOSTAPD_MODE_IEEE80211B;
1529         case QCA_ACS_MODE_IEEE80211G:
1530                 return HOSTAPD_MODE_IEEE80211G;
1531         case QCA_ACS_MODE_IEEE80211A:
1532                 return HOSTAPD_MODE_IEEE80211A;
1533         case QCA_ACS_MODE_IEEE80211AD:
1534                 return HOSTAPD_MODE_IEEE80211AD;
1535         case QCA_ACS_MODE_IEEE80211ANY:
1536                 return HOSTAPD_MODE_IEEE80211ANY;
1537         default:
1538                 return NUM_HOSTAPD_MODES;
1539         }
1540 }
1541
1542
1543 static void qca_nl80211_acs_select_ch(struct wpa_driver_nl80211_data *drv,
1544                                    const u8 *data, size_t len)
1545 {
1546         struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_ACS_MAX + 1];
1547         union wpa_event_data event;
1548
1549         wpa_printf(MSG_DEBUG,
1550                    "nl80211: ACS channel selection vendor event received");
1551
1552         if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_ACS_MAX,
1553                       (struct nlattr *) data, len, NULL) ||
1554             !tb[QCA_WLAN_VENDOR_ATTR_ACS_PRIMARY_CHANNEL] ||
1555             !tb[QCA_WLAN_VENDOR_ATTR_ACS_SECONDARY_CHANNEL])
1556                 return;
1557
1558         os_memset(&event, 0, sizeof(event));
1559         event.acs_selected_channels.pri_channel =
1560                 nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_PRIMARY_CHANNEL]);
1561         event.acs_selected_channels.sec_channel =
1562                 nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_SECONDARY_CHANNEL]);
1563         if (tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG0_CENTER_CHANNEL])
1564                 event.acs_selected_channels.vht_seg0_center_ch =
1565                         nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG0_CENTER_CHANNEL]);
1566         if (tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG0_CENTER_CHANNEL])
1567                 event.acs_selected_channels.vht_seg1_center_ch =
1568                         nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG1_CENTER_CHANNEL]);
1569         if (tb[QCA_WLAN_VENDOR_ATTR_ACS_CHWIDTH])
1570                 event.acs_selected_channels.ch_width =
1571                         nla_get_u16(tb[QCA_WLAN_VENDOR_ATTR_ACS_CHWIDTH]);
1572         if (tb[QCA_WLAN_VENDOR_ATTR_ACS_HW_MODE]) {
1573                 u8 hw_mode = nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_HW_MODE]);
1574
1575                 event.acs_selected_channels.hw_mode = get_qca_hw_mode(hw_mode);
1576                 if (event.acs_selected_channels.hw_mode == NUM_HOSTAPD_MODES ||
1577                     event.acs_selected_channels.hw_mode ==
1578                     HOSTAPD_MODE_IEEE80211ANY) {
1579                         wpa_printf(MSG_DEBUG,
1580                                    "nl80211: Invalid hw_mode %d in ACS selection event",
1581                                    hw_mode);
1582                         return;
1583                 }
1584         }
1585
1586         wpa_printf(MSG_INFO,
1587                    "nl80211: ACS Results: PCH: %d SCH: %d BW: %d VHT0: %d VHT1: %d HW_MODE: %d",
1588                    event.acs_selected_channels.pri_channel,
1589                    event.acs_selected_channels.sec_channel,
1590                    event.acs_selected_channels.ch_width,
1591                    event.acs_selected_channels.vht_seg0_center_ch,
1592                    event.acs_selected_channels.vht_seg1_center_ch,
1593                    event.acs_selected_channels.hw_mode);
1594
1595         /* Ignore ACS channel list check for backwards compatibility */
1596
1597         wpa_supplicant_event(drv->ctx, EVENT_ACS_CHANNEL_SELECTED, &event);
1598 }
1599
1600
1601 static void qca_nl80211_key_mgmt_auth(struct wpa_driver_nl80211_data *drv,
1602                                       const u8 *data, size_t len)
1603 {
1604         struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_MAX + 1];
1605         u8 *bssid;
1606
1607         wpa_printf(MSG_DEBUG,
1608                    "nl80211: Key management roam+auth vendor event received");
1609
1610         if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_MAX,
1611                       (struct nlattr *) data, len, NULL) ||
1612             !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID] ||
1613             nla_len(tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID]) != ETH_ALEN ||
1614             !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_REQ_IE] ||
1615             !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_RESP_IE] ||
1616             !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_AUTHORIZED])
1617                 return;
1618
1619         bssid = nla_data(tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID]);
1620         wpa_printf(MSG_DEBUG, "  * roam BSSID " MACSTR, MAC2STR(bssid));
1621
1622         mlme_event_connect(drv, NL80211_CMD_ROAM, NULL,
1623                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID],
1624                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_REQ_IE],
1625                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_RESP_IE],
1626                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_AUTHORIZED],
1627                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_KEY_REPLAY_CTR],
1628                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KCK],
1629                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KEK],
1630                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_SUBNET_STATUS]);
1631 }
1632
1633
1634 static void qca_nl80211_dfs_offload_radar_event(
1635         struct wpa_driver_nl80211_data *drv, u32 subcmd, u8 *msg, int length)
1636 {
1637         union wpa_event_data data;
1638         struct nlattr *tb[NL80211_ATTR_MAX + 1];
1639
1640         wpa_printf(MSG_DEBUG,
1641                    "nl80211: DFS offload radar vendor event received");
1642
1643         if (nla_parse(tb, NL80211_ATTR_MAX,
1644                       (struct nlattr *) msg, length, NULL))
1645                 return;
1646
1647         if (!tb[NL80211_ATTR_WIPHY_FREQ]) {
1648                 wpa_printf(MSG_INFO,
1649                            "nl80211: Error parsing WIPHY_FREQ in FS offload radar vendor event");
1650                 return;
1651         }
1652
1653         os_memset(&data, 0, sizeof(data));
1654         data.dfs_event.freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
1655
1656         wpa_printf(MSG_DEBUG, "nl80211: DFS event on freq %d MHz",
1657                    data.dfs_event.freq);
1658
1659         /* Check HT params */
1660         if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
1661                 data.dfs_event.ht_enabled = 1;
1662                 data.dfs_event.chan_offset = 0;
1663
1664                 switch (nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])) {
1665                 case NL80211_CHAN_NO_HT:
1666                         data.dfs_event.ht_enabled = 0;
1667                         break;
1668                 case NL80211_CHAN_HT20:
1669                         break;
1670                 case NL80211_CHAN_HT40PLUS:
1671                         data.dfs_event.chan_offset = 1;
1672                         break;
1673                 case NL80211_CHAN_HT40MINUS:
1674                         data.dfs_event.chan_offset = -1;
1675                         break;
1676                 }
1677         }
1678
1679         /* Get VHT params */
1680         if (tb[NL80211_ATTR_CHANNEL_WIDTH])
1681                 data.dfs_event.chan_width =
1682                         convert2width(nla_get_u32(
1683                                               tb[NL80211_ATTR_CHANNEL_WIDTH]));
1684         if (tb[NL80211_ATTR_CENTER_FREQ1])
1685                 data.dfs_event.cf1 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ1]);
1686         if (tb[NL80211_ATTR_CENTER_FREQ2])
1687                 data.dfs_event.cf2 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ2]);
1688
1689         wpa_printf(MSG_DEBUG, "nl80211: DFS event on freq %d MHz, ht: %d, "
1690                     "offset: %d, width: %d, cf1: %dMHz, cf2: %dMHz",
1691                     data.dfs_event.freq, data.dfs_event.ht_enabled,
1692                     data.dfs_event.chan_offset, data.dfs_event.chan_width,
1693                     data.dfs_event.cf1, data.dfs_event.cf2);
1694
1695         switch (subcmd) {
1696         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_RADAR_DETECTED:
1697                 wpa_supplicant_event(drv->ctx, EVENT_DFS_RADAR_DETECTED, &data);
1698                 break;
1699         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_STARTED:
1700                 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_STARTED, &data);
1701                 break;
1702         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_FINISHED:
1703                 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_FINISHED, &data);
1704                 break;
1705         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_ABORTED:
1706                 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_ABORTED, &data);
1707                 break;
1708         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_NOP_FINISHED:
1709                 wpa_supplicant_event(drv->ctx, EVENT_DFS_NOP_FINISHED, &data);
1710                 break;
1711         default:
1712                 wpa_printf(MSG_DEBUG,
1713                            "nl80211: Unknown DFS offload radar event %d received",
1714                            subcmd);
1715                 break;
1716         }
1717 }
1718
1719
1720 static void qca_nl80211_scan_trigger_event(struct wpa_driver_nl80211_data *drv,
1721                                            u8 *data, size_t len)
1722 {
1723         struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_SCAN_MAX + 1];
1724         u64 cookie = 0;
1725         union wpa_event_data event;
1726         struct scan_info *info;
1727
1728         if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_SCAN_MAX,
1729                       (struct nlattr *) data, len, NULL) ||
1730             !tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE])
1731                 return;
1732
1733         cookie = nla_get_u64(tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE]);
1734         if (cookie != drv->vendor_scan_cookie) {
1735                 /* External scan trigger event, ignore */
1736                 return;
1737         }
1738
1739         /* Cookie match, own scan */
1740         os_memset(&event, 0, sizeof(event));
1741         info = &event.scan_info;
1742         info->external_scan = 0;
1743         info->nl_scan_event = 0;
1744
1745         drv->scan_state = SCAN_STARTED;
1746         wpa_supplicant_event(drv->ctx, EVENT_SCAN_STARTED, &event);
1747 }
1748
1749
1750 static void send_vendor_scan_event(struct wpa_driver_nl80211_data *drv,
1751                                    int aborted, struct nlattr *tb[],
1752                                    int external_scan)
1753 {
1754         union wpa_event_data event;
1755         struct nlattr *nl;
1756         int rem;
1757         struct scan_info *info;
1758         int freqs[MAX_REPORT_FREQS];
1759         int num_freqs = 0;
1760
1761         os_memset(&event, 0, sizeof(event));
1762         info = &event.scan_info;
1763         info->aborted = aborted;
1764         info->external_scan = external_scan;
1765
1766         if (tb[QCA_WLAN_VENDOR_ATTR_SCAN_SSIDS]) {
1767                 nla_for_each_nested(nl,
1768                                     tb[QCA_WLAN_VENDOR_ATTR_SCAN_SSIDS], rem) {
1769                         struct wpa_driver_scan_ssid *s =
1770                                 &info->ssids[info->num_ssids];
1771                         s->ssid = nla_data(nl);
1772                         s->ssid_len = nla_len(nl);
1773                         wpa_printf(MSG_DEBUG,
1774                                    "nl80211: Scan probed for SSID '%s'",
1775                                    wpa_ssid_txt(s->ssid, s->ssid_len));
1776                         info->num_ssids++;
1777                         if (info->num_ssids == WPAS_MAX_SCAN_SSIDS)
1778                                 break;
1779                 }
1780         }
1781
1782         if (tb[QCA_WLAN_VENDOR_ATTR_SCAN_FREQUENCIES]) {
1783                 char msg[300], *pos, *end;
1784                 int res;
1785
1786                 pos = msg;
1787                 end = pos + sizeof(msg);
1788                 *pos = '\0';
1789
1790                 nla_for_each_nested(nl,
1791                                     tb[QCA_WLAN_VENDOR_ATTR_SCAN_FREQUENCIES],
1792                                     rem) {
1793                         freqs[num_freqs] = nla_get_u32(nl);
1794                         res = os_snprintf(pos, end - pos, " %d",
1795                                           freqs[num_freqs]);
1796                         if (!os_snprintf_error(end - pos, res))
1797                                 pos += res;
1798                         num_freqs++;
1799                         if (num_freqs == MAX_REPORT_FREQS - 1)
1800                                 break;
1801                 }
1802
1803                 info->freqs = freqs;
1804                 info->num_freqs = num_freqs;
1805                 wpa_printf(MSG_DEBUG, "nl80211: Scan included frequencies:%s",
1806                            msg);
1807         }
1808         wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS, &event);
1809 }
1810
1811
1812 static void qca_nl80211_scan_done_event(struct wpa_driver_nl80211_data *drv,
1813                                         u8 *data, size_t len)
1814 {
1815         struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_SCAN_MAX + 1];
1816         u64 cookie = 0;
1817         enum scan_status status;
1818         int external_scan;
1819
1820         if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_SCAN_MAX,
1821                       (struct nlattr *) data, len, NULL) ||
1822             !tb[QCA_WLAN_VENDOR_ATTR_SCAN_STATUS] ||
1823             !tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE])
1824                 return;
1825
1826         status = nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_SCAN_STATUS]);
1827         if (status >= VENDOR_SCAN_STATUS_MAX)
1828                 return; /* invalid status */
1829
1830         cookie = nla_get_u64(tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE]);
1831         if (cookie != drv->vendor_scan_cookie) {
1832                 /* Event from an external scan, get scan results */
1833                 external_scan = 1;
1834         } else {
1835                 external_scan = 0;
1836                 if (status == VENDOR_SCAN_STATUS_NEW_RESULTS)
1837                         drv->scan_state = SCAN_COMPLETED;
1838                 else
1839                         drv->scan_state = SCAN_ABORTED;
1840
1841                 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout, drv,
1842                                      drv->ctx);
1843                 drv->vendor_scan_cookie = 0;
1844                 drv->last_scan_cmd = 0;
1845         }
1846
1847         send_vendor_scan_event(drv, (status == VENDOR_SCAN_STATUS_ABORTED), tb,
1848                                external_scan);
1849 }
1850
1851 #endif /* CONFIG_DRIVER_NL80211_QCA */
1852
1853
1854 static void nl80211_vendor_event_qca(struct wpa_driver_nl80211_data *drv,
1855                                      u32 subcmd, u8 *data, size_t len)
1856 {
1857         switch (subcmd) {
1858         case QCA_NL80211_VENDOR_SUBCMD_TEST:
1859                 wpa_hexdump(MSG_DEBUG, "nl80211: QCA test event", data, len);
1860                 break;
1861 #ifdef CONFIG_DRIVER_NL80211_QCA
1862         case QCA_NL80211_VENDOR_SUBCMD_AVOID_FREQUENCY:
1863                 qca_nl80211_avoid_freq(drv, data, len);
1864                 break;
1865         case QCA_NL80211_VENDOR_SUBCMD_KEY_MGMT_ROAM_AUTH:
1866                 qca_nl80211_key_mgmt_auth(drv, data, len);
1867                 break;
1868         case QCA_NL80211_VENDOR_SUBCMD_DO_ACS:
1869                 qca_nl80211_acs_select_ch(drv, data, len);
1870                 break;
1871         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_STARTED:
1872         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_FINISHED:
1873         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_ABORTED:
1874         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_NOP_FINISHED:
1875         case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_RADAR_DETECTED:
1876                 qca_nl80211_dfs_offload_radar_event(drv, subcmd, data, len);
1877                 break;
1878         case QCA_NL80211_VENDOR_SUBCMD_TRIGGER_SCAN:
1879                 qca_nl80211_scan_trigger_event(drv, data, len);
1880                 break;
1881         case QCA_NL80211_VENDOR_SUBCMD_SCAN_DONE:
1882                 qca_nl80211_scan_done_event(drv, data, len);
1883                 break;
1884 #endif /* CONFIG_DRIVER_NL80211_QCA */
1885         default:
1886                 wpa_printf(MSG_DEBUG,
1887                            "nl80211: Ignore unsupported QCA vendor event %u",
1888                            subcmd);
1889                 break;
1890         }
1891 }
1892
1893
1894 static void nl80211_vendor_event(struct wpa_driver_nl80211_data *drv,
1895                                  struct nlattr **tb)
1896 {
1897         u32 vendor_id, subcmd, wiphy = 0;
1898         int wiphy_idx;
1899         u8 *data = NULL;
1900         size_t len = 0;
1901
1902         if (!tb[NL80211_ATTR_VENDOR_ID] ||
1903             !tb[NL80211_ATTR_VENDOR_SUBCMD])
1904                 return;
1905
1906         vendor_id = nla_get_u32(tb[NL80211_ATTR_VENDOR_ID]);
1907         subcmd = nla_get_u32(tb[NL80211_ATTR_VENDOR_SUBCMD]);
1908
1909         if (tb[NL80211_ATTR_WIPHY])
1910                 wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
1911
1912         wpa_printf(MSG_DEBUG, "nl80211: Vendor event: wiphy=%u vendor_id=0x%x subcmd=%u",
1913                    wiphy, vendor_id, subcmd);
1914
1915         if (tb[NL80211_ATTR_VENDOR_DATA]) {
1916                 data = nla_data(tb[NL80211_ATTR_VENDOR_DATA]);
1917                 len = nla_len(tb[NL80211_ATTR_VENDOR_DATA]);
1918                 wpa_hexdump(MSG_MSGDUMP, "nl80211: Vendor data", data, len);
1919         }
1920
1921         wiphy_idx = nl80211_get_wiphy_index(drv->first_bss);
1922         if (wiphy_idx >= 0 && wiphy_idx != (int) wiphy) {
1923                 wpa_printf(MSG_DEBUG, "nl80211: Ignore vendor event for foreign wiphy %u (own: %d)",
1924                            wiphy, wiphy_idx);
1925                 return;
1926         }
1927
1928         switch (vendor_id) {
1929         case OUI_QCA:
1930                 nl80211_vendor_event_qca(drv, subcmd, data, len);
1931                 break;
1932         default:
1933                 wpa_printf(MSG_DEBUG, "nl80211: Ignore unsupported vendor event");
1934                 break;
1935         }
1936 }
1937
1938
1939 static void nl80211_reg_change_event(struct wpa_driver_nl80211_data *drv,
1940                                      struct nlattr *tb[])
1941 {
1942         union wpa_event_data data;
1943         enum nl80211_reg_initiator init;
1944
1945         wpa_printf(MSG_DEBUG, "nl80211: Regulatory domain change");
1946
1947         if (tb[NL80211_ATTR_REG_INITIATOR] == NULL)
1948                 return;
1949
1950         os_memset(&data, 0, sizeof(data));
1951         init = nla_get_u8(tb[NL80211_ATTR_REG_INITIATOR]);
1952         wpa_printf(MSG_DEBUG, " * initiator=%d", init);
1953         switch (init) {
1954         case NL80211_REGDOM_SET_BY_CORE:
1955                 data.channel_list_changed.initiator = REGDOM_SET_BY_CORE;
1956                 break;
1957         case NL80211_REGDOM_SET_BY_USER:
1958                 data.channel_list_changed.initiator = REGDOM_SET_BY_USER;
1959                 break;
1960         case NL80211_REGDOM_SET_BY_DRIVER:
1961                 data.channel_list_changed.initiator = REGDOM_SET_BY_DRIVER;
1962                 break;
1963         case NL80211_REGDOM_SET_BY_COUNTRY_IE:
1964                 data.channel_list_changed.initiator = REGDOM_SET_BY_COUNTRY_IE;
1965                 break;
1966         }
1967
1968         if (tb[NL80211_ATTR_REG_TYPE]) {
1969                 enum nl80211_reg_type type;
1970                 type = nla_get_u8(tb[NL80211_ATTR_REG_TYPE]);
1971                 wpa_printf(MSG_DEBUG, " * type=%d", type);
1972                 switch (type) {
1973                 case NL80211_REGDOM_TYPE_COUNTRY:
1974                         data.channel_list_changed.type = REGDOM_TYPE_COUNTRY;
1975                         break;
1976                 case NL80211_REGDOM_TYPE_WORLD:
1977                         data.channel_list_changed.type = REGDOM_TYPE_WORLD;
1978                         break;
1979                 case NL80211_REGDOM_TYPE_CUSTOM_WORLD:
1980                         data.channel_list_changed.type =
1981                                 REGDOM_TYPE_CUSTOM_WORLD;
1982                         break;
1983                 case NL80211_REGDOM_TYPE_INTERSECTION:
1984                         data.channel_list_changed.type =
1985                                 REGDOM_TYPE_INTERSECTION;
1986                         break;
1987                 }
1988         }
1989
1990         if (tb[NL80211_ATTR_REG_ALPHA2]) {
1991                 os_strlcpy(data.channel_list_changed.alpha2,
1992                            nla_get_string(tb[NL80211_ATTR_REG_ALPHA2]),
1993                            sizeof(data.channel_list_changed.alpha2));
1994                 wpa_printf(MSG_DEBUG, " * alpha2=%s",
1995                            data.channel_list_changed.alpha2);
1996         }
1997
1998         wpa_supplicant_event(drv->ctx, EVENT_CHANNEL_LIST_CHANGED, &data);
1999 }
2000
2001
2002 static void do_process_drv_event(struct i802_bss *bss, int cmd,
2003                                  struct nlattr **tb)
2004 {
2005         struct wpa_driver_nl80211_data *drv = bss->drv;
2006         union wpa_event_data data;
2007         int external_scan_event = 0;
2008
2009         wpa_printf(MSG_DEBUG, "nl80211: Drv Event %d (%s) received for %s",
2010                    cmd, nl80211_command_to_string(cmd), bss->ifname);
2011
2012         if (cmd == NL80211_CMD_ROAM &&
2013             (drv->capa.flags & WPA_DRIVER_FLAGS_KEY_MGMT_OFFLOAD)) {
2014                 /*
2015                  * Device will use roam+auth vendor event to indicate
2016                  * roaming, so ignore the regular roam event.
2017                  */
2018                 wpa_printf(MSG_DEBUG,
2019                            "nl80211: Ignore roam event (cmd=%d), device will use vendor event roam+auth",
2020                            cmd);
2021                 return;
2022         }
2023
2024         if (drv->ap_scan_as_station != NL80211_IFTYPE_UNSPECIFIED &&
2025             (cmd == NL80211_CMD_NEW_SCAN_RESULTS ||
2026              cmd == NL80211_CMD_SCAN_ABORTED)) {
2027                 wpa_driver_nl80211_set_mode(drv->first_bss,
2028                                             drv->ap_scan_as_station);
2029                 drv->ap_scan_as_station = NL80211_IFTYPE_UNSPECIFIED;
2030         }
2031
2032         switch (cmd) {
2033         case NL80211_CMD_TRIGGER_SCAN:
2034                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Scan trigger");
2035                 drv->scan_state = SCAN_STARTED;
2036                 if (drv->scan_for_auth) {
2037                         /*
2038                          * Cannot indicate EVENT_SCAN_STARTED here since we skip
2039                          * EVENT_SCAN_RESULTS in scan_for_auth case and the
2040                          * upper layer implementation could get confused about
2041                          * scanning state.
2042                          */
2043                         wpa_printf(MSG_DEBUG, "nl80211: Do not indicate scan-start event due to internal scan_for_auth");
2044                         break;
2045                 }
2046                 wpa_supplicant_event(drv->ctx, EVENT_SCAN_STARTED, NULL);
2047                 break;
2048         case NL80211_CMD_START_SCHED_SCAN:
2049                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Sched scan started");
2050                 drv->scan_state = SCHED_SCAN_STARTED;
2051                 break;
2052         case NL80211_CMD_SCHED_SCAN_STOPPED:
2053                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Sched scan stopped");
2054                 drv->scan_state = SCHED_SCAN_STOPPED;
2055                 wpa_supplicant_event(drv->ctx, EVENT_SCHED_SCAN_STOPPED, NULL);
2056                 break;
2057         case NL80211_CMD_NEW_SCAN_RESULTS:
2058                 wpa_dbg(drv->ctx, MSG_DEBUG,
2059                         "nl80211: New scan results available");
2060                 drv->scan_complete_events = 1;
2061                 if (drv->last_scan_cmd == NL80211_CMD_TRIGGER_SCAN) {
2062                         drv->scan_state = SCAN_COMPLETED;
2063                         eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout,
2064                                              drv, drv->ctx);
2065                         drv->last_scan_cmd = 0;
2066                 } else {
2067                         external_scan_event = 1;
2068                 }
2069                 send_scan_event(drv, 0, tb, external_scan_event);
2070                 break;
2071         case NL80211_CMD_SCHED_SCAN_RESULTS:
2072                 wpa_dbg(drv->ctx, MSG_DEBUG,
2073                         "nl80211: New sched scan results available");
2074                 drv->scan_state = SCHED_SCAN_RESULTS;
2075                 send_scan_event(drv, 0, tb, 0);
2076                 break;
2077         case NL80211_CMD_SCAN_ABORTED:
2078                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Scan aborted");
2079                 if (drv->last_scan_cmd == NL80211_CMD_TRIGGER_SCAN) {
2080                         drv->scan_state = SCAN_ABORTED;
2081                         /*
2082                          * Need to indicate that scan results are available in
2083                          * order not to make wpa_supplicant stop its scanning.
2084                          */
2085                         eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout,
2086                                              drv, drv->ctx);
2087                         drv->last_scan_cmd = 0;
2088                 } else {
2089                         external_scan_event = 1;
2090                 }
2091                 send_scan_event(drv, 1, tb, external_scan_event);
2092                 break;
2093         case NL80211_CMD_AUTHENTICATE:
2094         case NL80211_CMD_ASSOCIATE:
2095         case NL80211_CMD_DEAUTHENTICATE:
2096         case NL80211_CMD_DISASSOCIATE:
2097         case NL80211_CMD_FRAME_TX_STATUS:
2098         case NL80211_CMD_UNPROT_DEAUTHENTICATE:
2099         case NL80211_CMD_UNPROT_DISASSOCIATE:
2100                 mlme_event(bss, cmd, tb[NL80211_ATTR_FRAME],
2101                            tb[NL80211_ATTR_MAC], tb[NL80211_ATTR_TIMED_OUT],
2102                            tb[NL80211_ATTR_WIPHY_FREQ], tb[NL80211_ATTR_ACK],
2103                            tb[NL80211_ATTR_COOKIE],
2104                            tb[NL80211_ATTR_RX_SIGNAL_DBM],
2105                            tb[NL80211_ATTR_STA_WME]);
2106                 break;
2107         case NL80211_CMD_CONNECT:
2108         case NL80211_CMD_ROAM:
2109                 mlme_event_connect(drv, cmd,
2110                                    tb[NL80211_ATTR_STATUS_CODE],
2111                                    tb[NL80211_ATTR_MAC],
2112                                    tb[NL80211_ATTR_REQ_IE],
2113                                    tb[NL80211_ATTR_RESP_IE],
2114                                    NULL, NULL, NULL, NULL, NULL);
2115                 break;
2116         case NL80211_CMD_CH_SWITCH_NOTIFY:
2117                 mlme_event_ch_switch(drv,
2118                                      tb[NL80211_ATTR_IFINDEX],
2119                                      tb[NL80211_ATTR_WIPHY_FREQ],
2120                                      tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
2121                                      tb[NL80211_ATTR_CHANNEL_WIDTH],
2122                                      tb[NL80211_ATTR_CENTER_FREQ1],
2123                                      tb[NL80211_ATTR_CENTER_FREQ2]);
2124                 break;
2125         case NL80211_CMD_DISCONNECT:
2126                 mlme_event_disconnect(drv, tb[NL80211_ATTR_REASON_CODE],
2127                                       tb[NL80211_ATTR_MAC],
2128                                       tb[NL80211_ATTR_DISCONNECTED_BY_AP]);
2129                 break;
2130         case NL80211_CMD_MICHAEL_MIC_FAILURE:
2131                 mlme_event_michael_mic_failure(bss, tb);
2132                 break;
2133         case NL80211_CMD_JOIN_IBSS:
2134                 mlme_event_join_ibss(drv, tb);
2135                 break;
2136         case NL80211_CMD_REMAIN_ON_CHANNEL:
2137                 mlme_event_remain_on_channel(drv, 0, tb);
2138                 break;
2139         case NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL:
2140                 mlme_event_remain_on_channel(drv, 1, tb);
2141                 break;
2142         case NL80211_CMD_NOTIFY_CQM:
2143                 nl80211_cqm_event(drv, tb);
2144                 break;
2145         case NL80211_CMD_REG_CHANGE:
2146                 nl80211_reg_change_event(drv, tb);
2147                 break;
2148         case NL80211_CMD_REG_BEACON_HINT:
2149                 wpa_printf(MSG_DEBUG, "nl80211: Regulatory beacon hint");
2150                 os_memset(&data, 0, sizeof(data));
2151                 data.channel_list_changed.initiator = REGDOM_BEACON_HINT;
2152                 wpa_supplicant_event(drv->ctx, EVENT_CHANNEL_LIST_CHANGED,
2153                                      &data);
2154                 break;
2155         case NL80211_CMD_NEW_STATION:
2156                 nl80211_new_station_event(drv, bss, tb);
2157                 break;
2158         case NL80211_CMD_DEL_STATION:
2159                 nl80211_del_station_event(drv, bss, tb);
2160                 break;
2161         case NL80211_CMD_SET_REKEY_OFFLOAD:
2162                 nl80211_rekey_offload_event(drv, tb);
2163                 break;
2164         case NL80211_CMD_PMKSA_CANDIDATE:
2165                 nl80211_pmksa_candidate_event(drv, tb);
2166                 break;
2167         case NL80211_CMD_PROBE_CLIENT:
2168                 nl80211_client_probe_event(drv, tb);
2169                 break;
2170         case NL80211_CMD_TDLS_OPER:
2171                 nl80211_tdls_oper_event(drv, tb);
2172                 break;
2173         case NL80211_CMD_CONN_FAILED:
2174                 nl80211_connect_failed_event(drv, tb);
2175                 break;
2176         case NL80211_CMD_FT_EVENT:
2177                 mlme_event_ft_event(drv, tb);
2178                 break;
2179         case NL80211_CMD_RADAR_DETECT:
2180                 nl80211_radar_event(drv, tb);
2181                 break;
2182         case NL80211_CMD_STOP_AP:
2183                 nl80211_stop_ap(drv, tb);
2184                 break;
2185         case NL80211_CMD_VENDOR:
2186                 nl80211_vendor_event(drv, tb);
2187                 break;
2188         case NL80211_CMD_NEW_PEER_CANDIDATE:
2189                 nl80211_new_peer_candidate(drv, tb);
2190                 break;
2191         default:
2192                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Ignored unknown event "
2193                         "(cmd=%d)", cmd);
2194                 break;
2195         }
2196 }
2197
2198
2199 int process_global_event(struct nl_msg *msg, void *arg)
2200 {
2201         struct nl80211_global *global = arg;
2202         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
2203         struct nlattr *tb[NL80211_ATTR_MAX + 1];
2204         struct wpa_driver_nl80211_data *drv, *tmp;
2205         int ifidx = -1;
2206         struct i802_bss *bss;
2207         u64 wdev_id = 0;
2208         int wdev_id_set = 0;
2209
2210         nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
2211                   genlmsg_attrlen(gnlh, 0), NULL);
2212
2213         if (tb[NL80211_ATTR_IFINDEX])
2214                 ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
2215         else if (tb[NL80211_ATTR_WDEV]) {
2216                 wdev_id = nla_get_u64(tb[NL80211_ATTR_WDEV]);
2217                 wdev_id_set = 1;
2218         }
2219
2220         dl_list_for_each_safe(drv, tmp, &global->interfaces,
2221                               struct wpa_driver_nl80211_data, list) {
2222                 for (bss = drv->first_bss; bss; bss = bss->next) {
2223                         if ((ifidx == -1 && !wdev_id_set) ||
2224                             ifidx == bss->ifindex ||
2225                             (wdev_id_set && bss->wdev_id_set &&
2226                              wdev_id == bss->wdev_id)) {
2227                                 do_process_drv_event(bss, gnlh->cmd, tb);
2228                                 return NL_SKIP;
2229                         }
2230                 }
2231                 wpa_printf(MSG_DEBUG,
2232                            "nl80211: Ignored event (cmd=%d) for foreign interface (ifindex %d wdev 0x%llx)",
2233                            gnlh->cmd, ifidx, (long long unsigned int) wdev_id);
2234         }
2235
2236         return NL_SKIP;
2237 }
2238
2239
2240 int process_bss_event(struct nl_msg *msg, void *arg)
2241 {
2242         struct i802_bss *bss = arg;
2243         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
2244         struct nlattr *tb[NL80211_ATTR_MAX + 1];
2245
2246         nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
2247                   genlmsg_attrlen(gnlh, 0), NULL);
2248
2249         wpa_printf(MSG_DEBUG, "nl80211: BSS Event %d (%s) received for %s",
2250                    gnlh->cmd, nl80211_command_to_string(gnlh->cmd),
2251                    bss->ifname);
2252
2253         switch (gnlh->cmd) {
2254         case NL80211_CMD_FRAME:
2255         case NL80211_CMD_FRAME_TX_STATUS:
2256                 mlme_event(bss, gnlh->cmd, tb[NL80211_ATTR_FRAME],
2257                            tb[NL80211_ATTR_MAC], tb[NL80211_ATTR_TIMED_OUT],
2258                            tb[NL80211_ATTR_WIPHY_FREQ], tb[NL80211_ATTR_ACK],
2259                            tb[NL80211_ATTR_COOKIE],
2260                            tb[NL80211_ATTR_RX_SIGNAL_DBM],
2261                            tb[NL80211_ATTR_STA_WME]);
2262                 break;
2263         case NL80211_CMD_UNEXPECTED_FRAME:
2264                 nl80211_spurious_frame(bss, tb, 0);
2265                 break;
2266         case NL80211_CMD_UNEXPECTED_4ADDR_FRAME:
2267                 nl80211_spurious_frame(bss, tb, 1);
2268                 break;
2269         default:
2270                 wpa_printf(MSG_DEBUG, "nl80211: Ignored unknown event "
2271                            "(cmd=%d)", gnlh->cmd);
2272                 break;
2273         }
2274
2275         return NL_SKIP;
2276 }