gsupplicant/supplicant.c

   1 /*
   2  *
   3  *  WPA supplicant library with GLib integration
   4  *
   5  *  Copyright (C) 2012-2013  Intel Corporation. All rights reserved.
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License version 2 as
   9  *  published by the Free Software Foundation.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  19  *
  20  */
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <errno.h>
  27 #include <stdio.h>
  28 #include <stdlib.h>
  29 #include <string.h>
  30 #include <stdint.h>
  31 #include <syslog.h>
  32 #include <ctype.h>
  33 #include <stdbool.h>
  34 #include <netinet/if_ether.h>
  35 #include <netinet/in.h>
  36
  37 #include <glib.h>
  38 #include <gdbus.h>
  39
  40 #include "dbus.h"
  41 #include "gsupplicant.h"
  42
  43 #define IEEE80211_CAP_ESS       0x0001
  44 #define IEEE80211_CAP_IBSS      0x0002
  45 #define IEEE80211_CAP_PRIVACY   0x0010
  46
  47 #define BSS_UNKNOWN_STRENGTH    -90
  48
  49 static DBusConnection *connection;
  50
  51 static const GSupplicantCallbacks *callbacks_pointer;
  52
  53 static dbus_bool_t system_available = FALSE;
  54 static dbus_bool_t system_ready = FALSE;
  55
  56 static dbus_int32_t debug_level;
  57 static dbus_bool_t debug_timestamp = FALSE;
  58 static dbus_bool_t debug_showkeys = FALSE;
  59
  60 static const char *debug_strings[] = {
  61         "msgdump", "debug", "info", "warning", "error", NULL
  62 };
  63
  64 static unsigned int eap_methods;
  65
  66 struct strvalmap {
  67         const char *str;
  68         unsigned int val;
  69 };
  70
  71 static struct strvalmap eap_method_map[] = {
  72         { "MD5",        G_SUPPLICANT_EAP_METHOD_MD5     },
  73         { "TLS",        G_SUPPLICANT_EAP_METHOD_TLS     },
  74         { "MSCHAPV2",   G_SUPPLICANT_EAP_METHOD_MSCHAPV2        },
  75         { "PEAP",       G_SUPPLICANT_EAP_METHOD_PEAP    },
  76         { "TTLS",       G_SUPPLICANT_EAP_METHOD_TTLS    },
  77         { "GTC",        G_SUPPLICANT_EAP_METHOD_GTC     },
  78         { "OTP",        G_SUPPLICANT_EAP_METHOD_OTP     },
  79         { "LEAP",       G_SUPPLICANT_EAP_METHOD_LEAP    },
  80         { "WSC",        G_SUPPLICANT_EAP_METHOD_WSC     },
  81         { }
  82 };
  83
  84 static struct strvalmap keymgmt_map[] = {
  85         { "none",               G_SUPPLICANT_KEYMGMT_NONE               },
  86         { "ieee8021x",          G_SUPPLICANT_KEYMGMT_IEEE8021X  },
  87         { "wpa-none",           G_SUPPLICANT_KEYMGMT_WPA_NONE   },
  88         { "wpa-psk",            G_SUPPLICANT_KEYMGMT_WPA_PSK    },
  89         { "wpa-psk-sha256",     G_SUPPLICANT_KEYMGMT_WPA_PSK_256        },
  90         { "wpa-ft-psk",         G_SUPPLICANT_KEYMGMT_WPA_FT_PSK },
  91         { "wpa-ft-eap",         G_SUPPLICANT_KEYMGMT_WPA_FT_EAP },
  92         { "wpa-eap",            G_SUPPLICANT_KEYMGMT_WPA_EAP    },
  93         { "wpa-eap-sha256",     G_SUPPLICANT_KEYMGMT_WPA_EAP_256        },
  94         { "wps",                G_SUPPLICANT_KEYMGMT_WPS                },
  95         { "sae",                G_SUPPLICANT_KEYMGMT_SAE                },
  96         { }
  97 };
  98
  99 static struct strvalmap authalg_capa_map[] = {
 100         { "open",       G_SUPPLICANT_CAPABILITY_AUTHALG_OPEN    },
 101         { "shared",     G_SUPPLICANT_CAPABILITY_AUTHALG_SHARED  },
 102         { "leap",       G_SUPPLICANT_CAPABILITY_AUTHALG_LEAP    },
 103         { }
 104 };
 105
 106 static struct strvalmap proto_capa_map[] = {
 107         { "wpa",        G_SUPPLICANT_CAPABILITY_PROTO_WPA               },
 108         { "rsn",        G_SUPPLICANT_CAPABILITY_PROTO_RSN               },
 109         { }
 110 };
 111
 112 static struct strvalmap group_map[] = {
 113         { "wep40",      G_SUPPLICANT_GROUP_WEP40        },
 114         { "wep104",     G_SUPPLICANT_GROUP_WEP104       },
 115         { "tkip",       G_SUPPLICANT_GROUP_TKIP },
 116         { "ccmp",       G_SUPPLICANT_GROUP_CCMP },
 117         { }
 118 };
 119
 120 static struct strvalmap pairwise_map[] = {
 121         { "none",       G_SUPPLICANT_PAIRWISE_NONE      },
 122         { "tkip",       G_SUPPLICANT_PAIRWISE_TKIP      },
 123         { "ccmp",       G_SUPPLICANT_PAIRWISE_CCMP      },
 124         { }
 125 };
 126
 127 static struct strvalmap scan_capa_map[] = {
 128         { "active",     G_SUPPLICANT_CAPABILITY_SCAN_ACTIVE     },
 129         { "passive",    G_SUPPLICANT_CAPABILITY_SCAN_PASSIVE    },
 130         { "ssid",       G_SUPPLICANT_CAPABILITY_SCAN_SSID               },
 131         { }
 132 };
 133
 134 static struct strvalmap mode_capa_map[] = {
 135         { "infrastructure",     G_SUPPLICANT_CAPABILITY_MODE_INFRA      },
 136         { "ad-hoc",             G_SUPPLICANT_CAPABILITY_MODE_IBSS       },
 137         { "ap",                 G_SUPPLICANT_CAPABILITY_MODE_AP         },
 138         { "p2p",                G_SUPPLICANT_CAPABILITY_MODE_P2P        },
 139         { }
 140 };
 141
 142 static GHashTable *interface_table;
 143 static GHashTable *bss_mapping;
 144 static GHashTable *peer_mapping;
 145 static GHashTable *group_mapping;
 146 static GHashTable *pending_peer_connection;
 147 static GHashTable *config_file_table;
 148
 149 struct _GSupplicantWpsCredentials {
 150         unsigned char ssid[32];
 151         unsigned int ssid_len;
 152         char *key;
 153 };
 154
 155 struct added_network_information {
 156         char * ssid;
 157         GSupplicantSecurity security;
 158         char * passphrase;
 159         char * private_passphrase;
 160 };
 161
 162 struct _GSupplicantInterface {
 163         char *path;
 164         char *network_path;
 165         unsigned int keymgmt_capa;
 166         unsigned int authalg_capa;
 167         unsigned int proto_capa;
 168         unsigned int group_capa;
 169         unsigned int pairwise_capa;
 170         unsigned int scan_capa;
 171         unsigned int mode_capa;
 172         unsigned int max_scan_ssids;
 173         bool p2p_support;
 174         bool p2p_finding;
 175         bool ap_create_in_progress;
 176         dbus_bool_t ready;
 177         GSupplicantState state;
 178         dbus_bool_t scanning;
 179         GSupplicantInterfaceCallback scan_callback;
 180         void *scan_data;
 181         int apscan;
 182         char *ifname;
 183         char *driver;
 184         char *bridge;
 185         struct _GSupplicantWpsCredentials wps_cred;
 186         GSupplicantWpsState wps_state;
 187         GHashTable *network_table;
 188         GHashTable *peer_table;
 189         GHashTable *group_table;
 190         GHashTable *bss_mapping;
 191         void *data;
 192         const char *pending_peer_path;
 193         GSupplicantNetwork *current_network;
 194         struct added_network_information network_info;
 195 };
 196
 197 struct g_supplicant_bss {
 198         GSupplicantInterface *interface;
 199         char *path;
 200         unsigned char bssid[6];
 201         unsigned char ssid[32];
 202         unsigned int ssid_len;
 203         dbus_uint16_t frequency;
 204         dbus_uint32_t maxrate;
 205         dbus_int16_t signal;
 206         GSupplicantMode mode;
 207         GSupplicantSecurity security;
 208         dbus_bool_t rsn_selected;
 209         unsigned int wpa_keymgmt;
 210         unsigned int wpa_pairwise;
 211         unsigned int wpa_group;
 212         unsigned int rsn_keymgmt;
 213         unsigned int rsn_pairwise;
 214         unsigned int rsn_group;
 215         unsigned int keymgmt;
 216         dbus_bool_t privacy;
 217         dbus_bool_t psk;
 218         dbus_bool_t ieee8021x;
 219         unsigned int wps_capabilities;
 220 };
 221
 222 struct _GSupplicantNetwork {
 223         GSupplicantInterface *interface;
 224         char *path;
 225         char *group;
 226         char *name;
 227         unsigned char ssid[32];
 228         unsigned int ssid_len;
 229         dbus_int16_t signal;
 230         dbus_uint16_t frequency;
 231         struct g_supplicant_bss *best_bss;
 232         GSupplicantMode mode;
 233         GSupplicantSecurity security;
 234         dbus_bool_t wps;
 235         unsigned int wps_capabilities;
 236         GHashTable *bss_table;
 237         GHashTable *config_table;
 238         unsigned int keymgmt;
 239 };
 240
 241 struct _GSupplicantPeer {
 242         GSupplicantInterface *interface;
 243         char *path;
 244         unsigned char device_address[ETH_ALEN];
 245         unsigned char iface_address[ETH_ALEN];
 246         char *name;
 247         unsigned char *widi_ies;
 248         int widi_ies_length;
 249         char *identifier;
 250         unsigned int wps_capabilities;
 251         GSList *groups;
 252         const GSupplicantInterface *current_group_iface;
 253         bool connection_requested;
 254 };
 255
 256 struct _GSupplicantGroup {
 257         GSupplicantInterface *interface;
 258         GSupplicantInterface *orig_interface;
 259         char *path;
 260         int role;
 261         GSList *members;
 262 };
 263
 264 struct interface_data {
 265         GSupplicantInterface *interface;
 266         char *path; /* Interface path cannot be taken from interface (above) as
 267                      * it might have been freed already.
 268                      */
 269         GSupplicantInterfaceCallback callback;
 270         void *user_data;
 271         bool network_remove_in_progress;
 272         GSupplicantSSID *ssid;
 273 };
 274
 275 struct interface_create_data {
 276         char *ifname;
 277         char *driver;
 278         char *bridge;
 279         GSupplicantInterface *interface;
 280         GSupplicantInterfaceCallback callback;
 281         void *user_data;
 282 };
 283
 284 struct interface_connect_data {
 285         GSupplicantInterface *interface;
 286         char *path;
 287         GSupplicantInterfaceCallback callback;
 288         void *user_data;
 289         union {
 290                 GSupplicantSSID *ssid;
 291                 GSupplicantPeerParams *peer;
 292         };
 293 };
 294
 295 struct interface_scan_data {
 296         GSupplicantInterface *interface;
 297         char *path;
 298         GSupplicantInterfaceCallback callback;
 299         GSupplicantScanParams *scan_params;
 300         void *user_data;
 301 };
 302
 303 static int network_remove(struct interface_data *data);
 304
 305 static inline void debug(const char *format, ...)
 306 {
 307         char str[256];
 308         va_list ap;
 309
 310         if (!callbacks_pointer || !callbacks_pointer->debug)
 311                 return;
 312
 313         va_start(ap, format);
 314
 315         if (vsnprintf(str, sizeof(str), format, ap) > 0)
 316                 callbacks_pointer->debug(str);
 317
 318         va_end(ap);
 319 }
 320
 321 #define SUPPLICANT_DBG(fmt, arg...) \
 322         debug("%s:%s() " fmt, __FILE__, __FUNCTION__ , ## arg);
 323
 324 static GSupplicantMode string2mode(const char *mode)
 325 {
 326         if (!mode)
 327                 return G_SUPPLICANT_MODE_UNKNOWN;
 328
 329         if (g_str_equal(mode, "infrastructure"))
 330                 return G_SUPPLICANT_MODE_INFRA;
 331         else if (g_str_equal(mode, "ad-hoc"))
 332                 return G_SUPPLICANT_MODE_IBSS;
 333
 334         return G_SUPPLICANT_MODE_UNKNOWN;
 335 }
 336
 337 static const char *mode2string(GSupplicantMode mode)
 338 {
 339         switch (mode) {
 340         case G_SUPPLICANT_MODE_UNKNOWN:
 341                 break;
 342         case G_SUPPLICANT_MODE_INFRA:
 343                 return "managed";
 344         case G_SUPPLICANT_MODE_IBSS:
 345                 return "adhoc";
 346         case G_SUPPLICANT_MODE_MASTER:
 347                 return "ap";
 348         }
 349
 350         return NULL;
 351 }
 352
 353 static const char *security2string(GSupplicantSecurity security)
 354 {
 355         switch (security) {
 356         case G_SUPPLICANT_SECURITY_UNKNOWN:
 357                 break;
 358         case G_SUPPLICANT_SECURITY_NONE:
 359                 return "none";
 360         case G_SUPPLICANT_SECURITY_WEP:
 361                 return "wep";
 362         case G_SUPPLICANT_SECURITY_PSK:
 363                 return "psk";
 364         case G_SUPPLICANT_SECURITY_IEEE8021X:
 365                 return "ieee8021x";
 366         }
 367
 368         return NULL;
 369 }
 370
 371 static GSupplicantState string2state(const char *state)
 372 {
 373         if (!state)
 374                 return G_SUPPLICANT_STATE_UNKNOWN;
 375
 376         if (g_str_equal(state, "unknown"))
 377                 return G_SUPPLICANT_STATE_UNKNOWN;
 378         else if (g_str_equal(state, "interface_disabled"))
 379                 return G_SUPPLICANT_STATE_DISABLED;
 380         else if (g_str_equal(state, "disconnected"))
 381                 return G_SUPPLICANT_STATE_DISCONNECTED;
 382         else if (g_str_equal(state, "inactive"))
 383                 return G_SUPPLICANT_STATE_INACTIVE;
 384         else if (g_str_equal(state, "scanning"))
 385                 return G_SUPPLICANT_STATE_SCANNING;
 386         else if (g_str_equal(state, "authenticating"))
 387                 return G_SUPPLICANT_STATE_AUTHENTICATING;
 388         else if (g_str_equal(state, "associating"))
 389                 return G_SUPPLICANT_STATE_ASSOCIATING;
 390         else if (g_str_equal(state, "associated"))
 391                 return G_SUPPLICANT_STATE_ASSOCIATED;
 392         else if (g_str_equal(state, "group_handshake"))
 393                 return G_SUPPLICANT_STATE_GROUP_HANDSHAKE;
 394         else if (g_str_equal(state, "4way_handshake"))
 395                 return G_SUPPLICANT_STATE_4WAY_HANDSHAKE;
 396         else if (g_str_equal(state, "completed"))
 397                 return G_SUPPLICANT_STATE_COMPLETED;
 398
 399         return G_SUPPLICANT_STATE_UNKNOWN;
 400 }
 401
 402 static bool compare_network_parameters(GSupplicantInterface *interface,
 403                                 GSupplicantSSID *ssid)
 404 {
 405         if (memcmp(interface->network_info.ssid, ssid->ssid, ssid->ssid_len))
 406                 return FALSE;
 407
 408         if (interface->network_info.security != ssid->security)
 409                 return FALSE;
 410
 411         if (interface->network_info.passphrase &&
 412                         g_strcmp0(interface->network_info.passphrase,
 413                                 ssid->passphrase) != 0) {
 414                 return FALSE;
 415         }
 416
 417         if (interface->network_info.private_passphrase &&
 418                         g_strcmp0(interface->network_info.private_passphrase,
 419                                 ssid->private_key_passphrase) != 0) {
 420                 return FALSE;
 421         }
 422
 423         return TRUE;
 424 }
 425
 426 static void remove_network_information(GSupplicantInterface * interface)
 427 {
 428         g_free(interface->network_info.ssid);
 429         g_free(interface->network_info.passphrase);
 430         g_free(interface->network_info.private_passphrase);
 431         interface->network_info.ssid = NULL;
 432         interface->network_info.passphrase = NULL;
 433         interface->network_info.private_passphrase = NULL;
 434 }
 435
 436 static int store_network_information(GSupplicantInterface * interface,
 437                                 GSupplicantSSID *ssid)
 438 {
 439         interface->network_info.ssid = g_malloc(ssid->ssid_len + 1);
 440         if (interface->network_info.ssid != NULL) {
 441                 memcpy(interface->network_info.ssid, ssid->ssid,
 442                         ssid->ssid_len);
 443                 interface->network_info.ssid[ssid->ssid_len] = '\0';
 444         } else {
 445                 return -ENOMEM;
 446         }
 447
 448         interface->network_info.security = ssid->security;
 449
 450         if ((ssid->security == G_SUPPLICANT_SECURITY_WEP ||
 451                 ssid->security == G_SUPPLICANT_SECURITY_PSK ||
 452                 ssid->security == G_SUPPLICANT_SECURITY_NONE) &&
 453                 ssid->passphrase) {
 454                 interface->network_info.passphrase = g_strdup(ssid->passphrase);
 455         }
 456
 457         if (ssid->security == G_SUPPLICANT_SECURITY_IEEE8021X &&
 458                         ssid->private_key_passphrase) {
 459                 interface->network_info.private_passphrase =
 460                         g_strdup(ssid->private_key_passphrase);
 461         }
 462
 463         return 0;
 464 }
 465
 466 static void callback_system_ready(void)
 467 {
 468         if (system_ready)
 469                 return;
 470
 471         system_ready = TRUE;
 472
 473         if (!callbacks_pointer)
 474                 return;
 475
 476         if (!callbacks_pointer->system_ready)
 477                 return;
 478
 479         callbacks_pointer->system_ready();
 480 }
 481
 482 static void callback_system_killed(void)
 483 {
 484         system_ready = FALSE;
 485
 486         if (!callbacks_pointer)
 487                 return;
 488
 489         if (!callbacks_pointer->system_killed)
 490                 return;
 491
 492         callbacks_pointer->system_killed();
 493 }
 494
 495 static void callback_interface_added(GSupplicantInterface *interface)
 496 {
 497         SUPPLICANT_DBG("");
 498
 499         if (!callbacks_pointer)
 500                 return;
 501
 502         if (!callbacks_pointer->interface_added)
 503                 return;
 504
 505         callbacks_pointer->interface_added(interface);
 506 }
 507
 508 static void callback_interface_state(GSupplicantInterface *interface)
 509 {
 510         if (!callbacks_pointer)
 511                 return;
 512
 513         if (!callbacks_pointer->interface_state)
 514                 return;
 515
 516         callbacks_pointer->interface_state(interface);
 517 }
 518
 519 static void callback_interface_removed(GSupplicantInterface *interface)
 520 {
 521         if (!callbacks_pointer)
 522                 return;
 523
 524         if (!callbacks_pointer->interface_removed)
 525                 return;
 526
 527         callbacks_pointer->interface_removed(interface);
 528 }
 529
 530 static void callback_p2p_support(GSupplicantInterface *interface)
 531 {
 532         SUPPLICANT_DBG("");
 533
 534         if (!interface->p2p_support)
 535                 return;
 536
 537         if (callbacks_pointer && callbacks_pointer->p2p_support)
 538                 callbacks_pointer->p2p_support(interface);
 539 }
 540
 541 static void callback_scan_started(GSupplicantInterface *interface)
 542 {
 543         if (!callbacks_pointer)
 544                 return;
 545
 546         if (!callbacks_pointer->scan_started)
 547                 return;
 548
 549         callbacks_pointer->scan_started(interface);
 550 }
 551
 552 static void callback_ap_create_fail(GSupplicantInterface *interface)
 553 {
 554         if (!callbacks_pointer)
 555                 return;
 556
 557         if (!callbacks_pointer->ap_create_fail)
 558                 return;
 559
 560         callbacks_pointer->ap_create_fail(interface);
 561 }
 562
 563 static void callback_scan_finished(GSupplicantInterface *interface)
 564 {
 565         if (!callbacks_pointer)
 566                 return;
 567
 568         if (!callbacks_pointer->scan_finished)
 569                 return;
 570
 571         callbacks_pointer->scan_finished(interface);
 572 }
 573
 574 static void callback_network_added(GSupplicantNetwork *network)
 575 {
 576         if (!callbacks_pointer)
 577                 return;
 578
 579         if (!callbacks_pointer->network_added)
 580                 return;
 581
 582         callbacks_pointer->network_added(network);
 583 }
 584
 585 static void callback_network_removed(GSupplicantNetwork *network)
 586 {
 587         if (!callbacks_pointer)
 588                 return;
 589
 590         if (!callbacks_pointer->network_removed)
 591                 return;
 592
 593         callbacks_pointer->network_removed(network);
 594 }
 595
 596 static void callback_network_changed(GSupplicantNetwork *network,
 597                                         const char *property)
 598 {
 599         if (!callbacks_pointer)
 600                 return;
 601
 602         if (!callbacks_pointer->network_changed)
 603                 return;
 604
 605         callbacks_pointer->network_changed(network, property);
 606 }
 607
 608 static void callback_network_associated(GSupplicantNetwork *network)
 609 {
 610         if (!callbacks_pointer)
 611                 return;
 612
 613         if (!callbacks_pointer->network_associated)
 614                 return;
 615
 616         callbacks_pointer->network_associated(network);
 617 }
 618
 619 static void callback_sta_authorized(GSupplicantInterface *interface,
 620                                         const char *addr)
 621 {
 622         if (!callbacks_pointer)
 623                 return;
 624
 625         if (!callbacks_pointer->sta_authorized)
 626                 return;
 627
 628         callbacks_pointer->sta_authorized(interface, addr);
 629 }
 630
 631 static void callback_sta_deauthorized(GSupplicantInterface *interface,
 632                                         const char *addr)
 633 {
 634         if (!callbacks_pointer)
 635                 return;
 636
 637         if (!callbacks_pointer->sta_deauthorized)
 638                 return;
 639
 640         callbacks_pointer->sta_deauthorized(interface, addr);
 641 }
 642
 643 static void callback_peer_found(GSupplicantPeer *peer)
 644 {
 645         if (!callbacks_pointer)
 646                 return;
 647
 648         if (!callbacks_pointer->peer_found)
 649                 return;
 650
 651         callbacks_pointer->peer_found(peer);
 652 }
 653
 654 static void callback_peer_lost(GSupplicantPeer *peer)
 655 {
 656         if (!callbacks_pointer)
 657                 return;
 658
 659         if (!callbacks_pointer->peer_lost)
 660                 return;
 661
 662         callbacks_pointer->peer_lost(peer);
 663 }
 664
 665 static void callback_peer_changed(GSupplicantPeer *peer,
 666                                                 GSupplicantPeerState state)
 667 {
 668         if (!callbacks_pointer)
 669                 return;
 670
 671         if (!callbacks_pointer->peer_changed)
 672                 return;
 673
 674         callbacks_pointer->peer_changed(peer, state);
 675 }
 676
 677 static void callback_peer_request(GSupplicantPeer *peer)
 678 {
 679         if (!callbacks_pointer)
 680                 return;
 681
 682         if (!callbacks_pointer->peer_request)
 683                 return;
 684
 685         peer->connection_requested = true;
 686
 687         callbacks_pointer->peer_request(peer);
 688 }
 689
 690 static void callback_disconnect_reason_code(GSupplicantInterface *interface,
 691                                         int reason_code)
 692 {
 693         if (!callbacks_pointer)
 694                 return;
 695
 696         if (!callbacks_pointer->disconnect_reasoncode)
 697                 return;
 698
 699         if (reason_code != 0)
 700                 callbacks_pointer->disconnect_reasoncode(interface,
 701                                                         reason_code);
 702 }
 703
 704 static void callback_assoc_status_code(GSupplicantInterface *interface,
 705                                 int status_code)
 706 {
 707         if (!callbacks_pointer)
 708                 return;
 709
 710         if (!callbacks_pointer->assoc_status_code)
 711                 return;
 712
 713         callbacks_pointer->assoc_status_code(interface, status_code);
 714
 715 }
 716
 717 static void remove_group(gpointer data)
 718 {
 719         GSupplicantGroup *group = data;
 720
 721         if (group->members)
 722                 g_slist_free_full(group->members, g_free);
 723
 724         g_free(group->path);
 725         g_free(group);
 726 }
 727
 728 static void remove_interface(gpointer data)
 729 {
 730         GSupplicantInterface *interface = data;
 731
 732         g_hash_table_destroy(interface->bss_mapping);
 733         g_hash_table_destroy(interface->network_table);
 734         g_hash_table_destroy(interface->peer_table);
 735         g_hash_table_destroy(interface->group_table);
 736
 737         if (interface->scan_callback) {
 738                 SUPPLICANT_DBG("call interface %p callback %p scanning %d",
 739                                 interface, interface->scan_callback,
 740                                 interface->scanning);
 741
 742                 interface->scan_callback(-EIO, interface, interface->scan_data);
 743                 interface->scan_callback = NULL;
 744                 interface->scan_data = NULL;
 745
 746                 if (interface->scanning) {
 747                         interface->scanning = FALSE;
 748                         callback_scan_finished(interface);
 749                 }
 750         }
 751
 752         callback_interface_removed(interface);
 753
 754         g_free(interface->wps_cred.key);
 755         g_free(interface->path);
 756         g_free(interface->network_path);
 757         g_free(interface->ifname);
 758         g_free(interface->driver);
 759         g_free(interface->bridge);
 760         remove_network_information(interface);
 761         g_free(interface);
 762 }
 763
 764 static void remove_network(gpointer data)
 765 {
 766         GSupplicantNetwork *network = data;
 767
 768         g_hash_table_destroy(network->bss_table);
 769
 770         callback_network_removed(network);
 771
 772         g_hash_table_destroy(network->config_table);
 773
 774         g_free(network->path);
 775         g_free(network->group);
 776         g_free(network->name);
 777         g_free(network);
 778 }
 779
 780 static void remove_bss(gpointer data)
 781 {
 782         struct g_supplicant_bss *bss = data;
 783
 784         supplicant_dbus_property_call_cancel_all(bss);
 785
 786         g_free(bss->path);
 787         g_free(bss);
 788 }
 789
 790 static void remove_peer(gpointer data)
 791 {
 792         GSupplicantPeer *peer = data;
 793
 794         callback_peer_lost(peer);
 795
 796         if (peer->groups)
 797                 g_slist_free_full(peer->groups, g_free);
 798
 799         if (peer_mapping)
 800                 g_hash_table_remove(peer_mapping, peer->path);
 801
 802         if (pending_peer_connection)
 803                 g_hash_table_remove(pending_peer_connection, peer->path);
 804
 805         g_free(peer->path);
 806         g_free(peer->name);
 807         g_free(peer->identifier);
 808         g_free(peer->widi_ies);
 809
 810         g_free(peer);
 811 }
 812
 813 static void remove_ssid(gpointer data)
 814 {
 815         GSupplicantSSID *ssid = data;
 816
 817         if (!ssid)
 818                 return;
 819
 820         g_free((void *) ssid->ssid);
 821         g_free((char *) ssid->eap);
 822         g_free((char *) ssid->passphrase);
 823         g_free((char *) ssid->identity);
 824         g_free((char *) ssid->anonymous_identity);
 825         g_free((char *) ssid->ca_cert_path);
 826         g_free((char *) ssid->subject_match);
 827         g_free((char *) ssid->altsubject_match);
 828         g_free((char *) ssid->domain_suffix_match);
 829         g_free((char *) ssid->domain_match);
 830         g_free((char *) ssid->client_cert_path);
 831         g_free((char *) ssid->private_key_path);
 832         g_free((char *) ssid->private_key_passphrase);
 833         g_free((char *) ssid->phase2_auth);
 834         g_free((char *) ssid->pin_wps);
 835         g_free((char *) ssid->bgscan);
 836
 837         g_free(ssid);
 838 }
 839
 840 static void debug_strvalmap(const char *label, struct strvalmap *map,
 841                                                         unsigned int val)
 842 {
 843         int i;
 844
 845         for (i = 0; map[i].str; i++) {
 846                 if (val & map[i].val)
 847                         SUPPLICANT_DBG("%s: %s", label, map[i].str);
 848         }
 849 }
 850
 851 static void interface_capability_keymgmt(DBusMessageIter *iter, void *user_data)
 852 {
 853         GSupplicantInterface *interface = user_data;
 854         const char *str = NULL;
 855         int i;
 856
 857         dbus_message_iter_get_basic(iter, &str);
 858         if (!str)
 859                 return;
 860
 861         for (i = 0; keymgmt_map[i].str; i++)
 862                 if (strcmp(str, keymgmt_map[i].str) == 0) {
 863                         interface->keymgmt_capa |= keymgmt_map[i].val;
 864                         break;
 865                 }
 866 }
 867
 868 static void interface_capability_authalg(DBusMessageIter *iter, void *user_data)
 869 {
 870         GSupplicantInterface *interface = user_data;
 871         const char *str = NULL;
 872         int i;
 873
 874         dbus_message_iter_get_basic(iter, &str);
 875         if (!str)
 876                 return;
 877
 878         for (i = 0; authalg_capa_map[i].str; i++)
 879                 if (strcmp(str, authalg_capa_map[i].str) == 0) {
 880                         interface->authalg_capa |= authalg_capa_map[i].val;
 881                         break;
 882                 }
 883 }
 884
 885 static void interface_capability_proto(DBusMessageIter *iter, void *user_data)
 886 {
 887         GSupplicantInterface *interface = user_data;
 888         const char *str = NULL;
 889         int i;
 890
 891         dbus_message_iter_get_basic(iter, &str);
 892         if (!str)
 893                 return;
 894
 895         for (i = 0; proto_capa_map[i].str; i++)
 896                 if (strcmp(str, proto_capa_map[i].str) == 0) {
 897                         interface->proto_capa |= proto_capa_map[i].val;
 898                         break;
 899                 }
 900 }
 901
 902 static void interface_capability_pairwise(DBusMessageIter *iter,
 903                                                         void *user_data)
 904 {
 905         GSupplicantInterface *interface = user_data;
 906         const char *str = NULL;
 907         int i;
 908
 909         dbus_message_iter_get_basic(iter, &str);
 910         if (!str)
 911                 return;
 912
 913         for (i = 0; pairwise_map[i].str; i++)
 914                 if (strcmp(str, pairwise_map[i].str) == 0) {
 915                         interface->pairwise_capa |= pairwise_map[i].val;
 916                         break;
 917                 }
 918 }
 919
 920 static void interface_capability_group(DBusMessageIter *iter, void *user_data)
 921 {
 922         GSupplicantInterface *interface = user_data;
 923         const char *str = NULL;
 924         int i;
 925
 926         dbus_message_iter_get_basic(iter, &str);
 927         if (!str)
 928                 return;
 929
 930         for (i = 0; group_map[i].str; i++)
 931                 if (strcmp(str, group_map[i].str) == 0) {
 932                         interface->group_capa |= group_map[i].val;
 933                         break;
 934                 }
 935 }
 936
 937 static void interface_capability_scan(DBusMessageIter *iter, void *user_data)
 938 {
 939         GSupplicantInterface *interface = user_data;
 940         const char *str = NULL;
 941         int i;
 942
 943         dbus_message_iter_get_basic(iter, &str);
 944         if (!str)
 945                 return;
 946
 947         for (i = 0; scan_capa_map[i].str; i++)
 948                 if (strcmp(str, scan_capa_map[i].str) == 0) {
 949                         interface->scan_capa |= scan_capa_map[i].val;
 950                         break;
 951                 }
 952 }
 953
 954 static void interface_capability_mode(DBusMessageIter *iter, void *user_data)
 955 {
 956         GSupplicantInterface *interface = user_data;
 957         const char *str = NULL;
 958         int i;
 959
 960         dbus_message_iter_get_basic(iter, &str);
 961         if (!str)
 962                 return;
 963
 964         for (i = 0; mode_capa_map[i].str; i++)
 965                 if (strcmp(str, mode_capa_map[i].str) == 0) {
 966                         interface->mode_capa |= mode_capa_map[i].val;
 967                         break;
 968                 }
 969 }
 970
 971 static void interface_capability(const char *key, DBusMessageIter *iter,
 972                                                         void *user_data)
 973 {
 974         GSupplicantInterface *interface = user_data;
 975
 976         if (!key)
 977                 return;
 978
 979         if (g_strcmp0(key, "KeyMgmt") == 0)
 980                 supplicant_dbus_array_foreach(iter,
 981                                 interface_capability_keymgmt, interface);
 982         else if (g_strcmp0(key, "AuthAlg") == 0)
 983                 supplicant_dbus_array_foreach(iter,
 984                                 interface_capability_authalg, interface);
 985         else if (g_strcmp0(key, "Protocol") == 0)
 986                 supplicant_dbus_array_foreach(iter,
 987                                 interface_capability_proto, interface);
 988         else if (g_strcmp0(key, "Pairwise") == 0)
 989                 supplicant_dbus_array_foreach(iter,
 990                                 interface_capability_pairwise, interface);
 991         else if (g_strcmp0(key, "Group") == 0)
 992                 supplicant_dbus_array_foreach(iter,
 993                                 interface_capability_group, interface);
 994         else if (g_strcmp0(key, "Scan") == 0)
 995                 supplicant_dbus_array_foreach(iter,
 996                                 interface_capability_scan, interface);
 997         else if (g_strcmp0(key, "Modes") == 0)
 998                 supplicant_dbus_array_foreach(iter,
 999                                 interface_capability_mode, interface);
1000         else if (g_strcmp0(key, "MaxScanSSID") == 0) {
1001                 dbus_int32_t max_scan_ssid;
1002
1003                 dbus_message_iter_get_basic(iter, &max_scan_ssid);
1004                 if (max_scan_ssid < 2)
1005                         max_scan_ssid = 0;
1006                 interface->max_scan_ssids = max_scan_ssid;
1007
1008         } else
1009                 SUPPLICANT_DBG("key %s type %c",
1010                                 key, dbus_message_iter_get_arg_type(iter));
1011 }
1012
1013 static void set_bss_expiration_age(DBusMessageIter *iter, void *user_data)
1014 {
1015         unsigned int bss_expiration_age = GPOINTER_TO_UINT(user_data);
1016
1017         dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT32,
1018                                 &bss_expiration_age);
1019 }
1020
1021 int g_supplicant_interface_set_bss_expiration_age(GSupplicantInterface *interface,
1022                                         unsigned int bss_expiration_age)
1023 {
1024        return supplicant_dbus_property_set(interface->path,
1025                                        SUPPLICANT_INTERFACE ".Interface",
1026                                        "BSSExpireAge", DBUS_TYPE_UINT32_AS_STRING,
1027                                        set_bss_expiration_age, NULL,
1028                                        GUINT_TO_POINTER(bss_expiration_age), NULL);
1029 }
1030
1031 struct set_apscan_data
1032 {
1033         unsigned int ap_scan;
1034         GSupplicantInterface *interface;
1035 };
1036
1037 static void set_apscan(DBusMessageIter *iter, void *user_data)
1038 {
1039         struct set_apscan_data *data = user_data;
1040         unsigned int ap_scan = data->ap_scan;
1041
1042         dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT32, &ap_scan);
1043 }
1044
1045 static void set_apscan_complete(const char *error,
1046                 DBusMessageIter *iter, void *user_data)
1047 {
1048         struct set_apscan_data *data = user_data;
1049         GSupplicantInterface *interface = data->interface;
1050
1051         if (error) {
1052                 interface->ap_create_in_progress = false;
1053                 SUPPLICANT_DBG("Set AP scan error %s", error);
1054                 goto error;
1055         }
1056
1057         interface->ap_create_in_progress = true;
1058 error:
1059         dbus_free(data);
1060 }
1061
1062 int g_supplicant_interface_set_apscan(GSupplicantInterface *interface,
1063                                                         unsigned int ap_scan)
1064 {
1065         struct set_apscan_data *data;
1066         int ret;
1067
1068         data = dbus_malloc0(sizeof(*data));
1069
1070         if (!data)
1071                 return -ENOMEM;
1072
1073         data->ap_scan = ap_scan;
1074         data->interface = interface;
1075
1076         ret = supplicant_dbus_property_set(interface->path,
1077                         SUPPLICANT_INTERFACE ".Interface",
1078                         "ApScan", DBUS_TYPE_UINT32_AS_STRING,
1079                         set_apscan, set_apscan_complete, data, NULL);
1080         if (ret < 0)
1081                 dbus_free(data);
1082
1083         return ret;
1084 }
1085
1086 void g_supplicant_interface_set_data(GSupplicantInterface *interface,
1087                                                                 void *data)
1088 {
1089         if (!interface)
1090                 return;
1091
1092         interface->data = data;
1093
1094         if (!data)
1095                 interface->scan_callback = NULL;
1096 }
1097
1098 void *g_supplicant_interface_get_data(GSupplicantInterface *interface)
1099 {
1100         if (!interface)
1101                 return NULL;
1102
1103         return interface->data;
1104 }
1105
1106 const char *g_supplicant_interface_get_ifname(GSupplicantInterface *interface)
1107 {
1108         if (!interface)
1109                 return NULL;
1110
1111         return interface->ifname;
1112 }
1113
1114 const char *g_supplicant_interface_get_driver(GSupplicantInterface *interface)
1115 {
1116         if (!interface)
1117                 return NULL;
1118
1119         return interface->driver;
1120 }
1121
1122 GSupplicantState g_supplicant_interface_get_state(
1123                                         GSupplicantInterface *interface)
1124 {
1125         if (!interface)
1126                 return G_SUPPLICANT_STATE_UNKNOWN;
1127
1128         return interface->state;
1129 }
1130
1131 const char *g_supplicant_interface_get_wps_key(GSupplicantInterface *interface)
1132 {
1133         if (!interface)
1134                 return NULL;
1135
1136         return (const char *)interface->wps_cred.key;
1137 }
1138
1139 const void *g_supplicant_interface_get_wps_ssid(GSupplicantInterface *interface,
1140                                                         unsigned int *ssid_len)
1141 {
1142         if (!ssid_len)
1143                 return NULL;
1144
1145         if (!interface || interface->wps_cred.ssid_len == 0) {
1146                 *ssid_len = 0;
1147                 return NULL;
1148         }
1149
1150         *ssid_len = interface->wps_cred.ssid_len;
1151         return interface->wps_cred.ssid;
1152 }
1153
1154 GSupplicantWpsState g_supplicant_interface_get_wps_state(
1155                                         GSupplicantInterface *interface)
1156 {
1157         if (!interface)
1158                 return G_SUPPLICANT_WPS_STATE_UNKNOWN;
1159
1160         return interface->wps_state;
1161 }
1162
1163 unsigned int g_supplicant_interface_get_mode(GSupplicantInterface *interface)
1164 {
1165         if (!interface)
1166                 return 0;
1167
1168         return interface->mode_capa;
1169 }
1170
1171 unsigned int g_supplicant_interface_get_max_scan_ssids(
1172                                 GSupplicantInterface *interface)
1173 {
1174         if (!interface)
1175                 return 0;
1176
1177         return interface->max_scan_ssids;
1178 }
1179
1180 static void set_network_enabled(DBusMessageIter *iter, void *user_data)
1181 {
1182         dbus_bool_t enable = *(dbus_bool_t *)user_data;
1183
1184         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &enable);
1185 }
1186
1187 int g_supplicant_interface_enable_selected_network(GSupplicantInterface *interface,
1188                                                         dbus_bool_t enable)
1189 {
1190         if (!interface)
1191                 return -1;
1192
1193         if (!interface->network_path)
1194                 return -1;
1195
1196         SUPPLICANT_DBG(" ");
1197         return supplicant_dbus_property_set(interface->network_path,
1198                                 SUPPLICANT_INTERFACE ".Network",
1199                                 "Enabled", DBUS_TYPE_BOOLEAN_AS_STRING,
1200                                 set_network_enabled, NULL, &enable, NULL);
1201 }
1202
1203 dbus_bool_t g_supplicant_interface_get_ready(GSupplicantInterface *interface)
1204 {
1205         if (!interface)
1206                 return FALSE;
1207
1208         return interface->ready;
1209 }
1210
1211 GSupplicantInterface *g_supplicant_network_get_interface(
1212                                         GSupplicantNetwork *network)
1213 {
1214         if (!network)
1215                 return NULL;
1216
1217         return network->interface;
1218 }
1219
1220 const char *g_supplicant_network_get_name(GSupplicantNetwork *network)
1221 {
1222         if (!network || !network->name)
1223                 return "";
1224
1225         return network->name;
1226 }
1227
1228 const char *g_supplicant_network_get_identifier(GSupplicantNetwork *network)
1229 {
1230         if (!network || !network->group)
1231                 return "";
1232
1233         return network->group;
1234 }
1235
1236 const char *g_supplicant_network_get_path(GSupplicantNetwork *network)
1237 {
1238         if (!network || !network->path)
1239                 return NULL;
1240
1241         return network->path;
1242 }
1243
1244 const char *g_supplicant_network_get_mode(GSupplicantNetwork *network)
1245 {
1246         if (!network)
1247                 return NULL;
1248
1249         return mode2string(network->mode);
1250 }
1251
1252 const char *g_supplicant_network_get_security(GSupplicantNetwork *network)
1253 {
1254         if (!network)
1255                 return NULL;
1256
1257         return security2string(network->security);
1258 }
1259
1260 const void *g_supplicant_network_get_ssid(GSupplicantNetwork *network,
1261                                                 unsigned int *ssid_len)
1262 {
1263         if (!network) {
1264                 *ssid_len = 0;
1265                 return NULL;
1266         }
1267
1268         *ssid_len = network->ssid_len;
1269         return network->ssid;
1270 }
1271
1272 dbus_int16_t g_supplicant_network_get_signal(GSupplicantNetwork *network)
1273 {
1274         if (!network)
1275                 return 0;
1276
1277         return network->signal;
1278 }
1279
1280 dbus_uint16_t g_supplicant_network_get_frequency(GSupplicantNetwork *network)
1281 {
1282         if (!network)
1283                 return 0;
1284
1285         return network->frequency;
1286 }
1287
1288 dbus_bool_t g_supplicant_network_get_wps(GSupplicantNetwork *network)
1289 {
1290         if (!network)
1291                 return FALSE;
1292
1293         return network->wps;
1294 }
1295
1296 dbus_bool_t g_supplicant_network_is_wps_active(GSupplicantNetwork *network)
1297 {
1298         if (!network)
1299                 return FALSE;
1300
1301         if (network->wps_capabilities & G_SUPPLICANT_WPS_CONFIGURED)
1302                 return TRUE;
1303
1304         return FALSE;
1305 }
1306
1307 dbus_bool_t g_supplicant_network_is_wps_pbc(GSupplicantNetwork *network)
1308 {
1309         if (!network)
1310                 return FALSE;
1311
1312         if (network->wps_capabilities & G_SUPPLICANT_WPS_PBC)
1313                 return TRUE;
1314
1315         return FALSE;
1316 }
1317
1318 dbus_bool_t g_supplicant_network_is_wps_advertizing(GSupplicantNetwork *network)
1319 {
1320         if (!network)
1321                 return FALSE;
1322
1323         if (network->wps_capabilities & G_SUPPLICANT_WPS_REGISTRAR)
1324                 return TRUE;
1325
1326         return FALSE;
1327 }
1328
1329 GSupplicantInterface *g_supplicant_peer_get_interface(GSupplicantPeer *peer)
1330 {
1331         if (!peer)
1332                 return NULL;
1333
1334         return peer->interface;
1335 }
1336
1337 const char *g_supplicant_peer_get_path(GSupplicantPeer *peer)
1338 {
1339         if (!peer)
1340                 return NULL;
1341
1342         return peer->path;
1343 }
1344
1345 const char *g_supplicant_peer_get_identifier(GSupplicantPeer *peer)
1346 {
1347         if (!peer)
1348                 return NULL;
1349
1350         return peer->identifier;
1351 }
1352
1353 const void *g_supplicant_peer_get_device_address(GSupplicantPeer *peer)
1354 {
1355         if (!peer)
1356                 return NULL;
1357
1358         return peer->device_address;
1359 }
1360
1361 const void *g_supplicant_peer_get_iface_address(GSupplicantPeer *peer)
1362 {
1363         if (!peer)
1364                 return NULL;
1365
1366         return peer->iface_address;
1367 }
1368
1369 const char *g_supplicant_peer_get_name(GSupplicantPeer *peer)
1370 {
1371         if (!peer)
1372                 return NULL;
1373
1374         return peer->name;
1375 }
1376
1377 const unsigned char *g_supplicant_peer_get_widi_ies(GSupplicantPeer *peer,
1378                                                                 int *length)
1379 {
1380         if (!peer || !length)
1381                 return NULL;
1382
1383         *length = peer->widi_ies_length;
1384         return peer->widi_ies;
1385 }
1386
1387 bool g_supplicant_peer_is_wps_pbc(GSupplicantPeer *peer)
1388 {
1389         if (!peer)
1390                 return false;
1391
1392         if (peer->wps_capabilities & G_SUPPLICANT_WPS_PBC)
1393                 return true;
1394
1395         return false;
1396 }
1397
1398 bool g_supplicant_peer_is_wps_pin(GSupplicantPeer *peer)
1399 {
1400         if (!peer)
1401                 return false;
1402
1403         if (peer->wps_capabilities & G_SUPPLICANT_WPS_PIN)
1404                 return true;
1405
1406         return false;
1407 }
1408
1409 bool g_supplicant_peer_is_in_a_group(GSupplicantPeer *peer)
1410 {
1411         if (!peer || !peer->groups)
1412                 return false;
1413
1414         return true;
1415 }
1416
1417 GSupplicantInterface *g_supplicant_peer_get_group_interface(GSupplicantPeer *peer)
1418 {
1419         if (!peer)
1420                 return NULL;
1421
1422         return (GSupplicantInterface *) peer->current_group_iface;
1423 }
1424
1425 bool g_supplicant_peer_is_client(GSupplicantPeer *peer)
1426 {
1427         GSupplicantGroup *group;
1428         GSList *list;
1429
1430         if (!peer)
1431                 return false;
1432
1433         for (list = peer->groups; list; list = list->next) {
1434                 const char *path = list->data;
1435
1436                 group = g_hash_table_lookup(group_mapping, path);
1437                 if (!group)
1438                         continue;
1439
1440                 if (group->role != G_SUPPLICANT_GROUP_ROLE_CLIENT ||
1441                                 group->orig_interface != peer->interface)
1442                         continue;
1443
1444                 if (group->interface == peer->current_group_iface)
1445                         return true;
1446         }
1447
1448         return false;
1449 }
1450
1451 bool g_supplicant_peer_has_requested_connection(GSupplicantPeer *peer)
1452 {
1453         if (!peer)
1454                 return false;
1455
1456         return peer->connection_requested;
1457 }
1458
1459 unsigned int g_supplicant_network_get_keymgmt(GSupplicantNetwork *network)
1460 {
1461         if (!network)
1462                 return 0;
1463
1464         return network->keymgmt;
1465 }
1466
1467 static void merge_network(GSupplicantNetwork *network)
1468 {
1469         GString *str;
1470         const char *ssid, *mode, *key_mgmt;
1471         unsigned int i, ssid_len;
1472         char *group;
1473
1474         ssid = g_hash_table_lookup(network->config_table, "ssid");
1475         mode = g_hash_table_lookup(network->config_table, "mode");
1476         key_mgmt = g_hash_table_lookup(network->config_table, "key_mgmt");
1477
1478         SUPPLICANT_DBG("ssid %s mode %s", ssid, mode);
1479
1480         if (ssid)
1481                 ssid_len = strlen(ssid);
1482         else
1483                 ssid_len = 0;
1484
1485         str = g_string_sized_new((ssid_len * 2) + 24);
1486         if (!str)
1487                 return;
1488
1489         for (i = 0; i < ssid_len; i++)
1490                 g_string_append_printf(str, "%02x", ssid[i]);
1491
1492         if (g_strcmp0(mode, "0") == 0)
1493                 g_string_append_printf(str, "_managed");
1494         else if (g_strcmp0(mode, "1") == 0)
1495                 g_string_append_printf(str, "_adhoc");
1496
1497         if ((g_strcmp0(key_mgmt, "WPA-PSK") == 0) ||
1498             (g_strcmp0(key_mgmt, "SAE") == 0))
1499                 g_string_append_printf(str, "_psk");
1500
1501         group = g_string_free(str, FALSE);
1502
1503         SUPPLICANT_DBG("%s", group);
1504
1505         g_free(group);
1506
1507         g_hash_table_destroy(network->config_table);
1508
1509         g_free(network->path);
1510         g_free(network);
1511 }
1512
1513 static void network_property(const char *key, DBusMessageIter *iter,
1514                                                         void *user_data)
1515 {
1516         GSupplicantNetwork *network = user_data;
1517
1518         if (!network->interface)
1519                 return;
1520
1521         if (!key) {
1522                 merge_network(network);
1523                 return;
1524         }
1525
1526         if (g_strcmp0(key, "Enabled") == 0) {
1527                 dbus_bool_t enabled = FALSE;
1528
1529                 dbus_message_iter_get_basic(iter, &enabled);
1530         } else if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
1531                 const char *str = NULL;
1532
1533                 dbus_message_iter_get_basic(iter, &str);
1534                 if (str) {
1535                         g_hash_table_replace(network->config_table,
1536                                                 g_strdup(key), g_strdup(str));
1537                 }
1538         } else
1539                 SUPPLICANT_DBG("key %s type %c",
1540                                 key, dbus_message_iter_get_arg_type(iter));
1541 }
1542
1543 static void interface_network_added(DBusMessageIter *iter, void *user_data)
1544 {
1545         GSupplicantInterface *interface = user_data;
1546         GSupplicantNetwork *network;
1547         const char *path = NULL;
1548
1549         SUPPLICANT_DBG("");
1550
1551         dbus_message_iter_get_basic(iter, &path);
1552         if (!path)
1553                 return;
1554
1555         if (g_strcmp0(path, "/") == 0)
1556                 return;
1557
1558         network = g_try_new0(GSupplicantNetwork, 1);
1559         if (!network)
1560                 return;
1561
1562         network->interface = interface;
1563         network->path = g_strdup(path);
1564
1565         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1566                                                         g_free, g_free);
1567
1568         dbus_message_iter_next(iter);
1569         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1570                 supplicant_dbus_property_foreach(iter, network_property,
1571                                                                 network);
1572                 network_property(NULL, NULL, network);
1573                 return;
1574         }
1575
1576         supplicant_dbus_property_get_all(path,
1577                                 SUPPLICANT_INTERFACE ".Network",
1578                                         network_property, network, NULL);
1579 }
1580
1581 static void interface_network_removed(DBusMessageIter *iter, void *user_data)
1582 {
1583         SUPPLICANT_DBG("");
1584 }
1585
1586 static char *create_name(unsigned char *ssid, int ssid_len)
1587 {
1588         GString *string;
1589         const gchar *remainder, *invalid;
1590         int valid_bytes, remaining_bytes;
1591
1592         if (ssid_len < 1 || ssid[0] == '\0')
1593                 return g_strdup("");
1594
1595         string = NULL;
1596         remainder = (const gchar *)ssid;
1597         remaining_bytes = ssid_len;
1598
1599         while (remaining_bytes != 0) {
1600                 if (g_utf8_validate(remainder, remaining_bytes,
1601                                         &invalid)) {
1602                         break;
1603                 }
1604
1605                 valid_bytes = invalid - remainder;
1606
1607                 if (!string)
1608                         string = g_string_sized_new(remaining_bytes);
1609
1610                 g_string_append_len(string, remainder, valid_bytes);
1611
1612                 /* append U+FFFD REPLACEMENT CHARACTER */
1613                 g_string_append(string, "\357\277\275");
1614
1615                 remaining_bytes -= valid_bytes + 1;
1616                 remainder = invalid + 1;
1617         }
1618
1619         if (!string)
1620                 return g_strndup((const gchar *)ssid, ssid_len + 1);
1621
1622         g_string_append(string, remainder);
1623
1624         return g_string_free(string, FALSE);
1625 }
1626
1627 static char *create_group(struct g_supplicant_bss *bss)
1628 {
1629         GString *str;
1630         unsigned int i;
1631         const char *mode, *security;
1632
1633         str = g_string_sized_new((bss->ssid_len * 2) + 24);
1634         if (!str)
1635                 return NULL;
1636
1637         if (bss->ssid_len > 0 && bss->ssid[0] != '\0') {
1638                 for (i = 0; i < bss->ssid_len; i++)
1639                         g_string_append_printf(str, "%02x", bss->ssid[i]);
1640         } else
1641                 g_string_append_printf(str, "hidden");
1642
1643         mode = mode2string(bss->mode);
1644         if (mode)
1645                 g_string_append_printf(str, "_%s", mode);
1646
1647         security = security2string(bss->security);
1648         if (security)
1649                 g_string_append_printf(str, "_%s", security);
1650
1651         return g_string_free(str, FALSE);
1652 }
1653
1654 static int add_or_replace_bss_to_network(struct g_supplicant_bss *bss)
1655 {
1656         GSupplicantInterface *interface = bss->interface;
1657         GSupplicantNetwork *network;
1658         char *group;
1659         bool is_new_network;
1660
1661         group = create_group(bss);
1662         SUPPLICANT_DBG("New group created: %s", group);
1663
1664         if (!group)
1665                 return -ENOMEM;
1666
1667         network = g_hash_table_lookup(interface->network_table, group);
1668         if (network) {
1669                 g_free(group);
1670                 SUPPLICANT_DBG("Network %s already exist", network->name);
1671                 is_new_network = false;
1672
1673                 goto done;
1674         }
1675
1676         is_new_network = true;
1677
1678         network = g_try_new0(GSupplicantNetwork, 1);
1679         if (!network) {
1680                 g_free(group);
1681                 return -ENOMEM;
1682         }
1683
1684         network->interface = interface;
1685         if (!network->path)
1686                 network->path = g_strdup(bss->path);
1687         network->group = group;
1688         network->name = create_name(bss->ssid, bss->ssid_len);
1689         network->mode = bss->mode;
1690         network->security = bss->security;
1691         network->keymgmt = bss->keymgmt;
1692         network->ssid_len = bss->ssid_len;
1693         memcpy(network->ssid, bss->ssid, bss->ssid_len);
1694         network->signal = bss->signal;
1695         network->frequency = bss->frequency;
1696         network->best_bss = bss;
1697
1698         if ((bss->keymgmt & G_SUPPLICANT_KEYMGMT_WPS) != 0) {
1699                 network->wps = TRUE;
1700                 network->wps_capabilities = bss->wps_capabilities;
1701         }
1702
1703         SUPPLICANT_DBG("New network %s created", network->name);
1704
1705         network->bss_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1706                                                         NULL, remove_bss);
1707
1708         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1709                                                         g_free, g_free);
1710
1711         g_hash_table_replace(interface->network_table,
1712                                                 network->group, network);
1713
1714         callback_network_added(network);
1715
1716 done:
1717         /* We update network's WPS properties if only bss provides WPS. */
1718         if ((bss->keymgmt & G_SUPPLICANT_KEYMGMT_WPS) != 0) {
1719                 network->wps = TRUE;
1720                 network->wps_capabilities = bss->wps_capabilities;
1721
1722                 if (!is_new_network)
1723                         callback_network_changed(network, "WPSCapabilities");
1724         }
1725
1726         /*
1727          * Do not change best BSS if we are connected. It will be done through
1728          * CurrentBSS property in case of misalignment with wpa_s or roaming.
1729          */
1730         if (network != interface->current_network &&
1731                                 bss->signal > network->signal) {
1732                 network->signal = bss->signal;
1733                 network->best_bss = bss;
1734                 callback_network_changed(network, "Signal");
1735         }
1736
1737         g_hash_table_replace(interface->bss_mapping, bss->path, network);
1738         g_hash_table_replace(network->bss_table, bss->path, bss);
1739
1740         g_hash_table_replace(bss_mapping, bss->path, interface);
1741
1742         return 0;
1743 }
1744
1745 static void bss_rates(DBusMessageIter *iter, void *user_data)
1746 {
1747         struct g_supplicant_bss *bss = user_data;
1748         dbus_uint32_t rate = 0;
1749
1750         dbus_message_iter_get_basic(iter, &rate);
1751         if (rate == 0)
1752                 return;
1753
1754         if (rate > bss->maxrate)
1755                 bss->maxrate = rate;
1756 }
1757
1758 static void bss_keymgmt(DBusMessageIter *iter, void *user_data)
1759 {
1760         unsigned int *keymgmt = user_data;
1761         const char *str = NULL;
1762         int i;
1763
1764         dbus_message_iter_get_basic(iter, &str);
1765         if (!str)
1766                 return;
1767
1768         for (i = 0; keymgmt_map[i].str; i++)
1769                 if (strcmp(str, keymgmt_map[i].str) == 0) {
1770                         SUPPLICANT_DBG("Keymgmt: %s", str);
1771                         *keymgmt |= keymgmt_map[i].val;
1772                         break;
1773                 }
1774 }
1775
1776 static void bss_group(DBusMessageIter *iter, void *user_data)
1777 {
1778         unsigned int *group = user_data;
1779         const char *str = NULL;
1780         int i;
1781
1782         dbus_message_iter_get_basic(iter, &str);
1783         if (!str)
1784                 return;
1785
1786         for (i = 0; group_map[i].str; i++)
1787                 if (strcmp(str, group_map[i].str) == 0) {
1788                         SUPPLICANT_DBG("Group: %s", str);
1789                         *group |= group_map[i].val;
1790                         break;
1791                 }
1792 }
1793
1794 static void bss_pairwise(DBusMessageIter *iter, void *user_data)
1795 {
1796         unsigned int *pairwise = user_data;
1797         const char *str = NULL;
1798         int i;
1799
1800         dbus_message_iter_get_basic(iter, &str);
1801         if (!str)
1802                 return;
1803
1804         for (i = 0; pairwise_map[i].str; i++)
1805                 if (strcmp(str, pairwise_map[i].str) == 0) {
1806                         SUPPLICANT_DBG("Pairwise: %s", str);
1807                         *pairwise |= pairwise_map[i].val;
1808                         break;
1809                 }
1810 }
1811
1812 static void bss_wpa(const char *key, DBusMessageIter *iter,
1813                         void *user_data)
1814 {
1815         struct g_supplicant_bss *bss = user_data;
1816         unsigned int value = 0;
1817
1818         SUPPLICANT_DBG("Key: %s", key);
1819
1820         if (g_strcmp0(key, "KeyMgmt") == 0) {
1821                 supplicant_dbus_array_foreach(iter, bss_keymgmt, &value);
1822
1823                 if (bss->rsn_selected)
1824                         bss->rsn_keymgmt = value;
1825                 else
1826                         bss->wpa_keymgmt = value;
1827         } else if (g_strcmp0(key, "Group") == 0) {
1828                 supplicant_dbus_array_foreach(iter, bss_group, &value);
1829
1830                 if (bss->rsn_selected)
1831                         bss->rsn_group = value;
1832                 else
1833                         bss->wpa_group = value;
1834         } else if (g_strcmp0(key, "Pairwise") == 0) {
1835                 supplicant_dbus_array_foreach(iter, bss_pairwise, &value);
1836
1837                 if (bss->rsn_selected)
1838                         bss->rsn_pairwise = value;
1839                 else
1840                         bss->wpa_pairwise = value;
1841         }
1842 }
1843
1844 static unsigned int get_tlv(unsigned char *ie, unsigned int ie_size,
1845                                                         unsigned int type)
1846 {
1847         unsigned int len = 0;
1848
1849         while (len + 4 < ie_size) {
1850                 unsigned int hi = ie[len];
1851                 unsigned int lo = ie[len + 1];
1852                 unsigned int tmp_type = (hi << 8) + lo;
1853                 unsigned int v_len = 0;
1854
1855                 /* hi and lo are used to recreate an unsigned int
1856                  * based on 2 8bits length unsigned int. */
1857
1858                 hi = ie[len + 2];
1859                 lo = ie[len + 3];
1860                 v_len = (hi << 8) + lo;
1861
1862                 if (tmp_type == type) {
1863                         unsigned int ret_value = 0;
1864                         unsigned char *value = (unsigned char *)&ret_value;
1865
1866                         SUPPLICANT_DBG("IE: match type 0x%x", type);
1867
1868                         /* Verifying length relevance */
1869                         if (v_len > sizeof(unsigned int) ||
1870                                 len + 4 + v_len > ie_size)
1871                                 break;
1872
1873                         memcpy(value, ie + len + 4, v_len);
1874
1875                         SUPPLICANT_DBG("returning 0x%x", ret_value);
1876                         return ret_value;
1877                 }
1878
1879                 len += v_len + 4;
1880         }
1881
1882         SUPPLICANT_DBG("returning 0");
1883         return 0;
1884 }
1885
1886 static void bss_process_ies(DBusMessageIter *iter, void *user_data)
1887 {
1888         struct g_supplicant_bss *bss = user_data;
1889         const unsigned char WPS_OUI[] = { 0x00, 0x50, 0xf2, 0x04 };
1890         unsigned char *ie, *ie_end;
1891         DBusMessageIter array;
1892         unsigned int value;
1893         int ie_len;
1894
1895 #define WMM_WPA1_WPS_INFO 221
1896 #define WPS_INFO_MIN_LEN  6
1897 #define WPS_VERSION_TLV   0x104A
1898 #define WPS_STATE_TLV     0x1044
1899 #define WPS_METHODS_TLV   0x1012
1900 #define WPS_REGISTRAR_TLV 0x1041
1901 #define WPS_VERSION       0x10
1902 #define WPS_PBC           0x04
1903 #define WPS_PIN           0x00
1904 #define WPS_CONFIGURED    0x02
1905
1906         dbus_message_iter_recurse(iter, &array);
1907         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1908
1909         if (!ie || ie_len < 2)
1910                 return;
1911
1912         bss->wps_capabilities = 0;
1913         bss->keymgmt = 0;
1914
1915         for (ie_end = ie + ie_len; ie < ie_end && ie + ie[1] + 1 <= ie_end;
1916                                                         ie += ie[1] + 2) {
1917
1918                 if (ie[0] != WMM_WPA1_WPS_INFO || ie[1] < WPS_INFO_MIN_LEN ||
1919                         memcmp(ie+2, WPS_OUI, sizeof(WPS_OUI)) != 0)
1920                         continue;
1921
1922                 SUPPLICANT_DBG("IE: match WPS_OUI");
1923
1924                 value = get_tlv(&ie[6], ie[1], WPS_STATE_TLV);
1925                 if (get_tlv(&ie[6], ie[1], WPS_VERSION_TLV) == WPS_VERSION &&
1926                                                                 value != 0) {
1927                         bss->keymgmt |= G_SUPPLICANT_KEYMGMT_WPS;
1928
1929                         if (value == WPS_CONFIGURED)
1930                                 bss->wps_capabilities |=
1931                                         G_SUPPLICANT_WPS_CONFIGURED;
1932                 }
1933
1934                 value = get_tlv(&ie[6], ie[1], WPS_METHODS_TLV);
1935                 if (value != 0) {
1936                         if (GUINT16_FROM_BE(value) == WPS_PBC)
1937                                 bss->wps_capabilities |= G_SUPPLICANT_WPS_PBC;
1938                         if (GUINT16_FROM_BE(value) == WPS_PIN)
1939                                 bss->wps_capabilities |= G_SUPPLICANT_WPS_PIN;
1940                 } else
1941                         bss->wps_capabilities |=
1942                                 G_SUPPLICANT_WPS_PBC | G_SUPPLICANT_WPS_PIN;
1943
1944                 /* If the AP sends this it means it's advertizing
1945                  * as a registrar and the WPS process is launched
1946                  * on its side */
1947                 if (get_tlv(&ie[6], ie[1], WPS_REGISTRAR_TLV) != 0)
1948                         bss->wps_capabilities |= G_SUPPLICANT_WPS_REGISTRAR;
1949
1950                 SUPPLICANT_DBG("WPS Methods 0x%x", bss->wps_capabilities);
1951         }
1952 }
1953
1954 static void bss_compute_security(struct g_supplicant_bss *bss)
1955 {
1956         /*
1957          * Combining RSN and WPA keymgmt
1958          * We combine it since parsing IEs might have set something for WPS. */
1959         bss->keymgmt |= bss->rsn_keymgmt | bss->wpa_keymgmt;
1960
1961         bss->ieee8021x = FALSE;
1962         bss->psk = FALSE;
1963
1964         if (bss->keymgmt &
1965                         (G_SUPPLICANT_KEYMGMT_WPA_EAP |
1966                                 G_SUPPLICANT_KEYMGMT_WPA_FT_EAP |
1967                                 G_SUPPLICANT_KEYMGMT_WPA_EAP_256))
1968                 bss->ieee8021x = TRUE;
1969
1970         if (bss->keymgmt &
1971                         (G_SUPPLICANT_KEYMGMT_WPA_PSK |
1972                                 G_SUPPLICANT_KEYMGMT_WPA_FT_PSK |
1973                                 G_SUPPLICANT_KEYMGMT_WPA_PSK_256 |
1974                                 G_SUPPLICANT_KEYMGMT_SAE))
1975                 bss->psk = TRUE;
1976
1977         if (bss->ieee8021x)
1978                 bss->security = G_SUPPLICANT_SECURITY_IEEE8021X;
1979         else if (bss->psk)
1980                 bss->security = G_SUPPLICANT_SECURITY_PSK;
1981         else if (bss->privacy)
1982                 bss->security = G_SUPPLICANT_SECURITY_WEP;
1983         else
1984                 bss->security = G_SUPPLICANT_SECURITY_NONE;
1985 }
1986
1987
1988 static void bss_property(const char *key, DBusMessageIter *iter,
1989                                                         void *user_data)
1990 {
1991         struct g_supplicant_bss *bss = user_data;
1992
1993         if (!bss->interface)
1994                 return;
1995
1996         SUPPLICANT_DBG("key %s", key);
1997
1998         if (!key)
1999                 return;
2000
2001         if (g_strcmp0(key, "BSSID") == 0) {
2002                 DBusMessageIter array;
2003                 unsigned char *addr;
2004                 int addr_len;
2005
2006                 dbus_message_iter_recurse(iter, &array);
2007                 dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
2008
2009                 if (addr_len == 6)
2010                         memcpy(bss->bssid, addr, addr_len);
2011         } else if (g_strcmp0(key, "SSID") == 0) {
2012                 DBusMessageIter array;
2013                 unsigned char *ssid;
2014                 int ssid_len;
2015
2016                 dbus_message_iter_recurse(iter, &array);
2017                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
2018
2019                 if (ssid_len > 0 && ssid_len < 33) {
2020                         memcpy(bss->ssid, ssid, ssid_len);
2021                         bss->ssid_len = ssid_len;
2022                 } else {
2023                         memset(bss->ssid, 0, sizeof(bss->ssid));
2024                         bss->ssid_len = 0;
2025                 }
2026         } else if (g_strcmp0(key, "Capabilities") == 0) {
2027                 dbus_uint16_t capabilities = 0x0000;
2028
2029                 dbus_message_iter_get_basic(iter, &capabilities);
2030
2031                 if (capabilities & IEEE80211_CAP_ESS)
2032                         bss->mode = G_SUPPLICANT_MODE_INFRA;
2033                 else if (capabilities & IEEE80211_CAP_IBSS)
2034                         bss->mode = G_SUPPLICANT_MODE_IBSS;
2035
2036                 if (capabilities & IEEE80211_CAP_PRIVACY)
2037                         bss->privacy = TRUE;
2038         } else if (g_strcmp0(key, "Mode") == 0) {
2039                 const char *mode = NULL;
2040
2041                 dbus_message_iter_get_basic(iter, &mode);
2042                 bss->mode = string2mode(mode);
2043         } else if (g_strcmp0(key, "Frequency") == 0) {
2044                 dbus_uint16_t frequency = 0;
2045
2046                 dbus_message_iter_get_basic(iter, &frequency);
2047                 bss->frequency = frequency;
2048         } else if (g_strcmp0(key, "Signal") == 0) {
2049                 dbus_int16_t signal = 0;
2050
2051                 dbus_message_iter_get_basic(iter, &signal);
2052
2053                 bss->signal = signal;
2054                 if (!bss->signal)
2055                         bss->signal = BSS_UNKNOWN_STRENGTH;
2056
2057         } else if (g_strcmp0(key, "Level") == 0) {
2058                 dbus_int32_t level = 0;
2059
2060                 dbus_message_iter_get_basic(iter, &level);
2061         } else if (g_strcmp0(key, "Rates") == 0) {
2062                 supplicant_dbus_array_foreach(iter, bss_rates, bss);
2063         } else if (g_strcmp0(key, "MaxRate") == 0) {
2064                 dbus_uint32_t maxrate = 0;
2065
2066                 dbus_message_iter_get_basic(iter, &maxrate);
2067                 if (maxrate != 0)
2068                         bss->maxrate = maxrate;
2069         } else if (g_strcmp0(key, "Privacy") == 0) {
2070                 dbus_bool_t privacy = FALSE;
2071
2072                 dbus_message_iter_get_basic(iter, &privacy);
2073                 bss->privacy = privacy;
2074         } else if (g_strcmp0(key, "RSN") == 0) {
2075                 bss->rsn_selected = TRUE;
2076
2077                 supplicant_dbus_property_foreach(iter, bss_wpa, bss);
2078         } else if (g_strcmp0(key, "WPA") == 0) {
2079                 bss->rsn_selected = FALSE;
2080
2081                 supplicant_dbus_property_foreach(iter, bss_wpa, bss);
2082         } else if (g_strcmp0(key, "IEs") == 0)
2083                 bss_process_ies(iter, bss);
2084         else
2085                 SUPPLICANT_DBG("key %s type %c",
2086                                 key, dbus_message_iter_get_arg_type(iter));
2087 }
2088
2089 static struct g_supplicant_bss *interface_bss_added(DBusMessageIter *iter,
2090                                                         void *user_data)
2091 {
2092         GSupplicantInterface *interface = user_data;
2093         GSupplicantNetwork *network;
2094         struct g_supplicant_bss *bss;
2095         const char *path = NULL;
2096
2097         SUPPLICANT_DBG("");
2098
2099         dbus_message_iter_get_basic(iter, &path);
2100         if (!path)
2101                 return NULL;
2102
2103         if (g_strcmp0(path, "/") == 0)
2104                 return NULL;
2105
2106         SUPPLICANT_DBG("%s", path);
2107
2108         network = g_hash_table_lookup(interface->bss_mapping, path);
2109         if (network) {
2110                 bss = g_hash_table_lookup(network->bss_table, path);
2111                 if (bss)
2112                         return NULL;
2113         }
2114
2115         bss = g_try_new0(struct g_supplicant_bss, 1);
2116         if (!bss)
2117                 return NULL;
2118
2119         bss->interface = interface;
2120         bss->path = g_strdup(path);
2121         bss->signal = BSS_UNKNOWN_STRENGTH;
2122
2123         return bss;
2124 }
2125
2126 static void interface_bss_added_with_keys(DBusMessageIter *iter,
2127                                                 void *user_data)
2128 {
2129         struct g_supplicant_bss *bss;
2130
2131         SUPPLICANT_DBG("");
2132
2133         bss = interface_bss_added(iter, user_data);
2134         if (!bss)
2135                 return;
2136
2137         dbus_message_iter_next(iter);
2138
2139         if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_INVALID)
2140                 return;
2141
2142         supplicant_dbus_property_foreach(iter, bss_property, bss);
2143
2144         bss_compute_security(bss);
2145         if (add_or_replace_bss_to_network(bss) < 0)
2146                 SUPPLICANT_DBG("add_or_replace_bss_to_network failed");
2147 }
2148
2149 static void interface_bss_added_without_keys(DBusMessageIter *iter,
2150                                                 void *user_data)
2151 {
2152         struct g_supplicant_bss *bss;
2153
2154         SUPPLICANT_DBG("");
2155
2156         bss = interface_bss_added(iter, user_data);
2157         if (!bss)
2158                 return;
2159
2160         supplicant_dbus_property_get_all(bss->path,
2161                                         SUPPLICANT_INTERFACE ".BSS",
2162                                         bss_property, bss, bss);
2163
2164         bss_compute_security(bss);
2165         if (add_or_replace_bss_to_network(bss) < 0)
2166                         SUPPLICANT_DBG("add_or_replace_bss_to_network failed");
2167 }
2168
2169 static void update_signal(gpointer key, gpointer value,
2170                                                 gpointer user_data)
2171 {
2172         struct g_supplicant_bss *bss = value;
2173         GSupplicantNetwork *network = user_data;
2174
2175         if (bss->signal > network->signal) {
2176                 network->signal = bss->signal;
2177                 network->best_bss = bss;
2178         }
2179 }
2180
2181 static void update_network_signal(GSupplicantNetwork *network)
2182 {
2183         if (g_hash_table_size(network->bss_table) <= 1 && network->best_bss)
2184                 return;
2185
2186         g_hash_table_foreach(network->bss_table,
2187                                 update_signal, network);
2188
2189         SUPPLICANT_DBG("New network signal %d", network->signal);
2190 }
2191
2192 static void interface_current_bss(GSupplicantInterface *interface,
2193                                                 DBusMessageIter *iter)
2194 {
2195         GSupplicantNetwork *network;
2196         struct g_supplicant_bss *bss;
2197         const char *path;
2198
2199         dbus_message_iter_get_basic(iter, &path);
2200         if (g_strcmp0(path, "/") == 0) {
2201                 interface->current_network = NULL;
2202                 return;
2203         }
2204
2205         interface_bss_added_without_keys(iter, interface);
2206
2207         network = g_hash_table_lookup(interface->bss_mapping, path);
2208         if (!network)
2209                 return;
2210
2211         bss = g_hash_table_lookup(network->bss_table, path);
2212         if (!bss)
2213                 return;
2214
2215         interface->current_network = network;
2216
2217         if (bss != network->best_bss) {
2218                 /*
2219                  * This is the case where either wpa_s got associated
2220                  * to a BSS different than the one ConnMan considers
2221                  * the best, or we are roaming.
2222                  */
2223                 SUPPLICANT_DBG("Update best BSS for %s", network->name);
2224
2225                 network->best_bss = bss;
2226
2227                 if (network->signal != bss->signal) {
2228                         SUPPLICANT_DBG("New network signal %d dBm",
2229                                                 bss->signal);
2230
2231                         network->signal = bss->signal;
2232                         callback_network_changed(network, "Signal");
2233                 }
2234         }
2235
2236         /*
2237          * wpa_s could notify about CurrentBSS in any state once
2238          * it got associated. It is not sure such notification will
2239          * arrive together with transition to ASSOCIATED state.
2240          * In fact, for networks with security WEP or OPEN, it
2241          * always arrives together with transition to COMPLETED.
2242          */
2243         switch (interface->state) {
2244         case G_SUPPLICANT_STATE_UNKNOWN:
2245         case G_SUPPLICANT_STATE_DISABLED:
2246         case G_SUPPLICANT_STATE_DISCONNECTED:
2247         case G_SUPPLICANT_STATE_INACTIVE:
2248         case G_SUPPLICANT_STATE_SCANNING:
2249         case G_SUPPLICANT_STATE_AUTHENTICATING:
2250         case G_SUPPLICANT_STATE_ASSOCIATING:
2251                 return;
2252         case G_SUPPLICANT_STATE_ASSOCIATED:
2253         case G_SUPPLICANT_STATE_4WAY_HANDSHAKE:
2254         case G_SUPPLICANT_STATE_GROUP_HANDSHAKE:
2255         case G_SUPPLICANT_STATE_COMPLETED:
2256                 callback_network_associated(network);
2257                 break;
2258         }
2259 }
2260
2261 static void interface_bss_removed(DBusMessageIter *iter, void *user_data)
2262 {
2263         GSupplicantInterface *interface = user_data;
2264         GSupplicantNetwork *network;
2265         struct g_supplicant_bss *bss = NULL;
2266         const char *path = NULL;
2267         bool is_current_network_bss = false;
2268
2269         dbus_message_iter_get_basic(iter, &path);
2270         if (!path)
2271                 return;
2272
2273         network = g_hash_table_lookup(interface->bss_mapping, path);
2274         if (!network)
2275                 return;
2276
2277         bss = g_hash_table_lookup(network->bss_table, path);
2278         if (network->best_bss == bss) {
2279                 network->best_bss = NULL;
2280                 network->signal = BSS_UNKNOWN_STRENGTH;
2281                 is_current_network_bss = true;
2282         }
2283
2284         g_hash_table_remove(bss_mapping, path);
2285
2286         g_hash_table_remove(interface->bss_mapping, path);
2287         g_hash_table_remove(network->bss_table, path);
2288
2289         update_network_signal(network);
2290
2291         if (g_hash_table_size(network->bss_table) == 0) {
2292                 g_hash_table_remove(interface->network_table, network->group);
2293         } else {
2294                 if (is_current_network_bss && network->best_bss)
2295                         callback_network_changed(network, "");
2296         }
2297 }
2298
2299 static void set_config_methods(DBusMessageIter *iter, void *user_data)
2300 {
2301         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, user_data);
2302 }
2303
2304 static void wps_property(const char *key, DBusMessageIter *iter,
2305                                                         void *user_data)
2306 {
2307         GSupplicantInterface *interface = user_data;
2308
2309         if (!interface)
2310                 return;
2311
2312         SUPPLICANT_DBG("key: %s", key);
2313
2314         if (g_strcmp0(key, "ConfigMethods") == 0) {
2315                 const char *config_methods = "push_button", *str = NULL;
2316
2317                 dbus_message_iter_get_basic(iter, &str);
2318                 if (str && strlen(str) > 0) {
2319                         /* It was already set at wpa_s level, don't modify it. */
2320                         SUPPLICANT_DBG("%s", str);
2321                         return;
2322                 }
2323
2324                 supplicant_dbus_property_set(interface->path,
2325                         SUPPLICANT_INTERFACE ".Interface.WPS",
2326                         "ConfigMethods", DBUS_TYPE_STRING_AS_STRING,
2327                         set_config_methods, NULL, &config_methods, NULL);
2328
2329                 SUPPLICANT_DBG("No value. Set %s", config_methods);
2330         }
2331
2332 }
2333
2334 static void interface_property(const char *key, DBusMessageIter *iter,
2335                                                         void *user_data)
2336 {
2337         GSupplicantInterface *interface = user_data;
2338
2339         if (!interface)
2340                 return;
2341
2342         SUPPLICANT_DBG("%s", key);
2343
2344         if (!key) {
2345                 debug_strvalmap("KeyMgmt capability", keymgmt_map,
2346                                                 interface->keymgmt_capa);
2347                 debug_strvalmap("AuthAlg capability", authalg_capa_map,
2348                                                 interface->authalg_capa);
2349                 debug_strvalmap("Protocol capability", proto_capa_map,
2350                                                 interface->proto_capa);
2351                 debug_strvalmap("Pairwise capability", pairwise_map,
2352                                                 interface->pairwise_capa);
2353                 debug_strvalmap("Group capability", group_map,
2354                                                 interface->group_capa);
2355                 debug_strvalmap("Scan capability", scan_capa_map,
2356                                                 interface->scan_capa);
2357                 debug_strvalmap("Mode capability", mode_capa_map,
2358                                                 interface->mode_capa);
2359
2360                 supplicant_dbus_property_get_all(interface->path,
2361                                 SUPPLICANT_INTERFACE ".Interface.WPS",
2362                                 wps_property, interface, interface);
2363
2364                 if (interface->ready)
2365                         callback_interface_added(interface);
2366
2367                 return;
2368         }
2369
2370         if (g_strcmp0(key, "Capabilities") == 0) {
2371                 supplicant_dbus_property_foreach(iter, interface_capability,
2372                                                                 interface);
2373                 if (interface->mode_capa & G_SUPPLICANT_CAPABILITY_MODE_P2P)
2374                         interface->p2p_support = true;
2375         } else if (g_strcmp0(key, "State") == 0) {
2376                 const char *str = NULL;
2377
2378                 dbus_message_iter_get_basic(iter, &str);
2379                 if (str)
2380                         if (string2state(str) != interface->state) {
2381                                 interface->state = string2state(str);
2382                                 callback_interface_state(interface);
2383                         }
2384
2385                 if (interface->ap_create_in_progress) {
2386                         if (interface->state == G_SUPPLICANT_STATE_DISCONNECTED)
2387                                 callback_ap_create_fail(interface);
2388
2389                         interface->ap_create_in_progress = false;
2390                 }
2391
2392                 if (interface->state == G_SUPPLICANT_STATE_DISABLED)
2393                         interface->ready = FALSE;
2394                 else
2395                         interface->ready = TRUE;
2396
2397                 SUPPLICANT_DBG("state %s (%d)", str, interface->state);
2398         } else if (g_strcmp0(key, "Scanning") == 0) {
2399                 dbus_bool_t scanning = FALSE;
2400
2401                 dbus_message_iter_get_basic(iter, &scanning);
2402                 interface->scanning = scanning;
2403
2404                 if (interface->ready) {
2405                         if (interface->scanning)
2406                                 callback_scan_started(interface);
2407                         else
2408                                 callback_scan_finished(interface);
2409                 }
2410         } else if (g_strcmp0(key, "ApScan") == 0) {
2411                 int apscan = 1;
2412
2413                 dbus_message_iter_get_basic(iter, &apscan);
2414                 interface->apscan = apscan;
2415         } else if (g_strcmp0(key, "Ifname") == 0) {
2416                 const char *str = NULL;
2417
2418                 dbus_message_iter_get_basic(iter, &str);
2419                 if (str) {
2420                         g_free(interface->ifname);
2421                         interface->ifname = g_strdup(str);
2422                 }
2423         } else if (g_strcmp0(key, "Driver") == 0) {
2424                 const char *str = NULL;
2425
2426                 dbus_message_iter_get_basic(iter, &str);
2427                 if (str) {
2428                         g_free(interface->driver);
2429                         interface->driver = g_strdup(str);
2430                 }
2431         } else if (g_strcmp0(key, "BridgeIfname") == 0) {
2432                 const char *str = NULL;
2433
2434                 dbus_message_iter_get_basic(iter, &str);
2435                 if (str) {
2436                         g_free(interface->bridge);
2437                         interface->bridge = g_strdup(str);
2438                 }
2439         } else if (g_strcmp0(key, "ConfigFile") == 0) {
2440                 const char *str = NULL;
2441
2442                 dbus_message_iter_get_basic(iter, &str);
2443                 if (str && strlen(str) > 0 && interface->ifname) {
2444                         SUPPLICANT_DBG("New {%s, %s}", interface->ifname, str);
2445                         g_hash_table_replace(config_file_table,
2446                                 g_strdup(interface->ifname), g_strdup(str));
2447                 }
2448         } else if (g_strcmp0(key, "CurrentBSS") == 0) {
2449                 interface_current_bss(interface, iter);
2450         } else if (g_strcmp0(key, "CurrentNetwork") == 0) {
2451                 interface_network_added(iter, interface);
2452         } else if (g_strcmp0(key, "BSSs") == 0) {
2453                 supplicant_dbus_array_foreach(iter,
2454                                         interface_bss_added_without_keys,
2455                                         interface);
2456         } else if (g_strcmp0(key, "Blobs") == 0) {
2457                 /* Nothing */
2458         } else if (g_strcmp0(key, "Networks") == 0) {
2459                 supplicant_dbus_array_foreach(iter, interface_network_added,
2460                                                                 interface);
2461         } else if (g_strcmp0(key, "DisconnectReason") == 0) {
2462                 int reason_code;
2463                 if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
2464                         dbus_message_iter_get_basic(iter, &reason_code);
2465                         callback_disconnect_reason_code(interface, reason_code);
2466                 }
2467         } else if (g_strcmp0(key, "AssocStatusCode") == 0) {
2468                 int status_code;
2469                 if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
2470                         dbus_message_iter_get_basic(iter, &status_code);
2471                         callback_assoc_status_code(interface, status_code);
2472                 }
2473         } else {
2474                 SUPPLICANT_DBG("key %s type %c",
2475                                 key, dbus_message_iter_get_arg_type(iter));
2476         }
2477 }
2478
2479 static void scan_network_update(DBusMessageIter *iter, void *user_data)
2480 {
2481         GSupplicantInterface *interface = user_data;
2482         GSupplicantNetwork *network;
2483         char *path;
2484
2485         if (!iter)
2486                 return;
2487
2488         dbus_message_iter_get_basic(iter, &path);
2489
2490         if (!path)
2491                 return;
2492
2493         if (g_strcmp0(path, "/") == 0)
2494                 return;
2495
2496         /* Update the network details based on scan BSS data */
2497         network = g_hash_table_lookup(interface->bss_mapping, path);
2498         if (network)
2499                 callback_network_added(network);
2500 }
2501
2502 static void scan_bss_data(const char *key, DBusMessageIter *iter,
2503                                 void *user_data)
2504 {
2505         GSupplicantInterface *interface = user_data;
2506
2507         if (iter)
2508                 supplicant_dbus_array_foreach(iter, scan_network_update,
2509                                                 interface);
2510
2511         if (interface->scan_callback)
2512                 interface->scan_callback(0, interface, interface->scan_data);
2513
2514         interface->scan_callback = NULL;
2515         interface->scan_data = NULL;
2516 }
2517
2518 static GSupplicantInterface *interface_alloc(const char *path)
2519 {
2520         GSupplicantInterface *interface;
2521
2522         interface = g_try_new0(GSupplicantInterface, 1);
2523         if (!interface)
2524                 return NULL;
2525
2526         interface->path = g_strdup(path);
2527
2528         interface->network_table = g_hash_table_new_full(g_str_hash,
2529                                         g_str_equal, NULL, remove_network);
2530         interface->peer_table = g_hash_table_new_full(g_str_hash,
2531                                         g_str_equal, NULL, remove_peer);
2532         interface->group_table = g_hash_table_new_full(g_str_hash,
2533                                         g_str_equal, NULL, remove_group);
2534         interface->bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
2535                                                                 NULL, NULL);
2536
2537         g_hash_table_replace(interface_table, interface->path, interface);
2538
2539         return interface;
2540 }
2541
2542 static void interface_added(DBusMessageIter *iter, void *user_data)
2543 {
2544         GSupplicantInterface *interface;
2545         const char *path = NULL;
2546         bool properties_appended = GPOINTER_TO_UINT(user_data);
2547
2548         SUPPLICANT_DBG("");
2549
2550         dbus_message_iter_get_basic(iter, &path);
2551         if (!path)
2552                 return;
2553
2554         if (g_strcmp0(path, "/") == 0)
2555                 return;
2556
2557         interface = g_hash_table_lookup(interface_table, path);
2558         if (interface)
2559                 return;
2560
2561         interface = interface_alloc(path);
2562         if (!interface)
2563                 return;
2564
2565         if (!properties_appended) {
2566                 supplicant_dbus_property_get_all(path,
2567                                                 SUPPLICANT_INTERFACE ".Interface",
2568                                                 interface_property, interface,
2569                                                 interface);
2570                 return;
2571         }
2572
2573         dbus_message_iter_next(iter);
2574         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
2575                 supplicant_dbus_property_foreach(iter, interface_property,
2576                                                                 interface);
2577                 interface_property(NULL, NULL, interface);
2578         }
2579 }
2580
2581 static void interface_removed(DBusMessageIter *iter, void *user_data)
2582 {
2583         const char *path = NULL;
2584         GSupplicantInterface *interface = user_data;
2585
2586         dbus_message_iter_get_basic(iter, &path);
2587         if (!path)
2588                 return;
2589
2590         interface = g_hash_table_lookup(interface_table, path);
2591         g_supplicant_interface_cancel(interface);
2592
2593         g_hash_table_remove(interface_table, path);
2594 }
2595
2596 static void eap_method(DBusMessageIter *iter, void *user_data)
2597 {
2598         const char *str = NULL;
2599         int i;
2600
2601         dbus_message_iter_get_basic(iter, &str);
2602         if (!str)
2603                 return;
2604
2605         for (i = 0; eap_method_map[i].str; i++)
2606                 if (strcmp(str, eap_method_map[i].str) == 0) {
2607                         eap_methods |= eap_method_map[i].val;
2608                         break;
2609                 }
2610 }
2611
2612 static void service_property(const char *key, DBusMessageIter *iter,
2613                                                         void *user_data)
2614 {
2615         if (!key) {
2616                 callback_system_ready();
2617                 return;
2618         }
2619
2620         if (g_strcmp0(key, "DebugLevel") == 0) {
2621                 const char *str = NULL;
2622                 int i;
2623
2624                 dbus_message_iter_get_basic(iter, &str);
2625                 for (i = 0; debug_strings[i]; i++)
2626                         if (g_strcmp0(debug_strings[i], str) == 0) {
2627                                 debug_level = i;
2628                                 break;
2629                         }
2630                 SUPPLICANT_DBG("Debug level %d", debug_level);
2631         } else if (g_strcmp0(key, "DebugTimestamp") == 0) {
2632                 dbus_message_iter_get_basic(iter, &debug_timestamp);
2633                 SUPPLICANT_DBG("Debug timestamp %u", debug_timestamp);
2634         } else if (g_strcmp0(key, "DebugShowKeys") == 0) {
2635                 dbus_message_iter_get_basic(iter, &debug_showkeys);
2636                 SUPPLICANT_DBG("Debug show keys %u", debug_showkeys);
2637         } else if (g_strcmp0(key, "Interfaces") == 0) {
2638                 supplicant_dbus_array_foreach(iter, interface_added, NULL);
2639         } else if (g_strcmp0(key, "EapMethods") == 0) {
2640                 supplicant_dbus_array_foreach(iter, eap_method, NULL);
2641                 debug_strvalmap("EAP method", eap_method_map, eap_methods);
2642         } else if (g_strcmp0(key, "Country") == 0) {
2643                 const char *country = NULL;
2644
2645                 dbus_message_iter_get_basic(iter, &country);
2646                 SUPPLICANT_DBG("Country %s", country);
2647         } else
2648                 SUPPLICANT_DBG("key %s type %c",
2649                                 key, dbus_message_iter_get_arg_type(iter));
2650 }
2651
2652 static void signal_name_owner_changed(const char *path, DBusMessageIter *iter)
2653 {
2654         const char *name = NULL, *old = NULL, *new = NULL;
2655
2656         SUPPLICANT_DBG("");
2657
2658         if (g_strcmp0(path, DBUS_PATH_DBUS) != 0)
2659                 return;
2660
2661         dbus_message_iter_get_basic(iter, &name);
2662         if (!name)
2663                 return;
2664
2665         if (g_strcmp0(name, SUPPLICANT_SERVICE) != 0)
2666                 return;
2667
2668         dbus_message_iter_next(iter);
2669         dbus_message_iter_get_basic(iter, &old);
2670         dbus_message_iter_next(iter);
2671         dbus_message_iter_get_basic(iter, &new);
2672
2673         if (!old || !new)
2674                 return;
2675
2676         if (strlen(old) > 0 && strlen(new) == 0) {
2677                 system_available = FALSE;
2678                 g_hash_table_remove_all(bss_mapping);
2679                 g_hash_table_remove_all(peer_mapping);
2680                 g_hash_table_remove_all(group_mapping);
2681                 g_hash_table_remove_all(config_file_table);
2682                 g_hash_table_remove_all(interface_table);
2683                 callback_system_killed();
2684         }
2685
2686         if (strlen(new) > 0 && strlen(old) == 0) {
2687                 system_available = TRUE;
2688                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
2689                                                 SUPPLICANT_INTERFACE,
2690                                                 service_property, NULL, NULL);
2691         }
2692 }
2693
2694 static void signal_properties_changed(const char *path, DBusMessageIter *iter)
2695 {
2696         SUPPLICANT_DBG("");
2697
2698         if (g_strcmp0(path, SUPPLICANT_PATH) != 0)
2699                 return;
2700
2701         supplicant_dbus_property_foreach(iter, service_property, NULL);
2702 }
2703
2704 static void signal_interface_added(const char *path, DBusMessageIter *iter)
2705 {
2706         SUPPLICANT_DBG("path %s %s", path, SUPPLICANT_PATH);
2707
2708         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
2709                 interface_added(iter, GUINT_TO_POINTER(true));
2710 }
2711
2712 static void signal_interface_removed(const char *path, DBusMessageIter *iter)
2713 {
2714         SUPPLICANT_DBG("");
2715
2716         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
2717                 interface_removed(iter, NULL);
2718 }
2719
2720 static void signal_interface_changed(const char *path, DBusMessageIter *iter)
2721 {
2722         GSupplicantInterface *interface;
2723
2724         SUPPLICANT_DBG("");
2725
2726         interface = g_hash_table_lookup(interface_table, path);
2727         if (!interface)
2728                 return;
2729
2730         supplicant_dbus_property_foreach(iter, interface_property, interface);
2731 }
2732
2733 static void signal_scan_done(const char *path, DBusMessageIter *iter)
2734 {
2735         GSupplicantInterface *interface;
2736         dbus_bool_t success = FALSE;
2737
2738         SUPPLICANT_DBG("");
2739
2740         interface = g_hash_table_lookup(interface_table, path);
2741         if (!interface)
2742                 return;
2743
2744         dbus_message_iter_get_basic(iter, &success);
2745
2746         if (interface->scanning) {
2747                 callback_scan_finished(interface);
2748                 interface->scanning = FALSE;
2749         }
2750
2751         /*
2752          * If scan is unsuccessful return -EIO else get the scanned BSSs
2753          * and update the network details accordingly
2754          */
2755         if (!success) {
2756                 if (interface->scan_callback)
2757                         interface->scan_callback(-EIO, interface,
2758                                                 interface->scan_data);
2759
2760                 interface->scan_callback = NULL;
2761                 interface->scan_data = NULL;
2762
2763                 return;
2764         }
2765
2766         supplicant_dbus_property_get(path, SUPPLICANT_INTERFACE ".Interface",
2767                                 "BSSs", scan_bss_data, interface, interface);
2768 }
2769
2770 static void signal_bss_added(const char *path, DBusMessageIter *iter)
2771 {
2772         GSupplicantInterface *interface;
2773
2774         SUPPLICANT_DBG("");
2775
2776         interface = g_hash_table_lookup(interface_table, path);
2777         if (!interface)
2778                 return;
2779
2780         interface_bss_added_with_keys(iter, interface);
2781 }
2782
2783 static void signal_bss_removed(const char *path, DBusMessageIter *iter)
2784 {
2785         GSupplicantInterface *interface;
2786
2787         SUPPLICANT_DBG("");
2788
2789         interface = g_hash_table_lookup(interface_table, path);
2790         if (!interface)
2791                 return;
2792
2793         interface_bss_removed(iter, interface);
2794 }
2795
2796 static void signal_network_added(const char *path, DBusMessageIter *iter)
2797 {
2798         GSupplicantInterface *interface;
2799
2800         SUPPLICANT_DBG("");
2801
2802         interface = g_hash_table_lookup(interface_table, path);
2803         if (!interface)
2804                 return;
2805
2806         interface_network_added(iter, interface);
2807 }
2808
2809 static void signal_network_removed(const char *path, DBusMessageIter *iter)
2810 {
2811         GSupplicantInterface *interface;
2812
2813         SUPPLICANT_DBG("");
2814
2815         interface = g_hash_table_lookup(interface_table, path);
2816         if (!interface)
2817                 return;
2818
2819         interface_network_removed(iter, interface);
2820 }
2821
2822 static void signal_sta_authorized(const char *path, DBusMessageIter *iter)
2823 {
2824         GSupplicantInterface *interface;
2825         const char *addr = NULL;
2826
2827         SUPPLICANT_DBG("");
2828
2829         interface = g_hash_table_lookup(interface_table, path);
2830         if (!interface)
2831                 return;
2832
2833         dbus_message_iter_get_basic(iter, &addr);
2834         if (!addr)
2835                 return;
2836
2837         callback_sta_authorized(interface, addr);
2838 }
2839
2840 static void signal_sta_deauthorized(const char *path, DBusMessageIter *iter)
2841 {
2842         GSupplicantInterface *interface;
2843         const char *addr = NULL;
2844
2845         SUPPLICANT_DBG("");
2846
2847         interface = g_hash_table_lookup(interface_table, path);
2848         if (!interface)
2849                 return;
2850
2851         dbus_message_iter_get_basic(iter, &addr);
2852         if (!addr)
2853                 return;
2854
2855         callback_sta_deauthorized(interface, addr);
2856 }
2857
2858 static void signal_bss_changed(const char *path, DBusMessageIter *iter)
2859 {
2860         GSupplicantInterface *interface;
2861         GSupplicantNetwork *network;
2862         GSupplicantSecurity old_security;
2863         unsigned int old_wps_capabilities;
2864         struct g_supplicant_bss *bss;
2865
2866         SUPPLICANT_DBG("");
2867
2868         interface = g_hash_table_lookup(bss_mapping, path);
2869         if (!interface)
2870                 return;
2871
2872         network = g_hash_table_lookup(interface->bss_mapping, path);
2873         if (!network)
2874                 return;
2875
2876         bss = g_hash_table_lookup(network->bss_table, path);
2877         if (!bss)
2878                 return;
2879
2880         supplicant_dbus_property_foreach(iter, bss_property, bss);
2881
2882         old_security = network->security;
2883         bss_compute_security(bss);
2884
2885         if (old_security != bss->security) {
2886                 struct g_supplicant_bss *new_bss;
2887
2888                 SUPPLICANT_DBG("New network security for %s with path %s",
2889                                bss->ssid, bss->path);
2890
2891                 /*
2892                  * Security change policy:
2893                  * - We first copy the current bss into a new one with
2894                  *   its own pointer (path)
2895                  * - Clear the old bss pointer and remove the network completely
2896                  *   if there are no more BSSs in the bss table.
2897                  * - The new bss will be added either to an existing network
2898                  *   or an additional network will be created
2899                  */
2900
2901                 new_bss = g_try_new0(struct g_supplicant_bss, 1);
2902                 if (!new_bss)
2903                         return;
2904
2905                 memcpy(new_bss, bss, sizeof(struct g_supplicant_bss));
2906                 new_bss->path = g_strdup(bss->path);
2907
2908                 if (network->best_bss == bss) {
2909                         network->best_bss = NULL;
2910                         network->signal = BSS_UNKNOWN_STRENGTH;
2911                 }
2912
2913                 g_hash_table_remove(bss_mapping, path);
2914
2915                 g_hash_table_remove(interface->bss_mapping, path);
2916                 g_hash_table_remove(network->bss_table, path);
2917
2918                 update_network_signal(network);
2919
2920                 if (g_hash_table_size(network->bss_table) == 0)
2921                         g_hash_table_remove(interface->network_table,
2922                                             network->group);
2923
2924                 if (add_or_replace_bss_to_network(new_bss) < 0) {
2925                         /*
2926                          * Prevent a memory leak on failure in
2927                          * add_or_replace_bss_to_network
2928                          */
2929                         SUPPLICANT_DBG("Failed to add bss %s to network table",
2930                                        new_bss->path);
2931                         g_free(new_bss->path);
2932                         g_free(new_bss);
2933                 }
2934
2935                 return;
2936         }
2937
2938         old_wps_capabilities = network->wps_capabilities;
2939
2940         if (old_wps_capabilities != bss->wps_capabilities) {
2941                 network->wps_capabilities = bss->wps_capabilities;
2942                 callback_network_changed(network, "WPSCapabilities");
2943         }
2944
2945         /* Consider only property changes of the connected BSS */
2946         if (network == interface->current_network && bss != network->best_bss)
2947                 return;
2948
2949         if (bss->signal == network->signal)
2950                 return;
2951
2952         /*
2953          * If the new signal is lower than the SSID signal, we need
2954          * to check for the new maximum.
2955          */
2956         if (bss->signal < network->signal) {
2957                 if (bss != network->best_bss)
2958                         return;
2959                 network->signal = bss->signal;
2960                 update_network_signal(network);
2961         } else {
2962                 network->signal = bss->signal;
2963                 network->best_bss = bss;
2964         }
2965
2966         SUPPLICANT_DBG("New network signal for %s %d dBm", network->ssid,
2967                         network->signal);
2968
2969         callback_network_changed(network, "Signal");
2970 }
2971
2972 static void wps_credentials(const char *key, DBusMessageIter *iter,
2973                         void *user_data)
2974 {
2975         GSupplicantInterface *interface = user_data;
2976
2977         if (!key)
2978                 return;
2979
2980         SUPPLICANT_DBG("key %s", key);
2981
2982         if (g_strcmp0(key, "Key") == 0) {
2983                 DBusMessageIter array;
2984                 unsigned char *key_val;
2985                 int key_len;
2986
2987                 dbus_message_iter_recurse(iter, &array);
2988                 dbus_message_iter_get_fixed_array(&array, &key_val, &key_len);
2989
2990                 g_free(interface->wps_cred.key);
2991                 interface->wps_cred.key = g_try_malloc0(
2992                                                 sizeof(char) * key_len + 1);
2993
2994                 if (!interface->wps_cred.key)
2995                         return;
2996
2997                 memcpy(interface->wps_cred.key, key_val,
2998                                                 sizeof(char) * key_len);
2999
3000                 SUPPLICANT_DBG("WPS key present");
3001         } else if (g_strcmp0(key, "SSID") == 0) {
3002                 DBusMessageIter array;
3003                 unsigned char *ssid;
3004                 int ssid_len;
3005
3006                 dbus_message_iter_recurse(iter, &array);
3007                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
3008
3009                 if (ssid_len > 0 && ssid_len < 33) {
3010                         memcpy(interface->wps_cred.ssid, ssid, ssid_len);
3011                         interface->wps_cred.ssid_len = ssid_len;
3012                 } else {
3013                         memset(interface->wps_cred.ssid, 0, 32);
3014                         interface->wps_cred.ssid_len = 0;
3015                 }
3016         }
3017 }
3018
3019 static void signal_wps_credentials(const char *path, DBusMessageIter *iter)
3020 {
3021         GSupplicantInterface *interface;
3022
3023         SUPPLICANT_DBG("");
3024
3025         interface = g_hash_table_lookup(interface_table, path);
3026         if (!interface)
3027                 return;
3028
3029         supplicant_dbus_property_foreach(iter, wps_credentials, interface);
3030 }
3031
3032 static void wps_event_args(const char *key, DBusMessageIter *iter,
3033                         void *user_data)
3034 {
3035         GSupplicantInterface *interface = user_data;
3036
3037         if (!key || !interface)
3038                 return;
3039
3040         SUPPLICANT_DBG("Arg Key %s", key);
3041 }
3042
3043 static void signal_wps_event(const char *path, DBusMessageIter *iter)
3044 {
3045         GSupplicantInterface *interface;
3046         const char *name = NULL;
3047
3048         SUPPLICANT_DBG("");
3049
3050         interface = g_hash_table_lookup(interface_table, path);
3051         if (!interface)
3052                 return;
3053
3054         dbus_message_iter_get_basic(iter, &name);
3055
3056         SUPPLICANT_DBG("Name: %s", name);
3057
3058         if (g_strcmp0(name, "success") == 0)
3059                 interface->wps_state = G_SUPPLICANT_WPS_STATE_SUCCESS;
3060         else if (g_strcmp0(name, "fail") == 0)
3061                 interface->wps_state = G_SUPPLICANT_WPS_STATE_FAIL;
3062         else
3063                 interface->wps_state = G_SUPPLICANT_WPS_STATE_UNKNOWN;
3064
3065         if (!dbus_message_iter_has_next(iter))
3066                 return;
3067
3068         dbus_message_iter_next(iter);
3069
3070         supplicant_dbus_property_foreach(iter, wps_event_args, interface);
3071 }
3072
3073 static void create_peer_identifier(GSupplicantPeer *peer)
3074 {
3075         const unsigned char test[ETH_ALEN] = {};
3076
3077         if (!peer)
3078                 return;
3079
3080         if (!memcmp(peer->device_address, test, ETH_ALEN)) {
3081                 peer->identifier = g_strdup(peer->name);
3082                 return;
3083         }
3084
3085         peer->identifier = g_malloc0(19);
3086         snprintf(peer->identifier, 19, "%02x%02x%02x%02x%02x%02x",
3087                                                 peer->device_address[0],
3088                                                 peer->device_address[1],
3089                                                 peer->device_address[2],
3090                                                 peer->device_address[3],
3091                                                 peer->device_address[4],
3092                                                 peer->device_address[5]);
3093 }
3094
3095 struct peer_property_data {
3096         GSupplicantPeer *peer;
3097         GSList *old_groups;
3098         bool groups_changed;
3099         bool services_changed;
3100 };
3101
3102 static void peer_groups_relation(DBusMessageIter *iter, void *user_data)
3103 {
3104         struct peer_property_data *data = user_data;
3105         GSupplicantPeer *peer = data->peer;
3106         GSupplicantGroup *group;
3107         const char *str = NULL;
3108         GSList *elem;
3109
3110         dbus_message_iter_get_basic(iter, &str);
3111         if (!str)
3112                 return;
3113
3114         group = g_hash_table_lookup(group_mapping, str);
3115         if (!group)
3116                 return;
3117
3118         elem = g_slist_find_custom(data->old_groups, str, (GCompareFunc)g_strcmp0);
3119         if (elem) {
3120                 data->old_groups = g_slist_remove_link(data->old_groups, elem);
3121                 peer->groups = g_slist_concat(elem, peer->groups);
3122         } else {
3123                 peer->groups = g_slist_prepend(peer->groups, g_strdup(str));
3124                 data->groups_changed = true;
3125         }
3126 }
3127
3128 static void peer_property(const char *key, DBusMessageIter *iter,
3129                                                         void *user_data)
3130 {
3131         GSupplicantPeer *pending_peer;
3132         struct peer_property_data *data = user_data;
3133         GSupplicantPeer *peer = data->peer;
3134
3135         SUPPLICANT_DBG("key: %s", key);
3136
3137         if (!peer->interface)
3138                 return;
3139
3140         if (!key) {
3141                 if (peer->name) {
3142                         create_peer_identifier(peer);
3143                         callback_peer_found(peer);
3144                         pending_peer = g_hash_table_lookup(
3145                                         pending_peer_connection, peer->path);
3146
3147                         if (pending_peer && pending_peer == peer) {
3148                                 callback_peer_request(peer);
3149                                 g_hash_table_remove(pending_peer_connection,
3150                                                 peer->path);
3151                         }
3152
3153                         dbus_free(data);
3154                 }
3155
3156                 return;
3157         }
3158
3159         if (g_strcmp0(key, "DeviceAddress") == 0) {
3160                 unsigned char *dev_addr;
3161                 DBusMessageIter array;
3162                 int len;
3163
3164                 dbus_message_iter_recurse(iter, &array);
3165                 dbus_message_iter_get_fixed_array(&array, &dev_addr, &len);
3166
3167                 if (len == ETH_ALEN)
3168                         memcpy(peer->device_address, dev_addr, len);
3169         } else if (g_strcmp0(key, "DeviceName") == 0) {
3170                 const char *str = NULL;
3171
3172                 dbus_message_iter_get_basic(iter, &str);
3173                 if (str)
3174                         peer->name = g_strdup(str);
3175         } else if (g_strcmp0(key, "config_method") == 0) {
3176                 uint16_t wps_config;
3177
3178                 dbus_message_iter_get_basic(iter, &wps_config);
3179
3180                 if (wps_config & G_SUPPLICANT_WPS_CONFIG_PBC)
3181                         peer->wps_capabilities |= G_SUPPLICANT_WPS_PBC;
3182                 if (wps_config & ~G_SUPPLICANT_WPS_CONFIG_PBC)
3183                         peer->wps_capabilities |= G_SUPPLICANT_WPS_PIN;
3184         } else if (g_strcmp0(key, "Groups") == 0) {
3185                 data->old_groups = peer->groups;
3186                 peer->groups = NULL;
3187
3188                 supplicant_dbus_array_foreach(iter,
3189                                                 peer_groups_relation, data);
3190                 if (g_slist_length(data->old_groups) > 0) {
3191                         g_slist_free_full(data->old_groups, g_free);
3192                         data->groups_changed = true;
3193                 }
3194         } else if (g_strcmp0(key, "IEs") == 0) {
3195                 DBusMessageIter array;
3196                 unsigned char *ie;
3197                 int ie_len;
3198
3199                 dbus_message_iter_recurse(iter, &array);
3200                 dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
3201
3202                 if (!ie || ie_len < 2)
3203                         return;
3204
3205                 if (peer->widi_ies) {
3206                         if (memcmp(peer->widi_ies, ie, ie_len) == 0)
3207                                 return;
3208
3209                         g_free(peer->widi_ies);
3210                         peer->widi_ies_length = 0;
3211                 }
3212
3213                 peer->widi_ies = g_malloc0(ie_len * sizeof(unsigned char));
3214
3215                 memcpy(peer->widi_ies, ie, ie_len);
3216                 peer->widi_ies_length = ie_len;
3217                 data->services_changed = true;
3218         }
3219 }
3220
3221 static void signal_peer_found(const char *path, DBusMessageIter *iter)
3222 {
3223         struct peer_property_data *property_data;
3224         GSupplicantInterface *interface;
3225         const char *obj_path = NULL;
3226         GSupplicantPeer *peer;
3227
3228         SUPPLICANT_DBG("");
3229
3230         interface = g_hash_table_lookup(interface_table, path);
3231         if (!interface)
3232                 return;
3233
3234         dbus_message_iter_get_basic(iter, &obj_path);
3235         if (!obj_path || g_strcmp0(obj_path, "/") == 0)
3236                 return;
3237
3238         peer = g_hash_table_lookup(interface->peer_table, obj_path);
3239         if (peer)
3240                 return;
3241
3242         peer = g_try_new0(GSupplicantPeer, 1);
3243         if (!peer)
3244                 return;
3245
3246         peer->interface = interface;
3247         peer->path = g_strdup(obj_path);
3248         g_hash_table_insert(interface->peer_table, peer->path, peer);
3249         g_hash_table_replace(peer_mapping, peer->path, interface);
3250
3251         property_data = dbus_malloc0(sizeof(struct peer_property_data));
3252         property_data->peer = peer;
3253
3254         dbus_message_iter_next(iter);
3255         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
3256                 supplicant_dbus_property_foreach(iter, peer_property,
3257                                                         property_data);
3258                 peer_property(NULL, NULL, property_data);
3259                 return;
3260         }
3261
3262         supplicant_dbus_property_get_all(obj_path,
3263                                         SUPPLICANT_INTERFACE ".Peer",
3264                                         peer_property, property_data, NULL);
3265 }
3266
3267 static void signal_peer_lost(const char *path, DBusMessageIter *iter)
3268 {
3269         GSupplicantInterface *interface;
3270         const char *obj_path = NULL;
3271         GSupplicantPeer *peer;
3272
3273         SUPPLICANT_DBG("");
3274
3275         interface = g_hash_table_lookup(interface_table, path);
3276         if (!interface)
3277                 return;
3278
3279         dbus_message_iter_get_basic(iter, &obj_path);
3280         if (!obj_path || g_strcmp0(obj_path, "/") == 0)
3281                 return;
3282
3283         peer = g_hash_table_lookup(interface->peer_table, obj_path);
3284         if (!peer)
3285                 return;
3286
3287         g_hash_table_remove(interface->peer_table, obj_path);
3288 }
3289
3290 static void signal_peer_changed(const char *path, DBusMessageIter *iter)
3291 {
3292         struct peer_property_data *property_data;
3293         GSupplicantInterface *interface;
3294         GSupplicantPeer *peer;
3295
3296         SUPPLICANT_DBG("");
3297
3298         interface = g_hash_table_lookup(peer_mapping, path);
3299         if (!interface)
3300                 return;
3301
3302         peer = g_hash_table_lookup(interface->peer_table, path);
3303         if (!peer) {
3304                 g_hash_table_remove(peer_mapping, path);
3305                 return;
3306         }
3307
3308         property_data = dbus_malloc0(sizeof(struct peer_property_data));
3309         property_data->peer = peer;
3310
3311         supplicant_dbus_property_foreach(iter, peer_property, property_data);
3312         if (property_data->services_changed)
3313                 callback_peer_changed(peer,
3314                                         G_SUPPLICANT_PEER_SERVICES_CHANGED);
3315
3316         if (property_data->groups_changed)
3317                 callback_peer_changed(peer, G_SUPPLICANT_PEER_GROUP_CHANGED);
3318
3319         dbus_free(property_data);
3320
3321         if (!g_supplicant_peer_is_in_a_group(peer))
3322                 peer->connection_requested = false;
3323 }
3324
3325 struct group_sig_data {
3326         const char *peer_obj_path;
3327         unsigned char iface_address[ETH_ALEN];
3328         const char *interface_obj_path;
3329         const char *group_obj_path;
3330         int role;
3331 };
3332
3333 static void group_sig_property(const char *key, DBusMessageIter *iter,
3334                                                         void *user_data)
3335 {
3336         struct group_sig_data *data = user_data;
3337
3338         if (!key)
3339                 return;
3340
3341         if (g_strcmp0(key, "peer_interface_addr") == 0) {
3342                 unsigned char *dev_addr;
3343                 DBusMessageIter array;
3344                 int len;
3345
3346                 dbus_message_iter_recurse(iter, &array);
3347                 dbus_message_iter_get_fixed_array(&array, &dev_addr, &len);
3348
3349                 if (len == ETH_ALEN)
3350                         memcpy(data->iface_address, dev_addr, len);
3351         } else if (g_strcmp0(key, "role") == 0) {
3352                 const char *str = NULL;
3353
3354                 dbus_message_iter_get_basic(iter, &str);
3355                 if (g_strcmp0(str, "GO") == 0)
3356                         data->role = G_SUPPLICANT_GROUP_ROLE_GO;
3357                 else
3358                         data->role = G_SUPPLICANT_GROUP_ROLE_CLIENT;
3359         } else if (g_strcmp0(key, "peer_object") == 0)
3360                 dbus_message_iter_get_basic(iter, &data->peer_obj_path);
3361         else if (g_strcmp0(key, "interface_object") == 0)
3362                 dbus_message_iter_get_basic(iter, &data->interface_obj_path);
3363         else if (g_strcmp0(key, "group_object") == 0)
3364                 dbus_message_iter_get_basic(iter, &data->group_obj_path);
3365
3366 }
3367
3368 static void signal_group_success(const char *path, DBusMessageIter *iter)
3369 {
3370         GSupplicantInterface *interface;
3371         struct group_sig_data data = {};
3372         GSupplicantPeer *peer;
3373
3374         SUPPLICANT_DBG("");
3375
3376         interface = g_hash_table_lookup(interface_table, path);
3377         if (!interface)
3378                 return;
3379
3380         supplicant_dbus_property_foreach(iter, group_sig_property, &data);
3381         if (!data.peer_obj_path)
3382                 return;
3383
3384         peer = g_hash_table_lookup(interface->peer_table, data.peer_obj_path);
3385         if (!peer)
3386                 return;
3387
3388         memcpy(peer->iface_address, data.iface_address, ETH_ALEN);
3389         interface->pending_peer_path = peer->path;
3390 }
3391
3392 static void signal_group_failure(const char *path, DBusMessageIter *iter)
3393 {
3394         GSupplicantInterface *interface;
3395         struct group_sig_data data = {};
3396         GSupplicantPeer *peer;
3397
3398         SUPPLICANT_DBG("");
3399
3400         interface = g_hash_table_lookup(interface_table, path);
3401         if (!interface)
3402                 return;
3403
3404         supplicant_dbus_property_foreach(iter, group_sig_property, &data);
3405         if (!data.peer_obj_path)
3406                 return;
3407
3408         peer = g_hash_table_lookup(interface->peer_table, data.peer_obj_path);
3409         if (!peer)
3410                 return;
3411
3412         callback_peer_changed(peer, G_SUPPLICANT_PEER_GROUP_FAILED);
3413         peer->connection_requested = false;
3414 }
3415
3416 static void signal_group_started(const char *path, DBusMessageIter *iter)
3417 {
3418         GSupplicantInterface *interface, *g_interface;
3419         struct group_sig_data data = {};
3420         GSupplicantGroup *group;
3421         GSupplicantPeer *peer;
3422
3423         SUPPLICANT_DBG("");
3424
3425         interface = g_hash_table_lookup(interface_table, path);
3426         if (!interface)
3427                 return;
3428
3429         supplicant_dbus_property_foreach(iter, group_sig_property, &data);
3430         if (!data.interface_obj_path || !data.group_obj_path)
3431                 return;
3432
3433         peer = g_hash_table_lookup(interface->peer_table,
3434                                                 interface->pending_peer_path);
3435         interface->pending_peer_path = NULL;
3436         if (!peer)
3437                 return;
3438
3439         g_interface = g_hash_table_lookup(interface_table,
3440                                                 data.interface_obj_path);
3441         if (!g_interface)
3442                 return;
3443
3444         group = g_hash_table_lookup(interface->group_table,
3445                                                 data.group_obj_path);
3446         if (group)
3447                 return;
3448
3449         group = g_try_new0(GSupplicantGroup, 1);
3450         if (!group)
3451                 return;
3452
3453         group->interface = g_interface;
3454         group->orig_interface = interface;
3455         group->path = g_strdup(data.group_obj_path);
3456         group->role = data.role;
3457
3458         g_hash_table_insert(interface->group_table, group->path, group);
3459         g_hash_table_replace(group_mapping, group->path, group);
3460
3461         peer->current_group_iface = g_interface;
3462         callback_peer_changed(peer, G_SUPPLICANT_PEER_GROUP_STARTED);
3463 }
3464
3465 static void remove_peer_group_interface(GHashTable *group_table,
3466                                 const char* path)
3467 {
3468         GSupplicantGroup *group;
3469         GHashTableIter iter;
3470         gpointer value, key;
3471
3472         if (!group_table)
3473                 return;
3474
3475         group = g_hash_table_lookup(group_table, path);
3476
3477         if (!group || !group->orig_interface)
3478                 return;
3479
3480         g_hash_table_iter_init(&iter, group->orig_interface->peer_table);
3481
3482         while (g_hash_table_iter_next(&iter, &key, &value)) {
3483                 GSupplicantPeer *peer = value;
3484
3485                 if (peer->current_group_iface == group->interface)
3486                         peer->current_group_iface = NULL;
3487         }
3488 }
3489
3490 static void signal_group_finished(const char *path, DBusMessageIter *iter)
3491 {
3492         GSupplicantInterface *interface;
3493         struct group_sig_data data = {};
3494
3495         SUPPLICANT_DBG("");
3496
3497         interface = g_hash_table_lookup(interface_table, path);
3498         if (!interface)
3499                 return;
3500
3501         supplicant_dbus_property_foreach(iter, group_sig_property, &data);
3502         if (!data.interface_obj_path || !data.group_obj_path)
3503                 return;
3504
3505         remove_peer_group_interface(interface->group_table, data.group_obj_path);
3506
3507         g_hash_table_remove(group_mapping, data.group_obj_path);
3508
3509         g_hash_table_remove(interface->group_table, data.group_obj_path);
3510 }
3511
3512 static void signal_group_request(const char *path, DBusMessageIter *iter)
3513 {
3514         GSupplicantInterface *interface;
3515         GSupplicantPeer *peer;
3516         const char *obj_path;
3517
3518         SUPPLICANT_DBG("");
3519
3520         interface = g_hash_table_lookup(interface_table, path);
3521         if (!interface)
3522                 return;
3523
3524         dbus_message_iter_get_basic(iter, &obj_path);
3525         if (!obj_path || !g_strcmp0(obj_path, "/"))
3526                 return;
3527
3528         peer = g_hash_table_lookup(interface->peer_table, obj_path);
3529         if (!peer)
3530                 return;
3531
3532         /*
3533          * Peer has been previously found and property set,
3534          * otherwise, defer connection to when peer property
3535          * is set.
3536          */
3537         if (peer->identifier)
3538                 callback_peer_request(peer);
3539         else
3540                 g_hash_table_replace(pending_peer_connection, peer->path, peer);
3541 }
3542
3543 static void signal_group_peer_joined(const char *path, DBusMessageIter *iter)
3544 {
3545         const char *peer_path = NULL;
3546         GSupplicantInterface *interface;
3547         GSupplicantGroup *group;
3548         GSupplicantPeer *peer;
3549
3550         SUPPLICANT_DBG("");
3551
3552         group = g_hash_table_lookup(group_mapping, path);
3553         if (!group)
3554                 return;
3555
3556         dbus_message_iter_get_basic(iter, &peer_path);
3557         if (!peer_path)
3558                 return;
3559
3560         interface = g_hash_table_lookup(peer_mapping, peer_path);
3561         if (!interface)
3562                 return;
3563
3564         peer = g_hash_table_lookup(interface->peer_table, peer_path);
3565         if (!peer)
3566                 return;
3567
3568         group->members = g_slist_prepend(group->members, g_strdup(peer_path));
3569
3570         callback_peer_changed(peer, G_SUPPLICANT_PEER_GROUP_JOINED);
3571 }
3572
3573 static void signal_group_peer_disconnected(const char *path, DBusMessageIter *iter)
3574 {
3575         const char *peer_path = NULL;
3576         GSupplicantInterface *interface;
3577         GSupplicantGroup *group;
3578         GSupplicantPeer *peer;
3579         GSList *elem;
3580
3581         SUPPLICANT_DBG("");
3582
3583         group = g_hash_table_lookup(group_mapping, path);
3584         if (!group)
3585                 return;
3586
3587         dbus_message_iter_get_basic(iter, &peer_path);
3588         if (!peer_path)
3589                 return;
3590
3591         for (elem = group->members; elem; elem = elem->next) {
3592                 if (!g_strcmp0(elem->data, peer_path))
3593                         break;
3594         }
3595
3596         if (!elem)
3597                 return;
3598
3599         g_free(elem->data);
3600         group->members = g_slist_delete_link(group->members, elem);
3601
3602         interface = g_hash_table_lookup(peer_mapping, peer_path);
3603         if (!interface)
3604                 return;
3605
3606         peer = g_hash_table_lookup(interface->peer_table, peer_path);
3607         if (!peer)
3608                 return;
3609
3610         callback_peer_changed(peer, G_SUPPLICANT_PEER_GROUP_DISCONNECTED);
3611         peer->connection_requested = false;
3612 }
3613
3614 static struct {
3615         const char *interface;
3616         const char *member;
3617         void (*function) (const char *path, DBusMessageIter *iter);
3618 } signal_map[] = {
3619         { DBUS_INTERFACE_DBUS,  "NameOwnerChanged",  signal_name_owner_changed },
3620
3621         { SUPPLICANT_INTERFACE, "PropertiesChanged", signal_properties_changed },
3622         { SUPPLICANT_INTERFACE, "InterfaceAdded",    signal_interface_added    },
3623         { SUPPLICANT_INTERFACE, "InterfaceCreated",  signal_interface_added    },
3624         { SUPPLICANT_INTERFACE, "InterfaceRemoved",  signal_interface_removed  },
3625
3626         { SUPPLICANT_INTERFACE ".Interface", "PropertiesChanged", signal_interface_changed },
3627         { SUPPLICANT_INTERFACE ".Interface", "ScanDone",          signal_scan_done         },
3628         { SUPPLICANT_INTERFACE ".Interface", "BSSAdded",          signal_bss_added         },
3629         { SUPPLICANT_INTERFACE ".Interface", "BSSRemoved",        signal_bss_removed       },
3630         { SUPPLICANT_INTERFACE ".Interface", "NetworkAdded",      signal_network_added     },
3631         { SUPPLICANT_INTERFACE ".Interface", "NetworkRemoved",    signal_network_removed   },
3632         { SUPPLICANT_INTERFACE ".Interface", "StaAuthorized",     signal_sta_authorized    },
3633         { SUPPLICANT_INTERFACE ".Interface", "StaDeauthorized",   signal_sta_deauthorized  },
3634
3635         { SUPPLICANT_INTERFACE ".BSS", "PropertiesChanged", signal_bss_changed   },
3636
3637         { SUPPLICANT_INTERFACE ".Interface.WPS", "Credentials", signal_wps_credentials },
3638         { SUPPLICANT_INTERFACE ".Interface.WPS", "Event",       signal_wps_event       },
3639
3640         { SUPPLICANT_INTERFACE ".Interface.P2PDevice", "DeviceFound", signal_peer_found },
3641         { SUPPLICANT_INTERFACE ".Interface.P2PDevice", "DeviceLost",  signal_peer_lost  },
3642
3643         { SUPPLICANT_INTERFACE ".Peer", "PropertiesChanged", signal_peer_changed },
3644
3645         { SUPPLICANT_INTERFACE ".Interface.P2PDevice", "GONegotiationSuccess", signal_group_success },
3646         { SUPPLICANT_INTERFACE ".Interface.P2PDevice", "GONegotiationFailure", signal_group_failure },
3647         { SUPPLICANT_INTERFACE ".Interface.P2PDevice", "GroupStarted", signal_group_started },
3648         { SUPPLICANT_INTERFACE ".Interface.P2PDevice", "GroupFinished", signal_group_finished },
3649         { SUPPLICANT_INTERFACE ".Interface.P2PDevice", "GONegotiationRequest", signal_group_request },
3650
3651         { SUPPLICANT_INTERFACE ".Group", "PeerJoined", signal_group_peer_joined },
3652         { SUPPLICANT_INTERFACE ".Group", "PeerDisconnected", signal_group_peer_disconnected },
3653
3654         { }
3655 };
3656
3657 static DBusHandlerResult g_supplicant_filter(DBusConnection *conn,
3658                                         DBusMessage *message, void *data)
3659 {
3660         DBusMessageIter iter;
3661         const char *path;
3662         int i;
3663
3664         path = dbus_message_get_path(message);
3665         if (!path)
3666                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
3667
3668         if (!dbus_message_iter_init(message, &iter))
3669                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
3670
3671         for (i = 0; signal_map[i].interface; i++) {
3672                 if (!dbus_message_has_interface(message, signal_map[i].interface))
3673                         continue;
3674
3675                 if (!dbus_message_has_member(message, signal_map[i].member))
3676                         continue;
3677
3678                 signal_map[i].function(path, &iter);
3679                 break;
3680         }
3681
3682         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
3683 }
3684
3685 void g_supplicant_interface_cancel(GSupplicantInterface *interface)
3686 {
3687         SUPPLICANT_DBG("Cancelling any pending DBus calls");
3688         supplicant_dbus_method_call_cancel_all(interface);
3689         supplicant_dbus_property_call_cancel_all(interface);
3690 }
3691
3692 struct supplicant_regdom {
3693         GSupplicantCountryCallback callback;
3694         const char *alpha2;
3695         const void *user_data;
3696 };
3697
3698 static void country_result(const char *error,
3699                                 DBusMessageIter *iter, void *user_data)
3700 {
3701         struct supplicant_regdom *regdom = user_data;
3702         int result = 0;
3703
3704         SUPPLICANT_DBG("Country setting result");
3705
3706         if (!user_data)
3707                 return;
3708
3709         if (error) {
3710                 SUPPLICANT_DBG("Country setting failure %s", error);
3711                 result = -EINVAL;
3712         }
3713
3714         if (regdom->callback)
3715                 regdom->callback(result, regdom->alpha2,
3716                                         (void *) regdom->user_data);
3717
3718         g_free(regdom);
3719 }
3720
3721 static void country_params(DBusMessageIter *iter, void *user_data)
3722 {
3723         struct supplicant_regdom *regdom = user_data;
3724
3725         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING,
3726                                                         &regdom->alpha2);
3727 }
3728
3729 int g_supplicant_set_country(const char *alpha2,
3730                                 GSupplicantCountryCallback callback,
3731                                         const void *user_data)
3732 {
3733         struct supplicant_regdom *regdom;
3734         int ret;
3735
3736         SUPPLICANT_DBG("Country setting %s", alpha2);
3737
3738         if (!system_available)
3739                 return -EFAULT;
3740
3741         regdom = dbus_malloc0(sizeof(*regdom));
3742         if (!regdom)
3743                 return -ENOMEM;
3744
3745         regdom->callback = callback;
3746         regdom->alpha2 = alpha2;
3747         regdom->user_data = user_data;
3748
3749         ret =  supplicant_dbus_property_set(SUPPLICANT_PATH, SUPPLICANT_INTERFACE,
3750                                         "Country", DBUS_TYPE_STRING_AS_STRING,
3751                                         country_params, country_result,
3752                                         regdom, NULL);
3753         if (ret < 0) {
3754                 dbus_free(regdom);
3755                 SUPPLICANT_DBG("Unable to set Country configuration");
3756         }
3757         return ret;
3758 }
3759
3760 int g_supplicant_interface_set_country(GSupplicantInterface *interface,
3761                                         GSupplicantCountryCallback callback,
3762                                                         const char *alpha2,
3763                                                         void *user_data)
3764 {
3765         struct supplicant_regdom *regdom;
3766         int ret;
3767
3768         regdom = dbus_malloc0(sizeof(*regdom));
3769         if (!regdom)
3770                 return -ENOMEM;
3771
3772         regdom->callback = callback;
3773         regdom->alpha2 = alpha2;
3774         regdom->user_data = user_data;
3775
3776         ret =  supplicant_dbus_property_set(interface->path,
3777                                 SUPPLICANT_INTERFACE ".Interface",
3778                                 "Country", DBUS_TYPE_STRING_AS_STRING,
3779                                 country_params, country_result,
3780                                         regdom, NULL);
3781         if (ret < 0) {
3782                 dbus_free(regdom);
3783                 SUPPLICANT_DBG("Unable to set Country configuration");
3784         }
3785
3786         return ret;
3787 }
3788
3789 bool g_supplicant_interface_has_p2p(GSupplicantInterface *interface)
3790 {
3791         if (!interface)
3792                 return false;
3793
3794         return interface->p2p_support;
3795 }
3796
3797 struct supplicant_p2p_dev_config {
3798         char *device_name;
3799         char *dev_type;
3800 };
3801
3802 static void p2p_device_config_result(const char *error,
3803                                         DBusMessageIter *iter, void *user_data)
3804 {
3805         struct supplicant_p2p_dev_config *config = user_data;
3806
3807         if (error)
3808                 SUPPLICANT_DBG("Unable to set P2P Device configuration: %s",
3809                                                                         error);
3810
3811         g_free(config->device_name);
3812         g_free(config->dev_type);
3813         dbus_free(config);
3814 }
3815
3816 static int dev_type_str2bin(const char *type, unsigned char dev_type[8])
3817 {
3818         int length, pos, end;
3819         char b[3] = {};
3820         char *e = NULL;
3821
3822         end = strlen(type);
3823         for (length = pos = 0; type[pos] != '\0' && length < 8; length++) {
3824                 if (pos+2 > end)
3825                         return 0;
3826
3827                 b[0] = type[pos];
3828                 b[1] = type[pos+1];
3829
3830                 dev_type[length] = strtol(b, &e, 16);
3831                 if (e && *e != '\0')
3832                         return 0;
3833
3834                 pos += 2;
3835         }
3836
3837         return 8;
3838 }
3839
3840 static void p2p_device_config_params(DBusMessageIter *iter, void *user_data)
3841 {
3842         struct supplicant_p2p_dev_config *config = user_data;
3843         DBusMessageIter dict;
3844
3845         supplicant_dbus_dict_open(iter, &dict);
3846
3847         supplicant_dbus_dict_append_basic(&dict, "DeviceName",
3848                                 DBUS_TYPE_STRING, &config->device_name);
3849
3850         if (config->dev_type) {
3851                 unsigned char dev_type[8] = {}, *type;
3852                 int len;
3853
3854                 len = dev_type_str2bin(config->dev_type, dev_type);
3855                 if (len) {
3856                         type = dev_type;
3857                         supplicant_dbus_dict_append_fixed_array(&dict,
3858                                         "PrimaryDeviceType",
3859                                         DBUS_TYPE_BYTE, &type, len);
3860                 }
3861         }
3862
3863         supplicant_dbus_dict_close(iter, &dict);
3864 }
3865
3866 int g_supplicant_interface_set_p2p_device_config(GSupplicantInterface *interface,
3867                                         const char *device_name,
3868                                         const char *primary_dev_type)
3869 {
3870         struct supplicant_p2p_dev_config *config;
3871         int ret;
3872
3873         SUPPLICANT_DBG("P2P Device settings %s/%s",
3874                                         device_name, primary_dev_type);
3875
3876         config = dbus_malloc0(sizeof(*config));
3877         if (!config)
3878                 return -ENOMEM;
3879
3880         config->device_name = g_strdup(device_name);
3881         config->dev_type = g_strdup(primary_dev_type);
3882
3883         ret = supplicant_dbus_property_set(interface->path,
3884                                 SUPPLICANT_INTERFACE ".Interface.P2PDevice",
3885                                 "P2PDeviceConfig",
3886                                 DBUS_TYPE_ARRAY_AS_STRING
3887                                 DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING
3888                                 DBUS_TYPE_STRING_AS_STRING
3889                                 DBUS_TYPE_VARIANT_AS_STRING
3890                                 DBUS_DICT_ENTRY_END_CHAR_AS_STRING,
3891                                 p2p_device_config_params,
3892                                 p2p_device_config_result, config, NULL);
3893         if (ret < 0) {
3894                 g_free(config->device_name);
3895                 g_free(config->dev_type);
3896                 dbus_free(config);
3897                 SUPPLICANT_DBG("Unable to set P2P Device configuration");
3898         }
3899
3900         return ret;
3901 }
3902
3903 static gboolean peer_lookup_by_identifier(gpointer key, gpointer value,
3904                                                         gpointer user_data)
3905 {
3906         const GSupplicantPeer *peer = value;
3907         const char *identifier = user_data;
3908
3909         if (!g_strcmp0(identifier, peer->identifier))
3910                 return TRUE;
3911
3912         return FALSE;
3913 }
3914
3915 GSupplicantPeer *g_supplicant_interface_peer_lookup(GSupplicantInterface *interface,
3916                                                         const char *identifier)
3917 {
3918         GSupplicantPeer *peer;
3919
3920         peer = g_hash_table_find(interface->peer_table,
3921                                         peer_lookup_by_identifier,
3922                                         (void *) identifier);
3923         return peer;
3924 }
3925
3926 static void interface_create_data_free(struct interface_create_data *data)
3927 {
3928         g_free(data->ifname);
3929         g_free(data->driver);
3930         g_free(data->bridge);
3931         dbus_free(data);
3932 }
3933
3934 static bool interface_exists(GSupplicantInterface *interface,
3935                                 const char *path)
3936 {
3937         GSupplicantInterface *tmp;
3938
3939         tmp = g_hash_table_lookup(interface_table, path);
3940         if (tmp && tmp == interface)
3941                 return true;
3942
3943         return false;
3944 }
3945
3946 static void interface_create_property(const char *key, DBusMessageIter *iter,
3947                                                         void *user_data)
3948 {
3949         struct interface_create_data *data = user_data;
3950         GSupplicantInterface *interface = data->interface;
3951
3952         if (!key) {
3953                 if (data->callback) {
3954                         data->callback(0, data->interface, data->user_data);
3955                         callback_p2p_support(interface);
3956                 }
3957
3958                 interface_create_data_free(data);
3959         }
3960
3961         interface_property(key, iter, interface);
3962 }
3963
3964 static void interface_create_result(const char *error,
3965                                 DBusMessageIter *iter, void *user_data)
3966 {
3967         struct interface_create_data *data = user_data;
3968         const char *path = NULL;
3969         int err;
3970
3971         SUPPLICANT_DBG("");
3972
3973         if (error) {
3974                 g_warning("error %s", error);
3975                 err = -EIO;
3976                 goto done;
3977         }
3978
3979         dbus_message_iter_get_basic(iter, &path);
3980         if (!path) {
3981                 err = -EINVAL;
3982                 goto done;
3983         }
3984
3985         if (!system_available) {
3986                 err = -EFAULT;
3987                 goto done;
3988         }
3989
3990         data->interface = g_hash_table_lookup(interface_table, path);
3991         if (!data->interface) {
3992                 data->interface = interface_alloc(path);
3993                 if (!data->interface) {
3994                         err = -ENOMEM;
3995                         goto done;
3996                 }
3997         }
3998
3999         err = supplicant_dbus_property_get_all(path,
4000                                         SUPPLICANT_INTERFACE ".Interface",
4001                                         interface_create_property, data,
4002                                         NULL);
4003         if (err == 0)
4004                 return;
4005
4006 done:
4007         if (data->callback)
4008                 data->callback(err, NULL, data->user_data);
4009
4010         interface_create_data_free(data);
4011 }
4012
4013 static void interface_create_params(DBusMessageIter *iter, void *user_data)
4014 {
4015         struct interface_create_data *data = user_data;
4016         DBusMessageIter dict;
4017         char *config_file = NULL;
4018
4019         SUPPLICANT_DBG("");
4020
4021         supplicant_dbus_dict_open(iter, &dict);
4022
4023         supplicant_dbus_dict_append_basic(&dict, "Ifname",
4024                                         DBUS_TYPE_STRING, &data->ifname);
4025
4026         if (data->driver)
4027                 supplicant_dbus_dict_append_basic(&dict, "Driver",
4028                                         DBUS_TYPE_STRING, &data->driver);
4029
4030         if (data->bridge)
4031                 supplicant_dbus_dict_append_basic(&dict, "BridgeIfname",
4032                                         DBUS_TYPE_STRING, &data->bridge);
4033
4034         config_file = g_hash_table_lookup(config_file_table, data->ifname);
4035         if (config_file) {
4036                 SUPPLICANT_DBG("[%s] ConfigFile %s", data->ifname, config_file);
4037
4038                 supplicant_dbus_dict_append_basic(&dict, "ConfigFile",
4039                                         DBUS_TYPE_STRING, &config_file);
4040         }
4041
4042         supplicant_dbus_dict_close(iter, &dict);
4043 }
4044
4045 static void interface_get_result(const char *error,
4046                                 DBusMessageIter *iter, void *user_data)
4047 {
4048         struct interface_create_data *data = user_data;
4049         GSupplicantInterface *interface;
4050         const char *path = NULL;
4051         int err;
4052
4053         SUPPLICANT_DBG("");
4054
4055         if (error) {
4056                 SUPPLICANT_DBG("Interface not created yet");
4057                 goto create;
4058         }
4059
4060         dbus_message_iter_get_basic(iter, &path);
4061         if (!path) {
4062                 err = -EINVAL;
4063                 goto done;
4064         }
4065
4066         interface = g_hash_table_lookup(interface_table, path);
4067         if (!interface) {
4068                 err = -ENOENT;
4069                 goto done;
4070         }
4071
4072         if (data->callback) {
4073                 data->callback(0, interface, data->user_data);
4074                 callback_p2p_support(interface);
4075         }
4076
4077         interface_create_data_free(data);
4078
4079         return;
4080
4081 create:
4082         if (!system_available) {
4083                 err = -EFAULT;
4084                 goto done;
4085         }
4086
4087         SUPPLICANT_DBG("Creating interface");
4088
4089         err = supplicant_dbus_method_call(SUPPLICANT_PATH,
4090                                                 SUPPLICANT_INTERFACE,
4091                                                 "CreateInterface",
4092                                                 interface_create_params,
4093                                                 interface_create_result, data,
4094                                                 NULL);
4095         if (err == 0)
4096                 return;
4097
4098 done:
4099         if (data->callback)
4100                 data->callback(err, NULL, data->user_data);
4101
4102         interface_create_data_free(data);
4103 }
4104
4105 static void interface_get_params(DBusMessageIter *iter, void *user_data)
4106 {
4107         struct interface_create_data *data = user_data;
4108
4109         SUPPLICANT_DBG("");
4110
4111         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &data->ifname);
4112 }
4113
4114 int g_supplicant_interface_create(const char *ifname, const char *driver,
4115                                         const char *bridge,
4116                                         GSupplicantInterfaceCallback callback,
4117                                                         void *user_data)
4118 {
4119         struct interface_create_data *data;
4120         int ret;
4121
4122         SUPPLICANT_DBG("ifname %s", ifname);
4123
4124         if (!ifname)
4125                 return -EINVAL;
4126
4127         if (!system_available)
4128                 return -EFAULT;
4129
4130         data = dbus_malloc0(sizeof(*data));
4131         if (!data)
4132                 return -ENOMEM;
4133
4134         data->ifname = g_strdup(ifname);
4135         data->driver = g_strdup(driver);
4136         data->bridge = g_strdup(bridge);
4137         data->callback = callback;
4138         data->user_data = user_data;
4139
4140         ret = supplicant_dbus_method_call(SUPPLICANT_PATH,
4141                                                 SUPPLICANT_INTERFACE,
4142                                                 "GetInterface",
4143                                                 interface_get_params,
4144                                                 interface_get_result, data,
4145                                                 NULL);
4146         if (ret < 0)
4147                 interface_create_data_free(data);
4148
4149         return ret;
4150 }
4151
4152 static void interface_remove_result(const char *error,
4153                                 DBusMessageIter *iter, void *user_data)
4154 {
4155         struct interface_data *data = user_data;
4156         int err;
4157
4158         if (error) {
4159                 err = -EIO;
4160                 SUPPLICANT_DBG("error: %s", error);
4161                 goto done;
4162         }
4163
4164         if (!system_available) {
4165                 err = -EFAULT;
4166                 goto done;
4167         }
4168
4169         /*
4170          * The gsupplicant interface is already freed by the InterfaceRemoved
4171          * signal callback. Simply invoke the interface_data callback.
4172          */
4173         err = 0;
4174
4175 done:
4176         g_free(data->path);
4177
4178         if (data->callback)
4179                 data->callback(err, NULL, data->user_data);
4180
4181         remove_ssid(data->ssid);
4182         dbus_free(data);
4183 }
4184
4185
4186 static void interface_remove_params(DBusMessageIter *iter, void *user_data)
4187 {
4188         struct interface_data *data = user_data;
4189
4190         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
4191                                                         &data->interface->path);
4192 }
4193
4194
4195 int g_supplicant_interface_remove(GSupplicantInterface *interface,
4196                         GSupplicantInterfaceCallback callback,
4197                                                         void *user_data)
4198 {
4199         struct interface_data *data;
4200         int ret;
4201
4202         if (!interface)
4203                 return -EINVAL;
4204
4205         if (!system_available)
4206                 return -EFAULT;
4207
4208         g_supplicant_interface_cancel(interface);
4209
4210         data = dbus_malloc0(sizeof(*data));
4211         if (!data)
4212                 return -ENOMEM;
4213
4214         data->interface = interface;
4215         data->path = g_strdup(interface->path);
4216         data->callback = callback;
4217         data->user_data = user_data;
4218
4219         ret = supplicant_dbus_method_call(SUPPLICANT_PATH,
4220                                                 SUPPLICANT_INTERFACE,
4221                                                 "RemoveInterface",
4222                                                 interface_remove_params,
4223                                                 interface_remove_result, data,
4224                                                 NULL);
4225         if (ret < 0) {
4226                 g_free(data->path);
4227                 dbus_free(data);
4228         }
4229         return ret;
4230 }
4231
4232 static void interface_scan_result(const char *error,
4233                                 DBusMessageIter *iter, void *user_data)
4234 {
4235         struct interface_scan_data *data = user_data;
4236         int err = 0;
4237
4238         if (error) {
4239                 SUPPLICANT_DBG("error %s", error);
4240                 err = -EIO;
4241         }
4242
4243         /* A non ready interface cannot send/receive anything */
4244         if (interface_exists(data->interface, data->path)) {
4245                 if (!data->interface->ready)
4246                         err = -ENOLINK;
4247         }
4248
4249         g_free(data->path);
4250
4251         if (err != 0) {
4252                 if (data->callback)
4253                         data->callback(err, data->interface, data->user_data);
4254         } else {
4255                 data->interface->scan_callback = data->callback;
4256                 data->interface->scan_data = data->user_data;
4257         }
4258
4259         if (data->scan_params)
4260                 g_supplicant_free_scan_params(data->scan_params);
4261
4262         dbus_free(data);
4263 }
4264
4265 static void add_scan_frequency(DBusMessageIter *iter, unsigned int freq)
4266 {
4267         DBusMessageIter data;
4268         unsigned int width = 0; /* Not used by wpa_supplicant atm */
4269
4270         dbus_message_iter_open_container(iter, DBUS_TYPE_STRUCT, NULL, &data);
4271
4272         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &freq);
4273         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &width);
4274
4275         dbus_message_iter_close_container(iter, &data);
4276 }
4277
4278 static void add_scan_frequencies(DBusMessageIter *iter,
4279                                                 void *user_data)
4280 {
4281         GSupplicantScanParams *scan_data = user_data;
4282         unsigned int freq;
4283         int i;
4284
4285         for (i = 0; i < scan_data->num_freqs; i++) {
4286                 freq = scan_data->freqs[i];
4287                 if (!freq)
4288                         break;
4289
4290                 add_scan_frequency(iter, freq);
4291         }
4292 }
4293
4294 static void append_ssid(DBusMessageIter *iter,
4295                         const void *ssid, unsigned int len)
4296 {
4297         DBusMessageIter array;
4298
4299         dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
4300         DBUS_TYPE_BYTE_AS_STRING, &array);
4301
4302         dbus_message_iter_append_fixed_array(&array, DBUS_TYPE_BYTE,
4303                                                                 &ssid, len);
4304         dbus_message_iter_close_container(iter, &array);
4305 }
4306
4307 static void append_ssids(DBusMessageIter *iter, void *user_data)
4308 {
4309         GSupplicantScanParams *scan_data = user_data;
4310         GSList *list;
4311
4312         for (list = scan_data->ssids; list; list = list->next) {
4313                 struct scan_ssid *scan_ssid = list->data;
4314
4315                 append_ssid(iter, scan_ssid->ssid, scan_ssid->ssid_len);
4316         }
4317 }
4318
4319 static void supplicant_add_scan_frequency(DBusMessageIter *dict,
4320                 supplicant_dbus_array_function function,
4321                                         void *user_data)
4322 {
4323         GSupplicantScanParams *scan_params = user_data;
4324         DBusMessageIter entry, value, array;
4325         const char *key = "Channels";
4326
4327         if (scan_params->freqs && scan_params->freqs[0] != 0) {
4328                 dbus_message_iter_open_container(dict, DBUS_TYPE_DICT_ENTRY,
4329                                                 NULL, &entry);
4330
4331                 dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &key);
4332
4333                 dbus_message_iter_open_container(&entry, DBUS_TYPE_VARIANT,
4334                                         DBUS_TYPE_ARRAY_AS_STRING
4335                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
4336                                         DBUS_TYPE_UINT32_AS_STRING
4337                                         DBUS_TYPE_UINT32_AS_STRING
4338                                         DBUS_STRUCT_END_CHAR_AS_STRING,
4339                                         &value);
4340
4341                 dbus_message_iter_open_container(&value, DBUS_TYPE_ARRAY,
4342                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
4343                                         DBUS_TYPE_UINT32_AS_STRING
4344                                         DBUS_TYPE_UINT32_AS_STRING
4345                                         DBUS_STRUCT_END_CHAR_AS_STRING,
4346                                         &array);
4347
4348                 if (function)
4349                         function(&array, user_data);
4350
4351                 dbus_message_iter_close_container(&value, &array);
4352                 dbus_message_iter_close_container(&entry, &value);
4353                 dbus_message_iter_close_container(dict, &entry);
4354         }
4355 }
4356
4357 static void interface_scan_params(DBusMessageIter *iter, void *user_data)
4358 {
4359         DBusMessageIter dict;
4360         const char *type = "passive";
4361         struct interface_scan_data *data = user_data;
4362
4363         supplicant_dbus_dict_open(iter, &dict);
4364
4365         if (data && data->scan_params) {
4366                 type = "active";
4367
4368                 supplicant_dbus_dict_append_basic(&dict, "Type",
4369                                         DBUS_TYPE_STRING, &type);
4370
4371
4372                 if (data->scan_params->ssids) {
4373                         supplicant_dbus_dict_append_array(&dict, "SSIDs",
4374                                                         DBUS_TYPE_STRING,
4375                                                         append_ssids,
4376                                                         data->scan_params);
4377                 }
4378                 supplicant_add_scan_frequency(&dict, add_scan_frequencies,
4379                                                 data->scan_params);
4380         } else
4381                 supplicant_dbus_dict_append_basic(&dict, "Type",
4382                                         DBUS_TYPE_STRING, &type);
4383
4384         supplicant_dbus_dict_close(iter, &dict);
4385 }
4386
4387 static int interface_ready_to_scan(GSupplicantInterface *interface)
4388 {
4389         if (!interface)
4390                 return -EINVAL;
4391
4392         if (!system_available)
4393                 return -EFAULT;
4394
4395         if (interface->scanning)
4396                 return -EALREADY;
4397
4398         switch (interface->state) {
4399         case G_SUPPLICANT_STATE_AUTHENTICATING:
4400         case G_SUPPLICANT_STATE_ASSOCIATING:
4401         case G_SUPPLICANT_STATE_ASSOCIATED:
4402         case G_SUPPLICANT_STATE_4WAY_HANDSHAKE:
4403         case G_SUPPLICANT_STATE_GROUP_HANDSHAKE:
4404                 return -EBUSY;
4405         case G_SUPPLICANT_STATE_UNKNOWN:
4406         case G_SUPPLICANT_STATE_DISABLED:
4407         case G_SUPPLICANT_STATE_DISCONNECTED:
4408         case G_SUPPLICANT_STATE_INACTIVE:
4409         case G_SUPPLICANT_STATE_SCANNING:
4410         case G_SUPPLICANT_STATE_COMPLETED:
4411                 break;
4412         }
4413
4414         return 0;
4415 }
4416
4417 int g_supplicant_interface_scan(GSupplicantInterface *interface,
4418                                 GSupplicantScanParams *scan_data,
4419                                 GSupplicantInterfaceCallback callback,
4420                                                         void *user_data)
4421 {
4422         struct interface_scan_data *data;
4423         int ret;
4424
4425         ret = interface_ready_to_scan(interface);
4426         if (ret)
4427                 return ret;
4428
4429         data = dbus_malloc0(sizeof(*data));
4430         if (!data)
4431                 return -ENOMEM;
4432
4433         data->interface = interface;
4434         data->path = g_strdup(interface->path);
4435         data->callback = callback;
4436         data->user_data = user_data;
4437         data->scan_params = scan_data;
4438
4439         interface->scan_callback = callback;
4440         interface->scan_data = user_data;
4441
4442         ret = supplicant_dbus_method_call(interface->path,
4443                         SUPPLICANT_INTERFACE ".Interface", "Scan",
4444                         interface_scan_params, interface_scan_result, data,
4445                         interface);
4446
4447         if (ret < 0) {
4448                 g_free(data->path);
4449                 dbus_free(data);
4450         }
4451
4452         return ret;
4453 }
4454
4455 static int parse_supplicant_error(DBusMessageIter *iter)
4456 {
4457         int err = -ECONNABORTED;
4458         char *key;
4459
4460         if (!iter)
4461                 return err;
4462
4463         /* If the given passphrase is malformed wpa_s returns
4464          * "invalid message format" but this error should be interpreted as
4465          * invalid-key.
4466          */
4467         while (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
4468                 dbus_message_iter_get_basic(iter, &key);
4469                 if (strncmp(key, "psk", 3) == 0 ||
4470                                 strncmp(key, "wep_key", 7) == 0 ||
4471                                 strcmp(key, "invalid message format") == 0) {
4472                         err = -ENOKEY;
4473                         break;
4474                 }
4475                 dbus_message_iter_next(iter);
4476         }
4477
4478         return err;
4479 }
4480
4481 static void interface_select_network_result(const char *error,
4482                                 DBusMessageIter *iter, void *user_data)
4483 {
4484         struct interface_connect_data *data = user_data;
4485         int err;
4486
4487         SUPPLICANT_DBG("");
4488
4489         err = 0;
4490         if (error) {
4491                 SUPPLICANT_DBG("SelectNetwork error %s", error);
4492                 err = parse_supplicant_error(iter);
4493         }
4494
4495         g_free(data->path);
4496
4497         if (data->callback)
4498                 data->callback(err, data->interface, data->user_data);
4499
4500         remove_ssid(data->ssid);
4501         dbus_free(data);
4502 }
4503
4504 static void interface_select_network_params(DBusMessageIter *iter,
4505                                                         void *user_data)
4506 {
4507         struct interface_connect_data *data = user_data;
4508         GSupplicantInterface *interface = data->interface;
4509
4510         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
4511                                         &interface->network_path);
4512 }
4513
4514 static void interface_add_network_result(const char *error,
4515                                 DBusMessageIter *iter, void *user_data)
4516 {
4517         struct interface_connect_data *data = user_data;
4518         GSupplicantInterface *interface = data->interface;
4519         const char *path;
4520         int err;
4521
4522         if (error)
4523                 goto error;
4524
4525         dbus_message_iter_get_basic(iter, &path);
4526         if (!path)
4527                 goto error;
4528
4529         SUPPLICANT_DBG("PATH: %s", path);
4530
4531         interface->network_path = g_strdup(path);
4532
4533         store_network_information(interface, data->ssid);
4534
4535         supplicant_dbus_method_call(data->interface->path,
4536                         SUPPLICANT_INTERFACE ".Interface", "SelectNetwork",
4537                         interface_select_network_params,
4538                         interface_select_network_result, data,
4539                         interface);
4540
4541         return;
4542
4543 error:
4544         SUPPLICANT_DBG("AddNetwork error %s", error);
4545
4546         if (interface_exists(data->interface, data->interface->path)) {
4547                 err = parse_supplicant_error(iter);
4548                 if (data->callback)
4549                         data->callback(err, data->interface, data->user_data);
4550
4551                 g_free(interface->network_path);
4552                 interface->network_path = NULL;
4553         }
4554
4555         g_free(data->path);
4556         remove_ssid(data->ssid);
4557         g_free(data);
4558 }
4559
4560 static void add_network_security_none(DBusMessageIter *dict)
4561 {
4562         const char *auth_alg = "OPEN";
4563
4564         supplicant_dbus_dict_append_basic(dict, "auth_alg",
4565                                         DBUS_TYPE_STRING, &auth_alg);
4566 }
4567
4568 static void add_network_security_wep(DBusMessageIter *dict,
4569                                         GSupplicantSSID *ssid)
4570 {
4571         const char *auth_alg = "OPEN SHARED";
4572         dbus_uint32_t key_index = 0;
4573
4574         supplicant_dbus_dict_append_basic(dict, "auth_alg",
4575                                         DBUS_TYPE_STRING, &auth_alg);
4576
4577         if (ssid->passphrase) {
4578                 int size = strlen(ssid->passphrase);
4579                 if (size == 10 || size == 26) {
4580                         unsigned char *key = g_try_malloc(13);
4581                         char tmp[3];
4582                         int i;
4583
4584                         memset(tmp, 0, sizeof(tmp));
4585                         if (!key)
4586                                 size = 0;
4587
4588                         for (i = 0; i < size / 2; i++) {
4589                                 memcpy(tmp, ssid->passphrase + (i * 2), 2);
4590                                 key[i] = (unsigned char) strtol(tmp, NULL, 16);
4591                         }
4592
4593                         supplicant_dbus_dict_append_fixed_array(dict,
4594                                                         "wep_key0",
4595                                                         DBUS_TYPE_BYTE,
4596                                                         &key, size / 2);
4597                         g_free(key);
4598                 } else if (size == 5 || size == 13) {
4599                         unsigned char *key = g_try_malloc(13);
4600                         int i;
4601
4602                         if (!key)
4603                                 size = 0;
4604
4605                         for (i = 0; i < size; i++)
4606                                 key[i] = (unsigned char) ssid->passphrase[i];
4607
4608                         supplicant_dbus_dict_append_fixed_array(dict,
4609                                                                 "wep_key0",
4610                                                                 DBUS_TYPE_BYTE,
4611                                                                 &key, size);
4612                         g_free(key);
4613                 } else
4614                         supplicant_dbus_dict_append_basic(dict,
4615                                                         "wep_key0",
4616                                                         DBUS_TYPE_STRING,
4617                                                         &ssid->passphrase);
4618
4619                 supplicant_dbus_dict_append_basic(dict, "wep_tx_keyidx",
4620                                         DBUS_TYPE_UINT32, &key_index);
4621         }
4622 }
4623
4624 static dbus_bool_t is_psk_raw_key(const char *psk)
4625 {
4626         int i;
4627
4628         /* A raw key is always 64 bytes length... */
4629         if (strlen(psk) != 64)
4630                 return FALSE;
4631
4632         /* ... and its content is in hex representation */
4633         for (i = 0; i < 64; i++)
4634                 if (!isxdigit((unsigned char) psk[i]))
4635                         return FALSE;
4636
4637         return TRUE;
4638 }
4639
4640 static unsigned char hexchar2bin(char c)
4641 {
4642         if ((c >= '0') && (c <= '9'))
4643                 return c - '0';
4644         else if ((c >= 'A') && (c <= 'F'))
4645                 return c - 'A' + 10;
4646         else if ((c >= 'a') && (c <= 'f'))
4647                 return c - 'a' + 10;
4648         else
4649                 return c;
4650 }
4651
4652 static void hexstring2bin(const char *string, unsigned char *data,
4653                                 size_t data_len)
4654 {
4655         size_t i;
4656
4657         for (i = 0; i < data_len; i++)
4658                 data[i] = (hexchar2bin(string[i * 2 + 0]) << 4 |
4659                            hexchar2bin(string[i * 2 + 1]) << 0);
4660 }
4661
4662 static void add_network_security_psk(DBusMessageIter *dict,
4663                                         GSupplicantSSID *ssid)
4664 {
4665         if (ssid->passphrase && strlen(ssid->passphrase) > 0) {
4666                 const char *key = "psk";
4667
4668                 if (is_psk_raw_key(ssid->passphrase)) {
4669                         unsigned char data[32];
4670                         unsigned char *datap = data;
4671
4672                         /* The above pointer alias is required by D-Bus because
4673                          * with D-Bus and GCC, non-heap-allocated arrays cannot
4674                          * be passed directly by their base pointer. */
4675
4676                         hexstring2bin(ssid->passphrase, datap, sizeof(data));
4677
4678                         supplicant_dbus_dict_append_fixed_array(dict,
4679                                                         key, DBUS_TYPE_BYTE,
4680                                                         &datap, sizeof(data));
4681                 } else
4682                         supplicant_dbus_dict_append_basic(dict,
4683                                                         key, DBUS_TYPE_STRING,
4684                                                         &ssid->passphrase);
4685         }
4686 }
4687
4688 static void add_network_security_tls(DBusMessageIter *dict,
4689                                         GSupplicantSSID *ssid)
4690 {
4691         /*
4692          * For TLS, we at least need:
4693          *              The client certificate
4694          *              The client private key file
4695          *              The client private key file password
4696          *
4697          * The Authority certificate is optional.
4698          */
4699         if (!ssid->client_cert_path)
4700                 return;
4701
4702         if (!ssid->private_key_path)
4703                 return;
4704
4705         if (!ssid->private_key_passphrase)
4706                 return;
4707
4708         if (ssid->ca_cert_path)
4709                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
4710                                         DBUS_TYPE_STRING, &ssid->ca_cert_path);
4711
4712         supplicant_dbus_dict_append_basic(dict, "private_key",
4713                                                 DBUS_TYPE_STRING,
4714                                                 &ssid->private_key_path);
4715         supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
4716                                                 DBUS_TYPE_STRING,
4717                                                 &ssid->private_key_passphrase);
4718         supplicant_dbus_dict_append_basic(dict, "client_cert",
4719                                                 DBUS_TYPE_STRING,
4720                                                 &ssid->client_cert_path);
4721 }
4722
4723 static void add_network_security_peap(DBusMessageIter *dict,
4724                                         GSupplicantSSID *ssid)
4725 {
4726         char *phase2_auth;
4727
4728         /*
4729          * For PEAP/TTLS, we at least need
4730          *              The authority certificate
4731          *              The 2nd phase authentication method
4732          *              The 2nd phase passphrase
4733          *
4734          * The Client certificate is optional although strongly recommended
4735          * When setting it, we need in addition
4736          *              The Client private key file
4737          *              The Client private key file password
4738          */
4739         if (!ssid->passphrase)
4740                 return;
4741
4742         if (!ssid->phase2_auth)
4743                 return;
4744
4745         if (ssid->client_cert_path) {
4746                 if (!ssid->private_key_path)
4747                         return;
4748
4749                 if (!ssid->private_key_passphrase)
4750                         return;
4751
4752                 supplicant_dbus_dict_append_basic(dict, "client_cert",
4753                                                 DBUS_TYPE_STRING,
4754                                                 &ssid->client_cert_path);
4755
4756                 supplicant_dbus_dict_append_basic(dict, "private_key",
4757                                                 DBUS_TYPE_STRING,
4758                                                 &ssid->private_key_path);
4759
4760                 supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
4761                                                 DBUS_TYPE_STRING,
4762                                                 &ssid->private_key_passphrase);
4763
4764         }
4765
4766         if(g_strcmp0(ssid->phase2_auth, "GTC") == 0 && g_strcmp0(ssid->eap, "ttls") == 0)
4767                 phase2_auth = g_strdup_printf("autheap=%s", ssid->phase2_auth);
4768         else if (g_str_has_prefix(ssid->phase2_auth, "EAP-")) {
4769                 phase2_auth = g_strdup_printf("autheap=%s",
4770                                         ssid->phase2_auth + strlen("EAP-"));
4771         } else
4772                 phase2_auth = g_strdup_printf("auth=%s", ssid->phase2_auth);
4773
4774         supplicant_dbus_dict_append_basic(dict, "password",
4775                                                 DBUS_TYPE_STRING,
4776                                                 &ssid->passphrase);
4777
4778         if (ssid->ca_cert_path)
4779                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
4780                                                 DBUS_TYPE_STRING,
4781                                                 &ssid->ca_cert_path);
4782
4783         supplicant_dbus_dict_append_basic(dict, "phase2",
4784                                                 DBUS_TYPE_STRING,
4785                                                 &phase2_auth);
4786
4787         g_free(phase2_auth);
4788 }
4789
4790 static void add_network_security_eap(DBusMessageIter *dict,
4791                                         GSupplicantSSID *ssid)
4792 {
4793         char *eap_value;
4794
4795         if (!ssid->eap || !ssid->identity)
4796                 return;
4797
4798         if (g_strcmp0(ssid->eap, "tls") == 0) {
4799                 add_network_security_tls(dict, ssid);
4800         } else if (g_strcmp0(ssid->eap, "peap") == 0 ||
4801                                 g_strcmp0(ssid->eap, "ttls") == 0) {
4802                 add_network_security_peap(dict, ssid);
4803         } else
4804                 return;
4805
4806         eap_value = g_ascii_strup(ssid->eap, -1);
4807
4808         supplicant_dbus_dict_append_basic(dict, "eap",
4809                                                 DBUS_TYPE_STRING,
4810                                                 &eap_value);
4811         supplicant_dbus_dict_append_basic(dict, "identity",
4812                                                 DBUS_TYPE_STRING,
4813                                                 &ssid->identity);
4814         if(ssid->anonymous_identity)
4815                 supplicant_dbus_dict_append_basic(dict, "anonymous_identity",
4816                                                      DBUS_TYPE_STRING,
4817                                                      &ssid->anonymous_identity);
4818
4819         if(ssid->subject_match)
4820                 supplicant_dbus_dict_append_basic(dict, "subject_match",
4821                                                      DBUS_TYPE_STRING,
4822                                                      &ssid->subject_match);
4823
4824         if(ssid->altsubject_match)
4825                 supplicant_dbus_dict_append_basic(dict, "altsubject_match",
4826                                                      DBUS_TYPE_STRING,
4827                                                      &ssid->altsubject_match);
4828
4829         if(ssid->domain_suffix_match)
4830                 supplicant_dbus_dict_append_basic(dict, "domain_suffix_match",
4831                                                      DBUS_TYPE_STRING,
4832                                                      &ssid->domain_suffix_match);
4833
4834         if(ssid->domain_match)
4835                 supplicant_dbus_dict_append_basic(dict, "domain_match",
4836                                                      DBUS_TYPE_STRING,
4837                                                      &ssid->domain_match);
4838
4839         g_free(eap_value);
4840 }
4841
4842 static void add_network_security_ciphers(DBusMessageIter *dict,
4843                                                 GSupplicantSSID *ssid)
4844 {
4845         unsigned int p_cipher, g_cipher, i;
4846         char *pairwise, *group;
4847         char *pair_ciphers[4];
4848         char *group_ciphers[5];
4849
4850         p_cipher = ssid->pairwise_cipher;
4851         g_cipher = ssid->group_cipher;
4852
4853         if (p_cipher == 0 && g_cipher == 0)
4854                 return;
4855
4856         i = 0;
4857
4858         if (p_cipher & G_SUPPLICANT_PAIRWISE_CCMP)
4859                 pair_ciphers[i++] = "CCMP";
4860
4861         if (p_cipher & G_SUPPLICANT_PAIRWISE_TKIP)
4862                 pair_ciphers[i++] = "TKIP";
4863
4864         if (p_cipher & G_SUPPLICANT_PAIRWISE_NONE)
4865                 pair_ciphers[i++] = "NONE";
4866
4867         pair_ciphers[i] = NULL;
4868
4869         i = 0;
4870
4871         if (g_cipher & G_SUPPLICANT_GROUP_CCMP)
4872                 group_ciphers[i++] = "CCMP";
4873
4874         if (g_cipher & G_SUPPLICANT_GROUP_TKIP)
4875                 group_ciphers[i++] = "TKIP";
4876
4877         if (g_cipher & G_SUPPLICANT_GROUP_WEP104)
4878                 group_ciphers[i++] = "WEP104";
4879
4880         if (g_cipher & G_SUPPLICANT_GROUP_WEP40)
4881                 group_ciphers[i++] = "WEP40";
4882
4883         group_ciphers[i] = NULL;
4884
4885         pairwise = g_strjoinv(" ", pair_ciphers);
4886         group = g_strjoinv(" ", group_ciphers);
4887
4888         SUPPLICANT_DBG("cipher %s %s", pairwise, group);
4889
4890         supplicant_dbus_dict_append_basic(dict, "pairwise",
4891                                                 DBUS_TYPE_STRING,
4892                                                 &pairwise);
4893         supplicant_dbus_dict_append_basic(dict, "group",
4894                                                 DBUS_TYPE_STRING,
4895                                                 &group);
4896
4897         g_free(pairwise);
4898         g_free(group);
4899 }
4900
4901 static void add_network_security_proto(DBusMessageIter *dict,
4902                                                 GSupplicantSSID *ssid)
4903 {
4904         unsigned int protocol, i;
4905         char *proto;
4906         char *protos[3];
4907
4908         protocol = ssid->protocol;
4909
4910         if (protocol == 0)
4911                 return;
4912
4913         i = 0;
4914
4915         if (protocol & G_SUPPLICANT_PROTO_RSN)
4916                 protos[i++] = "RSN";
4917
4918         if (protocol & G_SUPPLICANT_PROTO_WPA)
4919                 protos[i++] = "WPA";
4920
4921         protos[i] = NULL;
4922
4923         proto = g_strjoinv(" ", protos);
4924
4925         SUPPLICANT_DBG("proto %s", proto);
4926
4927         supplicant_dbus_dict_append_basic(dict, "proto",
4928                                                 DBUS_TYPE_STRING,
4929                                                 &proto);
4930
4931         g_free(proto);
4932 }
4933
4934 static void add_network_ieee80211w(DBusMessageIter *dict, GSupplicantSSID *ssid,
4935                                    GSupplicantMfpOptions ieee80211w)
4936 {
4937         supplicant_dbus_dict_append_basic(dict, "ieee80211w", DBUS_TYPE_UINT32,
4938                                           &ieee80211w);
4939 }
4940
4941 static void add_network_security(DBusMessageIter *dict, GSupplicantSSID *ssid)
4942 {
4943         GSupplicantMfpOptions ieee80211w;
4944         char *key_mgmt;
4945
4946         switch (ssid->security) {
4947         case G_SUPPLICANT_SECURITY_NONE:
4948                 key_mgmt = "NONE";
4949                 add_network_security_none(dict);
4950                 add_network_security_ciphers(dict, ssid);
4951                 break;
4952         case G_SUPPLICANT_SECURITY_UNKNOWN:
4953         case G_SUPPLICANT_SECURITY_WEP:
4954                 key_mgmt = "NONE";
4955                 add_network_security_wep(dict, ssid);
4956                 add_network_security_ciphers(dict, ssid);
4957                 break;
4958         case G_SUPPLICANT_SECURITY_PSK:
4959                 if (ssid->keymgmt & G_SUPPLICANT_KEYMGMT_SAE) {
4960                         if (ssid->keymgmt & G_SUPPLICANT_KEYMGMT_WPA_PSK) {
4961                                 /*
4962                                  * WPA3-Personal transition mode: supports both
4963                                  * WPA2-Personal (PSK) and WPA3-Personal (SAE)
4964                                  */
4965                                 key_mgmt = "SAE WPA-PSK";
4966                                 ieee80211w = G_SUPPLICANT_MFP_OPTIONAL;
4967                         } else {
4968                                 key_mgmt = "SAE";
4969                                 ieee80211w = G_SUPPLICANT_MFP_REQUIRED;
4970                         }
4971                         add_network_ieee80211w(dict, ssid, ieee80211w);
4972                 } else {
4973                         key_mgmt = "WPA-PSK";
4974                 }
4975                 add_network_security_psk(dict, ssid);
4976                 add_network_security_ciphers(dict, ssid);
4977                 add_network_security_proto(dict, ssid);
4978                 break;
4979         case G_SUPPLICANT_SECURITY_IEEE8021X:
4980                 key_mgmt = "WPA-EAP";
4981                 add_network_security_eap(dict, ssid);
4982                 add_network_security_ciphers(dict, ssid);
4983                 add_network_security_proto(dict, ssid);
4984                 break;
4985         }
4986
4987         supplicant_dbus_dict_append_basic(dict, "key_mgmt",
4988                                 DBUS_TYPE_STRING, &key_mgmt);
4989 }
4990
4991 static void add_network_mode(DBusMessageIter *dict, GSupplicantSSID *ssid)
4992 {
4993         dbus_uint32_t mode;
4994
4995         switch (ssid->mode) {
4996         case G_SUPPLICANT_MODE_UNKNOWN:
4997         case G_SUPPLICANT_MODE_INFRA:
4998                 mode = 0;
4999                 break;
5000         case G_SUPPLICANT_MODE_IBSS:
5001                 mode = 1;
5002                 break;
5003         case G_SUPPLICANT_MODE_MASTER:
5004                 mode = 2;
5005                 break;
5006         }
5007
5008         supplicant_dbus_dict_append_basic(dict, "mode",
5009                                 DBUS_TYPE_UINT32, &mode);
5010 }
5011
5012 static void interface_add_network_params(DBusMessageIter *iter, void *user_data)
5013 {
5014         DBusMessageIter dict;
5015         struct interface_connect_data *data = user_data;
5016         GSupplicantSSID *ssid = data->ssid;
5017
5018         supplicant_dbus_dict_open(iter, &dict);
5019
5020         if (ssid->scan_ssid)
5021                 supplicant_dbus_dict_append_basic(&dict, "scan_ssid",
5022                                          DBUS_TYPE_UINT32, &ssid->scan_ssid);
5023
5024         if (ssid->freq)
5025                 supplicant_dbus_dict_append_basic(&dict, "frequency",
5026                                          DBUS_TYPE_UINT32, &ssid->freq);
5027
5028         if (ssid->bgscan)
5029                 supplicant_dbus_dict_append_basic(&dict, "bgscan",
5030                                         DBUS_TYPE_STRING, &ssid->bgscan);
5031
5032         add_network_mode(&dict, ssid);
5033
5034         add_network_security(&dict, ssid);
5035
5036         supplicant_dbus_dict_append_fixed_array(&dict, "ssid",
5037                                         DBUS_TYPE_BYTE, &ssid->ssid,
5038                                                 ssid->ssid_len);
5039
5040         supplicant_dbus_dict_close(iter, &dict);
5041 }
5042
5043 static void interface_wps_start_result(const char *error,
5044                                 DBusMessageIter *iter, void *user_data)
5045 {
5046         struct interface_connect_data *data = user_data;
5047         int err;
5048
5049         SUPPLICANT_DBG("");
5050
5051         err = 0;
5052         if (error) {
5053                 SUPPLICANT_DBG("error: %s", error);
5054                 err = parse_supplicant_error(iter);
5055         }
5056
5057         if(data->callback)
5058                 data->callback(err, data->interface, data->user_data);
5059
5060         g_free(data->path);
5061         remove_ssid(data->ssid);
5062         dbus_free(data);
5063 }
5064
5065 static void interface_add_wps_params(DBusMessageIter *iter, void *user_data)
5066 {
5067         struct interface_connect_data *data = user_data;
5068         GSupplicantSSID *ssid = data->ssid;
5069         const char *role = "enrollee", *type;
5070         DBusMessageIter dict;
5071
5072         SUPPLICANT_DBG("");
5073
5074         supplicant_dbus_dict_open(iter, &dict);
5075
5076         supplicant_dbus_dict_append_basic(&dict, "Role",
5077                                                 DBUS_TYPE_STRING, &role);
5078
5079         type = "pbc";
5080         if (ssid->pin_wps) {
5081                 type = "pin";
5082                 supplicant_dbus_dict_append_basic(&dict, "Pin",
5083                                         DBUS_TYPE_STRING, &ssid->pin_wps);
5084         }
5085
5086         supplicant_dbus_dict_append_basic(&dict, "Type",
5087                                         DBUS_TYPE_STRING, &type);
5088
5089         supplicant_dbus_dict_close(iter, &dict);
5090 }
5091
5092 static void wps_start(const char *error, DBusMessageIter *iter, void *user_data)
5093 {
5094         struct interface_connect_data *data = user_data;
5095
5096         SUPPLICANT_DBG("");
5097
5098         if (error) {
5099                 SUPPLICANT_DBG("error: %s", error);
5100                 g_free(data->path);
5101                 remove_ssid(data->ssid);
5102                 dbus_free(data);
5103                 return;
5104         }
5105
5106         supplicant_dbus_method_call(data->interface->path,
5107                         SUPPLICANT_INTERFACE ".Interface.WPS", "Start",
5108                         interface_add_wps_params,
5109                         interface_wps_start_result, data, NULL);
5110 }
5111
5112 static void wps_process_credentials(DBusMessageIter *iter, void *user_data)
5113 {
5114         dbus_bool_t credentials = TRUE;
5115
5116         SUPPLICANT_DBG("");
5117
5118         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &credentials);
5119 }
5120
5121
5122 int g_supplicant_interface_connect(GSupplicantInterface *interface,
5123                                 GSupplicantSSID *ssid,
5124                                 GSupplicantInterfaceCallback callback,
5125                                                         void *user_data)
5126 {
5127         struct interface_connect_data *data;
5128         struct interface_data *intf_data;
5129         int ret = 0;
5130
5131         SUPPLICANT_DBG("");
5132
5133         if (!interface)
5134                 return -EINVAL;
5135
5136         if (!system_available)
5137                 return -EFAULT;
5138
5139         /* TODO: Check if we're already connected and switch */
5140
5141         data = dbus_malloc0(sizeof(*data));
5142         if (!data)
5143                 return -ENOMEM;
5144
5145         data->interface = interface;
5146         data->path = g_strdup(interface->path);
5147         data->callback = callback;
5148         data->ssid = ssid;
5149         data->user_data = user_data;
5150
5151         if (ssid->use_wps) {
5152                 g_free(interface->wps_cred.key);
5153                 memset(&interface->wps_cred, 0,
5154                                 sizeof(struct _GSupplicantWpsCredentials));
5155
5156                 ret = supplicant_dbus_property_set(interface->path,
5157                         SUPPLICANT_INTERFACE ".Interface.WPS",
5158                         "ProcessCredentials", DBUS_TYPE_BOOLEAN_AS_STRING,
5159                         wps_process_credentials, wps_start, data, interface);
5160         } else {
5161                 /* By the time there is a request for connect and the network
5162                  * path is not NULL it means that connman has not removed the
5163                  * previous network pointer. This can happen in the case AP
5164                  * deauthenticated client and connman does not remove the
5165                  * previously connected network pointer. This causes supplicant
5166                  * to reallocate the memory for struct wpa_ssid again even if it
5167                  * is the same SSID. This causes memory usage of wpa_supplicnat
5168                  * to go high. The idea here is that if the previously connected
5169                  * network is not removed at the time of next connection attempt
5170                  * check if the network path is not NULL. In case it is non-NULL
5171                  * first remove the network and then once removal is successful, add
5172                  * the network.
5173                  */
5174
5175                 if (interface->network_path != NULL) {
5176                         g_free(data->path);
5177                         dbus_free(data);
5178
5179                         /*
5180                          * If this add network is for the same network for
5181                          * which wpa_supplicant already has a profile then do
5182                          * not need to add another profile. Only if the
5183                          * profile that needs to get added is different from
5184                          * what is there in wpa_s delete the current one. A
5185                          * network is identified by its SSID, security_type
5186                          * and passphrase (private passphrase in case security
5187                          * type is 802.11x).
5188                          */
5189                         if (compare_network_parameters(interface, ssid)) {
5190                                 remove_ssid(ssid);
5191                                 return -EALREADY;
5192                         }
5193
5194                         intf_data = dbus_malloc0(sizeof(*intf_data));
5195                         if (!intf_data)
5196                                 return -ENOMEM;
5197
5198                         intf_data->interface = interface;
5199                         intf_data->path = g_strdup(interface->path);
5200                         intf_data->callback = callback;
5201                         intf_data->ssid = ssid;
5202                         intf_data->user_data = user_data;
5203                         intf_data->network_remove_in_progress = TRUE;
5204                         network_remove(intf_data);
5205                 } else {
5206                         ret = supplicant_dbus_method_call(interface->path,
5207                                         SUPPLICANT_INTERFACE ".Interface", "AddNetwork",
5208                                         interface_add_network_params,
5209                                         interface_add_network_result, data,
5210                                         interface);
5211                 }
5212         }
5213
5214         if (ret < 0) {
5215                 g_free(data->path);
5216                 remove_ssid(data->ssid);
5217                 dbus_free(data);
5218                 return ret;
5219         }
5220
5221         return -EINPROGRESS;
5222 }
5223
5224 static void network_remove_result(const char *error,
5225                                 DBusMessageIter *iter, void *user_data)
5226 {
5227         struct interface_data *data = user_data;
5228         struct interface_connect_data *connect_data;
5229         int result = 0;
5230
5231         SUPPLICANT_DBG("");
5232
5233         if (error) {
5234                 result = -EIO;
5235                 SUPPLICANT_DBG("error: %s", error);
5236
5237                 if (g_strcmp0("org.freedesktop.DBus.Error.UnknownMethod",
5238                                                 error) == 0)
5239                         result = -ECONNABORTED;
5240         }
5241
5242         g_free(data->interface->network_path);
5243         data->interface->network_path = NULL;
5244
5245         remove_network_information(data->interface);
5246
5247         if (data->network_remove_in_progress == TRUE) {
5248                 data->network_remove_in_progress = FALSE;
5249                 connect_data = dbus_malloc0(sizeof(*connect_data));
5250                 if (!connect_data)
5251                         return;
5252
5253                 connect_data->interface = data->interface;
5254                 connect_data->path = g_strdup(data->path);
5255                 connect_data->callback = data->callback;
5256                 connect_data->ssid = data->ssid;
5257                 connect_data->user_data = data->user_data;
5258
5259                 supplicant_dbus_method_call(data->interface->path,
5260                         SUPPLICANT_INTERFACE ".Interface", "AddNetwork",
5261                         interface_add_network_params,
5262                         interface_add_network_result, connect_data,
5263                         connect_data->interface);
5264         } else {
5265                 if (data->callback)
5266                         data->callback(result, data->interface, data->user_data);
5267                 remove_ssid(data->ssid);
5268         }
5269         g_free(data->path);
5270         dbus_free(data);
5271 }
5272
5273 static void network_remove_params(DBusMessageIter *iter, void *user_data)
5274 {
5275         struct interface_data *data = user_data;
5276         const char *path = data->interface->network_path;
5277
5278         SUPPLICANT_DBG("path %s", path);
5279
5280         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path);
5281 }
5282
5283 static int network_remove(struct interface_data *data)
5284 {
5285         GSupplicantInterface *interface = data->interface;
5286
5287         SUPPLICANT_DBG("");
5288
5289         return supplicant_dbus_method_call(interface->path,
5290                         SUPPLICANT_INTERFACE ".Interface", "RemoveNetwork",
5291                         network_remove_params, network_remove_result, data,
5292                         interface);
5293 }
5294
5295 static void interface_disconnect_result(const char *error,
5296                                 DBusMessageIter *iter, void *user_data)
5297 {
5298         struct interface_data *data = user_data;
5299         int result = 0;
5300
5301         SUPPLICANT_DBG("");
5302
5303         if (error) {
5304                 result = -EIO;
5305                 SUPPLICANT_DBG("error: %s", error);
5306
5307                 if (g_strcmp0("org.freedesktop.DBus.Error.UnknownMethod",
5308                                                 error) == 0)
5309                         result = -ECONNABORTED;
5310         }
5311
5312         /* If we are disconnecting from previous WPS successful
5313          * association. i.e.: it did not went through AddNetwork,
5314          * and interface->network_path was never set. */
5315         if (!data->interface->network_path) {
5316                 if (data->callback)
5317                         data->callback(result, data->interface,
5318                                                         data->user_data);
5319
5320                 g_free(data->path);
5321                 remove_ssid(data->ssid);
5322                 dbus_free(data);
5323                 return;
5324         }
5325
5326         if (result < 0 && data->callback) {
5327                 data->callback(result, data->interface, data->user_data);
5328                 data->callback = NULL;
5329         }
5330
5331         if (result != -ECONNABORTED) {
5332                 if (network_remove(data) < 0) {
5333                         g_free(data->path);
5334                         remove_ssid(data->ssid);
5335                         dbus_free(data);
5336                 }
5337         } else {
5338                 g_free(data->path);
5339                 remove_ssid(data->ssid);
5340                 dbus_free(data);
5341         }
5342 }
5343
5344 int g_supplicant_interface_disconnect(GSupplicantInterface *interface,
5345                                         GSupplicantInterfaceCallback callback,
5346                                                         void *user_data)
5347 {
5348         struct interface_data *data;
5349         int ret;
5350
5351         SUPPLICANT_DBG("");
5352
5353         if (!interface)
5354                 return -EINVAL;
5355
5356         if (!system_available)
5357                 return -EFAULT;
5358
5359         data = dbus_malloc0(sizeof(*data));
5360         if (!data)
5361                 return -ENOMEM;
5362
5363         data->interface = interface;
5364         data->path = g_strdup(interface->path);
5365         data->callback = callback;
5366         data->user_data = user_data;
5367
5368         ret = supplicant_dbus_method_call(interface->path,
5369                         SUPPLICANT_INTERFACE ".Interface", "Disconnect",
5370                         NULL, interface_disconnect_result, data,
5371                         interface);
5372
5373         if (ret < 0) {
5374                 g_free(data->path);
5375                 dbus_free(data);
5376         }
5377
5378         return ret;
5379 }
5380
5381 static void interface_p2p_find_result(const char *error,
5382                                         DBusMessageIter *iter, void *user_data)
5383 {
5384         struct interface_scan_data *data = user_data;
5385         int err = 0;
5386
5387         SUPPLICANT_DBG("error %s", error);
5388
5389         if (error)
5390                 err = -EIO;
5391
5392         if (interface_exists(data->interface, data->path)) {
5393                 if (!data->interface->ready)
5394                         err = -ENOLINK;
5395                 if (!err)
5396                         data->interface->p2p_finding = true;
5397         }
5398
5399         if (data->callback)
5400                 data->callback(err, data->interface, data->user_data);
5401
5402         g_free(data->path);
5403         dbus_free(data);
5404 }
5405
5406 static void interface_p2p_find_params(DBusMessageIter *iter, void *user_data)
5407 {
5408         DBusMessageIter dict;
5409
5410         supplicant_dbus_dict_open(iter, &dict);
5411         supplicant_dbus_dict_close(iter, &dict);
5412 }
5413
5414 int g_supplicant_interface_p2p_find(GSupplicantInterface *interface,
5415                                         GSupplicantInterfaceCallback callback,
5416                                                         void *user_data)
5417 {
5418         struct interface_scan_data *data;
5419         int ret;
5420
5421         if (!interface->p2p_support)
5422                 return -ENOTSUP;
5423
5424         ret = interface_ready_to_scan(interface);
5425         if (ret && ret != -EALREADY)
5426                 return ret;
5427
5428         data = dbus_malloc0(sizeof(*data));
5429         if (!data)
5430                 return -ENOMEM;
5431
5432         data->interface = interface;
5433         data->path = g_strdup(interface->path);
5434         data->callback = callback;
5435         data->user_data = user_data;
5436
5437         ret = supplicant_dbus_method_call(interface->path,
5438                         SUPPLICANT_INTERFACE ".Interface.P2PDevice", "Find",
5439                         interface_p2p_find_params, interface_p2p_find_result,
5440                         data, interface);
5441         if (ret < 0) {
5442                 g_free(data->path);
5443                 dbus_free(data);
5444         }
5445
5446         return ret;
5447 }
5448
5449 bool g_supplicant_interface_is_p2p_finding(GSupplicantInterface *interface)
5450 {
5451         if (!interface)
5452                 return false;
5453
5454         return interface->p2p_finding;
5455 }
5456
5457 int g_supplicant_interface_p2p_stop_find(GSupplicantInterface *interface)
5458 {
5459         if (!interface->p2p_finding)
5460                 return 0;
5461
5462         SUPPLICANT_DBG("");
5463
5464         interface->p2p_finding = false;
5465
5466         return supplicant_dbus_method_call(interface->path,
5467                 SUPPLICANT_INTERFACE ".Interface.P2PDevice", "StopFind",
5468                 NULL, NULL, NULL, NULL);
5469 }
5470
5471 static void interface_p2p_connect_result(const char *error,
5472                                         DBusMessageIter *iter, void *user_data)
5473 {
5474         struct interface_connect_data *data = user_data;
5475         int err = 0;
5476
5477         SUPPLICANT_DBG("");
5478
5479         if (error) {
5480                 SUPPLICANT_DBG("error: %s", error);
5481                 err = parse_supplicant_error(iter);
5482         }
5483
5484         if (data->callback)
5485                 data->callback(err, data->interface, data->user_data);
5486
5487         g_free(data->path);
5488         g_free(data->peer->wps_pin);
5489         g_free(data->peer->path);
5490         g_free(data->peer);
5491         g_free(data);
5492 }
5493
5494 static void interface_p2p_connect_params(DBusMessageIter *iter, void *user_data)
5495 {
5496         struct interface_connect_data *data = user_data;
5497         const char *wps = "pbc";
5498         DBusMessageIter dict;
5499         int go_intent = 7;
5500
5501         SUPPLICANT_DBG("");
5502
5503         supplicant_dbus_dict_open(iter, &dict);
5504
5505         if (data->peer->master)
5506                 go_intent = 15;
5507
5508         if (data->peer->wps_pin)
5509                 wps = "pin";
5510
5511         supplicant_dbus_dict_append_basic(&dict, "peer",
5512                                 DBUS_TYPE_OBJECT_PATH, &data->peer->path);
5513         supplicant_dbus_dict_append_basic(&dict, "wps_method",
5514                                 DBUS_TYPE_STRING, &wps);
5515         if (data->peer->wps_pin) {
5516                 supplicant_dbus_dict_append_basic(&dict, "pin",
5517                                 DBUS_TYPE_STRING, &data->peer->wps_pin);
5518         }
5519
5520         supplicant_dbus_dict_append_basic(&dict, "go_intent",
5521                                         DBUS_TYPE_INT32, &go_intent);
5522
5523         supplicant_dbus_dict_close(iter, &dict);
5524 }
5525
5526 int g_supplicant_interface_p2p_connect(GSupplicantInterface *interface,
5527                                         GSupplicantPeerParams *peer_params,
5528                                         GSupplicantInterfaceCallback callback,
5529                                         void *user_data)
5530 {
5531         struct interface_connect_data *data;
5532         int ret;
5533
5534         SUPPLICANT_DBG("");
5535
5536         if (!interface->p2p_support)
5537                 return -ENOTSUP;
5538
5539         data = dbus_malloc0(sizeof(*data));
5540         if (!data)
5541                 return -ENOMEM;
5542
5543         data->interface = interface;
5544         data->path = g_strdup(interface->path);
5545         data->peer = peer_params;
5546         data->callback = callback;
5547         data->user_data = user_data;
5548
5549         ret = supplicant_dbus_method_call(interface->path,
5550                 SUPPLICANT_INTERFACE ".Interface.P2PDevice", "Connect",
5551                 interface_p2p_connect_params, interface_p2p_connect_result,
5552                 data, interface);
5553         if (ret < 0) {
5554                 g_free(data->path);
5555                 dbus_free(data);
5556                 return ret;
5557         }
5558
5559         return -EINPROGRESS;
5560 }
5561
5562 int g_supplicant_interface_p2p_disconnect(GSupplicantInterface *interface,
5563                                         GSupplicantPeerParams *peer_params)
5564 {
5565         GSupplicantPeer *peer;
5566         int count = 0;
5567         GSList *list;
5568
5569         SUPPLICANT_DBG("");
5570
5571         if (!interface->p2p_support)
5572                 return -ENOTSUP;
5573
5574         peer = g_hash_table_lookup(interface->peer_table, peer_params->path);
5575         if (!peer)
5576                 return -ENODEV;
5577
5578         for (list = peer->groups; list; list = list->next, count++) {
5579                 const char *group_obj_path = list->data;
5580                 GSupplicantInterface *g_interface;
5581                 GSupplicantGroup *group;
5582
5583                 group = g_hash_table_lookup(group_mapping, group_obj_path);
5584                 if (!group || !group->interface)
5585                         continue;
5586
5587                 g_interface = group->interface;
5588                 supplicant_dbus_method_call(g_interface->path,
5589                                 SUPPLICANT_INTERFACE ".Interface.P2PDevice",
5590                                 "Disconnect", NULL, NULL, NULL, g_interface);
5591         }
5592
5593         if (count == 0 && peer->current_group_iface) {
5594                 supplicant_dbus_method_call(peer->current_group_iface->path,
5595                                 SUPPLICANT_INTERFACE ".Interface.P2PDevice",
5596                                 "Disconnect", NULL, NULL, NULL,
5597                                 peer->current_group_iface->path);
5598         }
5599
5600         peer->current_group_iface = NULL;
5601
5602         return -EINPROGRESS;
5603 }
5604
5605 struct p2p_service_data {
5606         bool registration;
5607         GSupplicantInterface *interface;
5608         GSupplicantP2PServiceParams *service;
5609         GSupplicantInterfaceCallback callback;
5610         void *user_data;
5611 };
5612
5613 static void interface_p2p_service_result(const char *error,
5614                                         DBusMessageIter *iter, void *user_data)
5615 {
5616         struct p2p_service_data *data = user_data;
5617         int result = 0;
5618
5619         SUPPLICANT_DBG("%s result - %s", data->registration ?
5620                                 "Registration" : "Deletion",
5621                                 error ? error : "Success");
5622         if (error)
5623                 result = -EINVAL;
5624
5625         if (data->callback)
5626                 data->callback(result, data->interface, data->user_data);
5627
5628         g_free(data->service->query);
5629         g_free(data->service->response);
5630         g_free(data->service->service);
5631         g_free(data->service->wfd_ies);
5632         g_free(data->service);
5633         dbus_free(data);
5634 }
5635
5636 static void interface_p2p_service_params(DBusMessageIter *iter,
5637                                                         void *user_data)
5638 {
5639         struct p2p_service_data *data = user_data;
5640         GSupplicantP2PServiceParams *service;
5641         DBusMessageIter dict;
5642         const char *type;
5643
5644         SUPPLICANT_DBG("");
5645
5646         service = data->service;
5647
5648         supplicant_dbus_dict_open(iter, &dict);
5649
5650         if (service->query && service->response) {
5651                 type = "bonjour";
5652                 supplicant_dbus_dict_append_basic(&dict, "service_type",
5653                                                 DBUS_TYPE_STRING, &type);
5654                 supplicant_dbus_dict_append_fixed_array(&dict, "query",
5655                                         DBUS_TYPE_BYTE, &service->query,
5656                                         service->query_length);
5657                 supplicant_dbus_dict_append_fixed_array(&dict, "response",
5658                                         DBUS_TYPE_BYTE, &service->response,
5659                                         service->response_length);
5660         } else if (service->version && service->service) {
5661                 type = "upnp";
5662                 supplicant_dbus_dict_append_basic(&dict, "service_type",
5663                                                 DBUS_TYPE_STRING, &type);
5664                 supplicant_dbus_dict_append_basic(&dict, "version",
5665                                         DBUS_TYPE_INT32, &service->version);
5666                 supplicant_dbus_dict_append_basic(&dict, "service",
5667                                         DBUS_TYPE_STRING, &service->service);
5668         }
5669
5670         supplicant_dbus_dict_close(iter, &dict);
5671 }
5672
5673 int g_supplicant_interface_p2p_add_service(GSupplicantInterface *interface,
5674                                 GSupplicantInterfaceCallback callback,
5675                                 GSupplicantP2PServiceParams *p2p_service_params,
5676                                 void *user_data)
5677 {
5678         struct p2p_service_data *data;
5679         int ret;
5680
5681         SUPPLICANT_DBG("");
5682
5683         if (!interface->p2p_support)
5684                 return -ENOTSUP;
5685
5686         data = dbus_malloc0(sizeof(*data));
5687         if (!data)
5688                 return -ENOMEM;
5689
5690         data->registration = true;
5691         data->interface = interface;
5692         data->service = p2p_service_params;
5693         data->callback = callback;
5694         data->user_data = user_data;
5695
5696         ret = supplicant_dbus_method_call(interface->path,
5697                 SUPPLICANT_INTERFACE ".Interface.P2PDevice", "AddService",
5698                 interface_p2p_service_params, interface_p2p_service_result,
5699                 data, interface);
5700         if (ret < 0) {
5701                 dbus_free(data);
5702                 return ret;
5703         }
5704
5705         return -EINPROGRESS;
5706 }
5707
5708 int g_supplicant_interface_p2p_del_service(GSupplicantInterface *interface,
5709                                 GSupplicantP2PServiceParams *p2p_service_params)
5710 {
5711         struct p2p_service_data *data;
5712         int ret;
5713
5714         SUPPLICANT_DBG("");
5715
5716         if (!interface->p2p_support)
5717                 return -ENOTSUP;
5718
5719         data = dbus_malloc0(sizeof(*data));
5720         if (!data)
5721                 return -ENOMEM;
5722
5723         data->interface = interface;
5724         data->service = p2p_service_params;
5725
5726         ret = supplicant_dbus_method_call(interface->path,
5727                 SUPPLICANT_INTERFACE ".Interface.P2PDevice", "DeleteService",
5728                 interface_p2p_service_params, interface_p2p_service_result,
5729                 data, interface);
5730         if (ret < 0) {
5731                 dbus_free(data);
5732                 return ret;
5733         }
5734
5735         return -EINPROGRESS;
5736 }
5737
5738 struct p2p_listen_data {
5739         int period;
5740         int interval;
5741 };
5742
5743 static void interface_p2p_listen_params(DBusMessageIter *iter, void *user_data)
5744 {
5745         struct p2p_listen_data *params = user_data;
5746         DBusMessageIter dict;
5747
5748         supplicant_dbus_dict_open(iter, &dict);
5749
5750         supplicant_dbus_dict_append_basic(&dict, "period",
5751                                         DBUS_TYPE_INT32, &params->period);
5752         supplicant_dbus_dict_append_basic(&dict, "interval",
5753                                         DBUS_TYPE_INT32, &params->interval);
5754         supplicant_dbus_dict_close(iter, &dict);
5755 }
5756
5757 int g_supplicant_interface_p2p_listen(GSupplicantInterface *interface,
5758                                                 int period, int interval)
5759 {
5760         struct p2p_listen_data params;
5761
5762         SUPPLICANT_DBG("");
5763
5764         if (!interface->p2p_support)
5765                 return -ENOTSUP;
5766
5767         params.period = period;
5768         params.interval = interval;
5769
5770         return supplicant_dbus_method_call(interface->path,
5771                         SUPPLICANT_INTERFACE ".Interface.P2PDevice",
5772                         "ExtendedListen", interface_p2p_listen_params,
5773                         NULL, &params, NULL);
5774 }
5775
5776 static void widi_ies_params(DBusMessageIter *iter, void *user_data)
5777 {
5778         struct p2p_service_data *data = user_data;
5779         GSupplicantP2PServiceParams *service = data->service;
5780         DBusMessageIter array;
5781
5782         SUPPLICANT_DBG("%p - %d", service->wfd_ies, service->wfd_ies_length);
5783
5784         dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
5785                                         DBUS_TYPE_BYTE_AS_STRING, &array);
5786
5787         if (service->wfd_ies && service->wfd_ies_length > 0) {
5788                 dbus_message_iter_append_fixed_array(&array, DBUS_TYPE_BYTE,
5789                                 &service->wfd_ies, service->wfd_ies_length);
5790         }
5791
5792         dbus_message_iter_close_container(iter, &array);
5793 }
5794
5795 int g_supplicant_set_widi_ies(GSupplicantP2PServiceParams *p2p_service_params,
5796                                         GSupplicantInterfaceCallback callback,
5797                                         void *user_data)
5798 {
5799         struct p2p_service_data *data;
5800         int ret;
5801
5802         SUPPLICANT_DBG("");
5803
5804         if (!system_available)
5805                 return -EFAULT;
5806
5807         data = dbus_malloc0(sizeof(*data));
5808         if (!data)
5809                 return -ENOMEM;
5810
5811         data->service = p2p_service_params;
5812         data->callback = callback;
5813         data->user_data = user_data;
5814
5815         if (p2p_service_params->wfd_ies)
5816                 data->registration = true;
5817
5818         ret = supplicant_dbus_property_set(SUPPLICANT_PATH,
5819                                         SUPPLICANT_INTERFACE, "WFDIEs",
5820                                         DBUS_TYPE_ARRAY_AS_STRING
5821                                         DBUS_TYPE_BYTE_AS_STRING,
5822                                         widi_ies_params,
5823                                         interface_p2p_service_result,
5824                                         data, NULL);
5825         if (ret < 0 && ret != -EINPROGRESS) {
5826                 dbus_free(data);
5827                 return ret;
5828         }
5829
5830         return -EINPROGRESS;
5831 }
5832
5833
5834 static const char *g_supplicant_rule0 = "type=signal,"
5835                                         "path=" DBUS_PATH_DBUS ","
5836                                         "sender=" DBUS_SERVICE_DBUS ","
5837                                         "interface=" DBUS_INTERFACE_DBUS ","
5838                                         "member=NameOwnerChanged,"
5839                                         "arg0=" SUPPLICANT_SERVICE;
5840 static const char *g_supplicant_rule1 = "type=signal,"
5841                         "interface=" SUPPLICANT_INTERFACE;
5842 static const char *g_supplicant_rule2 = "type=signal,"
5843                         "interface=" SUPPLICANT_INTERFACE ".Interface";
5844 static const char *g_supplicant_rule3 = "type=signal,"
5845                         "interface=" SUPPLICANT_INTERFACE ".Interface.WPS";
5846 static const char *g_supplicant_rule4 = "type=signal,"
5847                         "interface=" SUPPLICANT_INTERFACE ".BSS";
5848 static const char *g_supplicant_rule5 = "type=signal,"
5849                         "interface=" SUPPLICANT_INTERFACE ".Network";
5850 static const char *g_supplicant_rule6 = "type=signal,"
5851                 "interface=" SUPPLICANT_INTERFACE ".Interface.P2PDevice";
5852 static const char *g_supplicant_rule7 = "type=signal,"
5853                 "interface=" SUPPLICANT_INTERFACE ".Peer";
5854 static const char *g_supplicant_rule8 = "type=signal,"
5855                 "interface=" SUPPLICANT_INTERFACE ".Group";
5856
5857 static void invoke_introspect_method(void)
5858 {
5859         DBusMessage *message;
5860
5861         message = dbus_message_new_method_call(SUPPLICANT_SERVICE,
5862                                         SUPPLICANT_PATH,
5863                                         DBUS_INTERFACE_INTROSPECTABLE,
5864                                         "Introspect");
5865
5866         if (!message)
5867                 return;
5868
5869         dbus_message_set_no_reply(message, TRUE);
5870         dbus_connection_send(connection, message, NULL);
5871         dbus_message_unref(message);
5872 }
5873
5874 int g_supplicant_register(const GSupplicantCallbacks *callbacks)
5875 {
5876         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
5877         if (!connection)
5878                 return -EIO;
5879
5880         if (!dbus_connection_add_filter(connection, g_supplicant_filter,
5881                                                 NULL, NULL)) {
5882                 dbus_connection_unref(connection);
5883                 connection = NULL;
5884                 return -EIO;
5885         }
5886
5887         callbacks_pointer = callbacks;
5888         eap_methods = 0;
5889
5890         interface_table = g_hash_table_new_full(g_str_hash, g_str_equal,
5891                                                 NULL, remove_interface);
5892
5893         bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
5894                                                                 NULL, NULL);
5895         peer_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
5896                                                                 NULL, NULL);
5897         group_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
5898                                                                 NULL, NULL);
5899         pending_peer_connection = g_hash_table_new_full(g_str_hash, g_str_equal,
5900                                                                 NULL, NULL);
5901         config_file_table = g_hash_table_new_full(g_str_hash, g_str_equal,
5902                                                                 g_free, g_free);
5903
5904         supplicant_dbus_setup(connection);
5905
5906         dbus_bus_add_match(connection, g_supplicant_rule0, NULL);
5907         dbus_bus_add_match(connection, g_supplicant_rule1, NULL);
5908         dbus_bus_add_match(connection, g_supplicant_rule2, NULL);
5909         dbus_bus_add_match(connection, g_supplicant_rule3, NULL);
5910         dbus_bus_add_match(connection, g_supplicant_rule4, NULL);
5911         dbus_bus_add_match(connection, g_supplicant_rule5, NULL);
5912         dbus_bus_add_match(connection, g_supplicant_rule6, NULL);
5913         dbus_bus_add_match(connection, g_supplicant_rule7, NULL);
5914         dbus_bus_add_match(connection, g_supplicant_rule8, NULL);
5915         dbus_connection_flush(connection);
5916
5917         if (dbus_bus_name_has_owner(connection,
5918                                         SUPPLICANT_SERVICE, NULL)) {
5919                 system_available = TRUE;
5920                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
5921                                                 SUPPLICANT_INTERFACE,
5922                                                 service_property, NULL, NULL);
5923         } else
5924                 invoke_introspect_method();
5925
5926         return 0;
5927 }
5928
5929 static void unregister_interface_remove_params(DBusMessageIter *iter,
5930                                                 void *user_data)
5931 {
5932         const char *path = user_data;
5933
5934         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
5935                                                         &path);
5936 }
5937
5938
5939 static void unregister_remove_interface(gpointer key, gpointer value,
5940                                                 gpointer user_data)
5941 {
5942         GSupplicantInterface *interface = value;
5943
5944         supplicant_dbus_method_call(SUPPLICANT_PATH,
5945                                         SUPPLICANT_INTERFACE,
5946                                         "RemoveInterface",
5947                                         unregister_interface_remove_params,
5948                                         NULL, interface->path, NULL);
5949 }
5950
5951 void g_supplicant_unregister(const GSupplicantCallbacks *callbacks)
5952 {
5953         SUPPLICANT_DBG("");
5954
5955         if (connection) {
5956                 dbus_bus_remove_match(connection, g_supplicant_rule8, NULL);
5957                 dbus_bus_remove_match(connection, g_supplicant_rule7, NULL);
5958                 dbus_bus_remove_match(connection, g_supplicant_rule6, NULL);
5959                 dbus_bus_remove_match(connection, g_supplicant_rule5, NULL);
5960                 dbus_bus_remove_match(connection, g_supplicant_rule4, NULL);
5961                 dbus_bus_remove_match(connection, g_supplicant_rule3, NULL);
5962                 dbus_bus_remove_match(connection, g_supplicant_rule2, NULL);
5963                 dbus_bus_remove_match(connection, g_supplicant_rule1, NULL);
5964                 dbus_bus_remove_match(connection, g_supplicant_rule0, NULL);
5965                 dbus_connection_flush(connection);
5966
5967                 dbus_connection_remove_filter(connection,
5968                                                 g_supplicant_filter, NULL);
5969         }
5970
5971         if (config_file_table) {
5972                 g_hash_table_destroy(config_file_table);
5973                 config_file_table = NULL;
5974         }
5975
5976         if (bss_mapping) {
5977                 g_hash_table_destroy(bss_mapping);
5978                 bss_mapping = NULL;
5979         }
5980
5981         if (peer_mapping) {
5982                 g_hash_table_destroy(peer_mapping);
5983                 peer_mapping = NULL;
5984         }
5985
5986         if (group_mapping) {
5987                 g_hash_table_destroy(group_mapping);
5988                 group_mapping = NULL;
5989         }
5990
5991         if (interface_table) {
5992                 g_hash_table_foreach(interface_table,
5993                                         unregister_remove_interface, NULL);
5994                 g_hash_table_destroy(interface_table);
5995                 interface_table = NULL;
5996         }
5997
5998         if (system_available)
5999                 callback_system_killed();
6000
6001         if (connection) {
6002                 dbus_connection_unref(connection);
6003                 connection = NULL;
6004         }
6005
6006         callbacks_pointer = NULL;
6007         eap_methods = 0;
6008 }