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         default:
 133                 return "NL80211_CMD_UNKNOWN";
 134         }
 135 #undef C2S
 136 }
 137
 138
 139 static void mlme_event_auth(struct wpa_driver_nl80211_data *drv,
 140                             const u8 *frame, size_t len)
 141 {
 142         const struct ieee80211_mgmt *mgmt;
 143         union wpa_event_data event;
 144
 145         if (!(drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
 146             drv->force_connect_cmd) {
 147                 /*
 148                  * Avoid reporting two association events that would confuse
 149                  * the core code.
 150                  */
 151                 wpa_printf(MSG_DEBUG,
 152                            "nl80211: Ignore auth event when using driver SME");
 153                 return;
 154         }
 155
 156         wpa_printf(MSG_DEBUG, "nl80211: Authenticate event");
 157         mgmt = (const struct ieee80211_mgmt *) frame;
 158         if (len < 24 + sizeof(mgmt->u.auth)) {
 159                 wpa_printf(MSG_DEBUG, "nl80211: Too short association event "
 160                            "frame");
 161                 return;
 162         }
 163
 164         os_memcpy(drv->auth_bssid, mgmt->sa, ETH_ALEN);
 165         os_memset(drv->auth_attempt_bssid, 0, ETH_ALEN);
 166         os_memset(&event, 0, sizeof(event));
 167         os_memcpy(event.auth.peer, mgmt->sa, ETH_ALEN);
 168         event.auth.auth_type = le_to_host16(mgmt->u.auth.auth_alg);
 169         event.auth.auth_transaction =
 170                 le_to_host16(mgmt->u.auth.auth_transaction);
 171         event.auth.status_code = le_to_host16(mgmt->u.auth.status_code);
 172         if (len > 24 + sizeof(mgmt->u.auth)) {
 173                 event.auth.ies = mgmt->u.auth.variable;
 174                 event.auth.ies_len = len - 24 - sizeof(mgmt->u.auth);
 175         }
 176
 177         wpa_supplicant_event(drv->ctx, EVENT_AUTH, &event);
 178 }
 179
 180
 181 static int nl80211_parse_wmm_params(struct nlattr *wmm_attr,
 182                                     struct wmm_params *wmm_params)
 183 {
 184         struct nlattr *wmm_info[NL80211_STA_WME_MAX + 1];
 185         static struct nla_policy wme_policy[NL80211_STA_WME_MAX + 1] = {
 186                 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
 187         };
 188
 189         if (!wmm_attr) {
 190                 wpa_printf(MSG_DEBUG, "nl80211: WMM data missing");
 191                 return -1;
 192         }
 193
 194         if (nla_parse_nested(wmm_info, NL80211_STA_WME_MAX, wmm_attr,
 195                              wme_policy)) {
 196                 wpa_printf(MSG_DEBUG,
 197                            "nl80211: Failed to parse nested attributes");
 198                 return -1;
 199         }
 200
 201         if (!wmm_info[NL80211_STA_WME_UAPSD_QUEUES])
 202                 return -1;
 203
 204         wmm_params->uapsd_queues =
 205                 nla_get_u8(wmm_info[NL80211_STA_WME_UAPSD_QUEUES]);
 206         wmm_params->info_bitmap |= WMM_PARAMS_UAPSD_QUEUES_INFO;
 207
 208         return 0;
 209 }
 210
 211
 212 static void mlme_event_assoc(struct wpa_driver_nl80211_data *drv,
 213                             const u8 *frame, size_t len, struct nlattr *wmm)
 214 {
 215         const struct ieee80211_mgmt *mgmt;
 216         union wpa_event_data event;
 217         u16 status;
 218
 219         if (!(drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
 220             drv->force_connect_cmd) {
 221                 /*
 222                  * Avoid reporting two association events that would confuse
 223                  * the core code.
 224                  */
 225                 wpa_printf(MSG_DEBUG,
 226                            "nl80211: Ignore assoc event when using driver SME");
 227                 return;
 228         }
 229
 230         wpa_printf(MSG_DEBUG, "nl80211: Associate event");
 231         mgmt = (const struct ieee80211_mgmt *) frame;
 232         if (len < 24 + sizeof(mgmt->u.assoc_resp)) {
 233                 wpa_printf(MSG_DEBUG, "nl80211: Too short association event "
 234                            "frame");
 235                 return;
 236         }
 237
 238         status = le_to_host16(mgmt->u.assoc_resp.status_code);
 239         if (status != WLAN_STATUS_SUCCESS) {
 240                 os_memset(&event, 0, sizeof(event));
 241                 event.assoc_reject.bssid = mgmt->bssid;
 242                 if (len > 24 + sizeof(mgmt->u.assoc_resp)) {
 243                         event.assoc_reject.resp_ies =
 244                                 (u8 *) mgmt->u.assoc_resp.variable;
 245                         event.assoc_reject.resp_ies_len =
 246                                 len - 24 - sizeof(mgmt->u.assoc_resp);
 247                 }
 248                 event.assoc_reject.status_code = status;
 249
 250                 wpa_supplicant_event(drv->ctx, EVENT_ASSOC_REJECT, &event);
 251                 return;
 252         }
 253
 254         drv->associated = 1;
 255         os_memcpy(drv->bssid, mgmt->sa, ETH_ALEN);
 256         os_memcpy(drv->prev_bssid, mgmt->sa, ETH_ALEN);
 257
 258         os_memset(&event, 0, sizeof(event));
 259         if (len > 24 + sizeof(mgmt->u.assoc_resp)) {
 260                 event.assoc_info.resp_ies = (u8 *) mgmt->u.assoc_resp.variable;
 261                 event.assoc_info.resp_ies_len =
 262                         len - 24 - sizeof(mgmt->u.assoc_resp);
 263         }
 264
 265         event.assoc_info.freq = drv->assoc_freq;
 266
 267         nl80211_parse_wmm_params(wmm, &event.assoc_info.wmm_params);
 268
 269         wpa_supplicant_event(drv->ctx, EVENT_ASSOC, &event);
 270 }
 271
 272
 273 static void mlme_event_connect(struct wpa_driver_nl80211_data *drv,
 274                                enum nl80211_commands cmd, struct nlattr *status,
 275                                struct nlattr *addr, struct nlattr *req_ie,
 276                                struct nlattr *resp_ie,
 277                                struct nlattr *authorized,
 278                                struct nlattr *key_replay_ctr,
 279                                struct nlattr *ptk_kck,
 280                                struct nlattr *ptk_kek)
 281 {
 282         union wpa_event_data event;
 283
 284         if (drv->capa.flags & WPA_DRIVER_FLAGS_SME) {
 285                 /*
 286                  * Avoid reporting two association events that would confuse
 287                  * the core code.
 288                  */
 289                 wpa_printf(MSG_DEBUG, "nl80211: Ignore connect event (cmd=%d) "
 290                            "when using userspace SME", cmd);
 291                 return;
 292         }
 293
 294         if (cmd == NL80211_CMD_CONNECT)
 295                 wpa_printf(MSG_DEBUG, "nl80211: Connect event");
 296         else if (cmd == NL80211_CMD_ROAM)
 297                 wpa_printf(MSG_DEBUG, "nl80211: Roam event");
 298
 299         os_memset(&event, 0, sizeof(event));
 300         if (cmd == NL80211_CMD_CONNECT &&
 301             nla_get_u16(status) != WLAN_STATUS_SUCCESS) {
 302                 if (addr)
 303                         event.assoc_reject.bssid = nla_data(addr);
 304                 if (resp_ie) {
 305                         event.assoc_reject.resp_ies = nla_data(resp_ie);
 306                         event.assoc_reject.resp_ies_len = nla_len(resp_ie);
 307                 }
 308                 event.assoc_reject.status_code = nla_get_u16(status);
 309                 wpa_supplicant_event(drv->ctx, EVENT_ASSOC_REJECT, &event);
 310                 return;
 311         }
 312
 313         drv->associated = 1;
 314         if (addr) {
 315                 os_memcpy(drv->bssid, nla_data(addr), ETH_ALEN);
 316                 os_memcpy(drv->prev_bssid, drv->bssid, ETH_ALEN);
 317         }
 318
 319         if (req_ie) {
 320                 event.assoc_info.req_ies = nla_data(req_ie);
 321                 event.assoc_info.req_ies_len = nla_len(req_ie);
 322         }
 323         if (resp_ie) {
 324                 event.assoc_info.resp_ies = nla_data(resp_ie);
 325                 event.assoc_info.resp_ies_len = nla_len(resp_ie);
 326         }
 327
 328         event.assoc_info.freq = nl80211_get_assoc_freq(drv);
 329
 330         if (authorized && nla_get_u8(authorized)) {
 331                 event.assoc_info.authorized = 1;
 332                 wpa_printf(MSG_DEBUG, "nl80211: connection authorized");
 333         }
 334         if (key_replay_ctr) {
 335                 event.assoc_info.key_replay_ctr = nla_data(key_replay_ctr);
 336                 event.assoc_info.key_replay_ctr_len = nla_len(key_replay_ctr);
 337         }
 338         if (ptk_kck) {
 339                 event.assoc_info.ptk_kck = nla_data(ptk_kck);
 340                 event.assoc_info.ptk_kck_len = nla_len(ptk_kck);
 341         }
 342         if (ptk_kek) {
 343                 event.assoc_info.ptk_kek = nla_data(ptk_kek);
 344                 event.assoc_info.ptk_kek_len = nla_len(ptk_kek);
 345         }
 346
 347         wpa_supplicant_event(drv->ctx, EVENT_ASSOC, &event);
 348 }
 349
 350
 351 static void mlme_event_disconnect(struct wpa_driver_nl80211_data *drv,
 352                                   struct nlattr *reason, struct nlattr *addr,
 353                                   struct nlattr *by_ap)
 354 {
 355         union wpa_event_data data;
 356         unsigned int locally_generated = by_ap == NULL;
 357
 358         if (drv->capa.flags & WPA_DRIVER_FLAGS_SME) {
 359                 /*
 360                  * Avoid reporting two disassociation events that could
 361                  * confuse the core code.
 362                  */
 363                 wpa_printf(MSG_DEBUG, "nl80211: Ignore disconnect "
 364                            "event when using userspace SME");
 365                 return;
 366         }
 367
 368         if (drv->ignore_next_local_disconnect) {
 369                 drv->ignore_next_local_disconnect = 0;
 370                 if (locally_generated) {
 371                         wpa_printf(MSG_DEBUG, "nl80211: Ignore disconnect "
 372                                    "event triggered during reassociation");
 373                         return;
 374                 }
 375                 wpa_printf(MSG_WARNING, "nl80211: Was expecting local "
 376                            "disconnect but got another disconnect "
 377                            "event first");
 378         }
 379
 380         wpa_printf(MSG_DEBUG, "nl80211: Disconnect event");
 381         nl80211_mark_disconnected(drv);
 382         os_memset(&data, 0, sizeof(data));
 383         if (reason)
 384                 data.deauth_info.reason_code = nla_get_u16(reason);
 385         data.deauth_info.locally_generated = by_ap == NULL;
 386         wpa_supplicant_event(drv->ctx, EVENT_DEAUTH, &data);
 387 }
 388
 389
 390 static int calculate_chan_offset(int width, int freq, int cf1, int cf2)
 391 {
 392         int freq1 = 0;
 393
 394         switch (convert2width(width)) {
 395         case CHAN_WIDTH_20_NOHT:
 396         case CHAN_WIDTH_20:
 397                 return 0;
 398         case CHAN_WIDTH_40:
 399                 freq1 = cf1 - 10;
 400                 break;
 401         case CHAN_WIDTH_80:
 402                 freq1 = cf1 - 30;
 403                 break;
 404         case CHAN_WIDTH_160:
 405                 freq1 = cf1 - 70;
 406                 break;
 407         case CHAN_WIDTH_UNKNOWN:
 408         case CHAN_WIDTH_80P80:
 409                 /* FIXME: implement this */
 410                 return 0;
 411         }
 412
 413         return (abs(freq - freq1) / 20) % 2 == 0 ? 1 : -1;
 414 }
 415
 416
 417 static void mlme_event_ch_switch(struct wpa_driver_nl80211_data *drv,
 418                                  struct nlattr *ifindex, struct nlattr *freq,
 419                                  struct nlattr *type, struct nlattr *bw,
 420                                  struct nlattr *cf1, struct nlattr *cf2)
 421 {
 422         struct i802_bss *bss;
 423         union wpa_event_data data;
 424         int ht_enabled = 1;
 425         int chan_offset = 0;
 426         int ifidx;
 427
 428         wpa_printf(MSG_DEBUG, "nl80211: Channel switch event");
 429
 430         if (!freq)
 431                 return;
 432
 433         ifidx = nla_get_u32(ifindex);
 434         bss = get_bss_ifindex(drv, ifidx);
 435         if (bss == NULL) {
 436                 wpa_printf(MSG_WARNING, "nl80211: Unknown ifindex (%d) for channel switch, ignoring",
 437                            ifidx);
 438                 return;
 439         }
 440
 441         if (type) {
 442                 enum nl80211_channel_type ch_type = nla_get_u32(type);
 443
 444                 wpa_printf(MSG_DEBUG, "nl80211: Channel type: %d", ch_type);
 445                 switch (ch_type) {
 446                 case NL80211_CHAN_NO_HT:
 447                         ht_enabled = 0;
 448                         break;
 449                 case NL80211_CHAN_HT20:
 450                         break;
 451                 case NL80211_CHAN_HT40PLUS:
 452                         chan_offset = 1;
 453                         break;
 454                 case NL80211_CHAN_HT40MINUS:
 455                         chan_offset = -1;
 456                         break;
 457                 }
 458         } else if (bw && cf1) {
 459                 /* This can happen for example with VHT80 ch switch */
 460                 chan_offset = calculate_chan_offset(nla_get_u32(bw),
 461                                                     nla_get_u32(freq),
 462                                                     nla_get_u32(cf1),
 463                                                     cf2 ? nla_get_u32(cf2) : 0);
 464         } else {
 465                 wpa_printf(MSG_WARNING, "nl80211: Unknown secondary channel information - following channel definition calculations may fail");
 466         }
 467
 468         os_memset(&data, 0, sizeof(data));
 469         data.ch_switch.freq = nla_get_u32(freq);
 470         data.ch_switch.ht_enabled = ht_enabled;
 471         data.ch_switch.ch_offset = chan_offset;
 472         if (bw)
 473                 data.ch_switch.ch_width = convert2width(nla_get_u32(bw));
 474         if (cf1)
 475                 data.ch_switch.cf1 = nla_get_u32(cf1);
 476         if (cf2)
 477                 data.ch_switch.cf2 = nla_get_u32(cf2);
 478
 479         bss->freq = data.ch_switch.freq;
 480
 481         wpa_supplicant_event(bss->ctx, EVENT_CH_SWITCH, &data);
 482 }
 483
 484
 485 static void mlme_timeout_event(struct wpa_driver_nl80211_data *drv,
 486                                enum nl80211_commands cmd, struct nlattr *addr)
 487 {
 488         union wpa_event_data event;
 489         enum wpa_event_type ev;
 490
 491         if (nla_len(addr) != ETH_ALEN)
 492                 return;
 493
 494         wpa_printf(MSG_DEBUG, "nl80211: MLME event %d; timeout with " MACSTR,
 495                    cmd, MAC2STR((u8 *) nla_data(addr)));
 496
 497         if (cmd == NL80211_CMD_AUTHENTICATE)
 498                 ev = EVENT_AUTH_TIMED_OUT;
 499         else if (cmd == NL80211_CMD_ASSOCIATE)
 500                 ev = EVENT_ASSOC_TIMED_OUT;
 501         else
 502                 return;
 503
 504         os_memset(&event, 0, sizeof(event));
 505         os_memcpy(event.timeout_event.addr, nla_data(addr), ETH_ALEN);
 506         wpa_supplicant_event(drv->ctx, ev, &event);
 507 }
 508
 509
 510 static void mlme_event_mgmt(struct i802_bss *bss,
 511                             struct nlattr *freq, struct nlattr *sig,
 512                             const u8 *frame, size_t len)
 513 {
 514         struct wpa_driver_nl80211_data *drv = bss->drv;
 515         const struct ieee80211_mgmt *mgmt;
 516         union wpa_event_data event;
 517         u16 fc, stype;
 518         int ssi_signal = 0;
 519         int rx_freq = 0;
 520
 521         wpa_printf(MSG_MSGDUMP, "nl80211: Frame event");
 522         mgmt = (const struct ieee80211_mgmt *) frame;
 523         if (len < 24) {
 524                 wpa_printf(MSG_DEBUG, "nl80211: Too short management frame");
 525                 return;
 526         }
 527
 528         fc = le_to_host16(mgmt->frame_control);
 529         stype = WLAN_FC_GET_STYPE(fc);
 530
 531         if (sig)
 532                 ssi_signal = (s32) nla_get_u32(sig);
 533
 534         os_memset(&event, 0, sizeof(event));
 535         if (freq) {
 536                 event.rx_mgmt.freq = nla_get_u32(freq);
 537                 rx_freq = drv->last_mgmt_freq = event.rx_mgmt.freq;
 538         }
 539         wpa_printf(MSG_DEBUG,
 540                    "nl80211: RX frame sa=" MACSTR
 541                    " freq=%d ssi_signal=%d stype=%u (%s) len=%u",
 542                    MAC2STR(mgmt->sa), rx_freq, ssi_signal, stype, fc2str(fc),
 543                    (unsigned int) len);
 544         event.rx_mgmt.frame = frame;
 545         event.rx_mgmt.frame_len = len;
 546         event.rx_mgmt.ssi_signal = ssi_signal;
 547         event.rx_mgmt.drv_priv = bss;
 548         wpa_supplicant_event(drv->ctx, EVENT_RX_MGMT, &event);
 549 }
 550
 551
 552 static void mlme_event_mgmt_tx_status(struct wpa_driver_nl80211_data *drv,
 553                                       struct nlattr *cookie, const u8 *frame,
 554                                       size_t len, struct nlattr *ack)
 555 {
 556         union wpa_event_data event;
 557         const struct ieee80211_hdr *hdr;
 558         u16 fc;
 559
 560         wpa_printf(MSG_DEBUG, "nl80211: Frame TX status event");
 561         if (!is_ap_interface(drv->nlmode)) {
 562                 u64 cookie_val;
 563
 564                 if (!cookie)
 565                         return;
 566
 567                 cookie_val = nla_get_u64(cookie);
 568                 wpa_printf(MSG_DEBUG, "nl80211: Action TX status:"
 569                            " cookie=0%llx%s (ack=%d)",
 570                            (long long unsigned int) cookie_val,
 571                            cookie_val == drv->send_action_cookie ?
 572                            " (match)" : " (unknown)", ack != NULL);
 573                 if (cookie_val != drv->send_action_cookie)
 574                         return;
 575         }
 576
 577         hdr = (const struct ieee80211_hdr *) frame;
 578         fc = le_to_host16(hdr->frame_control);
 579
 580         os_memset(&event, 0, sizeof(event));
 581         event.tx_status.type = WLAN_FC_GET_TYPE(fc);
 582         event.tx_status.stype = WLAN_FC_GET_STYPE(fc);
 583         event.tx_status.dst = hdr->addr1;
 584         event.tx_status.data = frame;
 585         event.tx_status.data_len = len;
 586         event.tx_status.ack = ack != NULL;
 587         wpa_supplicant_event(drv->ctx, EVENT_TX_STATUS, &event);
 588 }
 589
 590
 591 static void mlme_event_deauth_disassoc(struct wpa_driver_nl80211_data *drv,
 592                                        enum wpa_event_type type,
 593                                        const u8 *frame, size_t len)
 594 {
 595         const struct ieee80211_mgmt *mgmt;
 596         union wpa_event_data event;
 597         const u8 *bssid = NULL;
 598         u16 reason_code = 0;
 599
 600         if (type == EVENT_DEAUTH)
 601                 wpa_printf(MSG_DEBUG, "nl80211: Deauthenticate event");
 602         else
 603                 wpa_printf(MSG_DEBUG, "nl80211: Disassociate event");
 604
 605         mgmt = (const struct ieee80211_mgmt *) frame;
 606         if (len >= 24) {
 607                 bssid = mgmt->bssid;
 608
 609                 if ((drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
 610                     !drv->associated &&
 611                     os_memcmp(bssid, drv->auth_bssid, ETH_ALEN) != 0 &&
 612                     os_memcmp(bssid, drv->auth_attempt_bssid, ETH_ALEN) != 0 &&
 613                     os_memcmp(bssid, drv->prev_bssid, ETH_ALEN) == 0) {
 614                         /*
 615                          * Avoid issues with some roaming cases where
 616                          * disconnection event for the old AP may show up after
 617                          * we have started connection with the new AP.
 618                          */
 619                         wpa_printf(MSG_DEBUG, "nl80211: Ignore deauth/disassoc event from old AP " MACSTR " when already authenticating with " MACSTR,
 620                                    MAC2STR(bssid),
 621                                    MAC2STR(drv->auth_attempt_bssid));
 622                         return;
 623                 }
 624
 625                 if (drv->associated != 0 &&
 626                     os_memcmp(bssid, drv->bssid, ETH_ALEN) != 0 &&
 627                     os_memcmp(bssid, drv->auth_bssid, ETH_ALEN) != 0) {
 628                         /*
 629                          * We have presumably received this deauth as a
 630                          * response to a clear_state_mismatch() outgoing
 631                          * deauth.  Don't let it take us offline!
 632                          */
 633                         wpa_printf(MSG_DEBUG, "nl80211: Deauth received "
 634                                    "from Unknown BSSID " MACSTR " -- ignoring",
 635                                    MAC2STR(bssid));
 636                         return;
 637                 }
 638         }
 639
 640         nl80211_mark_disconnected(drv);
 641         os_memset(&event, 0, sizeof(event));
 642
 643         /* Note: Same offset for Reason Code in both frame subtypes */
 644         if (len >= 24 + sizeof(mgmt->u.deauth))
 645                 reason_code = le_to_host16(mgmt->u.deauth.reason_code);
 646
 647         if (type == EVENT_DISASSOC) {
 648                 event.disassoc_info.locally_generated =
 649                         !os_memcmp(mgmt->sa, drv->first_bss->addr, ETH_ALEN);
 650                 event.disassoc_info.addr = bssid;
 651                 event.disassoc_info.reason_code = reason_code;
 652                 if (frame + len > mgmt->u.disassoc.variable) {
 653                         event.disassoc_info.ie = mgmt->u.disassoc.variable;
 654                         event.disassoc_info.ie_len = frame + len -
 655                                 mgmt->u.disassoc.variable;
 656                 }
 657         } else {
 658                 if (drv->ignore_deauth_event) {
 659                         wpa_printf(MSG_DEBUG, "nl80211: Ignore deauth event due to previous forced deauth-during-auth");
 660                         drv->ignore_deauth_event = 0;
 661                         return;
 662                 }
 663                 event.deauth_info.locally_generated =
 664                         !os_memcmp(mgmt->sa, drv->first_bss->addr, ETH_ALEN);
 665                 if (drv->ignore_next_local_deauth) {
 666                         drv->ignore_next_local_deauth = 0;
 667                         if (event.deauth_info.locally_generated) {
 668                                 wpa_printf(MSG_DEBUG, "nl80211: Ignore deauth event triggered due to own deauth request");
 669                                 return;
 670                         }
 671                         wpa_printf(MSG_WARNING, "nl80211: Was expecting local deauth but got another disconnect event first");
 672                 }
 673                 event.deauth_info.addr = bssid;
 674                 event.deauth_info.reason_code = reason_code;
 675                 if (frame + len > mgmt->u.deauth.variable) {
 676                         event.deauth_info.ie = mgmt->u.deauth.variable;
 677                         event.deauth_info.ie_len = frame + len -
 678                                 mgmt->u.deauth.variable;
 679                 }
 680         }
 681
 682         wpa_supplicant_event(drv->ctx, type, &event);
 683 }
 684
 685
 686 static void mlme_event_unprot_disconnect(struct wpa_driver_nl80211_data *drv,
 687                                          enum wpa_event_type type,
 688                                          const u8 *frame, size_t len)
 689 {
 690         const struct ieee80211_mgmt *mgmt;
 691         union wpa_event_data event;
 692         u16 reason_code = 0;
 693
 694         if (type == EVENT_UNPROT_DEAUTH)
 695                 wpa_printf(MSG_DEBUG, "nl80211: Unprot Deauthenticate event");
 696         else
 697                 wpa_printf(MSG_DEBUG, "nl80211: Unprot Disassociate event");
 698
 699         if (len < 24)
 700                 return;
 701
 702         mgmt = (const struct ieee80211_mgmt *) frame;
 703
 704         os_memset(&event, 0, sizeof(event));
 705         /* Note: Same offset for Reason Code in both frame subtypes */
 706         if (len >= 24 + sizeof(mgmt->u.deauth))
 707                 reason_code = le_to_host16(mgmt->u.deauth.reason_code);
 708
 709         if (type == EVENT_UNPROT_DISASSOC) {
 710                 event.unprot_disassoc.sa = mgmt->sa;
 711                 event.unprot_disassoc.da = mgmt->da;
 712                 event.unprot_disassoc.reason_code = reason_code;
 713         } else {
 714                 event.unprot_deauth.sa = mgmt->sa;
 715                 event.unprot_deauth.da = mgmt->da;
 716                 event.unprot_deauth.reason_code = reason_code;
 717         }
 718
 719         wpa_supplicant_event(drv->ctx, type, &event);
 720 }
 721
 722
 723 static void mlme_event(struct i802_bss *bss,
 724                        enum nl80211_commands cmd, struct nlattr *frame,
 725                        struct nlattr *addr, struct nlattr *timed_out,
 726                        struct nlattr *freq, struct nlattr *ack,
 727                        struct nlattr *cookie, struct nlattr *sig,
 728                        struct nlattr *wmm)
 729 {
 730         struct wpa_driver_nl80211_data *drv = bss->drv;
 731         const u8 *data;
 732         size_t len;
 733
 734         if (timed_out && addr) {
 735                 mlme_timeout_event(drv, cmd, addr);
 736                 return;
 737         }
 738
 739         if (frame == NULL) {
 740                 wpa_printf(MSG_DEBUG,
 741                            "nl80211: MLME event %d (%s) without frame data",
 742                            cmd, nl80211_command_to_string(cmd));
 743                 return;
 744         }
 745
 746         data = nla_data(frame);
 747         len = nla_len(frame);
 748         if (len < 4 + 2 * ETH_ALEN) {
 749                 wpa_printf(MSG_MSGDUMP, "nl80211: MLME event %d (%s) on %s("
 750                            MACSTR ") - too short",
 751                            cmd, nl80211_command_to_string(cmd), bss->ifname,
 752                            MAC2STR(bss->addr));
 753                 return;
 754         }
 755         wpa_printf(MSG_MSGDUMP, "nl80211: MLME event %d (%s) on %s(" MACSTR
 756                    ") A1=" MACSTR " A2=" MACSTR, cmd,
 757                    nl80211_command_to_string(cmd), bss->ifname,
 758                    MAC2STR(bss->addr), MAC2STR(data + 4),
 759                    MAC2STR(data + 4 + ETH_ALEN));
 760         if (cmd != NL80211_CMD_FRAME_TX_STATUS && !(data[4] & 0x01) &&
 761             os_memcmp(bss->addr, data + 4, ETH_ALEN) != 0 &&
 762             os_memcmp(bss->addr, data + 4 + ETH_ALEN, ETH_ALEN) != 0) {
 763                 wpa_printf(MSG_MSGDUMP, "nl80211: %s: Ignore MLME frame event "
 764                            "for foreign address", bss->ifname);
 765                 return;
 766         }
 767         wpa_hexdump(MSG_MSGDUMP, "nl80211: MLME event frame",
 768                     nla_data(frame), nla_len(frame));
 769
 770         switch (cmd) {
 771         case NL80211_CMD_AUTHENTICATE:
 772                 mlme_event_auth(drv, nla_data(frame), nla_len(frame));
 773                 break;
 774         case NL80211_CMD_ASSOCIATE:
 775                 mlme_event_assoc(drv, nla_data(frame), nla_len(frame), wmm);
 776                 break;
 777         case NL80211_CMD_DEAUTHENTICATE:
 778                 mlme_event_deauth_disassoc(drv, EVENT_DEAUTH,
 779                                            nla_data(frame), nla_len(frame));
 780                 break;
 781         case NL80211_CMD_DISASSOCIATE:
 782                 mlme_event_deauth_disassoc(drv, EVENT_DISASSOC,
 783                                            nla_data(frame), nla_len(frame));
 784                 break;
 785         case NL80211_CMD_FRAME:
 786                 mlme_event_mgmt(bss, freq, sig, nla_data(frame),
 787                                 nla_len(frame));
 788                 break;
 789         case NL80211_CMD_FRAME_TX_STATUS:
 790                 mlme_event_mgmt_tx_status(drv, cookie, nla_data(frame),
 791                                           nla_len(frame), ack);
 792                 break;
 793         case NL80211_CMD_UNPROT_DEAUTHENTICATE:
 794                 mlme_event_unprot_disconnect(drv, EVENT_UNPROT_DEAUTH,
 795                                              nla_data(frame), nla_len(frame));
 796                 break;
 797         case NL80211_CMD_UNPROT_DISASSOCIATE:
 798                 mlme_event_unprot_disconnect(drv, EVENT_UNPROT_DISASSOC,
 799                                              nla_data(frame), nla_len(frame));
 800                 break;
 801         default:
 802                 break;
 803         }
 804 }
 805
 806
 807 static void mlme_event_michael_mic_failure(struct i802_bss *bss,
 808                                            struct nlattr *tb[])
 809 {
 810         union wpa_event_data data;
 811
 812         wpa_printf(MSG_DEBUG, "nl80211: MLME event Michael MIC failure");
 813         os_memset(&data, 0, sizeof(data));
 814         if (tb[NL80211_ATTR_MAC]) {
 815                 wpa_hexdump(MSG_DEBUG, "nl80211: Source MAC address",
 816                             nla_data(tb[NL80211_ATTR_MAC]),
 817                             nla_len(tb[NL80211_ATTR_MAC]));
 818                 data.michael_mic_failure.src = nla_data(tb[NL80211_ATTR_MAC]);
 819         }
 820         if (tb[NL80211_ATTR_KEY_SEQ]) {
 821                 wpa_hexdump(MSG_DEBUG, "nl80211: TSC",
 822                             nla_data(tb[NL80211_ATTR_KEY_SEQ]),
 823                             nla_len(tb[NL80211_ATTR_KEY_SEQ]));
 824         }
 825         if (tb[NL80211_ATTR_KEY_TYPE]) {
 826                 enum nl80211_key_type key_type =
 827                         nla_get_u32(tb[NL80211_ATTR_KEY_TYPE]);
 828                 wpa_printf(MSG_DEBUG, "nl80211: Key Type %d", key_type);
 829                 if (key_type == NL80211_KEYTYPE_PAIRWISE)
 830                         data.michael_mic_failure.unicast = 1;
 831         } else
 832                 data.michael_mic_failure.unicast = 1;
 833
 834         if (tb[NL80211_ATTR_KEY_IDX]) {
 835                 u8 key_id = nla_get_u8(tb[NL80211_ATTR_KEY_IDX]);
 836                 wpa_printf(MSG_DEBUG, "nl80211: Key Id %d", key_id);
 837         }
 838
 839         wpa_supplicant_event(bss->ctx, EVENT_MICHAEL_MIC_FAILURE, &data);
 840 }
 841
 842
 843 static void mlme_event_join_ibss(struct wpa_driver_nl80211_data *drv,
 844                                  struct nlattr *tb[])
 845 {
 846         unsigned int freq;
 847
 848         if (tb[NL80211_ATTR_MAC] == NULL) {
 849                 wpa_printf(MSG_DEBUG, "nl80211: No address in IBSS joined "
 850                            "event");
 851                 return;
 852         }
 853         os_memcpy(drv->bssid, nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
 854
 855         drv->associated = 1;
 856         wpa_printf(MSG_DEBUG, "nl80211: IBSS " MACSTR " joined",
 857                    MAC2STR(drv->bssid));
 858
 859         freq = nl80211_get_assoc_freq(drv);
 860         if (freq) {
 861                 wpa_printf(MSG_DEBUG, "nl80211: IBSS on frequency %u MHz",
 862                            freq);
 863                 drv->first_bss->freq = freq;
 864         }
 865
 866         wpa_supplicant_event(drv->ctx, EVENT_ASSOC, NULL);
 867 }
 868
 869
 870 static void mlme_event_remain_on_channel(struct wpa_driver_nl80211_data *drv,
 871                                          int cancel_event, struct nlattr *tb[])
 872 {
 873         unsigned int freq, chan_type, duration;
 874         union wpa_event_data data;
 875         u64 cookie;
 876
 877         if (tb[NL80211_ATTR_WIPHY_FREQ])
 878                 freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
 879         else
 880                 freq = 0;
 881
 882         if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])
 883                 chan_type = nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
 884         else
 885                 chan_type = 0;
 886
 887         if (tb[NL80211_ATTR_DURATION])
 888                 duration = nla_get_u32(tb[NL80211_ATTR_DURATION]);
 889         else
 890                 duration = 0;
 891
 892         if (tb[NL80211_ATTR_COOKIE])
 893                 cookie = nla_get_u64(tb[NL80211_ATTR_COOKIE]);
 894         else
 895                 cookie = 0;
 896
 897         wpa_printf(MSG_DEBUG, "nl80211: Remain-on-channel event (cancel=%d "
 898                    "freq=%u channel_type=%u duration=%u cookie=0x%llx (%s))",
 899                    cancel_event, freq, chan_type, duration,
 900                    (long long unsigned int) cookie,
 901                    cookie == drv->remain_on_chan_cookie ? "match" : "unknown");
 902
 903         if (cookie != drv->remain_on_chan_cookie)
 904                 return; /* not for us */
 905
 906         if (cancel_event)
 907                 drv->pending_remain_on_chan = 0;
 908
 909         os_memset(&data, 0, sizeof(data));
 910         data.remain_on_channel.freq = freq;
 911         data.remain_on_channel.duration = duration;
 912         wpa_supplicant_event(drv->ctx, cancel_event ?
 913                              EVENT_CANCEL_REMAIN_ON_CHANNEL :
 914                              EVENT_REMAIN_ON_CHANNEL, &data);
 915 }
 916
 917
 918 static void mlme_event_ft_event(struct wpa_driver_nl80211_data *drv,
 919                                 struct nlattr *tb[])
 920 {
 921         union wpa_event_data data;
 922
 923         os_memset(&data, 0, sizeof(data));
 924
 925         if (tb[NL80211_ATTR_IE]) {
 926                 data.ft_ies.ies = nla_data(tb[NL80211_ATTR_IE]);
 927                 data.ft_ies.ies_len = nla_len(tb[NL80211_ATTR_IE]);
 928         }
 929
 930         if (tb[NL80211_ATTR_IE_RIC]) {
 931                 data.ft_ies.ric_ies = nla_data(tb[NL80211_ATTR_IE_RIC]);
 932                 data.ft_ies.ric_ies_len = nla_len(tb[NL80211_ATTR_IE_RIC]);
 933         }
 934
 935         if (tb[NL80211_ATTR_MAC])
 936                 os_memcpy(data.ft_ies.target_ap,
 937                           nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
 938
 939         wpa_printf(MSG_DEBUG, "nl80211: FT event target_ap " MACSTR,
 940                    MAC2STR(data.ft_ies.target_ap));
 941
 942         wpa_supplicant_event(drv->ctx, EVENT_FT_RESPONSE, &data);
 943 }
 944
 945
 946 static void send_scan_event(struct wpa_driver_nl80211_data *drv, int aborted,
 947                             struct nlattr *tb[])
 948 {
 949         union wpa_event_data event;
 950         struct nlattr *nl;
 951         int rem;
 952         struct scan_info *info;
 953 #define MAX_REPORT_FREQS 50
 954         int freqs[MAX_REPORT_FREQS];
 955         int num_freqs = 0;
 956
 957         if (drv->scan_for_auth) {
 958                 drv->scan_for_auth = 0;
 959                 wpa_printf(MSG_DEBUG, "nl80211: Scan results for missing "
 960                            "cfg80211 BSS entry");
 961                 wpa_driver_nl80211_authenticate_retry(drv);
 962                 return;
 963         }
 964
 965         os_memset(&event, 0, sizeof(event));
 966         info = &event.scan_info;
 967         info->aborted = aborted;
 968
 969         if (tb[NL80211_ATTR_SCAN_SSIDS]) {
 970                 nla_for_each_nested(nl, tb[NL80211_ATTR_SCAN_SSIDS], rem) {
 971                         struct wpa_driver_scan_ssid *s =
 972                                 &info->ssids[info->num_ssids];
 973                         s->ssid = nla_data(nl);
 974                         s->ssid_len = nla_len(nl);
 975                         wpa_printf(MSG_DEBUG, "nl80211: Scan probed for SSID '%s'",
 976                                    wpa_ssid_txt(s->ssid, s->ssid_len));
 977                         info->num_ssids++;
 978                         if (info->num_ssids == WPAS_MAX_SCAN_SSIDS)
 979                                 break;
 980                 }
 981         }
 982         if (tb[NL80211_ATTR_SCAN_FREQUENCIES]) {
 983                 char msg[200], *pos, *end;
 984                 int res;
 985
 986                 pos = msg;
 987                 end = pos + sizeof(msg);
 988                 *pos = '\0';
 989
 990                 nla_for_each_nested(nl, tb[NL80211_ATTR_SCAN_FREQUENCIES], rem)
 991                 {
 992                         freqs[num_freqs] = nla_get_u32(nl);
 993                         res = os_snprintf(pos, end - pos, " %d",
 994                                           freqs[num_freqs]);
 995                         if (res > 0 && end - pos > res)
 996                                 pos += res;
 997                         num_freqs++;
 998                         if (num_freqs == MAX_REPORT_FREQS - 1)
 999                                 break;
1000                 }
1001                 info->freqs = freqs;
1002                 info->num_freqs = num_freqs;
1003                 wpa_printf(MSG_DEBUG, "nl80211: Scan included frequencies:%s",
1004                            msg);
1005         }
1006         wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS, &event);
1007 }
1008
1009
1010 static void nl80211_cqm_event(struct wpa_driver_nl80211_data *drv,
1011                               struct nlattr *tb[])
1012 {
1013         static struct nla_policy cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
1014                 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
1015                 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U8 },
1016                 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
1017                 [NL80211_ATTR_CQM_PKT_LOSS_EVENT] = { .type = NLA_U32 },
1018         };
1019         struct nlattr *cqm[NL80211_ATTR_CQM_MAX + 1];
1020         enum nl80211_cqm_rssi_threshold_event event;
1021         union wpa_event_data ed;
1022         struct wpa_signal_info sig;
1023         int res;
1024
1025         if (tb[NL80211_ATTR_CQM] == NULL ||
1026             nla_parse_nested(cqm, NL80211_ATTR_CQM_MAX, tb[NL80211_ATTR_CQM],
1027                              cqm_policy)) {
1028                 wpa_printf(MSG_DEBUG, "nl80211: Ignore invalid CQM event");
1029                 return;
1030         }
1031
1032         os_memset(&ed, 0, sizeof(ed));
1033
1034         if (cqm[NL80211_ATTR_CQM_PKT_LOSS_EVENT]) {
1035                 if (!tb[NL80211_ATTR_MAC])
1036                         return;
1037                 os_memcpy(ed.low_ack.addr, nla_data(tb[NL80211_ATTR_MAC]),
1038                           ETH_ALEN);
1039                 wpa_supplicant_event(drv->ctx, EVENT_STATION_LOW_ACK, &ed);
1040                 return;
1041         }
1042
1043         if (cqm[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] == NULL)
1044                 return;
1045         event = nla_get_u32(cqm[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT]);
1046
1047         if (event == NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH) {
1048                 wpa_printf(MSG_DEBUG, "nl80211: Connection quality monitor "
1049                            "event: RSSI high");
1050                 ed.signal_change.above_threshold = 1;
1051         } else if (event == NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW) {
1052                 wpa_printf(MSG_DEBUG, "nl80211: Connection quality monitor "
1053                            "event: RSSI low");
1054                 ed.signal_change.above_threshold = 0;
1055         } else
1056                 return;
1057
1058         res = nl80211_get_link_signal(drv, &sig);
1059         if (res == 0) {
1060                 ed.signal_change.current_signal = sig.current_signal;
1061                 ed.signal_change.current_txrate = sig.current_txrate;
1062                 wpa_printf(MSG_DEBUG, "nl80211: Signal: %d dBm  txrate: %d",
1063                            sig.current_signal, sig.current_txrate);
1064         }
1065
1066         res = nl80211_get_link_noise(drv, &sig);
1067         if (res == 0) {
1068                 ed.signal_change.current_noise = sig.current_noise;
1069                 wpa_printf(MSG_DEBUG, "nl80211: Noise: %d dBm",
1070                            sig.current_noise);
1071         }
1072
1073         wpa_supplicant_event(drv->ctx, EVENT_SIGNAL_CHANGE, &ed);
1074 }
1075
1076
1077 static void nl80211_new_peer_candidate(struct wpa_driver_nl80211_data *drv,
1078                                        struct nlattr **tb)
1079 {
1080         const u8 *addr;
1081         union wpa_event_data data;
1082
1083         if (drv->nlmode != NL80211_IFTYPE_MESH_POINT)
1084                 return;
1085
1086         if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_IE])
1087                 return;
1088
1089         addr = nla_data(tb[NL80211_ATTR_MAC]);
1090         wpa_printf(MSG_DEBUG, "nl80211: New peer candidate" MACSTR,
1091                    MAC2STR(addr));
1092
1093         os_memset(&data, 0, sizeof(data));
1094         data.mesh_peer.peer = addr;
1095         data.mesh_peer.ies = nla_data(tb[NL80211_ATTR_IE]);
1096         data.mesh_peer.ie_len = nla_len(tb[NL80211_ATTR_IE]);
1097         wpa_supplicant_event(drv->ctx, EVENT_NEW_PEER_CANDIDATE, &data);
1098 }
1099
1100
1101 static void nl80211_new_station_event(struct wpa_driver_nl80211_data *drv,
1102                                       struct nlattr **tb)
1103 {
1104         u8 *addr;
1105         union wpa_event_data data;
1106
1107         if (tb[NL80211_ATTR_MAC] == NULL)
1108                 return;
1109         addr = nla_data(tb[NL80211_ATTR_MAC]);
1110         wpa_printf(MSG_DEBUG, "nl80211: New station " MACSTR, MAC2STR(addr));
1111
1112         if (is_ap_interface(drv->nlmode) && drv->device_ap_sme) {
1113                 u8 *ies = NULL;
1114                 size_t ies_len = 0;
1115                 if (tb[NL80211_ATTR_IE]) {
1116                         ies = nla_data(tb[NL80211_ATTR_IE]);
1117                         ies_len = nla_len(tb[NL80211_ATTR_IE]);
1118                 }
1119                 wpa_hexdump(MSG_DEBUG, "nl80211: Assoc Req IEs", ies, ies_len);
1120                 drv_event_assoc(drv->ctx, addr, ies, ies_len, 0);
1121                 return;
1122         }
1123
1124         if (drv->nlmode != NL80211_IFTYPE_ADHOC)
1125                 return;
1126
1127         os_memset(&data, 0, sizeof(data));
1128         os_memcpy(data.ibss_rsn_start.peer, addr, ETH_ALEN);
1129         wpa_supplicant_event(drv->ctx, EVENT_IBSS_RSN_START, &data);
1130 }
1131
1132
1133 static void nl80211_del_station_event(struct wpa_driver_nl80211_data *drv,
1134                                       struct nlattr **tb)
1135 {
1136         u8 *addr;
1137         union wpa_event_data data;
1138
1139         if (tb[NL80211_ATTR_MAC] == NULL)
1140                 return;
1141         addr = nla_data(tb[NL80211_ATTR_MAC]);
1142         wpa_printf(MSG_DEBUG, "nl80211: Delete station " MACSTR,
1143                    MAC2STR(addr));
1144
1145         if (is_ap_interface(drv->nlmode) && drv->device_ap_sme) {
1146                 drv_event_disassoc(drv->ctx, addr);
1147                 return;
1148         }
1149
1150         if (drv->nlmode != NL80211_IFTYPE_ADHOC)
1151                 return;
1152
1153         os_memset(&data, 0, sizeof(data));
1154         os_memcpy(data.ibss_peer_lost.peer, addr, ETH_ALEN);
1155         wpa_supplicant_event(drv->ctx, EVENT_IBSS_PEER_LOST, &data);
1156 }
1157
1158
1159 static void nl80211_rekey_offload_event(struct wpa_driver_nl80211_data *drv,
1160                                         struct nlattr **tb)
1161 {
1162         struct nlattr *rekey_info[NUM_NL80211_REKEY_DATA];
1163         static struct nla_policy rekey_policy[NUM_NL80211_REKEY_DATA] = {
1164                 [NL80211_REKEY_DATA_KEK] = {
1165                         .minlen = NL80211_KEK_LEN,
1166                         .maxlen = NL80211_KEK_LEN,
1167                 },
1168                 [NL80211_REKEY_DATA_KCK] = {
1169                         .minlen = NL80211_KCK_LEN,
1170                         .maxlen = NL80211_KCK_LEN,
1171                 },
1172                 [NL80211_REKEY_DATA_REPLAY_CTR] = {
1173                         .minlen = NL80211_REPLAY_CTR_LEN,
1174                         .maxlen = NL80211_REPLAY_CTR_LEN,
1175                 },
1176         };
1177         union wpa_event_data data;
1178
1179         if (!tb[NL80211_ATTR_MAC])
1180                 return;
1181         if (!tb[NL80211_ATTR_REKEY_DATA])
1182                 return;
1183         if (nla_parse_nested(rekey_info, MAX_NL80211_REKEY_DATA,
1184                              tb[NL80211_ATTR_REKEY_DATA], rekey_policy))
1185                 return;
1186         if (!rekey_info[NL80211_REKEY_DATA_REPLAY_CTR])
1187                 return;
1188
1189         os_memset(&data, 0, sizeof(data));
1190         data.driver_gtk_rekey.bssid = nla_data(tb[NL80211_ATTR_MAC]);
1191         wpa_printf(MSG_DEBUG, "nl80211: Rekey offload event for BSSID " MACSTR,
1192                    MAC2STR(data.driver_gtk_rekey.bssid));
1193         data.driver_gtk_rekey.replay_ctr =
1194                 nla_data(rekey_info[NL80211_REKEY_DATA_REPLAY_CTR]);
1195         wpa_hexdump(MSG_DEBUG, "nl80211: Rekey offload - Replay Counter",
1196                     data.driver_gtk_rekey.replay_ctr, NL80211_REPLAY_CTR_LEN);
1197         wpa_supplicant_event(drv->ctx, EVENT_DRIVER_GTK_REKEY, &data);
1198 }
1199
1200
1201 static void nl80211_pmksa_candidate_event(struct wpa_driver_nl80211_data *drv,
1202                                           struct nlattr **tb)
1203 {
1204         struct nlattr *cand[NUM_NL80211_PMKSA_CANDIDATE];
1205         static struct nla_policy cand_policy[NUM_NL80211_PMKSA_CANDIDATE] = {
1206                 [NL80211_PMKSA_CANDIDATE_INDEX] = { .type = NLA_U32 },
1207                 [NL80211_PMKSA_CANDIDATE_BSSID] = {
1208                         .minlen = ETH_ALEN,
1209                         .maxlen = ETH_ALEN,
1210                 },
1211                 [NL80211_PMKSA_CANDIDATE_PREAUTH] = { .type = NLA_FLAG },
1212         };
1213         union wpa_event_data data;
1214
1215         wpa_printf(MSG_DEBUG, "nl80211: PMKSA candidate event");
1216
1217         if (!tb[NL80211_ATTR_PMKSA_CANDIDATE])
1218                 return;
1219         if (nla_parse_nested(cand, MAX_NL80211_PMKSA_CANDIDATE,
1220                              tb[NL80211_ATTR_PMKSA_CANDIDATE], cand_policy))
1221                 return;
1222         if (!cand[NL80211_PMKSA_CANDIDATE_INDEX] ||
1223             !cand[NL80211_PMKSA_CANDIDATE_BSSID])
1224                 return;
1225
1226         os_memset(&data, 0, sizeof(data));
1227         os_memcpy(data.pmkid_candidate.bssid,
1228                   nla_data(cand[NL80211_PMKSA_CANDIDATE_BSSID]), ETH_ALEN);
1229         data.pmkid_candidate.index =
1230                 nla_get_u32(cand[NL80211_PMKSA_CANDIDATE_INDEX]);
1231         data.pmkid_candidate.preauth =
1232                 cand[NL80211_PMKSA_CANDIDATE_PREAUTH] != NULL;
1233         wpa_supplicant_event(drv->ctx, EVENT_PMKID_CANDIDATE, &data);
1234 }
1235
1236
1237 static void nl80211_client_probe_event(struct wpa_driver_nl80211_data *drv,
1238                                        struct nlattr **tb)
1239 {
1240         union wpa_event_data data;
1241
1242         wpa_printf(MSG_DEBUG, "nl80211: Probe client event");
1243
1244         if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_ACK])
1245                 return;
1246
1247         os_memset(&data, 0, sizeof(data));
1248         os_memcpy(data.client_poll.addr,
1249                   nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1250
1251         wpa_supplicant_event(drv->ctx, EVENT_DRIVER_CLIENT_POLL_OK, &data);
1252 }
1253
1254
1255 static void nl80211_tdls_oper_event(struct wpa_driver_nl80211_data *drv,
1256                                     struct nlattr **tb)
1257 {
1258         union wpa_event_data data;
1259
1260         wpa_printf(MSG_DEBUG, "nl80211: TDLS operation event");
1261
1262         if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_TDLS_OPERATION])
1263                 return;
1264
1265         os_memset(&data, 0, sizeof(data));
1266         os_memcpy(data.tdls.peer, nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1267         switch (nla_get_u8(tb[NL80211_ATTR_TDLS_OPERATION])) {
1268         case NL80211_TDLS_SETUP:
1269                 wpa_printf(MSG_DEBUG, "nl80211: TDLS setup request for peer "
1270                            MACSTR, MAC2STR(data.tdls.peer));
1271                 data.tdls.oper = TDLS_REQUEST_SETUP;
1272                 break;
1273         case NL80211_TDLS_TEARDOWN:
1274                 wpa_printf(MSG_DEBUG, "nl80211: TDLS teardown request for peer "
1275                            MACSTR, MAC2STR(data.tdls.peer));
1276                 data.tdls.oper = TDLS_REQUEST_TEARDOWN;
1277                 break;
1278         default:
1279                 wpa_printf(MSG_DEBUG, "nl80211: Unsupported TDLS operatione "
1280                            "event");
1281                 return;
1282         }
1283         if (tb[NL80211_ATTR_REASON_CODE]) {
1284                 data.tdls.reason_code =
1285                         nla_get_u16(tb[NL80211_ATTR_REASON_CODE]);
1286         }
1287
1288         wpa_supplicant_event(drv->ctx, EVENT_TDLS, &data);
1289 }
1290
1291
1292 static void nl80211_stop_ap(struct wpa_driver_nl80211_data *drv,
1293                             struct nlattr **tb)
1294 {
1295         wpa_supplicant_event(drv->ctx, EVENT_INTERFACE_UNAVAILABLE, NULL);
1296 }
1297
1298
1299 static void nl80211_connect_failed_event(struct wpa_driver_nl80211_data *drv,
1300                                          struct nlattr **tb)
1301 {
1302         union wpa_event_data data;
1303         u32 reason;
1304
1305         wpa_printf(MSG_DEBUG, "nl80211: Connect failed event");
1306
1307         if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_CONN_FAILED_REASON])
1308                 return;
1309
1310         os_memset(&data, 0, sizeof(data));
1311         os_memcpy(data.connect_failed_reason.addr,
1312                   nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1313
1314         reason = nla_get_u32(tb[NL80211_ATTR_CONN_FAILED_REASON]);
1315         switch (reason) {
1316         case NL80211_CONN_FAIL_MAX_CLIENTS:
1317                 wpa_printf(MSG_DEBUG, "nl80211: Max client reached");
1318                 data.connect_failed_reason.code = MAX_CLIENT_REACHED;
1319                 break;
1320         case NL80211_CONN_FAIL_BLOCKED_CLIENT:
1321                 wpa_printf(MSG_DEBUG, "nl80211: Blocked client " MACSTR
1322                            " tried to connect",
1323                            MAC2STR(data.connect_failed_reason.addr));
1324                 data.connect_failed_reason.code = BLOCKED_CLIENT;
1325                 break;
1326         default:
1327                 wpa_printf(MSG_DEBUG, "nl8021l: Unknown connect failed reason "
1328                            "%u", reason);
1329                 return;
1330         }
1331
1332         wpa_supplicant_event(drv->ctx, EVENT_CONNECT_FAILED_REASON, &data);
1333 }
1334
1335
1336 static void nl80211_radar_event(struct wpa_driver_nl80211_data *drv,
1337                                 struct nlattr **tb)
1338 {
1339         union wpa_event_data data;
1340         enum nl80211_radar_event event_type;
1341
1342         if (!tb[NL80211_ATTR_WIPHY_FREQ] || !tb[NL80211_ATTR_RADAR_EVENT])
1343                 return;
1344
1345         os_memset(&data, 0, sizeof(data));
1346         data.dfs_event.freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
1347         event_type = nla_get_u32(tb[NL80211_ATTR_RADAR_EVENT]);
1348
1349         /* Check HT params */
1350         if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
1351                 data.dfs_event.ht_enabled = 1;
1352                 data.dfs_event.chan_offset = 0;
1353
1354                 switch (nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])) {
1355                 case NL80211_CHAN_NO_HT:
1356                         data.dfs_event.ht_enabled = 0;
1357                         break;
1358                 case NL80211_CHAN_HT20:
1359                         break;
1360                 case NL80211_CHAN_HT40PLUS:
1361                         data.dfs_event.chan_offset = 1;
1362                         break;
1363                 case NL80211_CHAN_HT40MINUS:
1364                         data.dfs_event.chan_offset = -1;
1365                         break;
1366                 }
1367         }
1368
1369         /* Get VHT params */
1370         if (tb[NL80211_ATTR_CHANNEL_WIDTH])
1371                 data.dfs_event.chan_width =
1372                         convert2width(nla_get_u32(
1373                                               tb[NL80211_ATTR_CHANNEL_WIDTH]));
1374         if (tb[NL80211_ATTR_CENTER_FREQ1])
1375                 data.dfs_event.cf1 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ1]);
1376         if (tb[NL80211_ATTR_CENTER_FREQ2])
1377                 data.dfs_event.cf2 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ2]);
1378
1379         wpa_printf(MSG_DEBUG, "nl80211: DFS event on freq %d MHz, ht: %d, offset: %d, width: %d, cf1: %dMHz, cf2: %dMHz",
1380                    data.dfs_event.freq, data.dfs_event.ht_enabled,
1381                    data.dfs_event.chan_offset, data.dfs_event.chan_width,
1382                    data.dfs_event.cf1, data.dfs_event.cf2);
1383
1384         switch (event_type) {
1385         case NL80211_RADAR_DETECTED:
1386                 wpa_supplicant_event(drv->ctx, EVENT_DFS_RADAR_DETECTED, &data);
1387                 break;
1388         case NL80211_RADAR_CAC_FINISHED:
1389                 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_FINISHED, &data);
1390                 break;
1391         case NL80211_RADAR_CAC_ABORTED:
1392                 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_ABORTED, &data);
1393                 break;
1394         case NL80211_RADAR_NOP_FINISHED:
1395                 wpa_supplicant_event(drv->ctx, EVENT_DFS_NOP_FINISHED, &data);
1396                 break;
1397         default:
1398                 wpa_printf(MSG_DEBUG, "nl80211: Unknown radar event %d "
1399                            "received", event_type);
1400                 break;
1401         }
1402 }
1403
1404
1405 static void nl80211_spurious_frame(struct i802_bss *bss, struct nlattr **tb,
1406                                    int wds)
1407 {
1408         struct wpa_driver_nl80211_data *drv = bss->drv;
1409         union wpa_event_data event;
1410
1411         if (!tb[NL80211_ATTR_MAC])
1412                 return;
1413
1414         os_memset(&event, 0, sizeof(event));
1415         event.rx_from_unknown.bssid = bss->addr;
1416         event.rx_from_unknown.addr = nla_data(tb[NL80211_ATTR_MAC]);
1417         event.rx_from_unknown.wds = wds;
1418
1419         wpa_supplicant_event(drv->ctx, EVENT_RX_FROM_UNKNOWN, &event);
1420 }
1421
1422
1423 static void qca_nl80211_avoid_freq(struct wpa_driver_nl80211_data *drv,
1424                                    const u8 *data, size_t len)
1425 {
1426         u32 i, count;
1427         union wpa_event_data event;
1428         struct wpa_freq_range *range = NULL;
1429         const struct qca_avoid_freq_list *freq_range;
1430
1431         freq_range = (const struct qca_avoid_freq_list *) data;
1432         if (len < sizeof(freq_range->count))
1433                 return;
1434
1435         count = freq_range->count;
1436         if (len < sizeof(freq_range->count) +
1437             count * sizeof(struct qca_avoid_freq_range)) {
1438                 wpa_printf(MSG_DEBUG, "nl80211: Ignored too short avoid frequency list (len=%u)",
1439                            (unsigned int) len);
1440                 return;
1441         }
1442
1443         if (count > 0) {
1444                 range = os_calloc(count, sizeof(struct wpa_freq_range));
1445                 if (range == NULL)
1446                         return;
1447         }
1448
1449         os_memset(&event, 0, sizeof(event));
1450         for (i = 0; i < count; i++) {
1451                 unsigned int idx = event.freq_range.num;
1452                 range[idx].min = freq_range->range[i].start_freq;
1453                 range[idx].max = freq_range->range[i].end_freq;
1454                 wpa_printf(MSG_DEBUG, "nl80211: Avoid frequency range: %u-%u",
1455                            range[idx].min, range[idx].max);
1456                 if (range[idx].min > range[idx].max) {
1457                         wpa_printf(MSG_DEBUG, "nl80211: Ignore invalid frequency range");
1458                         continue;
1459                 }
1460                 event.freq_range.num++;
1461         }
1462         event.freq_range.range = range;
1463
1464         wpa_supplicant_event(drv->ctx, EVENT_AVOID_FREQUENCIES, &event);
1465
1466         os_free(range);
1467 }
1468
1469
1470 static void qca_nl80211_key_mgmt_auth(struct wpa_driver_nl80211_data *drv,
1471                                       const u8 *data, size_t len)
1472 {
1473         struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_MAX + 1];
1474         u8 *bssid;
1475
1476         wpa_printf(MSG_DEBUG,
1477                    "nl80211: Key management roam+auth vendor event received");
1478
1479         if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_MAX,
1480                       (struct nlattr *) data, len, NULL))
1481                 return;
1482         if (!tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID] ||
1483             nla_len(tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID]) != ETH_ALEN ||
1484             !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_REQ_IE] ||
1485             !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_RESP_IE] ||
1486             !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_AUTHORIZED])
1487                 return;
1488
1489         bssid = nla_data(tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID]);
1490         wpa_printf(MSG_DEBUG, "  * roam BSSID " MACSTR, MAC2STR(bssid));
1491
1492         mlme_event_connect(drv, NL80211_CMD_ROAM, NULL,
1493                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID],
1494                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_REQ_IE],
1495                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_RESP_IE],
1496                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_AUTHORIZED],
1497                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_KEY_REPLAY_CTR],
1498                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KCK],
1499                            tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KEK]);
1500 }
1501
1502
1503 static void nl80211_vendor_event_qca(struct wpa_driver_nl80211_data *drv,
1504                                      u32 subcmd, u8 *data, size_t len)
1505 {
1506         switch (subcmd) {
1507         case QCA_NL80211_VENDOR_SUBCMD_AVOID_FREQUENCY:
1508                 qca_nl80211_avoid_freq(drv, data, len);
1509                 break;
1510         case QCA_NL80211_VENDOR_SUBCMD_KEY_MGMT_ROAM_AUTH:
1511                 qca_nl80211_key_mgmt_auth(drv, data, len);
1512                 break;
1513         default:
1514                 wpa_printf(MSG_DEBUG,
1515                            "nl80211: Ignore unsupported QCA vendor event %u",
1516                            subcmd);
1517                 break;
1518         }
1519 }
1520
1521
1522 static void nl80211_vendor_event(struct wpa_driver_nl80211_data *drv,
1523                                  struct nlattr **tb)
1524 {
1525         u32 vendor_id, subcmd, wiphy = 0;
1526         int wiphy_idx;
1527         u8 *data = NULL;
1528         size_t len = 0;
1529
1530         if (!tb[NL80211_ATTR_VENDOR_ID] ||
1531             !tb[NL80211_ATTR_VENDOR_SUBCMD])
1532                 return;
1533
1534         vendor_id = nla_get_u32(tb[NL80211_ATTR_VENDOR_ID]);
1535         subcmd = nla_get_u32(tb[NL80211_ATTR_VENDOR_SUBCMD]);
1536
1537         if (tb[NL80211_ATTR_WIPHY])
1538                 wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
1539
1540         wpa_printf(MSG_DEBUG, "nl80211: Vendor event: wiphy=%u vendor_id=0x%x subcmd=%u",
1541                    wiphy, vendor_id, subcmd);
1542
1543         if (tb[NL80211_ATTR_VENDOR_DATA]) {
1544                 data = nla_data(tb[NL80211_ATTR_VENDOR_DATA]);
1545                 len = nla_len(tb[NL80211_ATTR_VENDOR_DATA]);
1546                 wpa_hexdump(MSG_MSGDUMP, "nl80211: Vendor data", data, len);
1547         }
1548
1549         wiphy_idx = nl80211_get_wiphy_index(drv->first_bss);
1550         if (wiphy_idx >= 0 && wiphy_idx != (int) wiphy) {
1551                 wpa_printf(MSG_DEBUG, "nl80211: Ignore vendor event for foreign wiphy %u (own: %d)",
1552                            wiphy, wiphy_idx);
1553                 return;
1554         }
1555
1556         switch (vendor_id) {
1557         case OUI_QCA:
1558                 nl80211_vendor_event_qca(drv, subcmd, data, len);
1559                 break;
1560         default:
1561                 wpa_printf(MSG_DEBUG, "nl80211: Ignore unsupported vendor event");
1562                 break;
1563         }
1564 }
1565
1566
1567 static void nl80211_reg_change_event(struct wpa_driver_nl80211_data *drv,
1568                                      struct nlattr *tb[])
1569 {
1570         union wpa_event_data data;
1571         enum nl80211_reg_initiator init;
1572
1573         wpa_printf(MSG_DEBUG, "nl80211: Regulatory domain change");
1574
1575         if (tb[NL80211_ATTR_REG_INITIATOR] == NULL)
1576                 return;
1577
1578         os_memset(&data, 0, sizeof(data));
1579         init = nla_get_u8(tb[NL80211_ATTR_REG_INITIATOR]);
1580         wpa_printf(MSG_DEBUG, " * initiator=%d", init);
1581         switch (init) {
1582         case NL80211_REGDOM_SET_BY_CORE:
1583                 data.channel_list_changed.initiator = REGDOM_SET_BY_CORE;
1584                 break;
1585         case NL80211_REGDOM_SET_BY_USER:
1586                 data.channel_list_changed.initiator = REGDOM_SET_BY_USER;
1587                 break;
1588         case NL80211_REGDOM_SET_BY_DRIVER:
1589                 data.channel_list_changed.initiator = REGDOM_SET_BY_DRIVER;
1590                 break;
1591         case NL80211_REGDOM_SET_BY_COUNTRY_IE:
1592                 data.channel_list_changed.initiator = REGDOM_SET_BY_COUNTRY_IE;
1593                 break;
1594         }
1595
1596         if (tb[NL80211_ATTR_REG_TYPE]) {
1597                 enum nl80211_reg_type type;
1598                 type = nla_get_u8(tb[NL80211_ATTR_REG_TYPE]);
1599                 wpa_printf(MSG_DEBUG, " * type=%d", type);
1600                 switch (type) {
1601                 case NL80211_REGDOM_TYPE_COUNTRY:
1602                         data.channel_list_changed.type = REGDOM_TYPE_COUNTRY;
1603                         break;
1604                 case NL80211_REGDOM_TYPE_WORLD:
1605                         data.channel_list_changed.type = REGDOM_TYPE_WORLD;
1606                         break;
1607                 case NL80211_REGDOM_TYPE_CUSTOM_WORLD:
1608                         data.channel_list_changed.type =
1609                                 REGDOM_TYPE_CUSTOM_WORLD;
1610                         break;
1611                 case NL80211_REGDOM_TYPE_INTERSECTION:
1612                         data.channel_list_changed.type =
1613                                 REGDOM_TYPE_INTERSECTION;
1614                         break;
1615                 }
1616         }
1617
1618         if (tb[NL80211_ATTR_REG_ALPHA2]) {
1619                 os_strlcpy(data.channel_list_changed.alpha2,
1620                            nla_get_string(tb[NL80211_ATTR_REG_ALPHA2]),
1621                            sizeof(data.channel_list_changed.alpha2));
1622                 wpa_printf(MSG_DEBUG, " * alpha2=%s",
1623                            data.channel_list_changed.alpha2);
1624         }
1625
1626         wpa_supplicant_event(drv->ctx, EVENT_CHANNEL_LIST_CHANGED, &data);
1627 }
1628
1629
1630 static void do_process_drv_event(struct i802_bss *bss, int cmd,
1631                                  struct nlattr **tb)
1632 {
1633         struct wpa_driver_nl80211_data *drv = bss->drv;
1634         union wpa_event_data data;
1635
1636         wpa_printf(MSG_DEBUG, "nl80211: Drv Event %d (%s) received for %s",
1637                    cmd, nl80211_command_to_string(cmd), bss->ifname);
1638
1639         if (cmd == NL80211_CMD_ROAM && drv->roam_auth_vendor_event_avail) {
1640                 /*
1641                  * Device will use roam+auth vendor event to indicate
1642                  * roaming, so ignore the regular roam event.
1643                  */
1644                 wpa_printf(MSG_DEBUG,
1645                            "nl80211: Ignore roam event (cmd=%d), device will use vendor event roam+auth",
1646                            cmd);
1647                 return;
1648         }
1649
1650         if (drv->ap_scan_as_station != NL80211_IFTYPE_UNSPECIFIED &&
1651             (cmd == NL80211_CMD_NEW_SCAN_RESULTS ||
1652              cmd == NL80211_CMD_SCAN_ABORTED)) {
1653                 wpa_driver_nl80211_set_mode(drv->first_bss,
1654                                             drv->ap_scan_as_station);
1655                 drv->ap_scan_as_station = NL80211_IFTYPE_UNSPECIFIED;
1656         }
1657
1658         switch (cmd) {
1659         case NL80211_CMD_TRIGGER_SCAN:
1660                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Scan trigger");
1661                 drv->scan_state = SCAN_STARTED;
1662                 if (drv->scan_for_auth) {
1663                         /*
1664                          * Cannot indicate EVENT_SCAN_STARTED here since we skip
1665                          * EVENT_SCAN_RESULTS in scan_for_auth case and the
1666                          * upper layer implementation could get confused about
1667                          * scanning state.
1668                          */
1669                         wpa_printf(MSG_DEBUG, "nl80211: Do not indicate scan-start event due to internal scan_for_auth");
1670                         break;
1671                 }
1672                 wpa_supplicant_event(drv->ctx, EVENT_SCAN_STARTED, NULL);
1673                 break;
1674         case NL80211_CMD_START_SCHED_SCAN:
1675                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Sched scan started");
1676                 drv->scan_state = SCHED_SCAN_STARTED;
1677                 break;
1678         case NL80211_CMD_SCHED_SCAN_STOPPED:
1679                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Sched scan stopped");
1680                 drv->scan_state = SCHED_SCAN_STOPPED;
1681                 wpa_supplicant_event(drv->ctx, EVENT_SCHED_SCAN_STOPPED, NULL);
1682                 break;
1683         case NL80211_CMD_NEW_SCAN_RESULTS:
1684                 wpa_dbg(drv->ctx, MSG_DEBUG,
1685                         "nl80211: New scan results available");
1686                 drv->scan_state = SCAN_COMPLETED;
1687                 drv->scan_complete_events = 1;
1688                 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout, drv,
1689                                      drv->ctx);
1690                 send_scan_event(drv, 0, tb);
1691                 break;
1692         case NL80211_CMD_SCHED_SCAN_RESULTS:
1693                 wpa_dbg(drv->ctx, MSG_DEBUG,
1694                         "nl80211: New sched scan results available");
1695                 drv->scan_state = SCHED_SCAN_RESULTS;
1696                 send_scan_event(drv, 0, tb);
1697                 break;
1698         case NL80211_CMD_SCAN_ABORTED:
1699                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Scan aborted");
1700                 drv->scan_state = SCAN_ABORTED;
1701                 /*
1702                  * Need to indicate that scan results are available in order
1703                  * not to make wpa_supplicant stop its scanning.
1704                  */
1705                 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout, drv,
1706                                      drv->ctx);
1707                 send_scan_event(drv, 1, tb);
1708                 break;
1709         case NL80211_CMD_AUTHENTICATE:
1710         case NL80211_CMD_ASSOCIATE:
1711         case NL80211_CMD_DEAUTHENTICATE:
1712         case NL80211_CMD_DISASSOCIATE:
1713         case NL80211_CMD_FRAME_TX_STATUS:
1714         case NL80211_CMD_UNPROT_DEAUTHENTICATE:
1715         case NL80211_CMD_UNPROT_DISASSOCIATE:
1716                 mlme_event(bss, cmd, tb[NL80211_ATTR_FRAME],
1717                            tb[NL80211_ATTR_MAC], tb[NL80211_ATTR_TIMED_OUT],
1718                            tb[NL80211_ATTR_WIPHY_FREQ], tb[NL80211_ATTR_ACK],
1719                            tb[NL80211_ATTR_COOKIE],
1720                            tb[NL80211_ATTR_RX_SIGNAL_DBM],
1721                            tb[NL80211_ATTR_STA_WME]);
1722                 break;
1723         case NL80211_CMD_CONNECT:
1724         case NL80211_CMD_ROAM:
1725                 mlme_event_connect(drv, cmd,
1726                                    tb[NL80211_ATTR_STATUS_CODE],
1727                                    tb[NL80211_ATTR_MAC],
1728                                    tb[NL80211_ATTR_REQ_IE],
1729                                    tb[NL80211_ATTR_RESP_IE],
1730                                    NULL, NULL, NULL, NULL);
1731                 break;
1732         case NL80211_CMD_CH_SWITCH_NOTIFY:
1733                 mlme_event_ch_switch(drv,
1734                                      tb[NL80211_ATTR_IFINDEX],
1735                                      tb[NL80211_ATTR_WIPHY_FREQ],
1736                                      tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
1737                                      tb[NL80211_ATTR_CHANNEL_WIDTH],
1738                                      tb[NL80211_ATTR_CENTER_FREQ1],
1739                                      tb[NL80211_ATTR_CENTER_FREQ2]);
1740                 break;
1741         case NL80211_CMD_DISCONNECT:
1742                 mlme_event_disconnect(drv, tb[NL80211_ATTR_REASON_CODE],
1743                                       tb[NL80211_ATTR_MAC],
1744                                       tb[NL80211_ATTR_DISCONNECTED_BY_AP]);
1745                 break;
1746         case NL80211_CMD_MICHAEL_MIC_FAILURE:
1747                 mlme_event_michael_mic_failure(bss, tb);
1748                 break;
1749         case NL80211_CMD_JOIN_IBSS:
1750                 mlme_event_join_ibss(drv, tb);
1751                 break;
1752         case NL80211_CMD_REMAIN_ON_CHANNEL:
1753                 mlme_event_remain_on_channel(drv, 0, tb);
1754                 break;
1755         case NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL:
1756                 mlme_event_remain_on_channel(drv, 1, tb);
1757                 break;
1758         case NL80211_CMD_NOTIFY_CQM:
1759                 nl80211_cqm_event(drv, tb);
1760                 break;
1761         case NL80211_CMD_REG_CHANGE:
1762                 nl80211_reg_change_event(drv, tb);
1763                 break;
1764         case NL80211_CMD_REG_BEACON_HINT:
1765                 wpa_printf(MSG_DEBUG, "nl80211: Regulatory beacon hint");
1766                 os_memset(&data, 0, sizeof(data));
1767                 data.channel_list_changed.initiator = REGDOM_BEACON_HINT;
1768                 wpa_supplicant_event(drv->ctx, EVENT_CHANNEL_LIST_CHANGED,
1769                                      &data);
1770                 break;
1771         case NL80211_CMD_NEW_STATION:
1772                 nl80211_new_station_event(drv, tb);
1773                 break;
1774         case NL80211_CMD_DEL_STATION:
1775                 nl80211_del_station_event(drv, tb);
1776                 break;
1777         case NL80211_CMD_SET_REKEY_OFFLOAD:
1778                 nl80211_rekey_offload_event(drv, tb);
1779                 break;
1780         case NL80211_CMD_PMKSA_CANDIDATE:
1781                 nl80211_pmksa_candidate_event(drv, tb);
1782                 break;
1783         case NL80211_CMD_PROBE_CLIENT:
1784                 nl80211_client_probe_event(drv, tb);
1785                 break;
1786         case NL80211_CMD_TDLS_OPER:
1787                 nl80211_tdls_oper_event(drv, tb);
1788                 break;
1789         case NL80211_CMD_CONN_FAILED:
1790                 nl80211_connect_failed_event(drv, tb);
1791                 break;
1792         case NL80211_CMD_FT_EVENT:
1793                 mlme_event_ft_event(drv, tb);
1794                 break;
1795         case NL80211_CMD_RADAR_DETECT:
1796                 nl80211_radar_event(drv, tb);
1797                 break;
1798         case NL80211_CMD_STOP_AP:
1799                 nl80211_stop_ap(drv, tb);
1800                 break;
1801         case NL80211_CMD_VENDOR:
1802                 nl80211_vendor_event(drv, tb);
1803                 break;
1804         case NL80211_CMD_NEW_PEER_CANDIDATE:
1805                 nl80211_new_peer_candidate(drv, tb);
1806                 break;
1807         default:
1808                 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Ignored unknown event "
1809                         "(cmd=%d)", cmd);
1810                 break;
1811         }
1812 }
1813
1814
1815 int process_drv_event(struct nl_msg *msg, void *arg)
1816 {
1817         struct wpa_driver_nl80211_data *drv = arg;
1818         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
1819         struct nlattr *tb[NL80211_ATTR_MAX + 1];
1820         struct i802_bss *bss;
1821         int ifidx = -1;
1822
1823         nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
1824                   genlmsg_attrlen(gnlh, 0), NULL);
1825
1826         if (tb[NL80211_ATTR_IFINDEX]) {
1827                 ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
1828
1829                 for (bss = drv->first_bss; bss; bss = bss->next)
1830                         if (ifidx == -1 || ifidx == bss->ifindex) {
1831                                 do_process_drv_event(bss, gnlh->cmd, tb);
1832                                 return NL_SKIP;
1833                         }
1834                 wpa_printf(MSG_DEBUG,
1835                            "nl80211: Ignored event (cmd=%d) for foreign interface (ifindex %d)",
1836                            gnlh->cmd, ifidx);
1837         } else if (tb[NL80211_ATTR_WDEV]) {
1838                 u64 wdev_id = nla_get_u64(tb[NL80211_ATTR_WDEV]);
1839                 wpa_printf(MSG_DEBUG, "nl80211: Process event on P2P device");
1840                 for (bss = drv->first_bss; bss; bss = bss->next) {
1841                         if (bss->wdev_id_set && wdev_id == bss->wdev_id) {
1842                                 do_process_drv_event(bss, gnlh->cmd, tb);
1843                                 return NL_SKIP;
1844                         }
1845                 }
1846                 wpa_printf(MSG_DEBUG,
1847                            "nl80211: Ignored event (cmd=%d) for foreign interface (wdev 0x%llx)",
1848                            gnlh->cmd, (long long unsigned int) wdev_id);
1849         }
1850
1851         return NL_SKIP;
1852 }
1853
1854
1855 int process_global_event(struct nl_msg *msg, void *arg)
1856 {
1857         struct nl80211_global *global = arg;
1858         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
1859         struct nlattr *tb[NL80211_ATTR_MAX + 1];
1860         struct wpa_driver_nl80211_data *drv, *tmp;
1861         int ifidx = -1;
1862         struct i802_bss *bss;
1863         u64 wdev_id = 0;
1864         int wdev_id_set = 0;
1865
1866         nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
1867                   genlmsg_attrlen(gnlh, 0), NULL);
1868
1869         if (tb[NL80211_ATTR_IFINDEX])
1870                 ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
1871         else if (tb[NL80211_ATTR_WDEV]) {
1872                 wdev_id = nla_get_u64(tb[NL80211_ATTR_WDEV]);
1873                 wdev_id_set = 1;
1874         }
1875
1876         dl_list_for_each_safe(drv, tmp, &global->interfaces,
1877                               struct wpa_driver_nl80211_data, list) {
1878                 for (bss = drv->first_bss; bss; bss = bss->next) {
1879                         if ((ifidx == -1 && !wdev_id_set) ||
1880                             ifidx == bss->ifindex ||
1881                             (wdev_id_set && bss->wdev_id_set &&
1882                              wdev_id == bss->wdev_id)) {
1883                                 do_process_drv_event(bss, gnlh->cmd, tb);
1884                                 return NL_SKIP;
1885                         }
1886                 }
1887         }
1888
1889         return NL_SKIP;
1890 }
1891
1892
1893 int process_bss_event(struct nl_msg *msg, void *arg)
1894 {
1895         struct i802_bss *bss = arg;
1896         struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
1897         struct nlattr *tb[NL80211_ATTR_MAX + 1];
1898
1899         nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
1900                   genlmsg_attrlen(gnlh, 0), NULL);
1901
1902         wpa_printf(MSG_DEBUG, "nl80211: BSS Event %d (%s) received for %s",
1903                    gnlh->cmd, nl80211_command_to_string(gnlh->cmd),
1904                    bss->ifname);
1905
1906         switch (gnlh->cmd) {
1907         case NL80211_CMD_FRAME:
1908         case NL80211_CMD_FRAME_TX_STATUS:
1909                 mlme_event(bss, gnlh->cmd, tb[NL80211_ATTR_FRAME],
1910                            tb[NL80211_ATTR_MAC], tb[NL80211_ATTR_TIMED_OUT],
1911                            tb[NL80211_ATTR_WIPHY_FREQ], tb[NL80211_ATTR_ACK],
1912                            tb[NL80211_ATTR_COOKIE],
1913                            tb[NL80211_ATTR_RX_SIGNAL_DBM],
1914                            tb[NL80211_ATTR_STA_WME]);
1915                 break;
1916         case NL80211_CMD_UNEXPECTED_FRAME:
1917                 nl80211_spurious_frame(bss, tb, 0);
1918                 break;
1919         case NL80211_CMD_UNEXPECTED_4ADDR_FRAME:
1920                 nl80211_spurious_frame(bss, tb, 1);
1921                 break;
1922         default:
1923                 wpa_printf(MSG_DEBUG, "nl80211: Ignored unknown event "
1924                            "(cmd=%d)", gnlh->cmd);
1925                 break;
1926         }
1927
1928         return NL_SKIP;
1929 }