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