gsupplicant/supplicant.c

   1 /*
   2  *
   3  *  WPA supplicant library with GLib integration
   4  *
   5  *  Copyright (C) 2010  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
  34 #include <glib.h>
  35 #include <gdbus.h>
  36
  37 #include "dbus.h"
  38 #include "gsupplicant.h"
  39
  40 #define TIMEOUT 5000
  41
  42 #define IEEE80211_CAP_ESS       0x0001
  43 #define IEEE80211_CAP_IBSS      0x0002
  44 #define IEEE80211_CAP_PRIVACY   0x0010
  45
  46 static DBusConnection *connection;
  47
  48 static const GSupplicantCallbacks *callbacks_pointer;
  49
  50 static dbus_bool_t system_available = FALSE;
  51 static dbus_bool_t system_ready = FALSE;
  52
  53 static dbus_int32_t debug_level;
  54 static dbus_bool_t debug_timestamp = FALSE;
  55 static dbus_bool_t debug_showkeys = FALSE;
  56
  57 static const char *debug_strings[] = {
  58         "msgdump", "debug", "info", "warning", "error", NULL
  59 };
  60
  61 static unsigned int eap_methods;
  62
  63 struct strvalmap {
  64         const char *str;
  65         unsigned int val;
  66 };
  67
  68 static struct strvalmap eap_method_map[] = {
  69         { "MD5",        G_SUPPLICANT_EAP_METHOD_MD5     },
  70         { "TLS",        G_SUPPLICANT_EAP_METHOD_TLS     },
  71         { "MSCHAPV2",   G_SUPPLICANT_EAP_METHOD_MSCHAPV2        },
  72         { "PEAP",       G_SUPPLICANT_EAP_METHOD_PEAP    },
  73         { "TTLS",       G_SUPPLICANT_EAP_METHOD_TTLS    },
  74         { "GTC",        G_SUPPLICANT_EAP_METHOD_GTC     },
  75         { "OTP",        G_SUPPLICANT_EAP_METHOD_OTP     },
  76         { "LEAP",       G_SUPPLICANT_EAP_METHOD_LEAP    },
  77         { "WSC",        G_SUPPLICANT_EAP_METHOD_WSC     },
  78         { }
  79 };
  80
  81 static struct strvalmap keymgmt_map[] = {
  82         { "none",               G_SUPPLICANT_KEYMGMT_NONE               },
  83         { "ieee8021x",          G_SUPPLICANT_KEYMGMT_IEEE8021X  },
  84         { "wpa-none",           G_SUPPLICANT_KEYMGMT_WPA_NONE   },
  85         { "wpa-psk",            G_SUPPLICANT_KEYMGMT_WPA_PSK    },
  86         { "wpa-psk-sha256",     G_SUPPLICANT_KEYMGMT_WPA_PSK_256        },
  87         { "wpa-ft-psk",         G_SUPPLICANT_KEYMGMT_WPA_FT_PSK },
  88         { "wpa-ft-eap",         G_SUPPLICANT_KEYMGMT_WPA_FT_EAP },
  89         { "wpa-eap",            G_SUPPLICANT_KEYMGMT_WPA_EAP    },
  90         { "wpa-eap-sha256",     G_SUPPLICANT_KEYMGMT_WPA_EAP_256        },
  91         { "wps",                G_SUPPLICANT_KEYMGMT_WPS                },
  92         { }
  93 };
  94
  95 static struct strvalmap authalg_capa_map[] = {
  96         { "open",       G_SUPPLICANT_CAPABILITY_AUTHALG_OPEN    },
  97         { "shared",     G_SUPPLICANT_CAPABILITY_AUTHALG_SHARED  },
  98         { "leap",       G_SUPPLICANT_CAPABILITY_AUTHALG_LEAP    },
  99         { }
 100 };
 101
 102 static struct strvalmap proto_capa_map[] = {
 103         { "wpa",        G_SUPPLICANT_CAPABILITY_PROTO_WPA               },
 104         { "rsn",        G_SUPPLICANT_CAPABILITY_PROTO_RSN               },
 105         { }
 106 };
 107
 108 static struct strvalmap group_map[] = {
 109         { "wep40",      G_SUPPLICANT_GROUP_WEP40        },
 110         { "wep104",     G_SUPPLICANT_GROUP_WEP104       },
 111         { "tkip",       G_SUPPLICANT_GROUP_TKIP },
 112         { "ccmp",       G_SUPPLICANT_GROUP_CCMP },
 113         { }
 114 };
 115
 116 static struct strvalmap pairwise_map[] = {
 117         { "none",       G_SUPPLICANT_PAIRWISE_NONE      },
 118         { "tkip",       G_SUPPLICANT_PAIRWISE_TKIP      },
 119         { "ccmp",       G_SUPPLICANT_PAIRWISE_CCMP      },
 120         { }
 121 };
 122
 123 static struct strvalmap scan_capa_map[] = {
 124         { "active",     G_SUPPLICANT_CAPABILITY_SCAN_ACTIVE     },
 125         { "passive",    G_SUPPLICANT_CAPABILITY_SCAN_PASSIVE    },
 126         { "ssid",       G_SUPPLICANT_CAPABILITY_SCAN_SSID               },
 127         { }
 128 };
 129
 130 static struct strvalmap mode_capa_map[] = {
 131         { "infrastructure",     G_SUPPLICANT_CAPABILITY_MODE_INFRA      },
 132         { "ad-hoc",             G_SUPPLICANT_CAPABILITY_MODE_IBSS       },
 133         { "ap",                 G_SUPPLICANT_CAPABILITY_MODE_AP         },
 134         { }
 135 };
 136
 137 static GHashTable *interface_table;
 138 static GHashTable *bss_mapping;
 139
 140 struct _GSupplicantWpsCredentials {
 141         unsigned char ssid[32];
 142         unsigned int ssid_len;
 143         char *key;
 144 };
 145
 146 struct _GSupplicantInterface {
 147         char *path;
 148         char *network_path;
 149         unsigned int keymgmt_capa;
 150         unsigned int authalg_capa;
 151         unsigned int proto_capa;
 152         unsigned int group_capa;
 153         unsigned int pairwise_capa;
 154         unsigned int scan_capa;
 155         unsigned int mode_capa;
 156         unsigned int max_scan_ssids;
 157         dbus_bool_t ready;
 158         GSupplicantState state;
 159         dbus_bool_t scanning;
 160         GSupplicantInterfaceCallback scan_callback;
 161         void *scan_data;
 162         int apscan;
 163         char *ifname;
 164         char *driver;
 165         char *bridge;
 166         struct _GSupplicantWpsCredentials wps_cred;
 167         GSupplicantWpsState wps_state;
 168         GHashTable *network_table;
 169         GHashTable *net_mapping;
 170         GHashTable *bss_mapping;
 171         void *data;
 172 };
 173
 174 struct g_supplicant_bss {
 175         GSupplicantInterface *interface;
 176         char *path;
 177         unsigned char bssid[6];
 178         unsigned char ssid[32];
 179         unsigned int ssid_len;
 180         dbus_uint16_t frequency;
 181         dbus_uint32_t maxrate;
 182         dbus_int16_t signal;
 183         GSupplicantMode mode;
 184         GSupplicantSecurity security;
 185         unsigned int keymgmt;
 186         unsigned int pairwise;
 187         unsigned int group;
 188         dbus_bool_t privacy;
 189         dbus_bool_t psk;
 190         dbus_bool_t ieee8021x;
 191         unsigned int wps_capabilities;
 192 };
 193
 194 struct _GSupplicantNetwork {
 195         GSupplicantInterface *interface;
 196         char *path;
 197         char *group;
 198         char *name;
 199         unsigned char ssid[32];
 200         unsigned int ssid_len;
 201         dbus_int16_t signal;
 202         dbus_uint16_t frequency;
 203         struct g_supplicant_bss *best_bss;
 204         GSupplicantMode mode;
 205         GSupplicantSecurity security;
 206         dbus_bool_t wps;
 207         unsigned int wps_capabilities;
 208         GHashTable *bss_table;
 209         GHashTable *config_table;
 210 };
 211
 212 static inline void debug(const char *format, ...)
 213 {
 214         char str[256];
 215         va_list ap;
 216
 217         if (callbacks_pointer->debug == NULL)
 218                 return;
 219
 220         va_start(ap, format);
 221
 222         if (vsnprintf(str, sizeof(str), format, ap) > 0)
 223                 callbacks_pointer->debug(str);
 224
 225         va_end(ap);
 226 }
 227
 228 #define SUPPLICANT_DBG(fmt, arg...) \
 229         debug("%s:%s() " fmt, __FILE__, __FUNCTION__ , ## arg);
 230
 231 static GSupplicantMode string2mode(const char *mode)
 232 {
 233         if (mode == NULL)
 234                 return G_SUPPLICANT_MODE_UNKNOWN;
 235
 236         if (g_str_equal(mode, "infrastructure") == TRUE)
 237                 return G_SUPPLICANT_MODE_INFRA;
 238         else if (g_str_equal(mode, "ad-hoc") == TRUE)
 239                 return G_SUPPLICANT_MODE_IBSS;
 240
 241         return G_SUPPLICANT_MODE_UNKNOWN;
 242 }
 243
 244 static const char *mode2string(GSupplicantMode mode)
 245 {
 246         switch (mode) {
 247         case G_SUPPLICANT_MODE_UNKNOWN:
 248                 break;
 249         case G_SUPPLICANT_MODE_INFRA:
 250                 return "managed";
 251         case G_SUPPLICANT_MODE_IBSS:
 252                 return "adhoc";
 253         case G_SUPPLICANT_MODE_MASTER:
 254                 return "ap";
 255         }
 256
 257         return NULL;
 258 }
 259
 260 static const char *security2string(GSupplicantSecurity security)
 261 {
 262         switch (security) {
 263         case G_SUPPLICANT_SECURITY_UNKNOWN:
 264                 break;
 265         case G_SUPPLICANT_SECURITY_NONE:
 266                 return "none";
 267         case G_SUPPLICANT_SECURITY_WEP:
 268                 return "wep";
 269         case G_SUPPLICANT_SECURITY_PSK:
 270                 return "psk";
 271         case G_SUPPLICANT_SECURITY_IEEE8021X:
 272                 return "ieee8021x";
 273         }
 274
 275         return NULL;
 276 }
 277
 278 static GSupplicantState string2state(const char *state)
 279 {
 280         if (state == NULL)
 281                 return G_SUPPLICANT_STATE_UNKNOWN;
 282
 283         if (g_str_equal(state, "unknown") == TRUE)
 284                 return G_SUPPLICANT_STATE_UNKNOWN;
 285         else if (g_str_equal(state, "disconnected") == TRUE)
 286                 return G_SUPPLICANT_STATE_DISCONNECTED;
 287         else if (g_str_equal(state, "inactive") == TRUE)
 288                 return G_SUPPLICANT_STATE_INACTIVE;
 289         else if (g_str_equal(state, "scanning") == TRUE)
 290                 return G_SUPPLICANT_STATE_SCANNING;
 291         else if (g_str_equal(state, "authenticating") == TRUE)
 292                 return G_SUPPLICANT_STATE_AUTHENTICATING;
 293         else if (g_str_equal(state, "associating") == TRUE)
 294                 return G_SUPPLICANT_STATE_ASSOCIATING;
 295         else if (g_str_equal(state, "associated") == TRUE)
 296                 return G_SUPPLICANT_STATE_ASSOCIATED;
 297         else if (g_str_equal(state, "group_handshake") == TRUE)
 298                 return G_SUPPLICANT_STATE_GROUP_HANDSHAKE;
 299         else if (g_str_equal(state, "4way_handshake") == TRUE)
 300                 return G_SUPPLICANT_STATE_4WAY_HANDSHAKE;
 301         else if (g_str_equal(state, "completed") == TRUE)
 302                 return G_SUPPLICANT_STATE_COMPLETED;
 303
 304         return G_SUPPLICANT_STATE_UNKNOWN;
 305 }
 306
 307 static void callback_system_ready(void)
 308 {
 309         if (system_ready == TRUE)
 310                 return;
 311
 312         system_ready = TRUE;
 313
 314         if (callbacks_pointer == NULL)
 315                 return;
 316
 317         if (callbacks_pointer->system_ready == NULL)
 318                 return;
 319
 320         callbacks_pointer->system_ready();
 321 }
 322
 323 static void callback_system_killed(void)
 324 {
 325         system_ready = FALSE;
 326
 327         if (callbacks_pointer == NULL)
 328                 return;
 329
 330         if (callbacks_pointer->system_killed == NULL)
 331                 return;
 332
 333         callbacks_pointer->system_killed();
 334 }
 335
 336 static void callback_interface_added(GSupplicantInterface *interface)
 337 {
 338         SUPPLICANT_DBG("");
 339
 340         if (callbacks_pointer == NULL)
 341                 return;
 342
 343         if (callbacks_pointer->interface_added == NULL)
 344                 return;
 345
 346         callbacks_pointer->interface_added(interface);
 347 }
 348
 349 static void callback_interface_state(GSupplicantInterface *interface)
 350 {
 351         if (callbacks_pointer == NULL)
 352                 return;
 353
 354         if (callbacks_pointer->interface_state == NULL)
 355                 return;
 356
 357         callbacks_pointer->interface_state(interface);
 358 }
 359
 360 static void callback_interface_removed(GSupplicantInterface *interface)
 361 {
 362         if (callbacks_pointer == NULL)
 363                 return;
 364
 365         if (callbacks_pointer->interface_removed == NULL)
 366                 return;
 367
 368         callbacks_pointer->interface_removed(interface);
 369 }
 370
 371 static void callback_scan_started(GSupplicantInterface *interface)
 372 {
 373         if (callbacks_pointer == NULL)
 374                 return;
 375
 376         if (callbacks_pointer->scan_started == NULL)
 377                 return;
 378
 379         callbacks_pointer->scan_started(interface);
 380 }
 381
 382 static void callback_scan_finished(GSupplicantInterface *interface)
 383 {
 384         if (callbacks_pointer == NULL)
 385                 return;
 386
 387         if (callbacks_pointer->scan_finished == NULL)
 388                 return;
 389
 390         callbacks_pointer->scan_finished(interface);
 391 }
 392
 393 static void callback_network_added(GSupplicantNetwork *network)
 394 {
 395         if (callbacks_pointer == NULL)
 396                 return;
 397
 398         if (callbacks_pointer->network_added == NULL)
 399                 return;
 400
 401         callbacks_pointer->network_added(network);
 402 }
 403
 404 static void callback_network_removed(GSupplicantNetwork *network)
 405 {
 406         if (callbacks_pointer == NULL)
 407                 return;
 408
 409         if (callbacks_pointer->network_removed == NULL)
 410                 return;
 411
 412         callbacks_pointer->network_removed(network);
 413 }
 414
 415 static void callback_network_changed(GSupplicantNetwork *network,
 416                                         const char *property)
 417 {
 418         if (callbacks_pointer == NULL)
 419                 return;
 420
 421         if (callbacks_pointer->network_changed == NULL)
 422                 return;
 423
 424         callbacks_pointer->network_changed(network, property);
 425 }
 426
 427 static void remove_interface(gpointer data)
 428 {
 429         GSupplicantInterface *interface = data;
 430
 431         g_hash_table_destroy(interface->bss_mapping);
 432         g_hash_table_destroy(interface->net_mapping);
 433         g_hash_table_destroy(interface->network_table);
 434
 435         callback_interface_removed(interface);
 436
 437         g_free(interface->wps_cred.key);
 438         g_free(interface->path);
 439         g_free(interface->network_path);
 440         g_free(interface->ifname);
 441         g_free(interface->driver);
 442         g_free(interface->bridge);
 443         g_free(interface);
 444 }
 445
 446 static void remove_network(gpointer data)
 447 {
 448         GSupplicantNetwork *network = data;
 449
 450         g_hash_table_destroy(network->bss_table);
 451
 452         callback_network_removed(network);
 453
 454         g_hash_table_destroy(network->config_table);
 455
 456         g_free(network->path);
 457         g_free(network->group);
 458         g_free(network->name);
 459         g_free(network);
 460 }
 461
 462 static void remove_bss(gpointer data)
 463 {
 464         struct g_supplicant_bss *bss = data;
 465
 466         g_free(bss->path);
 467         g_free(bss);
 468 }
 469
 470 static void debug_strvalmap(const char *label, struct strvalmap *map,
 471                                                         unsigned int val)
 472 {
 473         int i;
 474
 475         for (i = 0; map[i].str != NULL; i++) {
 476                 if (val & map[i].val)
 477                         SUPPLICANT_DBG("%s: %s", label, map[i].str);
 478         }
 479 }
 480
 481 static void interface_capability_keymgmt(DBusMessageIter *iter, void *user_data)
 482 {
 483         GSupplicantInterface *interface = user_data;
 484         const char *str = NULL;
 485         int i;
 486
 487         dbus_message_iter_get_basic(iter, &str);
 488         if (str == NULL)
 489                 return;
 490
 491         for (i = 0; keymgmt_map[i].str != NULL; i++)
 492                 if (strcmp(str, keymgmt_map[i].str) == 0) {
 493                         interface->keymgmt_capa |= keymgmt_map[i].val;
 494                         break;
 495                 }
 496 }
 497
 498 static void interface_capability_authalg(DBusMessageIter *iter, void *user_data)
 499 {
 500         GSupplicantInterface *interface = user_data;
 501         const char *str = NULL;
 502         int i;
 503
 504         dbus_message_iter_get_basic(iter, &str);
 505         if (str == NULL)
 506                 return;
 507
 508         for (i = 0; authalg_capa_map[i].str != NULL; i++)
 509                 if (strcmp(str, authalg_capa_map[i].str) == 0) {
 510                         interface->authalg_capa |= authalg_capa_map[i].val;
 511                         break;
 512                 }
 513 }
 514
 515 static void interface_capability_proto(DBusMessageIter *iter, void *user_data)
 516 {
 517         GSupplicantInterface *interface = user_data;
 518         const char *str = NULL;
 519         int i;
 520
 521         dbus_message_iter_get_basic(iter, &str);
 522         if (str == NULL)
 523                 return;
 524
 525         for (i = 0; proto_capa_map[i].str != NULL; i++)
 526                 if (strcmp(str, proto_capa_map[i].str) == 0) {
 527                         interface->proto_capa |= proto_capa_map[i].val;
 528                         break;
 529                 }
 530 }
 531
 532 static void interface_capability_pairwise(DBusMessageIter *iter,
 533                                                         void *user_data)
 534 {
 535         GSupplicantInterface *interface = user_data;
 536         const char *str = NULL;
 537         int i;
 538
 539         dbus_message_iter_get_basic(iter, &str);
 540         if (str == NULL)
 541                 return;
 542
 543         for (i = 0; pairwise_map[i].str != NULL; i++)
 544                 if (strcmp(str, pairwise_map[i].str) == 0) {
 545                         interface->pairwise_capa |= pairwise_map[i].val;
 546                         break;
 547                 }
 548 }
 549
 550 static void interface_capability_group(DBusMessageIter *iter, void *user_data)
 551 {
 552         GSupplicantInterface *interface = user_data;
 553         const char *str = NULL;
 554         int i;
 555
 556         dbus_message_iter_get_basic(iter, &str);
 557         if (str == NULL)
 558                 return;
 559
 560         for (i = 0; group_map[i].str != NULL; i++)
 561                 if (strcmp(str, group_map[i].str) == 0) {
 562                         interface->group_capa |= group_map[i].val;
 563                         break;
 564                 }
 565 }
 566
 567 static void interface_capability_scan(DBusMessageIter *iter, void *user_data)
 568 {
 569         GSupplicantInterface *interface = user_data;
 570         const char *str = NULL;
 571         int i;
 572
 573         dbus_message_iter_get_basic(iter, &str);
 574         if (str == NULL)
 575                 return;
 576
 577         for (i = 0; scan_capa_map[i].str != NULL; i++)
 578                 if (strcmp(str, scan_capa_map[i].str) == 0) {
 579                         interface->scan_capa |= scan_capa_map[i].val;
 580                         break;
 581                 }
 582 }
 583
 584 static void interface_capability_mode(DBusMessageIter *iter, void *user_data)
 585 {
 586         GSupplicantInterface *interface = user_data;
 587         const char *str = NULL;
 588         int i;
 589
 590         dbus_message_iter_get_basic(iter, &str);
 591         if (str == NULL)
 592                 return;
 593
 594         for (i = 0; mode_capa_map[i].str != NULL; i++)
 595                 if (strcmp(str, mode_capa_map[i].str) == 0) {
 596                         interface->mode_capa |= mode_capa_map[i].val;
 597                         break;
 598                 }
 599 }
 600
 601 static void interface_capability(const char *key, DBusMessageIter *iter,
 602                                                         void *user_data)
 603 {
 604         GSupplicantInterface *interface = user_data;
 605
 606         if (key == NULL)
 607                 return;
 608
 609         if (g_strcmp0(key, "KeyMgmt") == 0)
 610                 supplicant_dbus_array_foreach(iter,
 611                                 interface_capability_keymgmt, interface);
 612         else if (g_strcmp0(key, "AuthAlg") == 0)
 613                 supplicant_dbus_array_foreach(iter,
 614                                 interface_capability_authalg, interface);
 615         else if (g_strcmp0(key, "Protocol") == 0)
 616                 supplicant_dbus_array_foreach(iter,
 617                                 interface_capability_proto, interface);
 618         else if (g_strcmp0(key, "Pairwise") == 0)
 619                 supplicant_dbus_array_foreach(iter,
 620                                 interface_capability_pairwise, interface);
 621         else if (g_strcmp0(key, "Group") == 0)
 622                 supplicant_dbus_array_foreach(iter,
 623                                 interface_capability_group, interface);
 624         else if (g_strcmp0(key, "Scan") == 0)
 625                 supplicant_dbus_array_foreach(iter,
 626                                 interface_capability_scan, interface);
 627         else if (g_strcmp0(key, "Modes") == 0)
 628                 supplicant_dbus_array_foreach(iter,
 629                                 interface_capability_mode, interface);
 630         else if (g_strcmp0(key, "MaxScanSSID") == 0) {
 631                 dbus_int32_t max_scan_ssid;
 632
 633                 dbus_message_iter_get_basic(iter, &max_scan_ssid);
 634                 interface->max_scan_ssids = max_scan_ssid;
 635
 636         } else
 637                 SUPPLICANT_DBG("key %s type %c",
 638                                 key, dbus_message_iter_get_arg_type(iter));
 639 }
 640
 641 static void set_apscan(DBusMessageIter *iter, void *user_data)
 642 {
 643         unsigned int ap_scan = *(unsigned int *)user_data;
 644
 645         dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT32, &ap_scan);
 646 }
 647
 648 int g_supplicant_interface_set_apscan(GSupplicantInterface *interface,
 649                                                         unsigned int ap_scan)
 650 {
 651         return supplicant_dbus_property_set(interface->path,
 652                         SUPPLICANT_INTERFACE ".Interface",
 653                                 "ApScan", DBUS_TYPE_UINT32_AS_STRING,
 654                                         set_apscan, NULL, &ap_scan);
 655 }
 656
 657 void g_supplicant_interface_set_data(GSupplicantInterface *interface,
 658                                                                 void *data)
 659 {
 660         if (interface == NULL)
 661                 return;
 662
 663         interface->data = data;
 664 }
 665
 666 void *g_supplicant_interface_get_data(GSupplicantInterface *interface)
 667 {
 668         if (interface == NULL)
 669                 return NULL;
 670
 671         return interface->data;
 672 }
 673
 674 const char *g_supplicant_interface_get_ifname(GSupplicantInterface *interface)
 675 {
 676         if (interface == NULL)
 677                 return NULL;
 678
 679         return interface->ifname;
 680 }
 681
 682 const char *g_supplicant_interface_get_driver(GSupplicantInterface *interface)
 683 {
 684         if (interface == NULL)
 685                 return NULL;
 686
 687         return interface->driver;
 688 }
 689
 690 GSupplicantState g_supplicant_interface_get_state(
 691                                         GSupplicantInterface *interface)
 692 {
 693         if (interface == NULL)
 694                 return G_SUPPLICANT_STATE_UNKNOWN;
 695
 696         return interface->state;
 697 }
 698
 699 const char *g_supplicant_interface_get_wps_key(GSupplicantInterface *interface)
 700 {
 701         if (interface == NULL)
 702                 return NULL;
 703
 704         return (const char *)interface->wps_cred.key;
 705 }
 706
 707 const void *g_supplicant_interface_get_wps_ssid(GSupplicantInterface *interface,
 708                                                         unsigned int *ssid_len)
 709 {
 710         if (ssid_len == NULL)
 711                 return NULL;
 712
 713         if (interface == NULL || interface->wps_cred.ssid == NULL) {
 714                 *ssid_len = 0;
 715                 return NULL;
 716         }
 717
 718         *ssid_len = interface->wps_cred.ssid_len;
 719         return interface->wps_cred.ssid;
 720 }
 721
 722 GSupplicantWpsState g_supplicant_interface_get_wps_state(
 723                                         GSupplicantInterface *interface)
 724 {
 725         if (interface == NULL)
 726                 return G_SUPPLICANT_WPS_STATE_UNKNOWN;
 727
 728         return interface->wps_state;
 729 }
 730
 731 unsigned int g_supplicant_interface_get_mode(GSupplicantInterface *interface)
 732 {
 733         if (interface == NULL)
 734                 return 0;
 735
 736         return interface->mode_capa;
 737 }
 738
 739 unsigned int g_supplicant_interface_get_max_scan_ssids(
 740                                 GSupplicantInterface *interface)
 741 {
 742         if (interface == NULL)
 743                 return 0;
 744
 745         return interface->max_scan_ssids;
 746 }
 747
 748 static void set_network_enabled(DBusMessageIter *iter, void *user_data)
 749 {
 750         dbus_bool_t enable = *(dbus_bool_t *)user_data;
 751
 752         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &enable);
 753 }
 754
 755 int g_supplicant_interface_enable_selected_network(GSupplicantInterface *interface,
 756                                                         dbus_bool_t enable)
 757 {
 758         if (interface == NULL)
 759                 return -1;
 760
 761         if (interface->network_path == NULL)
 762                 return -1;
 763
 764         SUPPLICANT_DBG(" ");
 765         return supplicant_dbus_property_set(interface->network_path,
 766                                 SUPPLICANT_INTERFACE ".Network",
 767                                 "Enabled", DBUS_TYPE_BOOLEAN_AS_STRING,
 768                                 set_network_enabled, NULL, &enable);
 769 }
 770
 771 dbus_bool_t g_supplicant_interface_get_ready(GSupplicantInterface *interface)
 772 {
 773         if (interface == NULL)
 774                 return FALSE;
 775
 776         return interface->ready;
 777 }
 778
 779 GSupplicantInterface *g_supplicant_network_get_interface(
 780                                         GSupplicantNetwork *network)
 781 {
 782         if (network == NULL)
 783                 return NULL;
 784
 785         return network->interface;
 786 }
 787
 788 const char *g_supplicant_network_get_name(GSupplicantNetwork *network)
 789 {
 790         if (network == NULL || network->name == NULL)
 791                 return "";
 792
 793         return network->name;
 794 }
 795
 796 const char *g_supplicant_network_get_identifier(GSupplicantNetwork *network)
 797 {
 798         if (network == NULL || network->group == NULL)
 799                 return "";
 800
 801         return network->group;
 802 }
 803
 804 const char *g_supplicant_network_get_path(GSupplicantNetwork *network)
 805 {
 806         if (network == NULL || network->path == NULL)
 807                 return NULL;
 808
 809         return network->path;
 810 }
 811
 812 const char *g_supplicant_network_get_mode(GSupplicantNetwork *network)
 813 {
 814         if (network == NULL)
 815                 return G_SUPPLICANT_MODE_UNKNOWN;
 816
 817         return mode2string(network->mode);
 818 }
 819
 820 const char *g_supplicant_network_get_security(GSupplicantNetwork *network)
 821 {
 822         if (network == NULL)
 823                 return G_SUPPLICANT_SECURITY_UNKNOWN;
 824
 825         return security2string(network->security);
 826 }
 827
 828 const void *g_supplicant_network_get_ssid(GSupplicantNetwork *network,
 829                                                 unsigned int *ssid_len)
 830 {
 831         if (network == NULL || network->ssid == NULL) {
 832                 *ssid_len = 0;
 833                 return NULL;
 834         }
 835
 836         *ssid_len = network->ssid_len;
 837         return network->ssid;
 838 }
 839
 840 dbus_int16_t g_supplicant_network_get_signal(GSupplicantNetwork *network)
 841 {
 842         if (network == NULL)
 843                 return 0;
 844
 845         return network->signal;
 846 }
 847
 848 dbus_uint16_t g_supplicant_network_get_frequency(GSupplicantNetwork *network)
 849 {
 850         if (network == NULL)
 851                 return 0;
 852
 853         return network->frequency;
 854 }
 855
 856 dbus_bool_t g_supplicant_network_get_wps(GSupplicantNetwork *network)
 857 {
 858         if (network == NULL)
 859                 return FALSE;
 860
 861         return network->wps;
 862 }
 863
 864 dbus_bool_t g_supplicant_network_is_wps_active(GSupplicantNetwork *network)
 865 {
 866         if (network == NULL)
 867                 return FALSE;
 868
 869         if (network->wps_capabilities & G_SUPPLICANT_WPS_CONFIGURED)
 870                 return TRUE;
 871
 872         return FALSE;
 873 }
 874
 875 dbus_bool_t g_supplicant_network_is_wps_pbc(GSupplicantNetwork *network)
 876 {
 877         if (network == NULL)
 878                 return FALSE;
 879
 880         if (network->wps_capabilities & G_SUPPLICANT_WPS_PBC)
 881                 return TRUE;
 882
 883         return FALSE;
 884 }
 885
 886 dbus_bool_t g_supplicant_network_is_wps_advertizing(GSupplicantNetwork *network)
 887 {
 888         if (network == NULL)
 889                 return FALSE;
 890
 891         if (network->wps_capabilities & G_SUPPLICANT_WPS_REGISTRAR)
 892                 return TRUE;
 893
 894         return FALSE;
 895 }
 896
 897 static void merge_network(GSupplicantNetwork *network)
 898 {
 899         GString *str;
 900         const char *ssid, *mode, *key_mgmt;
 901         unsigned int i, ssid_len;
 902         char *group;
 903
 904         ssid = g_hash_table_lookup(network->config_table, "ssid");
 905         mode = g_hash_table_lookup(network->config_table, "mode");
 906         key_mgmt = g_hash_table_lookup(network->config_table, "key_mgmt");
 907
 908         SUPPLICANT_DBG("ssid %s mode %s", ssid, mode);
 909
 910         if (ssid != NULL)
 911                 ssid_len = strlen(ssid);
 912         else
 913                 ssid_len = 0;
 914
 915         str = g_string_sized_new((ssid_len * 2) + 24);
 916         if (str == NULL)
 917                 return;
 918
 919         for (i = 0; i < ssid_len; i++)
 920                 g_string_append_printf(str, "%02x", ssid[i]);
 921
 922         if (g_strcmp0(mode, "0") == 0)
 923                 g_string_append_printf(str, "_managed");
 924         else if (g_strcmp0(mode, "1") == 0)
 925                 g_string_append_printf(str, "_adhoc");
 926
 927         if (g_strcmp0(key_mgmt, "WPA-PSK") == 0)
 928                 g_string_append_printf(str, "_psk");
 929
 930         group = g_string_free(str, FALSE);
 931
 932         SUPPLICANT_DBG("%s", group);
 933
 934         g_free(group);
 935
 936         g_hash_table_destroy(network->config_table);
 937
 938         g_free(network->path);
 939         g_free(network);
 940 }
 941
 942 static void network_property(const char *key, DBusMessageIter *iter,
 943                                                         void *user_data)
 944 {
 945         GSupplicantNetwork *network = user_data;
 946
 947         if (network->interface == NULL)
 948                 return;
 949
 950         if (key == NULL) {
 951                 merge_network(network);
 952                 return;
 953         }
 954
 955         if (g_strcmp0(key, "Enabled") == 0) {
 956                 dbus_bool_t enabled = FALSE;
 957
 958                 dbus_message_iter_get_basic(iter, &enabled);
 959         } else if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
 960                 const char *str = NULL;
 961
 962                 dbus_message_iter_get_basic(iter, &str);
 963                 if (str != NULL) {
 964                         g_hash_table_replace(network->config_table,
 965                                                 g_strdup(key), g_strdup(str));
 966                 }
 967         } else
 968                 SUPPLICANT_DBG("key %s type %c",
 969                                 key, dbus_message_iter_get_arg_type(iter));
 970 }
 971
 972 static void interface_network_added(DBusMessageIter *iter, void *user_data)
 973 {
 974         GSupplicantInterface *interface = user_data;
 975         GSupplicantNetwork *network;
 976         const char *path = NULL;
 977
 978         SUPPLICANT_DBG("");
 979
 980         dbus_message_iter_get_basic(iter, &path);
 981         if (path == NULL)
 982                 return;
 983
 984         if (g_strcmp0(path, "/") == 0)
 985                 return;
 986
 987         network = g_hash_table_lookup(interface->net_mapping, path);
 988         if (network != NULL)
 989                 return;
 990
 991         network = g_try_new0(GSupplicantNetwork, 1);
 992         if (network == NULL)
 993                 return;
 994
 995         network->interface = interface;
 996         network->path = g_strdup(path);
 997
 998         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
 999                                                         g_free, g_free);
1000
1001         dbus_message_iter_next(iter);
1002         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1003                 supplicant_dbus_property_foreach(iter, network_property,
1004                                                                 network);
1005                 network_property(NULL, NULL, network);
1006                 return;
1007         }
1008
1009         supplicant_dbus_property_get_all(path,
1010                                 SUPPLICANT_INTERFACE ".Network",
1011                                                 network_property, network);
1012 }
1013
1014 static void interface_network_removed(DBusMessageIter *iter, void *user_data)
1015 {
1016         GSupplicantInterface *interface = user_data;
1017         GSupplicantNetwork *network;
1018         const char *path = NULL;
1019
1020         dbus_message_iter_get_basic(iter, &path);
1021         if (path == NULL)
1022                 return;
1023
1024         network = g_hash_table_lookup(interface->net_mapping, path);
1025         if (network == NULL)
1026                 return;
1027
1028         g_hash_table_remove(interface->net_mapping, path);
1029 }
1030
1031 static char *create_name(unsigned char *ssid, int ssid_len)
1032 {
1033         GString *string;
1034         const gchar *remainder, *invalid;
1035         int valid_bytes, remaining_bytes;
1036
1037         if (ssid_len < 1 || ssid[0] == '\0')
1038                 return g_strdup("");
1039
1040         string = NULL;
1041         remainder = (const gchar *)ssid;
1042         remaining_bytes = ssid_len;
1043
1044         while (remaining_bytes != 0) {
1045                 if (g_utf8_validate(remainder, remaining_bytes,
1046                                         &invalid) == TRUE) {
1047                         break;
1048                 }
1049
1050                 valid_bytes = invalid - remainder;
1051
1052                 if (string == NULL)
1053                         string = g_string_sized_new(remaining_bytes);
1054
1055                 g_string_append_len(string, remainder, valid_bytes);
1056
1057                 /* append U+FFFD REPLACEMENT CHARACTER */
1058                 g_string_append(string, "\357\277\275");
1059
1060                 remaining_bytes -= valid_bytes + 1;
1061                 remainder = invalid + 1;
1062         }
1063
1064         if (string == NULL)
1065                 return g_strndup((const gchar *)ssid, ssid_len + 1);
1066
1067         g_string_append(string, remainder);
1068
1069         return g_string_free(string, FALSE);
1070 }
1071
1072 static char *create_group(struct g_supplicant_bss *bss)
1073 {
1074         GString *str;
1075         unsigned int i;
1076         const char *mode, *security;
1077
1078         str = g_string_sized_new((bss->ssid_len * 2) + 24);
1079         if (str == NULL)
1080                 return NULL;
1081
1082         if (bss->ssid_len > 0 && bss->ssid[0] != '\0') {
1083                 for (i = 0; i < bss->ssid_len; i++)
1084                         g_string_append_printf(str, "%02x", bss->ssid[i]);
1085         } else
1086                 g_string_append_printf(str, "hidden");
1087
1088         mode = mode2string(bss->mode);
1089         if (mode != NULL)
1090                 g_string_append_printf(str, "_%s", mode);
1091
1092         security = security2string(bss->security);
1093         if (security != NULL)
1094                 g_string_append_printf(str, "_%s", security);
1095
1096         return g_string_free(str, FALSE);
1097 }
1098
1099 static void add_or_replace_bss_to_network(struct g_supplicant_bss *bss)
1100 {
1101         GSupplicantInterface *interface = bss->interface;
1102         GSupplicantNetwork *network;
1103         char *group;
1104
1105         group = create_group(bss);
1106         if (group == NULL)
1107                 return;
1108
1109         network = g_hash_table_lookup(interface->network_table, group);
1110         if (network != NULL) {
1111                 g_free(group);
1112                 goto done;
1113         }
1114
1115         network = g_try_new0(GSupplicantNetwork, 1);
1116         if (network == NULL) {
1117                 g_free(group);
1118                 return;
1119         }
1120
1121         network->interface = interface;
1122         if (network->path == NULL)
1123                 network->path = g_strdup(bss->path);
1124         network->group = group;
1125         network->name = create_name(bss->ssid, bss->ssid_len);
1126         network->mode = bss->mode;
1127         network->security = bss->security;
1128         network->ssid_len = bss->ssid_len;
1129         memcpy(network->ssid, bss->ssid, bss->ssid_len);
1130         network->signal = bss->signal;
1131         network->frequency = bss->frequency;
1132         network->best_bss = bss;
1133
1134         network->wps = FALSE;
1135         if ((bss->keymgmt & G_SUPPLICANT_KEYMGMT_WPS) != 0) {
1136                 network->wps = TRUE;
1137
1138                 network->wps_capabilities |= bss->wps_capabilities;
1139         }
1140
1141         network->bss_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1142                                                         NULL, remove_bss);
1143
1144         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1145                                                         g_free, g_free);
1146
1147         g_hash_table_replace(interface->network_table,
1148                                                 network->group, network);
1149
1150         callback_network_added(network);
1151
1152 done:
1153         if (bss->signal > network->signal) {
1154                 network->signal = bss->signal;
1155                 network->best_bss = bss;
1156                 callback_network_changed(network, "Signal");
1157         }
1158
1159         g_hash_table_replace(interface->bss_mapping, bss->path, network);
1160         g_hash_table_replace(network->bss_table, bss->path, bss);
1161
1162         g_hash_table_replace(bss_mapping, bss->path, interface);
1163 }
1164
1165 static void bss_rates(DBusMessageIter *iter, void *user_data)
1166 {
1167         struct g_supplicant_bss *bss = user_data;
1168         dbus_uint32_t rate = 0;
1169
1170         dbus_message_iter_get_basic(iter, &rate);
1171         if (rate == 0)
1172                 return;
1173
1174         if (rate > bss->maxrate)
1175                 bss->maxrate = rate;
1176 }
1177
1178 static void bss_keymgmt(DBusMessageIter *iter, void *user_data)
1179 {
1180         struct g_supplicant_bss *bss = user_data;
1181         const char *str = NULL;
1182         int i;
1183
1184         dbus_message_iter_get_basic(iter, &str);
1185         if (str == NULL)
1186                 return;
1187
1188         for (i = 0; keymgmt_map[i].str != NULL; i++)
1189                 if (strcmp(str, keymgmt_map[i].str) == 0) {
1190                         bss->keymgmt |= keymgmt_map[i].val;
1191                         break;
1192                 }
1193 }
1194
1195 static void bss_group(DBusMessageIter *iter, void *user_data)
1196 {
1197         struct g_supplicant_bss *bss = user_data;
1198         const char *str = NULL;
1199         int i;
1200
1201         dbus_message_iter_get_basic(iter, &str);
1202         if (str == NULL)
1203                 return;
1204
1205         for (i = 0; group_map[i].str != NULL; i++)
1206                 if (strcmp(str, group_map[i].str) == 0) {
1207                         bss->group |= group_map[i].val;
1208                         break;
1209                 }
1210 }
1211
1212 static void bss_pairwise(DBusMessageIter *iter, void *user_data)
1213 {
1214         struct g_supplicant_bss *bss = user_data;
1215         const char *str = NULL;
1216         int i;
1217
1218         dbus_message_iter_get_basic(iter, &str);
1219         if (str == NULL)
1220                 return;
1221
1222         for (i = 0; pairwise_map[i].str != NULL; i++)
1223                 if (strcmp(str, pairwise_map[i].str) == 0) {
1224                         bss->pairwise |= pairwise_map[i].val;
1225                         break;
1226                 }
1227 }
1228
1229 static void bss_wpa(const char *key, DBusMessageIter *iter,
1230                         void *user_data)
1231 {
1232         if (g_strcmp0(key, "KeyMgmt") == 0)
1233                 supplicant_dbus_array_foreach(iter, bss_keymgmt, user_data);
1234         else if (g_strcmp0(key, "Group") == 0)
1235                 supplicant_dbus_array_foreach(iter, bss_group, user_data);
1236         else if (g_strcmp0(key, "Pairwise") == 0)
1237                 supplicant_dbus_array_foreach(iter, bss_pairwise, user_data);
1238
1239 }
1240
1241 static unsigned int get_tlv(unsigned char *ie, unsigned int ie_size,
1242                                                         unsigned int type)
1243 {
1244         unsigned int len = 0;
1245
1246         while (len + 4 < ie_size) {
1247                 unsigned int hi = ie[len];
1248                 unsigned int lo = ie[len + 1];
1249                 unsigned int tmp_type = (hi << 8) + lo;
1250                 unsigned int v_len = 0;
1251
1252                 /* hi and lo are used to recreate an unsigned int
1253                  * based on 2 8bits length unsigned int. */
1254
1255                 hi = ie[len + 2];
1256                 lo = ie[len + 3];
1257                 v_len = (hi << 8) + lo;
1258
1259                 if (tmp_type == type) {
1260                         unsigned int ret_value = 0;
1261                         unsigned char *value = (unsigned char *)&ret_value;
1262
1263                         SUPPLICANT_DBG("IE: match type 0x%x", type);
1264
1265                         /* Verifying length relevance */
1266                         if (v_len > sizeof(unsigned int) ||
1267                                 len + 4 + v_len > ie_size)
1268                                 break;
1269
1270                         memcpy(value, ie + len + 4, v_len);
1271
1272                         SUPPLICANT_DBG("returning 0x%x", ret_value);
1273                         return ret_value;
1274                 }
1275
1276                 len += v_len + 4;
1277         }
1278
1279         SUPPLICANT_DBG("returning 0");
1280         return 0;
1281 }
1282
1283 static void bss_process_ies(DBusMessageIter *iter, void *user_data)
1284 {
1285         struct g_supplicant_bss *bss = user_data;
1286         const unsigned char WPS_OUI[] = { 0x00, 0x50, 0xf2, 0x04 };
1287         unsigned char *ie, *ie_end;
1288         DBusMessageIter array;
1289         unsigned int value;
1290         int ie_len;
1291
1292 #define WMM_WPA1_WPS_INFO 221
1293 #define WPS_INFO_MIN_LEN  6
1294 #define WPS_VERSION_TLV   0x104A
1295 #define WPS_STATE_TLV     0x1044
1296 #define WPS_METHODS_TLV   0x1012
1297 #define WPS_REGISTRAR_TLV 0x1041
1298 #define WPS_VERSION       0x10
1299 #define WPS_PBC           0x04
1300 #define WPS_PIN           0x00
1301 #define WPS_CONFIGURED    0x02
1302
1303         dbus_message_iter_recurse(iter, &array);
1304         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1305
1306         if (ie == NULL || ie_len < 2)
1307                 return;
1308
1309         for (ie_end = ie + ie_len; ie < ie_end && ie + ie[1] + 1 <= ie_end;
1310                                                         ie += ie[1] + 2) {
1311
1312                 if (ie[0] != WMM_WPA1_WPS_INFO || ie[1] < WPS_INFO_MIN_LEN ||
1313                         memcmp(ie+2, WPS_OUI, sizeof(WPS_OUI)) != 0)
1314                         continue;
1315
1316                 SUPPLICANT_DBG("IE: match WPS_OUI");
1317
1318                 value = get_tlv(&ie[6], ie[1], WPS_STATE_TLV);
1319                 if (get_tlv(&ie[6], ie[1], WPS_VERSION_TLV) == WPS_VERSION &&
1320                                                                 value != 0) {
1321                         bss->keymgmt |= G_SUPPLICANT_KEYMGMT_WPS;
1322
1323                         if (value == WPS_CONFIGURED)
1324                                 bss->wps_capabilities |=
1325                                         G_SUPPLICANT_WPS_CONFIGURED;
1326                 }
1327
1328                 value = get_tlv(&ie[6], ie[1], WPS_METHODS_TLV);
1329                 if (value != 0) {
1330                         if (GUINT16_FROM_BE(value) == WPS_PBC)
1331                                 bss->wps_capabilities |= G_SUPPLICANT_WPS_PBC;
1332                         if (GUINT16_FROM_BE(value) == WPS_PIN)
1333                                 bss->wps_capabilities |= G_SUPPLICANT_WPS_PIN;
1334                 } else
1335                         bss->wps_capabilities |=
1336                                 G_SUPPLICANT_WPS_PBC | G_SUPPLICANT_WPS_PIN;
1337
1338                 /* If the AP sends this it means it's advertizing
1339                  * as a registrar and the WPS process is launched
1340                  * on its side */
1341                 if (get_tlv(&ie[6], ie[1], WPS_REGISTRAR_TLV) != 0)
1342                         bss->wps_capabilities |= G_SUPPLICANT_WPS_REGISTRAR;
1343
1344                 SUPPLICANT_DBG("WPS Methods 0x%x", bss->wps_capabilities);
1345         }
1346 }
1347
1348 static void bss_compute_security(struct g_supplicant_bss *bss)
1349 {
1350         if (bss->ieee8021x == TRUE)
1351                 bss->security = G_SUPPLICANT_SECURITY_IEEE8021X;
1352         else if (bss->psk == TRUE)
1353                 bss->security = G_SUPPLICANT_SECURITY_PSK;
1354         else if (bss->privacy == TRUE)
1355                 bss->security = G_SUPPLICANT_SECURITY_WEP;
1356         else
1357                 bss->security = G_SUPPLICANT_SECURITY_NONE;
1358 }
1359
1360
1361 static void bss_property(const char *key, DBusMessageIter *iter,
1362                                                         void *user_data)
1363 {
1364         struct g_supplicant_bss *bss = user_data;
1365
1366         if (bss->interface == NULL)
1367                 return;
1368
1369         SUPPLICANT_DBG("key %s", key);
1370
1371         if (key == NULL) {
1372                 bss_compute_security(bss);
1373
1374                 add_or_replace_bss_to_network(bss);
1375                 return;
1376         }
1377
1378         if (g_strcmp0(key, "BSSID") == 0) {
1379                 DBusMessageIter array;
1380                 unsigned char *addr;
1381                 int addr_len;
1382
1383                 dbus_message_iter_recurse(iter, &array);
1384                 dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
1385
1386                 if (addr_len == 6)
1387                         memcpy(bss->bssid, addr, addr_len);
1388         } else if (g_strcmp0(key, "SSID") == 0) {
1389                 DBusMessageIter array;
1390                 unsigned char *ssid;
1391                 int ssid_len;
1392
1393                 dbus_message_iter_recurse(iter, &array);
1394                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
1395
1396                 if (ssid_len > 0 && ssid_len < 33) {
1397                         memcpy(bss->ssid, ssid, ssid_len);
1398                         bss->ssid_len = ssid_len;
1399                 } else {
1400                         memset(bss->ssid, 0, sizeof(bss->ssid));
1401                         bss->ssid_len = 0;
1402                 }
1403         } else if (g_strcmp0(key, "Capabilities") == 0) {
1404                 dbus_uint16_t capabilities = 0x0000;
1405
1406                 dbus_message_iter_get_basic(iter, &capabilities);
1407
1408                 if (capabilities & IEEE80211_CAP_ESS)
1409                         bss->mode = G_SUPPLICANT_MODE_INFRA;
1410                 else if (capabilities & IEEE80211_CAP_IBSS)
1411                         bss->mode = G_SUPPLICANT_MODE_IBSS;
1412
1413                 if (capabilities & IEEE80211_CAP_PRIVACY)
1414                         bss->privacy = TRUE;
1415         } else if (g_strcmp0(key, "Mode") == 0) {
1416                 const char *mode = NULL;
1417
1418                 dbus_message_iter_get_basic(iter, &mode);
1419                 bss->mode = string2mode(mode);
1420         } else if (g_strcmp0(key, "Frequency") == 0) {
1421                 dbus_uint16_t frequency = 0;
1422
1423                 dbus_message_iter_get_basic(iter, &frequency);
1424                 bss->frequency = frequency;
1425         } else if (g_strcmp0(key, "Signal") == 0) {
1426                 dbus_int16_t signal = 0;
1427
1428                 dbus_message_iter_get_basic(iter, &signal);
1429
1430                 bss->signal = signal;
1431         } else if (g_strcmp0(key, "Level") == 0) {
1432                 dbus_int32_t level = 0;
1433
1434                 dbus_message_iter_get_basic(iter, &level);
1435         } else if (g_strcmp0(key, "Rates") == 0) {
1436                 supplicant_dbus_array_foreach(iter, bss_rates, bss);
1437         } else if (g_strcmp0(key, "MaxRate") == 0) {
1438                 dbus_uint32_t maxrate = 0;
1439
1440                 dbus_message_iter_get_basic(iter, &maxrate);
1441                 if (maxrate != 0)
1442                         bss->maxrate = maxrate;
1443         } else if (g_strcmp0(key, "Privacy") == 0) {
1444                 dbus_bool_t privacy = FALSE;
1445
1446                 dbus_message_iter_get_basic(iter, &privacy);
1447                 bss->privacy = privacy;
1448         } else if ((g_strcmp0(key, "RSN") == 0) ||
1449                         (g_strcmp0(key, "WPA") == 0)) {
1450                 supplicant_dbus_property_foreach(iter, bss_wpa, bss);
1451
1452                 if (bss->keymgmt &
1453                         (G_SUPPLICANT_KEYMGMT_WPA_EAP |
1454                                 G_SUPPLICANT_KEYMGMT_WPA_FT_EAP |
1455                                 G_SUPPLICANT_KEYMGMT_WPA_EAP_256))
1456                         bss->ieee8021x = TRUE;
1457
1458                 if (bss->keymgmt &
1459                         (G_SUPPLICANT_KEYMGMT_WPA_PSK |
1460                                 G_SUPPLICANT_KEYMGMT_WPA_FT_PSK |
1461                                 G_SUPPLICANT_KEYMGMT_WPA_PSK_256))
1462                         bss->psk = TRUE;
1463         } else if (g_strcmp0(key, "IEs") == 0)
1464                 bss_process_ies(iter, bss);
1465         else
1466                 SUPPLICANT_DBG("key %s type %c",
1467                                 key, dbus_message_iter_get_arg_type(iter));
1468 }
1469
1470 static struct g_supplicant_bss *interface_bss_added(DBusMessageIter *iter,
1471                                                         void *user_data)
1472 {
1473         GSupplicantInterface *interface = user_data;
1474         GSupplicantNetwork *network;
1475         struct g_supplicant_bss *bss;
1476         const char *path = NULL;
1477
1478         SUPPLICANT_DBG("");
1479
1480         dbus_message_iter_get_basic(iter, &path);
1481         if (path == NULL)
1482                 return NULL;
1483
1484         if (g_strcmp0(path, "/") == 0)
1485                 return NULL;
1486
1487         SUPPLICANT_DBG("%s", path);
1488
1489         network = g_hash_table_lookup(interface->bss_mapping, path);
1490         if (network != NULL) {
1491                 bss = g_hash_table_lookup(network->bss_table, path);
1492                 if (bss != NULL)
1493                         return NULL;
1494         }
1495
1496         bss = g_try_new0(struct g_supplicant_bss, 1);
1497         if (bss == NULL)
1498                 return NULL;
1499
1500         bss->interface = interface;
1501         bss->path = g_strdup(path);
1502
1503         return bss;
1504 }
1505
1506 static void interface_bss_added_with_keys(DBusMessageIter *iter,
1507                                                 void *user_data)
1508 {
1509         struct g_supplicant_bss *bss;
1510
1511         SUPPLICANT_DBG("");
1512
1513         bss = interface_bss_added(iter, user_data);
1514         if (bss == NULL)
1515                 return;
1516
1517         dbus_message_iter_next(iter);
1518
1519         if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_INVALID)
1520                 return;
1521
1522         supplicant_dbus_property_foreach(iter, bss_property, bss);
1523         bss_property(NULL, NULL, bss);
1524 }
1525
1526 static void interface_bss_added_without_keys(DBusMessageIter *iter,
1527                                                 void *user_data)
1528 {
1529         struct g_supplicant_bss *bss;
1530
1531         SUPPLICANT_DBG("");
1532
1533         bss = interface_bss_added(iter, user_data);
1534         if (bss == NULL)
1535                 return;
1536
1537         supplicant_dbus_property_get_all(bss->path,
1538                                         SUPPLICANT_INTERFACE ".BSS",
1539                                                         bss_property, bss);
1540 }
1541
1542 static void update_signal(gpointer key, gpointer value,
1543                                                 gpointer user_data)
1544 {
1545         struct g_supplicant_bss *bss = value;
1546         GSupplicantNetwork *network = user_data;
1547
1548         if (bss->signal > network->signal) {
1549                 network->signal = bss->signal;
1550                 network->best_bss = bss;
1551         }
1552 }
1553
1554 static void update_network_signal(GSupplicantNetwork *network)
1555 {
1556         if (g_hash_table_size(network->bss_table) <= 1)
1557                 return;
1558
1559         g_hash_table_foreach(network->bss_table,
1560                                 update_signal, network);
1561
1562         SUPPLICANT_DBG("New network signal %d", network->signal);
1563 }
1564
1565 static void interface_bss_removed(DBusMessageIter *iter, void *user_data)
1566 {
1567         GSupplicantInterface *interface = user_data;
1568         GSupplicantNetwork *network;
1569         const char *path = NULL;
1570
1571         dbus_message_iter_get_basic(iter, &path);
1572         if (path == NULL)
1573                 return;
1574
1575         network = g_hash_table_lookup(interface->bss_mapping, path);
1576         if (network == NULL)
1577                 return;
1578
1579         g_hash_table_remove(bss_mapping, path);
1580
1581         g_hash_table_remove(interface->bss_mapping, path);
1582         g_hash_table_remove(network->bss_table, path);
1583
1584         update_network_signal(network);
1585
1586         if (g_hash_table_size(network->bss_table) == 0)
1587                 g_hash_table_remove(interface->network_table, network->group);
1588 }
1589
1590 static void interface_property(const char *key, DBusMessageIter *iter,
1591                                                         void *user_data)
1592 {
1593         GSupplicantInterface *interface = user_data;
1594
1595         if (interface == NULL)
1596                 return;
1597
1598         SUPPLICANT_DBG("%s", key);
1599
1600         if (key == NULL) {
1601                 debug_strvalmap("KeyMgmt capability", keymgmt_map,
1602                                                 interface->keymgmt_capa);
1603                 debug_strvalmap("AuthAlg capability", authalg_capa_map,
1604                                                 interface->authalg_capa);
1605                 debug_strvalmap("Protocol capability", proto_capa_map,
1606                                                 interface->proto_capa);
1607                 debug_strvalmap("Pairwise capability", pairwise_map,
1608                                                 interface->pairwise_capa);
1609                 debug_strvalmap("Group capability", group_map,
1610                                                 interface->group_capa);
1611                 debug_strvalmap("Scan capability", scan_capa_map,
1612                                                 interface->scan_capa);
1613                 debug_strvalmap("Mode capability", mode_capa_map,
1614                                                 interface->mode_capa);
1615
1616                 interface->ready = TRUE;
1617                 callback_interface_added(interface);
1618                 return;
1619         }
1620
1621         if (g_strcmp0(key, "Capabilities") == 0) {
1622                 supplicant_dbus_property_foreach(iter, interface_capability,
1623                                                                 interface);
1624         } else if (g_strcmp0(key, "State") == 0) {
1625                 const char *str = NULL;
1626
1627                 dbus_message_iter_get_basic(iter, &str);
1628                 if (str != NULL)
1629                         if (string2state(str) != interface->state) {
1630                                 interface->state = string2state(str);
1631                                 callback_interface_state(interface);
1632                         }
1633
1634                 SUPPLICANT_DBG("state %s (%d)", str, interface->state);
1635         } else if (g_strcmp0(key, "Scanning") == 0) {
1636                 dbus_bool_t scanning = FALSE;
1637
1638                 dbus_message_iter_get_basic(iter, &scanning);
1639                 interface->scanning = scanning;
1640
1641                 if (interface->ready == TRUE) {
1642                         if (interface->scanning == TRUE)
1643                                 callback_scan_started(interface);
1644                         else
1645                                 callback_scan_finished(interface);
1646                 }
1647         } else if (g_strcmp0(key, "ApScan") == 0) {
1648                 int apscan = 1;
1649
1650                 dbus_message_iter_get_basic(iter, &apscan);
1651                 interface->apscan = apscan;
1652         } else if (g_strcmp0(key, "Ifname") == 0) {
1653                 const char *str = NULL;
1654
1655                 dbus_message_iter_get_basic(iter, &str);
1656                 if (str != NULL) {
1657                         g_free(interface->ifname);
1658                         interface->ifname = g_strdup(str);
1659                 }
1660         } else if (g_strcmp0(key, "Driver") == 0) {
1661                 const char *str = NULL;
1662
1663                 dbus_message_iter_get_basic(iter, &str);
1664                 if (str != NULL) {
1665                         g_free(interface->driver);
1666                         interface->driver = g_strdup(str);
1667                 }
1668         } else if (g_strcmp0(key, "BridgeIfname") == 0) {
1669                 const char *str = NULL;
1670
1671                 dbus_message_iter_get_basic(iter, &str);
1672                 if (str != NULL) {
1673                         g_free(interface->bridge);
1674                         interface->bridge = g_strdup(str);
1675                 }
1676         } else if (g_strcmp0(key, "CurrentBSS") == 0) {
1677                 interface_bss_added_without_keys(iter, interface);
1678         } else if (g_strcmp0(key, "CurrentNetwork") == 0) {
1679                 interface_network_added(iter, interface);
1680         } else if (g_strcmp0(key, "BSSs") == 0) {
1681                 supplicant_dbus_array_foreach(iter, interface_bss_added_without_keys,
1682                                                                 interface);
1683         } else if (g_strcmp0(key, "Blobs") == 0) {
1684                 /* Nothing */
1685         } else if (g_strcmp0(key, "Networks") == 0) {
1686                 supplicant_dbus_array_foreach(iter, interface_network_added,
1687                                                                 interface);
1688         } else
1689                 SUPPLICANT_DBG("key %s type %c",
1690                                 key, dbus_message_iter_get_arg_type(iter));
1691 }
1692
1693 static void scan_network_update(DBusMessageIter *iter, void *user_data)
1694 {
1695         GSupplicantInterface *interface = user_data;
1696         GSupplicantNetwork *network;
1697         char *path;
1698
1699         if (iter == NULL)
1700                 return;
1701
1702         dbus_message_iter_get_basic(iter, &path);
1703
1704         if (path == NULL)
1705                 return;
1706
1707         if (g_strcmp0(path, "/") == 0)
1708                 return;
1709
1710         /* Update the network details based on scan BSS data */
1711         network = g_hash_table_lookup(interface->bss_mapping, path);
1712         if (network != NULL)
1713                 callback_network_added(network);
1714 }
1715
1716 static void scan_bss_data(const char *key, DBusMessageIter *iter,
1717                                 void *user_data)
1718 {
1719         GSupplicantInterface *interface = user_data;
1720
1721         if (iter)
1722                 supplicant_dbus_array_foreach(iter, scan_network_update,
1723                                                 interface);
1724
1725         if (interface->scan_callback != NULL)
1726                 interface->scan_callback(0, interface, interface->scan_data);
1727
1728         interface->scan_callback = NULL;
1729         interface->scan_data = NULL;
1730 }
1731
1732 static GSupplicantInterface *interface_alloc(const char *path)
1733 {
1734         GSupplicantInterface *interface;
1735
1736         interface = g_try_new0(GSupplicantInterface, 1);
1737         if (interface == NULL)
1738                 return NULL;
1739
1740         interface->path = g_strdup(path);
1741
1742         interface->network_table = g_hash_table_new_full(g_str_hash,
1743                                         g_str_equal, NULL, remove_network);
1744
1745         interface->net_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1746                                                                 NULL, NULL);
1747         interface->bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1748                                                                 NULL, NULL);
1749
1750         g_hash_table_replace(interface_table, interface->path, interface);
1751
1752         return interface;
1753 }
1754
1755 static void interface_added(DBusMessageIter *iter, void *user_data)
1756 {
1757         GSupplicantInterface *interface;
1758         const char *path = NULL;
1759
1760         SUPPLICANT_DBG("");
1761
1762         dbus_message_iter_get_basic(iter, &path);
1763         if (path == NULL)
1764                 return;
1765
1766         if (g_strcmp0(path, "/") == 0)
1767                 return;
1768
1769         interface = g_hash_table_lookup(interface_table, path);
1770         if (interface != NULL)
1771                 return;
1772
1773         interface = interface_alloc(path);
1774         if (interface == NULL)
1775                 return;
1776
1777         dbus_message_iter_next(iter);
1778         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1779                 supplicant_dbus_property_foreach(iter, interface_property,
1780                                                                 interface);
1781                 interface_property(NULL, NULL, interface);
1782                 return;
1783         }
1784
1785         supplicant_dbus_property_get_all(path,
1786                                         SUPPLICANT_INTERFACE ".Interface",
1787                                                 interface_property, interface);
1788 }
1789
1790 static void interface_removed(DBusMessageIter *iter, void *user_data)
1791 {
1792         const char *path = NULL;
1793
1794         dbus_message_iter_get_basic(iter, &path);
1795         if (path == NULL)
1796                 return;
1797
1798         g_hash_table_remove(interface_table, path);
1799 }
1800
1801 static void eap_method(DBusMessageIter *iter, void *user_data)
1802 {
1803         const char *str = NULL;
1804         int i;
1805
1806         dbus_message_iter_get_basic(iter, &str);
1807         if (str == NULL)
1808                 return;
1809
1810         for (i = 0; eap_method_map[i].str != NULL; i++)
1811                 if (strcmp(str, eap_method_map[i].str) == 0) {
1812                         eap_methods |= eap_method_map[i].val;
1813                         break;
1814                 }
1815 }
1816
1817 static void service_property(const char *key, DBusMessageIter *iter,
1818                                                         void *user_data)
1819 {
1820         if (key == NULL) {
1821                 callback_system_ready();
1822                 return;
1823         }
1824
1825         if (g_strcmp0(key, "DebugLevel") == 0) {
1826                 const char *str = NULL;
1827                 int i;
1828
1829                 dbus_message_iter_get_basic(iter, &str);
1830                 for (i = 0; debug_strings[i] != NULL; i++)
1831                         if (g_strcmp0(debug_strings[i], str) == 0) {
1832                                 debug_level = i;
1833                                 break;
1834                         }
1835                 SUPPLICANT_DBG("Debug level %d", debug_level);
1836         } else if (g_strcmp0(key, "DebugTimestamp") == 0) {
1837                 dbus_message_iter_get_basic(iter, &debug_timestamp);
1838                 SUPPLICANT_DBG("Debug timestamp %u", debug_timestamp);
1839         } else if (g_strcmp0(key, "DebugShowKeys") == 0) {
1840                 dbus_message_iter_get_basic(iter, &debug_showkeys);
1841                 SUPPLICANT_DBG("Debug show keys %u", debug_showkeys);
1842         } else if (g_strcmp0(key, "Interfaces") == 0) {
1843                 supplicant_dbus_array_foreach(iter, interface_added, NULL);
1844         } else if (g_strcmp0(key, "EapMethods") == 0) {
1845                 supplicant_dbus_array_foreach(iter, eap_method, NULL);
1846                 debug_strvalmap("EAP method", eap_method_map, eap_methods);
1847         } else if (g_strcmp0(key, "Country") == 0) {
1848                 const char *country = NULL;
1849
1850                 dbus_message_iter_get_basic(iter, &country);
1851                 SUPPLICANT_DBG("Country %s", country);
1852         } else
1853                 SUPPLICANT_DBG("key %s type %c",
1854                                 key, dbus_message_iter_get_arg_type(iter));
1855 }
1856
1857 static void signal_name_owner_changed(const char *path, DBusMessageIter *iter)
1858 {
1859         const char *name = NULL, *old = NULL, *new = NULL;
1860
1861         SUPPLICANT_DBG("");
1862
1863         if (g_strcmp0(path, DBUS_PATH_DBUS) != 0)
1864                 return;
1865
1866         dbus_message_iter_get_basic(iter, &name);
1867         if (name == NULL)
1868                 return;
1869
1870         if (g_strcmp0(name, SUPPLICANT_SERVICE) != 0)
1871                 return;
1872
1873         dbus_message_iter_next(iter);
1874         dbus_message_iter_get_basic(iter, &old);
1875         dbus_message_iter_next(iter);
1876         dbus_message_iter_get_basic(iter, &new);
1877
1878         if (old == NULL || new == NULL)
1879                 return;
1880
1881         if (strlen(old) > 0 && strlen(new) == 0) {
1882                 system_available = FALSE;
1883                 g_hash_table_remove_all(bss_mapping);
1884                 g_hash_table_remove_all(interface_table);
1885                 callback_system_killed();
1886         }
1887
1888         if (strlen(new) > 0 && strlen(old) == 0) {
1889                 system_available = TRUE;
1890                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
1891                                                         SUPPLICANT_INTERFACE,
1892                                                         service_property, NULL);
1893         }
1894 }
1895
1896 static void signal_properties_changed(const char *path, DBusMessageIter *iter)
1897 {
1898         SUPPLICANT_DBG("");
1899
1900         if (g_strcmp0(path, SUPPLICANT_PATH) != 0)
1901                 return;
1902
1903         supplicant_dbus_property_foreach(iter, service_property, NULL);
1904 }
1905
1906 static void signal_interface_added(const char *path, DBusMessageIter *iter)
1907 {
1908         SUPPLICANT_DBG("path %s %s", path, SUPPLICANT_PATH);
1909
1910         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1911                 interface_added(iter, NULL);
1912 }
1913
1914 static void signal_interface_removed(const char *path, DBusMessageIter *iter)
1915 {
1916         SUPPLICANT_DBG("");
1917
1918         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1919                 interface_removed(iter, NULL);
1920 }
1921
1922 static void signal_interface_changed(const char *path, DBusMessageIter *iter)
1923 {
1924         GSupplicantInterface *interface;
1925
1926         SUPPLICANT_DBG("");
1927
1928         interface = g_hash_table_lookup(interface_table, path);
1929         if (interface == NULL)
1930                 return;
1931
1932         supplicant_dbus_property_foreach(iter, interface_property, interface);
1933 }
1934
1935 static void signal_scan_done(const char *path, DBusMessageIter *iter)
1936 {
1937         GSupplicantInterface *interface;
1938         dbus_bool_t success = FALSE;
1939
1940         SUPPLICANT_DBG("");
1941
1942         interface = g_hash_table_lookup(interface_table, path);
1943         if (interface == NULL)
1944                 return;
1945
1946         dbus_message_iter_get_basic(iter, &success);
1947
1948         /*
1949          * If scan is unsuccessful return -EIO else get the scanned BSSs
1950          * and update the network details accordingly
1951          */
1952         if (success == FALSE) {
1953                 if (interface->scan_callback != NULL)
1954                         interface->scan_callback(-EIO, interface,
1955                                                 interface->scan_data);
1956
1957                 interface->scan_callback = NULL;
1958                 interface->scan_data = NULL;
1959
1960                 return;
1961         }
1962
1963         supplicant_dbus_property_get(path, SUPPLICANT_INTERFACE ".Interface",
1964                                         "BSSs", scan_bss_data, interface);
1965 }
1966
1967 static void signal_bss_added(const char *path, DBusMessageIter *iter)
1968 {
1969         GSupplicantInterface *interface;
1970
1971         SUPPLICANT_DBG("");
1972
1973         interface = g_hash_table_lookup(interface_table, path);
1974         if (interface == NULL)
1975                 return;
1976
1977         interface_bss_added_with_keys(iter, interface);
1978 }
1979
1980 static void signal_bss_removed(const char *path, DBusMessageIter *iter)
1981 {
1982         GSupplicantInterface *interface;
1983
1984         SUPPLICANT_DBG("");
1985
1986         interface = g_hash_table_lookup(interface_table, path);
1987         if (interface == NULL)
1988                 return;
1989
1990         interface_bss_removed(iter, interface);
1991 }
1992
1993 static void signal_network_added(const char *path, DBusMessageIter *iter)
1994 {
1995         GSupplicantInterface *interface;
1996
1997         SUPPLICANT_DBG("");
1998
1999         interface = g_hash_table_lookup(interface_table, path);
2000         if (interface == NULL)
2001                 return;
2002
2003         interface_network_added(iter, interface);
2004 }
2005
2006 static void signal_network_removed(const char *path, DBusMessageIter *iter)
2007 {
2008         GSupplicantInterface *interface;
2009
2010         SUPPLICANT_DBG("");
2011
2012         interface = g_hash_table_lookup(interface_table, path);
2013         if (interface == NULL)
2014                 return;
2015
2016         interface_network_removed(iter, interface);
2017 }
2018
2019 static void signal_bss_changed(const char *path, DBusMessageIter *iter)
2020 {
2021         GSupplicantInterface *interface;
2022         GSupplicantNetwork *network;
2023         struct g_supplicant_bss *bss;
2024
2025         SUPPLICANT_DBG("");
2026
2027         interface = g_hash_table_lookup(bss_mapping, path);
2028         if (interface == NULL)
2029                 return;
2030
2031         network = g_hash_table_lookup(interface->bss_mapping, path);
2032         if (network == NULL)
2033                 return;
2034
2035         bss = g_hash_table_lookup(network->bss_table, path);
2036         if (bss == NULL)
2037                 return;
2038
2039         supplicant_dbus_property_foreach(iter, bss_property, bss);
2040
2041         if (bss->signal == network->signal)
2042                 return;
2043
2044         /*
2045          * If the new signal is lower than the SSID signal, we need
2046          * to check for the new maximum.
2047          */
2048         if (bss->signal < network->signal) {
2049                 if (bss != network->best_bss)
2050                         return;
2051                 network->signal = bss->signal;
2052                 update_network_signal(network);
2053         } else {
2054                 network->signal = bss->signal;
2055                 network->best_bss = bss;
2056         }
2057
2058         SUPPLICANT_DBG("New network signal for %s %d dBm", network->ssid, network->signal);
2059
2060         callback_network_changed(network, "Signal");
2061 }
2062
2063 static void wps_credentials(const char *key, DBusMessageIter *iter,
2064                         void *user_data)
2065 {
2066         GSupplicantInterface *interface = user_data;
2067
2068         if (key == NULL)
2069                 return;
2070
2071         SUPPLICANT_DBG("key %s", key);
2072
2073         if (g_strcmp0(key, "Key") == 0) {
2074                 DBusMessageIter array;
2075                 unsigned char *key;
2076                 int key_len;
2077
2078                 dbus_message_iter_recurse(iter, &array);
2079                 dbus_message_iter_get_fixed_array(&array, &key, &key_len);
2080
2081                 g_free(interface->wps_cred.key);
2082                 interface->wps_cred.key = g_try_malloc0(
2083                                                 sizeof(char) * key_len+1);
2084
2085                 if (interface->wps_cred.key == NULL)
2086                         return;
2087
2088                 memcpy(interface->wps_cred.key, key, sizeof(char) * key_len);
2089
2090                 SUPPLICANT_DBG("WPS key present");
2091         } else if (g_strcmp0(key, "SSID") == 0) {
2092                 DBusMessageIter array;
2093                 unsigned char *ssid;
2094                 int ssid_len;
2095
2096                 dbus_message_iter_recurse(iter, &array);
2097                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
2098
2099                 if (ssid_len > 0 && ssid_len < 33) {
2100                         memcpy(interface->wps_cred.ssid, ssid, ssid_len);
2101                         interface->wps_cred.ssid_len = ssid_len;
2102                 } else {
2103                         memset(interface->wps_cred.ssid, 0, 32);
2104                         interface->wps_cred.ssid_len = 0;
2105                 }
2106         }
2107 }
2108
2109 static void signal_wps_credentials(const char *path, DBusMessageIter *iter)
2110 {
2111         GSupplicantInterface *interface;
2112
2113         SUPPLICANT_DBG("");
2114
2115         interface = g_hash_table_lookup(interface_table, path);
2116         if (interface == NULL)
2117                 return;
2118
2119         supplicant_dbus_property_foreach(iter, wps_credentials, interface);
2120 }
2121
2122 static void wps_event_args(const char *key, DBusMessageIter *iter,
2123                         void *user_data)
2124 {
2125         GSupplicantInterface *interface = user_data;
2126
2127         if (key == NULL || interface == NULL)
2128                 return;
2129
2130         SUPPLICANT_DBG("Arg Key %s", key);
2131 }
2132
2133 static void signal_wps_event(const char *path, DBusMessageIter *iter)
2134 {
2135         GSupplicantInterface *interface;
2136         const char *name = NULL;
2137
2138         SUPPLICANT_DBG("");
2139
2140         interface = g_hash_table_lookup(interface_table, path);
2141         if (interface == NULL)
2142                 return;
2143
2144         dbus_message_iter_get_basic(iter, &name);
2145
2146         SUPPLICANT_DBG("Name: %s", name);
2147
2148         if (g_strcmp0(name, "success") == 0)
2149                 interface->wps_state = G_SUPPLICANT_WPS_STATE_SUCCESS;
2150         else if (g_strcmp0(name, "failed") == 0)
2151                 interface->wps_state = G_SUPPLICANT_WPS_STATE_FAIL;
2152         else
2153                 interface->wps_state = G_SUPPLICANT_WPS_STATE_UNKNOWN;
2154
2155         if (!dbus_message_iter_has_next(iter))
2156                 return;
2157
2158         dbus_message_iter_next(iter);
2159
2160         supplicant_dbus_property_foreach(iter, wps_event_args, interface);
2161 }
2162
2163 static struct {
2164         const char *interface;
2165         const char *member;
2166         void (*function) (const char *path, DBusMessageIter *iter);
2167 } signal_map[] = {
2168         { DBUS_INTERFACE_DBUS,  "NameOwnerChanged",  signal_name_owner_changed },
2169
2170         { SUPPLICANT_INTERFACE, "PropertiesChanged", signal_properties_changed },
2171         { SUPPLICANT_INTERFACE, "InterfaceAdded",    signal_interface_added    },
2172         { SUPPLICANT_INTERFACE, "InterfaceCreated",  signal_interface_added    },
2173         { SUPPLICANT_INTERFACE, "InterfaceRemoved",  signal_interface_removed  },
2174
2175         { SUPPLICANT_INTERFACE ".Interface", "PropertiesChanged", signal_interface_changed },
2176         { SUPPLICANT_INTERFACE ".Interface", "ScanDone",          signal_scan_done         },
2177         { SUPPLICANT_INTERFACE ".Interface", "BSSAdded",          signal_bss_added         },
2178         { SUPPLICANT_INTERFACE ".Interface", "BSSRemoved",        signal_bss_removed       },
2179         { SUPPLICANT_INTERFACE ".Interface", "NetworkAdded",      signal_network_added     },
2180         { SUPPLICANT_INTERFACE ".Interface", "NetworkRemoved",    signal_network_removed   },
2181
2182         { SUPPLICANT_INTERFACE ".BSS", "PropertiesChanged", signal_bss_changed   },
2183
2184         { SUPPLICANT_INTERFACE ".Interface.WPS", "Credentials", signal_wps_credentials },
2185         { SUPPLICANT_INTERFACE ".Interface.WPS", "Event",       signal_wps_event       },
2186
2187         { }
2188 };
2189
2190 static DBusHandlerResult g_supplicant_filter(DBusConnection *conn,
2191                                         DBusMessage *message, void *data)
2192 {
2193         DBusMessageIter iter;
2194         const char *path;
2195         int i;
2196
2197         path = dbus_message_get_path(message);
2198         if (path == NULL)
2199                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2200
2201         if (dbus_message_iter_init(message, &iter) == FALSE)
2202                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2203
2204         for (i = 0; signal_map[i].interface != NULL; i++) {
2205                 if (dbus_message_has_interface(message,
2206                                         signal_map[i].interface) == FALSE)
2207                         continue;
2208
2209                 if (dbus_message_has_member(message,
2210                                         signal_map[i].member) == FALSE)
2211                         continue;
2212
2213                 signal_map[i].function(path, &iter);
2214                 break;
2215         }
2216
2217         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2218 }
2219
2220 struct supplicant_regdom {
2221         GSupplicantCountryCallback callback;
2222         const void *user_data;
2223 };
2224
2225 static void country_result(const char *error,
2226                                 DBusMessageIter *iter, void *user_data)
2227 {
2228         struct supplicant_regdom *regdom = user_data;
2229         char *alpha2;
2230
2231         SUPPLICANT_DBG("Country setting result");
2232
2233         if (user_data == NULL)
2234                 return;
2235
2236         if (error == NULL) {
2237                 alpha2 = (char *)regdom->user_data;
2238         } else {
2239                 SUPPLICANT_DBG("Country setting failure %s", error);
2240                 alpha2 = NULL;
2241         }
2242
2243         if (regdom->callback)
2244                 regdom->callback(alpha2);
2245
2246         g_free(regdom);
2247 }
2248
2249 static void country_params(DBusMessageIter *iter, void *user_data)
2250 {
2251         struct supplicant_regdom *regdom = user_data;
2252         const char *country;
2253
2254         country = regdom->user_data;
2255
2256         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &country);
2257 }
2258
2259 int g_supplicant_set_country(const char *alpha2,
2260                                 GSupplicantCountryCallback callback,
2261                                         const void *user_data)
2262 {
2263         struct supplicant_regdom *regdom;
2264
2265         SUPPLICANT_DBG("Country setting %s", alpha2);
2266
2267         if (system_available == FALSE)
2268                 return -EFAULT;
2269
2270         regdom = dbus_malloc0(sizeof(*regdom));
2271         if (regdom == NULL)
2272                 return -ENOMEM;
2273
2274         regdom->callback = callback;
2275         regdom->user_data = user_data;
2276
2277         return supplicant_dbus_property_set(SUPPLICANT_PATH, SUPPLICANT_INTERFACE,
2278                                         "Country", DBUS_TYPE_STRING_AS_STRING,
2279                                         country_params, country_result,
2280                                                 regdom);
2281 }
2282
2283 struct interface_data {
2284         GSupplicantInterface *interface;
2285         GSupplicantInterfaceCallback callback;
2286         void *user_data;
2287 };
2288
2289 struct interface_create_data {
2290         const char *ifname;
2291         const char *driver;
2292         const char *bridge;
2293         GSupplicantInterface *interface;
2294         GSupplicantInterfaceCallback callback;
2295         void *user_data;
2296 };
2297
2298 struct interface_connect_data {
2299         GSupplicantInterface *interface;
2300         GSupplicantInterfaceCallback callback;
2301         GSupplicantSSID *ssid;
2302         void *user_data;
2303 };
2304
2305 struct interface_scan_data {
2306         GSupplicantInterface *interface;
2307         GSupplicantInterfaceCallback callback;
2308         GSupplicantScanParams *scan_params;
2309         void *user_data;
2310 };
2311
2312 static void interface_create_property(const char *key, DBusMessageIter *iter,
2313                                                         void *user_data)
2314 {
2315         struct interface_create_data *data = user_data;
2316         GSupplicantInterface *interface = data->interface;
2317
2318         if (key == NULL) {
2319                 if (data->callback != NULL)
2320                         data->callback(0, data->interface, data->user_data);
2321
2322                 dbus_free(data);
2323         }
2324
2325         interface_property(key, iter, interface);
2326 }
2327
2328 static void interface_create_result(const char *error,
2329                                 DBusMessageIter *iter, void *user_data)
2330 {
2331         struct interface_create_data *data = user_data;
2332         const char *path = NULL;
2333         int err;
2334
2335         SUPPLICANT_DBG("");
2336
2337         if (error != NULL) {
2338                 g_critical("error %s", error);
2339                 err = -EIO;
2340                 goto done;
2341         }
2342
2343         dbus_message_iter_get_basic(iter, &path);
2344         if (path == NULL) {
2345                 err = -EINVAL;
2346                 goto done;
2347         }
2348
2349         if (system_available == FALSE) {
2350                 err = -EFAULT;
2351                 goto done;
2352         }
2353
2354         data->interface = g_hash_table_lookup(interface_table, path);
2355         if (data->interface == NULL) {
2356                 data->interface = interface_alloc(path);
2357                 if (data->interface == NULL) {
2358                         err = -ENOMEM;
2359                         goto done;
2360                 }
2361         }
2362
2363         err = supplicant_dbus_property_get_all(path,
2364                                         SUPPLICANT_INTERFACE ".Interface",
2365                                         interface_create_property, data);
2366         if (err == 0)
2367                 return;
2368
2369 done:
2370         if (data->callback != NULL)
2371                 data->callback(err, NULL, data->user_data);
2372
2373         dbus_free(data);
2374 }
2375
2376 static void interface_create_params(DBusMessageIter *iter, void *user_data)
2377 {
2378         struct interface_create_data *data = user_data;
2379         DBusMessageIter dict;
2380
2381         SUPPLICANT_DBG("");
2382
2383         supplicant_dbus_dict_open(iter, &dict);
2384
2385         supplicant_dbus_dict_append_basic(&dict, "Ifname",
2386                                         DBUS_TYPE_STRING, &data->ifname);
2387
2388         if (data->driver != NULL)
2389                 supplicant_dbus_dict_append_basic(&dict, "Driver",
2390                                         DBUS_TYPE_STRING, &data->driver);
2391
2392         if (data->bridge != NULL)
2393                 supplicant_dbus_dict_append_basic(&dict, "BridgeIfname",
2394                                         DBUS_TYPE_STRING, &data->bridge);
2395
2396         supplicant_dbus_dict_close(iter, &dict);
2397 }
2398
2399 static void interface_get_result(const char *error,
2400                                 DBusMessageIter *iter, void *user_data)
2401 {
2402         struct interface_create_data *data = user_data;
2403         GSupplicantInterface *interface;
2404         const char *path = NULL;
2405         int err;
2406
2407         SUPPLICANT_DBG("");
2408
2409         if (error != NULL) {
2410                 SUPPLICANT_DBG("Interface not created yet");
2411                 err = -EIO;
2412                 goto create;
2413         }
2414
2415         dbus_message_iter_get_basic(iter, &path);
2416         if (path == NULL) {
2417                 err = -EINVAL;
2418                 goto done;
2419         }
2420
2421         interface = g_hash_table_lookup(interface_table, path);
2422         if (interface == NULL) {
2423                 err = -ENOENT;
2424                 goto done;
2425         }
2426
2427         if (data->callback != NULL)
2428                 data->callback(0, interface, data->user_data);
2429
2430         dbus_free(data);
2431
2432         return;
2433
2434 create:
2435         if (system_available == FALSE) {
2436                 err = -EFAULT;
2437                 goto done;
2438         }
2439
2440         SUPPLICANT_DBG("Creating interface");
2441
2442         err = supplicant_dbus_method_call(SUPPLICANT_PATH,
2443                                                 SUPPLICANT_INTERFACE,
2444                                                 "CreateInterface",
2445                                                 interface_create_params,
2446                                                 interface_create_result, data);
2447         if (err == 0)
2448                 return;
2449
2450 done:
2451         if (data->callback != NULL)
2452                 data->callback(err, NULL, data->user_data);
2453
2454         dbus_free(data);
2455 }
2456
2457 static void interface_get_params(DBusMessageIter *iter, void *user_data)
2458 {
2459         struct interface_create_data *data = user_data;
2460
2461         SUPPLICANT_DBG("");
2462
2463         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &data->ifname);
2464 }
2465
2466 int g_supplicant_interface_create(const char *ifname, const char *driver,
2467                                         const char *bridge,
2468                                         GSupplicantInterfaceCallback callback,
2469                                                         void *user_data)
2470 {
2471         struct interface_create_data *data;
2472
2473         SUPPLICANT_DBG("ifname %s", ifname);
2474
2475         if (ifname == NULL)
2476                 return -EINVAL;
2477
2478         if (system_available == FALSE)
2479                 return -EFAULT;
2480
2481         data = dbus_malloc0(sizeof(*data));
2482         if (data == NULL)
2483                 return -ENOMEM;
2484
2485         data->ifname = ifname;
2486         data->driver = driver;
2487         data->bridge = bridge;
2488         data->callback = callback;
2489         data->user_data = user_data;
2490
2491         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2492                                                 SUPPLICANT_INTERFACE,
2493                                                 "GetInterface",
2494                                                 interface_get_params,
2495                                                 interface_get_result, data);
2496 }
2497
2498 static void interface_remove_result(const char *error,
2499                                 DBusMessageIter *iter, void *user_data)
2500 {
2501         struct interface_data *data = user_data;
2502         int err;
2503
2504         if (error != NULL) {
2505                 err = -EIO;
2506                 goto done;
2507         }
2508
2509         if (system_available == FALSE) {
2510                 err = -EFAULT;
2511                 goto done;
2512         }
2513
2514         /*
2515          * The gsupplicant interface is already freed by the InterfaceRemoved
2516          * signal callback. Simply invoke the interface_data callback.
2517          */
2518         err = 0;
2519
2520 done:
2521         if (data->callback != NULL)
2522                 data->callback(err, NULL, data->user_data);
2523
2524         dbus_free(data);
2525 }
2526
2527
2528 static void interface_remove_params(DBusMessageIter *iter, void *user_data)
2529 {
2530         struct interface_data *data = user_data;
2531
2532         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2533                                                         &data->interface->path);
2534 }
2535
2536
2537 int g_supplicant_interface_remove(GSupplicantInterface *interface,
2538                         GSupplicantInterfaceCallback callback,
2539                                                         void *user_data)
2540 {
2541         struct interface_data *data;
2542
2543         if (interface == NULL)
2544                 return -EINVAL;
2545
2546         if (system_available == FALSE)
2547                 return -EFAULT;
2548
2549         data = dbus_malloc0(sizeof(*data));
2550         if (data == NULL)
2551                 return -ENOMEM;
2552
2553         data->interface = interface;
2554         data->callback = callback;
2555         data->user_data = user_data;
2556
2557         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2558                                                 SUPPLICANT_INTERFACE,
2559                                                 "RemoveInterface",
2560                                                 interface_remove_params,
2561                                                 interface_remove_result, data);
2562 }
2563
2564 static void interface_scan_result(const char *error,
2565                                 DBusMessageIter *iter, void *user_data)
2566 {
2567         struct interface_scan_data *data = user_data;
2568
2569         if (error != NULL) {
2570                 SUPPLICANT_DBG("error %s", error);
2571
2572                 if (data->callback != NULL)
2573                         data->callback(-EIO, data->interface, data->user_data);
2574         } else {
2575                 data->interface->scan_callback = data->callback;
2576                 data->interface->scan_data = data->user_data;
2577         }
2578
2579         if (data != NULL && data->scan_params != NULL)
2580                 g_free(data->scan_params);
2581
2582         dbus_free(data);
2583 }
2584
2585 static void add_scan_frequency(DBusMessageIter *iter, unsigned int freq)
2586 {
2587         DBusMessageIter data;
2588         unsigned int width = 0; /* Not used by wpa_supplicant atm */
2589
2590         dbus_message_iter_open_container(iter, DBUS_TYPE_STRUCT, NULL, &data);
2591
2592         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &freq);
2593         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &width);
2594
2595         dbus_message_iter_close_container(iter, &data);
2596 }
2597
2598 static void add_scan_frequencies(DBusMessageIter *iter,
2599                                                 void *user_data)
2600 {
2601         GSupplicantScanParams *scan_data = user_data;
2602         unsigned int freq;
2603         int i;
2604
2605         for (i = 0; i < G_SUPPLICANT_MAX_FAST_SCAN; i++) {
2606                 freq = scan_data->freqs[i];
2607                 if (!freq)
2608                         break;
2609
2610                 add_scan_frequency(iter, freq);
2611         }
2612 }
2613
2614 static void append_ssid(DBusMessageIter *iter,
2615                         const void *ssid, unsigned int len)
2616 {
2617         DBusMessageIter array;
2618
2619         dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
2620         DBUS_TYPE_BYTE_AS_STRING, &array);
2621
2622         dbus_message_iter_append_fixed_array(&array, DBUS_TYPE_BYTE,
2623                                                                 &ssid, len);
2624         dbus_message_iter_close_container(iter, &array);
2625 }
2626
2627 static void append_ssids(DBusMessageIter *iter, void *user_data)
2628 {
2629         GSupplicantScanParams *scan_data = user_data;
2630         int i;
2631
2632         for (i = 0; i < scan_data->num_ssids; i++)
2633                 append_ssid(iter, scan_data->ssids[i].ssid,
2634                                         scan_data->ssids[i].ssid_len);
2635 }
2636
2637 static void supplicant_add_scan_frequency(DBusMessageIter *dict,
2638                 supplicant_dbus_array_function function,
2639                                         void *user_data)
2640 {
2641         GSupplicantScanParams *scan_params = user_data;
2642         DBusMessageIter entry, value, array;
2643         const char *key = "Channels";
2644
2645         if (scan_params->freqs[0] != 0) {
2646                 dbus_message_iter_open_container(dict, DBUS_TYPE_DICT_ENTRY,
2647                                                 NULL, &entry);
2648
2649                 dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &key);
2650
2651                 dbus_message_iter_open_container(&entry, DBUS_TYPE_VARIANT,
2652                                         DBUS_TYPE_ARRAY_AS_STRING
2653                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2654                                         DBUS_TYPE_UINT32_AS_STRING
2655                                         DBUS_TYPE_UINT32_AS_STRING
2656                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2657                                         &value);
2658
2659                 dbus_message_iter_open_container(&value, DBUS_TYPE_ARRAY,
2660                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2661                                         DBUS_TYPE_UINT32_AS_STRING
2662                                         DBUS_TYPE_UINT32_AS_STRING
2663                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2664                                         &array);
2665
2666                 if (function)
2667                         function(&array, user_data);
2668
2669                 dbus_message_iter_close_container(&value, &array);
2670                 dbus_message_iter_close_container(&entry, &value);
2671                 dbus_message_iter_close_container(dict, &entry);
2672         }
2673 }
2674
2675 static void interface_scan_params(DBusMessageIter *iter, void *user_data)
2676 {
2677         DBusMessageIter dict;
2678         const char *type = "passive";
2679         struct interface_scan_data *data = user_data;
2680
2681         supplicant_dbus_dict_open(iter, &dict);
2682
2683         if (data && data->scan_params) {
2684                 type = "active";
2685
2686                 supplicant_dbus_dict_append_basic(&dict, "Type",
2687                                         DBUS_TYPE_STRING, &type);
2688
2689                 supplicant_dbus_dict_append_array(&dict, "SSIDs",
2690                                                 DBUS_TYPE_STRING,
2691                                                 append_ssids,
2692                                                 data->scan_params);
2693
2694                 supplicant_add_scan_frequency(&dict, add_scan_frequencies,
2695                                                 data->scan_params);
2696         } else
2697                 supplicant_dbus_dict_append_basic(&dict, "Type",
2698                                         DBUS_TYPE_STRING, &type);
2699
2700         supplicant_dbus_dict_close(iter, &dict);
2701 }
2702
2703 int g_supplicant_interface_scan(GSupplicantInterface *interface,
2704                                 GSupplicantScanParams *scan_data,
2705                                 GSupplicantInterfaceCallback callback,
2706                                                         void *user_data)
2707 {
2708         struct interface_scan_data *data;
2709         int ret;
2710
2711         if (interface == NULL)
2712                 return -EINVAL;
2713
2714         if (system_available == FALSE)
2715                 return -EFAULT;
2716
2717         if (interface->scanning == TRUE)
2718                 return -EALREADY;
2719
2720         switch (interface->state) {
2721         case G_SUPPLICANT_STATE_AUTHENTICATING:
2722         case G_SUPPLICANT_STATE_ASSOCIATING:
2723         case G_SUPPLICANT_STATE_ASSOCIATED:
2724         case G_SUPPLICANT_STATE_4WAY_HANDSHAKE:
2725         case G_SUPPLICANT_STATE_GROUP_HANDSHAKE:
2726                 return -EBUSY;
2727         case G_SUPPLICANT_STATE_UNKNOWN:
2728         case G_SUPPLICANT_STATE_DISCONNECTED:
2729         case G_SUPPLICANT_STATE_INACTIVE:
2730         case G_SUPPLICANT_STATE_SCANNING:
2731         case G_SUPPLICANT_STATE_COMPLETED:
2732                 break;
2733         }
2734
2735         data = dbus_malloc0(sizeof(*data));
2736         if (data == NULL)
2737                 return -ENOMEM;
2738
2739         data->interface = interface;
2740         data->callback = callback;
2741         data->user_data = user_data;
2742         data->scan_params = scan_data;
2743
2744         ret = supplicant_dbus_method_call(interface->path,
2745                         SUPPLICANT_INTERFACE ".Interface", "Scan",
2746                         interface_scan_params, interface_scan_result, data);
2747
2748         if (ret < 0)
2749                 dbus_free(data);
2750
2751         return ret;
2752 }
2753
2754 static int parse_supplicant_error(DBusMessageIter *iter)
2755 {
2756         int err = -ECANCELED;
2757         char *key;
2758
2759         /* If the given passphrase is malformed wpa_s returns
2760          * "invalid message format" but this error should be interpreted as
2761          * invalid-key.
2762          */
2763         while (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
2764                 dbus_message_iter_get_basic(iter, &key);
2765                 if (strncmp(key, "psk", 3) == 0 ||
2766                                 strncmp(key, "wep_key", 7) == 0 ||
2767                                 strcmp(key, "invalid message format") == 0) {
2768                         err = -ENOKEY;
2769                         break;
2770                 }
2771                 dbus_message_iter_next(iter);
2772         }
2773
2774         return err;
2775 }
2776
2777 static void interface_select_network_result(const char *error,
2778                                 DBusMessageIter *iter, void *user_data)
2779 {
2780         struct interface_connect_data *data = user_data;
2781         int err;
2782
2783         SUPPLICANT_DBG("");
2784
2785         err = 0;
2786         if (error != NULL) {
2787                 SUPPLICANT_DBG("SelectNetwork error %s", error);
2788                 err = parse_supplicant_error(iter);
2789         }
2790
2791         if (data->callback != NULL)
2792                 data->callback(err, data->interface, data->user_data);
2793
2794         g_free(data->ssid);
2795         dbus_free(data);
2796 }
2797
2798 static void interface_select_network_params(DBusMessageIter *iter,
2799                                                         void *user_data)
2800 {
2801         struct interface_connect_data *data = user_data;
2802         GSupplicantInterface *interface = data->interface;
2803
2804         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2805                                         &interface->network_path);
2806 }
2807
2808 static void interface_add_network_result(const char *error,
2809                                 DBusMessageIter *iter, void *user_data)
2810 {
2811         struct interface_connect_data *data = user_data;
2812         GSupplicantInterface *interface = data->interface;
2813         const char *path;
2814         int err;
2815
2816         if (error != NULL)
2817                 goto error;
2818
2819         dbus_message_iter_get_basic(iter, &path);
2820         if (path == NULL)
2821                 goto error;
2822
2823         SUPPLICANT_DBG("PATH: %s", path);
2824
2825         g_free(interface->network_path);
2826         interface->network_path = g_strdup(path);
2827
2828         supplicant_dbus_method_call(data->interface->path,
2829                         SUPPLICANT_INTERFACE ".Interface", "SelectNetwork",
2830                         interface_select_network_params,
2831                         interface_select_network_result, data);
2832
2833         return;
2834
2835 error:
2836         SUPPLICANT_DBG("AddNetwork error %s", error);
2837         err = parse_supplicant_error(iter);
2838         if (data->callback != NULL)
2839                 data->callback(err, data->interface, data->user_data);
2840
2841         g_free(interface->network_path);
2842         interface->network_path = NULL;
2843         g_free(data->ssid);
2844         g_free(data);
2845 }
2846
2847 static void add_network_security_wep(DBusMessageIter *dict,
2848                                         GSupplicantSSID *ssid)
2849 {
2850         const char *auth_alg = "OPEN SHARED";
2851         const char *key_index = "0";
2852
2853         supplicant_dbus_dict_append_basic(dict, "auth_alg",
2854                                         DBUS_TYPE_STRING, &auth_alg);
2855
2856         if (ssid->passphrase) {
2857                 int size = strlen(ssid->passphrase);
2858                 if (size == 10 || size == 26) {
2859                         unsigned char *key = g_try_malloc(13);
2860                         char tmp[3];
2861                         int i;
2862
2863                         memset(tmp, 0, sizeof(tmp));
2864                         if (key == NULL)
2865                                 size = 0;
2866
2867                         for (i = 0; i < size / 2; i++) {
2868                                 memcpy(tmp, ssid->passphrase + (i * 2), 2);
2869                                 key[i] = (unsigned char) strtol(tmp, NULL, 16);
2870                         }
2871
2872                         supplicant_dbus_dict_append_fixed_array(dict,
2873                                                         "wep_key0",
2874                                                         DBUS_TYPE_BYTE,
2875                                                         &key, size / 2);
2876                         g_free(key);
2877                 } else if (size == 5 || size == 13) {
2878                         unsigned char *key = g_try_malloc(13);
2879                         int i;
2880
2881                         if (key == NULL)
2882                                 size = 0;
2883
2884                         for (i = 0; i < size; i++)
2885                                 key[i] = (unsigned char) ssid->passphrase[i];
2886
2887                         supplicant_dbus_dict_append_fixed_array(dict,
2888                                                                 "wep_key0",
2889                                                                 DBUS_TYPE_BYTE,
2890                                                                 &key, size);
2891                         g_free(key);
2892                 } else
2893                         supplicant_dbus_dict_append_basic(dict,
2894                                                         "wep_key0",
2895                                                         DBUS_TYPE_STRING,
2896                                                         &ssid->passphrase);
2897
2898                 supplicant_dbus_dict_append_basic(dict, "wep_tx_keyidx",
2899                                         DBUS_TYPE_STRING, &key_index);
2900         }
2901 }
2902
2903 static dbus_bool_t is_psk_raw_key(const char *psk)
2904 {
2905         int i;
2906
2907         /* A raw key is always 64 bytes length... */
2908         if (strlen(psk) != 64)
2909                 return FALSE;
2910
2911         /* ... and its content is in hex representation */
2912         for (i = 0; i < 64; i++)
2913                 if (!isxdigit((unsigned char) psk[i]))
2914                         return FALSE;
2915
2916         return TRUE;
2917 }
2918
2919 static void add_network_security_psk(DBusMessageIter *dict,
2920                                         GSupplicantSSID *ssid)
2921 {
2922         if (ssid->passphrase && strlen(ssid->passphrase) > 0) {
2923
2924                 if (is_psk_raw_key(ssid->passphrase) == TRUE)
2925                         supplicant_dbus_property_append_fixed_array(dict,
2926                                                         "psk", DBUS_TYPE_BYTE,
2927                                                         &ssid->passphrase, 64);
2928                 else
2929                         supplicant_dbus_dict_append_basic(dict, "psk",
2930                                                         DBUS_TYPE_STRING,
2931                                                         &ssid->passphrase);
2932         }
2933 }
2934
2935 static void add_network_security_tls(DBusMessageIter *dict,
2936                                         GSupplicantSSID *ssid)
2937 {
2938         /*
2939          * For TLS, we at least need:
2940          *              The client certificate
2941          *              The client private key file
2942          *              The client private key file password
2943          *
2944          * The Authority certificate is optional.
2945          */
2946         if (ssid->client_cert_path == NULL)
2947                 return;
2948
2949         if (ssid->private_key_path == NULL)
2950                 return;
2951
2952         if (ssid->private_key_passphrase == NULL)
2953                 return;
2954
2955         if (ssid->ca_cert_path)
2956                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
2957                                         DBUS_TYPE_STRING, &ssid->ca_cert_path);
2958
2959         supplicant_dbus_dict_append_basic(dict, "private_key",
2960                                                 DBUS_TYPE_STRING,
2961                                                 &ssid->private_key_path);
2962         supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
2963                                                 DBUS_TYPE_STRING,
2964                                                 &ssid->private_key_passphrase);
2965         supplicant_dbus_dict_append_basic(dict, "client_cert",
2966                                                 DBUS_TYPE_STRING,
2967                                                 &ssid->client_cert_path);
2968 }
2969
2970 static void add_network_security_peap(DBusMessageIter *dict,
2971                                         GSupplicantSSID *ssid)
2972 {
2973         char *phase2_auth;
2974
2975         /*
2976          * For PEAP/TTLS, we at least need
2977          *              The authority certificate
2978          *              The 2nd phase authentication method
2979          *              The 2nd phase passphrase
2980          *
2981          * The Client certificate is optional although strongly recommended
2982          * When setting it, we need in addition
2983          *              The Client private key file
2984          *              The Client private key file password
2985          */
2986         if (ssid->passphrase == NULL)
2987                 return;
2988
2989         if (ssid->phase2_auth == NULL)
2990                 return;
2991
2992         if (ssid->client_cert_path) {
2993                 if (ssid->private_key_path == NULL)
2994                         return;
2995
2996                 if (ssid->private_key_passphrase == NULL)
2997                         return;
2998
2999                 supplicant_dbus_dict_append_basic(dict, "client_cert",
3000                                                 DBUS_TYPE_STRING,
3001                                                 &ssid->client_cert_path);
3002
3003                 supplicant_dbus_dict_append_basic(dict, "private_key",
3004                                                 DBUS_TYPE_STRING,
3005                                                 &ssid->private_key_path);
3006
3007                 supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
3008                                                 DBUS_TYPE_STRING,
3009                                                 &ssid->private_key_passphrase);
3010
3011         }
3012
3013         if (g_str_has_prefix(ssid->phase2_auth, "EAP-") == TRUE) {
3014                 phase2_auth = g_strdup_printf("autheap=%s",
3015                                         ssid->phase2_auth + strlen("EAP-"));
3016         } else
3017                 phase2_auth = g_strdup_printf("auth=%s", ssid->phase2_auth);
3018
3019         supplicant_dbus_dict_append_basic(dict, "password",
3020                                                 DBUS_TYPE_STRING,
3021                                                 &ssid->passphrase);
3022
3023         if (ssid->ca_cert_path)
3024                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
3025                                                 DBUS_TYPE_STRING,
3026                                                 &ssid->ca_cert_path);
3027
3028         supplicant_dbus_dict_append_basic(dict, "phase2",
3029                                                 DBUS_TYPE_STRING,
3030                                                 &phase2_auth);
3031
3032         g_free(phase2_auth);
3033 }
3034
3035 static void add_network_security_eap(DBusMessageIter *dict,
3036                                         GSupplicantSSID *ssid)
3037 {
3038         char *eap_value;
3039
3040         if (ssid->eap == NULL || ssid->identity == NULL)
3041                 return;
3042
3043         if (g_strcmp0(ssid->eap, "tls") == 0) {
3044                 add_network_security_tls(dict, ssid);
3045         } else if (g_strcmp0(ssid->eap, "peap") == 0 ||
3046                                 g_strcmp0(ssid->eap, "ttls") == 0) {
3047                 add_network_security_peap(dict, ssid);
3048         } else
3049                 return;
3050
3051         eap_value = g_ascii_strup(ssid->eap, -1);
3052
3053         supplicant_dbus_dict_append_basic(dict, "eap",
3054                                                 DBUS_TYPE_STRING,
3055                                                 &eap_value);
3056         supplicant_dbus_dict_append_basic(dict, "identity",
3057                                                 DBUS_TYPE_STRING,
3058                                                 &ssid->identity);
3059
3060         g_free(eap_value);
3061 }
3062
3063 static void add_network_security_ciphers(DBusMessageIter *dict,
3064                                                 GSupplicantSSID *ssid)
3065 {
3066         unsigned int p_cipher, g_cipher, i;
3067         char *pairwise, *group;
3068         char *pair_ciphers[4];
3069         char *group_ciphers[5];
3070
3071         p_cipher = ssid->pairwise_cipher;
3072         g_cipher = ssid->group_cipher;
3073
3074         if (p_cipher == 0 && g_cipher == 0)
3075                 return;
3076
3077         i = 0;
3078
3079         if (p_cipher & G_SUPPLICANT_PAIRWISE_CCMP)
3080                 pair_ciphers[i++] = "CCMP";
3081
3082         if (p_cipher & G_SUPPLICANT_PAIRWISE_TKIP)
3083                 pair_ciphers[i++] = "TKIP";
3084
3085         if (p_cipher & G_SUPPLICANT_PAIRWISE_NONE)
3086                 pair_ciphers[i++] = "NONE";
3087
3088         pair_ciphers[i] = NULL;
3089
3090         i = 0;
3091
3092         if (g_cipher & G_SUPPLICANT_GROUP_CCMP)
3093                 group_ciphers[i++] = "CCMP";
3094
3095         if (g_cipher & G_SUPPLICANT_GROUP_TKIP)
3096                 group_ciphers[i++] = "TKIP";
3097
3098         if (g_cipher & G_SUPPLICANT_GROUP_WEP104)
3099                 group_ciphers[i++] = "WEP104";
3100
3101         if (g_cipher & G_SUPPLICANT_GROUP_WEP40)
3102                 group_ciphers[i++] = "WEP40";
3103
3104         group_ciphers[i] = NULL;
3105
3106         pairwise = g_strjoinv(" ", pair_ciphers);
3107         group = g_strjoinv(" ", group_ciphers);
3108
3109         SUPPLICANT_DBG("cipher %s %s", pairwise, group);
3110
3111         supplicant_dbus_dict_append_basic(dict, "pairwise",
3112                                                 DBUS_TYPE_STRING,
3113                                                 &pairwise);
3114         supplicant_dbus_dict_append_basic(dict, "group",
3115                                                 DBUS_TYPE_STRING,
3116                                                 &group);
3117
3118         g_free(pairwise);
3119         g_free(group);
3120 }
3121
3122 static void add_network_security_proto(DBusMessageIter *dict,
3123                                                 GSupplicantSSID *ssid)
3124 {
3125         unsigned int protocol, i;
3126         char *proto;
3127         char *protos[3];
3128
3129         protocol = ssid->protocol;
3130
3131         if (protocol == 0)
3132                 return;
3133
3134         i = 0;
3135
3136         if (protocol & G_SUPPLICANT_PROTO_RSN)
3137                 protos[i++] = "RSN";
3138
3139         if (protocol & G_SUPPLICANT_PROTO_WPA)
3140                 protos[i++] = "WPA";
3141
3142         protos[i] = NULL;
3143
3144         proto = g_strjoinv(" ", protos);
3145
3146         SUPPLICANT_DBG("proto %s", proto);
3147
3148         supplicant_dbus_dict_append_basic(dict, "proto",
3149                                                 DBUS_TYPE_STRING,
3150                                                 &proto);
3151
3152         g_free(proto);
3153 }
3154
3155 static void add_network_security(DBusMessageIter *dict, GSupplicantSSID *ssid)
3156 {
3157         char *key_mgmt;
3158
3159         switch (ssid->security) {
3160         case G_SUPPLICANT_SECURITY_UNKNOWN:
3161         case G_SUPPLICANT_SECURITY_NONE:
3162         case G_SUPPLICANT_SECURITY_WEP:
3163                 key_mgmt = "NONE";
3164                 add_network_security_wep(dict, ssid);
3165                 add_network_security_ciphers(dict, ssid);
3166                 break;
3167         case G_SUPPLICANT_SECURITY_PSK:
3168                 key_mgmt = "WPA-PSK";
3169                 add_network_security_psk(dict, ssid);
3170                 add_network_security_ciphers(dict, ssid);
3171                 add_network_security_proto(dict, ssid);
3172                 break;
3173         case G_SUPPLICANT_SECURITY_IEEE8021X:
3174                 key_mgmt = "WPA-EAP";
3175                 add_network_security_eap(dict, ssid);
3176                 add_network_security_ciphers(dict, ssid);
3177                 add_network_security_proto(dict, ssid);
3178                 break;
3179         }
3180
3181         supplicant_dbus_dict_append_basic(dict, "key_mgmt",
3182                                 DBUS_TYPE_STRING, &key_mgmt);
3183 }
3184
3185 static void add_network_mode(DBusMessageIter *dict, GSupplicantSSID *ssid)
3186 {
3187         dbus_uint32_t mode;
3188
3189         switch (ssid->mode) {
3190         case G_SUPPLICANT_MODE_UNKNOWN:
3191         case G_SUPPLICANT_MODE_INFRA:
3192                 mode = 0;
3193                 break;
3194         case G_SUPPLICANT_MODE_IBSS:
3195                 mode = 1;
3196                 break;
3197         case G_SUPPLICANT_MODE_MASTER:
3198                 mode = 2;
3199                 break;
3200         }
3201
3202         supplicant_dbus_dict_append_basic(dict, "mode",
3203                                 DBUS_TYPE_UINT32, &mode);
3204 }
3205
3206 static void interface_add_network_params(DBusMessageIter *iter, void *user_data)
3207 {
3208         DBusMessageIter dict;
3209         struct interface_connect_data *data = user_data;
3210         GSupplicantSSID *ssid = data->ssid;
3211
3212         supplicant_dbus_dict_open(iter, &dict);
3213
3214         if (ssid->scan_ssid)
3215                 supplicant_dbus_dict_append_basic(&dict, "scan_ssid",
3216                                          DBUS_TYPE_UINT32, &ssid->scan_ssid);
3217
3218         if (ssid->freq)
3219                 supplicant_dbus_dict_append_basic(&dict, "frequency",
3220                                          DBUS_TYPE_UINT32, &ssid->freq);
3221
3222         if (ssid->bgscan != NULL)
3223                 supplicant_dbus_dict_append_basic(&dict, "bgscan",
3224                                         DBUS_TYPE_STRING, &ssid->bgscan);
3225
3226         add_network_mode(&dict, ssid);
3227
3228         add_network_security(&dict, ssid);
3229
3230         supplicant_dbus_dict_append_fixed_array(&dict, "ssid",
3231                                         DBUS_TYPE_BYTE, &ssid->ssid,
3232                                                 ssid->ssid_len);
3233
3234         supplicant_dbus_dict_close(iter, &dict);
3235 }
3236
3237 static void interface_wps_start_result(const char *error,
3238                                 DBusMessageIter *iter, void *user_data)
3239 {
3240         struct interface_connect_data *data = user_data;
3241
3242         SUPPLICANT_DBG("");
3243         if (error != NULL)
3244                 SUPPLICANT_DBG("error: %s", error);
3245
3246         g_free(data->ssid);
3247         dbus_free(data);
3248 }
3249
3250 static void interface_add_wps_params(DBusMessageIter *iter, void *user_data)
3251 {
3252         struct interface_connect_data *data = user_data;
3253         GSupplicantSSID *ssid = data->ssid;
3254         const char *role = "enrollee", *type;
3255         DBusMessageIter dict;
3256
3257         SUPPLICANT_DBG("");
3258
3259         supplicant_dbus_dict_open(iter, &dict);
3260
3261         supplicant_dbus_dict_append_basic(&dict, "Role",
3262                                                 DBUS_TYPE_STRING, &role);
3263
3264         type = "pbc";
3265         if (ssid->pin_wps != NULL) {
3266                 type = "pin";
3267                 supplicant_dbus_dict_append_basic(&dict, "Pin",
3268                                         DBUS_TYPE_STRING, &ssid->pin_wps);
3269         }
3270
3271         supplicant_dbus_dict_append_basic(&dict, "Type",
3272                                         DBUS_TYPE_STRING, &type);
3273
3274         supplicant_dbus_dict_close(iter, &dict);
3275 }
3276
3277 static void wps_start(const char *error, DBusMessageIter *iter, void *user_data)
3278 {
3279         struct interface_connect_data *data = user_data;
3280
3281         SUPPLICANT_DBG("");
3282
3283         if (error != NULL) {
3284                 SUPPLICANT_DBG("error: %s", error);
3285                 g_free(data->ssid);
3286                 dbus_free(data);
3287                 return;
3288         }
3289
3290         supplicant_dbus_method_call(data->interface->path,
3291                         SUPPLICANT_INTERFACE ".Interface.WPS", "Start",
3292                         interface_add_wps_params,
3293                         interface_wps_start_result, data);
3294 }
3295
3296 static void wps_process_credentials(DBusMessageIter *iter, void *user_data)
3297 {
3298         dbus_bool_t credentials = TRUE;
3299
3300         SUPPLICANT_DBG("");
3301
3302         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &credentials);
3303 }
3304
3305
3306 int g_supplicant_interface_connect(GSupplicantInterface *interface,
3307                                 GSupplicantSSID *ssid,
3308                                 GSupplicantInterfaceCallback callback,
3309                                                         void *user_data)
3310 {
3311         struct interface_connect_data *data;
3312         int ret;
3313
3314         if (interface == NULL)
3315                 return -EINVAL;
3316
3317         if (system_available == FALSE)
3318                 return -EFAULT;
3319
3320         /* TODO: Check if we're already connected and switch */
3321
3322         data = dbus_malloc0(sizeof(*data));
3323         if (data == NULL)
3324                 return -ENOMEM;
3325
3326         data->interface = interface;
3327         data->callback = callback;
3328         data->ssid = ssid;
3329         data->user_data = user_data;
3330
3331         if (ssid->use_wps == TRUE) {
3332                 g_free(interface->wps_cred.key);
3333                 memset(&interface->wps_cred, 0,
3334                                 sizeof(struct _GSupplicantWpsCredentials));
3335
3336                 ret = supplicant_dbus_property_set(interface->path,
3337                         SUPPLICANT_INTERFACE ".Interface.WPS",
3338                         "ProcessCredentials", DBUS_TYPE_BOOLEAN_AS_STRING,
3339                         wps_process_credentials, wps_start, data);
3340         } else
3341                 ret = supplicant_dbus_method_call(interface->path,
3342                         SUPPLICANT_INTERFACE ".Interface", "AddNetwork",
3343                         interface_add_network_params,
3344                         interface_add_network_result, data);
3345
3346         if (ret < 0)
3347                 return ret;
3348
3349         return -EINPROGRESS;
3350 }
3351
3352 static void network_remove_result(const char *error,
3353                                 DBusMessageIter *iter, void *user_data)
3354 {
3355         struct interface_data *data = user_data;
3356         int result = 0;
3357
3358         SUPPLICANT_DBG("");
3359
3360         if (error != NULL)
3361                 result = -EIO;
3362
3363         if (data->callback != NULL)
3364                 data->callback(result, data->interface, data->user_data);
3365
3366         dbus_free(data);
3367 }
3368
3369 static void network_remove_params(DBusMessageIter *iter, void *user_data)
3370 {
3371         struct interface_data *data = user_data;
3372         const char *path = data->interface->network_path;
3373
3374         SUPPLICANT_DBG("path %s", path);
3375
3376         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path);
3377 }
3378
3379 static int network_remove(struct interface_data *data)
3380 {
3381         GSupplicantInterface *interface = data->interface;
3382
3383         SUPPLICANT_DBG("");
3384
3385         return supplicant_dbus_method_call(interface->path,
3386                         SUPPLICANT_INTERFACE ".Interface", "RemoveNetwork",
3387                         network_remove_params, network_remove_result, data);
3388 }
3389
3390 static void interface_disconnect_result(const char *error,
3391                                 DBusMessageIter *iter, void *user_data)
3392 {
3393         struct interface_data *data = user_data;
3394
3395         SUPPLICANT_DBG("");
3396
3397         if (error != NULL && data->callback != NULL)
3398                 data->callback(-EIO, data->interface, data->user_data);
3399
3400         /* If we are disconnecting from previous WPS successful
3401          * association. i.e.: it did not went through AddNetwork,
3402          * and interface->network_path was never set. */
3403         if (data->interface->network_path == NULL)
3404                 return;
3405
3406         network_remove(data);
3407 }
3408
3409 int g_supplicant_interface_disconnect(GSupplicantInterface *interface,
3410                                         GSupplicantInterfaceCallback callback,
3411                                                         void *user_data)
3412 {
3413         struct interface_data *data;
3414
3415         SUPPLICANT_DBG("");
3416
3417         if (interface == NULL)
3418                 return -EINVAL;
3419
3420         if (system_available == FALSE)
3421                 return -EFAULT;
3422
3423         data = dbus_malloc0(sizeof(*data));
3424         if (data == NULL)
3425                 return -ENOMEM;
3426
3427         data->interface = interface;
3428         data->callback = callback;
3429         data->user_data = user_data;
3430
3431         return supplicant_dbus_method_call(interface->path,
3432                         SUPPLICANT_INTERFACE ".Interface", "Disconnect",
3433                                 NULL, interface_disconnect_result, data);
3434 }
3435
3436
3437 static const char *g_supplicant_rule0 = "type=signal,"
3438                                         "path=" DBUS_PATH_DBUS ","
3439                                         "sender=" DBUS_SERVICE_DBUS ","
3440                                         "interface=" DBUS_INTERFACE_DBUS ","
3441                                         "member=NameOwnerChanged,"
3442                                         "arg0=" SUPPLICANT_SERVICE;
3443 static const char *g_supplicant_rule1 = "type=signal,"
3444                         "interface=" SUPPLICANT_INTERFACE;
3445 static const char *g_supplicant_rule2 = "type=signal,"
3446                         "interface=" SUPPLICANT_INTERFACE ".Interface";
3447 static const char *g_supplicant_rule3 = "type=signal,"
3448                         "interface=" SUPPLICANT_INTERFACE ".Interface.WPS";
3449 static const char *g_supplicant_rule4 = "type=signal,"
3450                         "interface=" SUPPLICANT_INTERFACE ".BSS";
3451 static const char *g_supplicant_rule5 = "type=signal,"
3452                         "interface=" SUPPLICANT_INTERFACE ".Network";
3453
3454 static void invoke_introspect_method(void)
3455 {
3456         DBusMessage *message;
3457
3458         message = dbus_message_new_method_call(SUPPLICANT_SERVICE,
3459                                         SUPPLICANT_PATH,
3460                                         DBUS_INTERFACE_INTROSPECTABLE,
3461                                         "Introspect");
3462
3463         if (message == NULL)
3464                 return;
3465
3466         dbus_message_set_no_reply(message, TRUE);
3467         dbus_connection_send(connection, message, NULL);
3468         dbus_message_unref(message);
3469 }
3470
3471 int g_supplicant_register(const GSupplicantCallbacks *callbacks)
3472 {
3473         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
3474         if (connection == NULL)
3475                 return -EIO;
3476
3477         if (dbus_connection_add_filter(connection,
3478                                 g_supplicant_filter, NULL, NULL) == FALSE) {
3479                 dbus_connection_unref(connection);
3480                 connection = NULL;
3481                 return -EIO;
3482         }
3483
3484         callbacks_pointer = callbacks;
3485         eap_methods = 0;
3486
3487         interface_table = g_hash_table_new_full(g_str_hash, g_str_equal,
3488                                                 NULL, remove_interface);
3489
3490         bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
3491                                                                 NULL, NULL);
3492
3493         supplicant_dbus_setup(connection);
3494
3495         dbus_bus_add_match(connection, g_supplicant_rule0, NULL);
3496         dbus_bus_add_match(connection, g_supplicant_rule1, NULL);
3497         dbus_bus_add_match(connection, g_supplicant_rule2, NULL);
3498         dbus_bus_add_match(connection, g_supplicant_rule3, NULL);
3499         dbus_bus_add_match(connection, g_supplicant_rule4, NULL);
3500         dbus_bus_add_match(connection, g_supplicant_rule5, NULL);
3501         dbus_connection_flush(connection);
3502
3503         if (dbus_bus_name_has_owner(connection,
3504                                         SUPPLICANT_SERVICE, NULL) == TRUE) {
3505                 system_available = TRUE;
3506                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
3507                                                 SUPPLICANT_INTERFACE,
3508                                                 service_property, NULL);
3509         } else
3510                 invoke_introspect_method();
3511
3512         return 0;
3513 }
3514
3515 static void unregister_interface_remove_params(DBusMessageIter *iter,
3516                                                 void *user_data)
3517 {
3518         const char *path = user_data;
3519
3520         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
3521                                                         &path);
3522 }
3523
3524
3525 static void unregister_remove_interface(gpointer key, gpointer value,
3526                                                 gpointer user_data)
3527 {
3528         GSupplicantInterface *interface = value;
3529
3530         supplicant_dbus_method_call(SUPPLICANT_PATH,
3531                                         SUPPLICANT_INTERFACE,
3532                                         "RemoveInterface",
3533                                         unregister_interface_remove_params,
3534                                                 NULL, interface->path);
3535 }
3536
3537 void g_supplicant_unregister(const GSupplicantCallbacks *callbacks)
3538 {
3539         SUPPLICANT_DBG("");
3540
3541         if (connection != NULL) {
3542                 dbus_bus_remove_match(connection, g_supplicant_rule5, NULL);
3543                 dbus_bus_remove_match(connection, g_supplicant_rule4, NULL);
3544                 dbus_bus_remove_match(connection, g_supplicant_rule3, NULL);
3545                 dbus_bus_remove_match(connection, g_supplicant_rule2, NULL);
3546                 dbus_bus_remove_match(connection, g_supplicant_rule1, NULL);
3547                 dbus_bus_remove_match(connection, g_supplicant_rule0, NULL);
3548                 dbus_connection_flush(connection);
3549
3550                 dbus_connection_remove_filter(connection,
3551                                                 g_supplicant_filter, NULL);
3552         }
3553
3554         if (bss_mapping != NULL) {
3555                 g_hash_table_destroy(bss_mapping);
3556                 bss_mapping = NULL;
3557         }
3558
3559         if (system_available == TRUE)
3560                 callback_system_killed();
3561
3562         if (interface_table != NULL) {
3563                 g_hash_table_foreach(interface_table,
3564                                         unregister_remove_interface, NULL);
3565                 g_hash_table_destroy(interface_table);
3566                 interface_table = NULL;
3567         }
3568
3569         if (connection != NULL) {
3570                 dbus_connection_unref(connection);
3571                 connection = NULL;
3572         }
3573
3574         callbacks_pointer = NULL;
3575         eap_methods = 0;
3576 }