gsupplicant/supplicant.c

   1 /*
   2  *
   3  *  WPA supplicant library with GLib integration
   4  *
   5  *  Copyright (C) 2012  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         if (interface->max_scan_ssids == 0)
 746                 return WPAS_MAX_SCAN_SSIDS;
 747
 748         return interface->max_scan_ssids;
 749 }
 750
 751 static void set_network_enabled(DBusMessageIter *iter, void *user_data)
 752 {
 753         dbus_bool_t enable = *(dbus_bool_t *)user_data;
 754
 755         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &enable);
 756 }
 757
 758 int g_supplicant_interface_enable_selected_network(GSupplicantInterface *interface,
 759                                                         dbus_bool_t enable)
 760 {
 761         if (interface == NULL)
 762                 return -1;
 763
 764         if (interface->network_path == NULL)
 765                 return -1;
 766
 767         SUPPLICANT_DBG(" ");
 768         return supplicant_dbus_property_set(interface->network_path,
 769                                 SUPPLICANT_INTERFACE ".Network",
 770                                 "Enabled", DBUS_TYPE_BOOLEAN_AS_STRING,
 771                                 set_network_enabled, NULL, &enable);
 772 }
 773
 774 dbus_bool_t g_supplicant_interface_get_ready(GSupplicantInterface *interface)
 775 {
 776         if (interface == NULL)
 777                 return FALSE;
 778
 779         return interface->ready;
 780 }
 781
 782 GSupplicantInterface *g_supplicant_network_get_interface(
 783                                         GSupplicantNetwork *network)
 784 {
 785         if (network == NULL)
 786                 return NULL;
 787
 788         return network->interface;
 789 }
 790
 791 const char *g_supplicant_network_get_name(GSupplicantNetwork *network)
 792 {
 793         if (network == NULL || network->name == NULL)
 794                 return "";
 795
 796         return network->name;
 797 }
 798
 799 const char *g_supplicant_network_get_identifier(GSupplicantNetwork *network)
 800 {
 801         if (network == NULL || network->group == NULL)
 802                 return "";
 803
 804         return network->group;
 805 }
 806
 807 const char *g_supplicant_network_get_path(GSupplicantNetwork *network)
 808 {
 809         if (network == NULL || network->path == NULL)
 810                 return NULL;
 811
 812         return network->path;
 813 }
 814
 815 const char *g_supplicant_network_get_mode(GSupplicantNetwork *network)
 816 {
 817         if (network == NULL)
 818                 return G_SUPPLICANT_MODE_UNKNOWN;
 819
 820         return mode2string(network->mode);
 821 }
 822
 823 const char *g_supplicant_network_get_security(GSupplicantNetwork *network)
 824 {
 825         if (network == NULL)
 826                 return G_SUPPLICANT_SECURITY_UNKNOWN;
 827
 828         return security2string(network->security);
 829 }
 830
 831 const void *g_supplicant_network_get_ssid(GSupplicantNetwork *network,
 832                                                 unsigned int *ssid_len)
 833 {
 834         if (network == NULL || network->ssid == NULL) {
 835                 *ssid_len = 0;
 836                 return NULL;
 837         }
 838
 839         *ssid_len = network->ssid_len;
 840         return network->ssid;
 841 }
 842
 843 dbus_int16_t g_supplicant_network_get_signal(GSupplicantNetwork *network)
 844 {
 845         if (network == NULL)
 846                 return 0;
 847
 848         return network->signal;
 849 }
 850
 851 dbus_uint16_t g_supplicant_network_get_frequency(GSupplicantNetwork *network)
 852 {
 853         if (network == NULL)
 854                 return 0;
 855
 856         return network->frequency;
 857 }
 858
 859 dbus_bool_t g_supplicant_network_get_wps(GSupplicantNetwork *network)
 860 {
 861         if (network == NULL)
 862                 return FALSE;
 863
 864         return network->wps;
 865 }
 866
 867 dbus_bool_t g_supplicant_network_is_wps_active(GSupplicantNetwork *network)
 868 {
 869         if (network == NULL)
 870                 return FALSE;
 871
 872         if (network->wps_capabilities & G_SUPPLICANT_WPS_CONFIGURED)
 873                 return TRUE;
 874
 875         return FALSE;
 876 }
 877
 878 dbus_bool_t g_supplicant_network_is_wps_pbc(GSupplicantNetwork *network)
 879 {
 880         if (network == NULL)
 881                 return FALSE;
 882
 883         if (network->wps_capabilities & G_SUPPLICANT_WPS_PBC)
 884                 return TRUE;
 885
 886         return FALSE;
 887 }
 888
 889 dbus_bool_t g_supplicant_network_is_wps_advertizing(GSupplicantNetwork *network)
 890 {
 891         if (network == NULL)
 892                 return FALSE;
 893
 894         if (network->wps_capabilities & G_SUPPLICANT_WPS_REGISTRAR)
 895                 return TRUE;
 896
 897         return FALSE;
 898 }
 899
 900 static void merge_network(GSupplicantNetwork *network)
 901 {
 902         GString *str;
 903         const char *ssid, *mode, *key_mgmt;
 904         unsigned int i, ssid_len;
 905         char *group;
 906
 907         ssid = g_hash_table_lookup(network->config_table, "ssid");
 908         mode = g_hash_table_lookup(network->config_table, "mode");
 909         key_mgmt = g_hash_table_lookup(network->config_table, "key_mgmt");
 910
 911         SUPPLICANT_DBG("ssid %s mode %s", ssid, mode);
 912
 913         if (ssid != NULL)
 914                 ssid_len = strlen(ssid);
 915         else
 916                 ssid_len = 0;
 917
 918         str = g_string_sized_new((ssid_len * 2) + 24);
 919         if (str == NULL)
 920                 return;
 921
 922         for (i = 0; i < ssid_len; i++)
 923                 g_string_append_printf(str, "%02x", ssid[i]);
 924
 925         if (g_strcmp0(mode, "0") == 0)
 926                 g_string_append_printf(str, "_managed");
 927         else if (g_strcmp0(mode, "1") == 0)
 928                 g_string_append_printf(str, "_adhoc");
 929
 930         if (g_strcmp0(key_mgmt, "WPA-PSK") == 0)
 931                 g_string_append_printf(str, "_psk");
 932
 933         group = g_string_free(str, FALSE);
 934
 935         SUPPLICANT_DBG("%s", group);
 936
 937         g_free(group);
 938
 939         g_hash_table_destroy(network->config_table);
 940
 941         g_free(network->path);
 942         g_free(network);
 943 }
 944
 945 static void network_property(const char *key, DBusMessageIter *iter,
 946                                                         void *user_data)
 947 {
 948         GSupplicantNetwork *network = user_data;
 949
 950         if (network->interface == NULL)
 951                 return;
 952
 953         if (key == NULL) {
 954                 merge_network(network);
 955                 return;
 956         }
 957
 958         if (g_strcmp0(key, "Enabled") == 0) {
 959                 dbus_bool_t enabled = FALSE;
 960
 961                 dbus_message_iter_get_basic(iter, &enabled);
 962         } else if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
 963                 const char *str = NULL;
 964
 965                 dbus_message_iter_get_basic(iter, &str);
 966                 if (str != NULL) {
 967                         g_hash_table_replace(network->config_table,
 968                                                 g_strdup(key), g_strdup(str));
 969                 }
 970         } else
 971                 SUPPLICANT_DBG("key %s type %c",
 972                                 key, dbus_message_iter_get_arg_type(iter));
 973 }
 974
 975 static void interface_network_added(DBusMessageIter *iter, void *user_data)
 976 {
 977         GSupplicantInterface *interface = user_data;
 978         GSupplicantNetwork *network;
 979         const char *path = NULL;
 980
 981         SUPPLICANT_DBG("");
 982
 983         dbus_message_iter_get_basic(iter, &path);
 984         if (path == NULL)
 985                 return;
 986
 987         if (g_strcmp0(path, "/") == 0)
 988                 return;
 989
 990         network = g_hash_table_lookup(interface->net_mapping, path);
 991         if (network != NULL)
 992                 return;
 993
 994         network = g_try_new0(GSupplicantNetwork, 1);
 995         if (network == NULL)
 996                 return;
 997
 998         network->interface = interface;
 999         network->path = g_strdup(path);
1000
1001         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1002                                                         g_free, g_free);
1003
1004         dbus_message_iter_next(iter);
1005         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1006                 supplicant_dbus_property_foreach(iter, network_property,
1007                                                                 network);
1008                 network_property(NULL, NULL, network);
1009                 return;
1010         }
1011
1012         supplicant_dbus_property_get_all(path,
1013                                 SUPPLICANT_INTERFACE ".Network",
1014                                                 network_property, network);
1015 }
1016
1017 static void interface_network_removed(DBusMessageIter *iter, void *user_data)
1018 {
1019         GSupplicantInterface *interface = user_data;
1020         GSupplicantNetwork *network;
1021         const char *path = NULL;
1022
1023         dbus_message_iter_get_basic(iter, &path);
1024         if (path == NULL)
1025                 return;
1026
1027         network = g_hash_table_lookup(interface->net_mapping, path);
1028         if (network == NULL)
1029                 return;
1030
1031         g_hash_table_remove(interface->net_mapping, path);
1032 }
1033
1034 static char *create_name(unsigned char *ssid, int ssid_len)
1035 {
1036         GString *string;
1037         const gchar *remainder, *invalid;
1038         int valid_bytes, remaining_bytes;
1039
1040         if (ssid_len < 1 || ssid[0] == '\0')
1041                 return g_strdup("");
1042
1043         string = NULL;
1044         remainder = (const gchar *)ssid;
1045         remaining_bytes = ssid_len;
1046
1047         while (remaining_bytes != 0) {
1048                 if (g_utf8_validate(remainder, remaining_bytes,
1049                                         &invalid) == TRUE) {
1050                         break;
1051                 }
1052
1053                 valid_bytes = invalid - remainder;
1054
1055                 if (string == NULL)
1056                         string = g_string_sized_new(remaining_bytes);
1057
1058                 g_string_append_len(string, remainder, valid_bytes);
1059
1060                 /* append U+FFFD REPLACEMENT CHARACTER */
1061                 g_string_append(string, "\357\277\275");
1062
1063                 remaining_bytes -= valid_bytes + 1;
1064                 remainder = invalid + 1;
1065         }
1066
1067         if (string == NULL)
1068                 return g_strndup((const gchar *)ssid, ssid_len + 1);
1069
1070         g_string_append(string, remainder);
1071
1072         return g_string_free(string, FALSE);
1073 }
1074
1075 static char *create_group(struct g_supplicant_bss *bss)
1076 {
1077         GString *str;
1078         unsigned int i;
1079         const char *mode, *security;
1080
1081         str = g_string_sized_new((bss->ssid_len * 2) + 24);
1082         if (str == NULL)
1083                 return NULL;
1084
1085         if (bss->ssid_len > 0 && bss->ssid[0] != '\0') {
1086                 for (i = 0; i < bss->ssid_len; i++)
1087                         g_string_append_printf(str, "%02x", bss->ssid[i]);
1088         } else
1089                 g_string_append_printf(str, "hidden");
1090
1091         mode = mode2string(bss->mode);
1092         if (mode != NULL)
1093                 g_string_append_printf(str, "_%s", mode);
1094
1095         security = security2string(bss->security);
1096         if (security != NULL)
1097                 g_string_append_printf(str, "_%s", security);
1098
1099         return g_string_free(str, FALSE);
1100 }
1101
1102 static void add_or_replace_bss_to_network(struct g_supplicant_bss *bss)
1103 {
1104         GSupplicantInterface *interface = bss->interface;
1105         GSupplicantNetwork *network;
1106         char *group;
1107
1108         group = create_group(bss);
1109         SUPPLICANT_DBG("New group created: %s", group);
1110
1111         if (group == NULL)
1112                 return;
1113
1114         network = g_hash_table_lookup(interface->network_table, group);
1115         if (network != NULL) {
1116                 g_free(group);
1117                 SUPPLICANT_DBG("Network %s already exist", network->name);
1118
1119                 goto done;
1120         }
1121
1122         network = g_try_new0(GSupplicantNetwork, 1);
1123         if (network == NULL) {
1124                 g_free(group);
1125                 return;
1126         }
1127
1128         network->interface = interface;
1129         if (network->path == NULL)
1130                 network->path = g_strdup(bss->path);
1131         network->group = group;
1132         network->name = create_name(bss->ssid, bss->ssid_len);
1133         network->mode = bss->mode;
1134         network->security = bss->security;
1135         network->ssid_len = bss->ssid_len;
1136         memcpy(network->ssid, bss->ssid, bss->ssid_len);
1137         network->signal = bss->signal;
1138         network->frequency = bss->frequency;
1139         network->best_bss = bss;
1140
1141         network->wps = FALSE;
1142         if ((bss->keymgmt & G_SUPPLICANT_KEYMGMT_WPS) != 0) {
1143                 network->wps = TRUE;
1144
1145                 network->wps_capabilities |= bss->wps_capabilities;
1146         }
1147
1148         SUPPLICANT_DBG("New network %s created", network->name);
1149
1150         network->bss_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1151                                                         NULL, remove_bss);
1152
1153         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1154                                                         g_free, g_free);
1155
1156         g_hash_table_replace(interface->network_table,
1157                                                 network->group, network);
1158
1159         callback_network_added(network);
1160
1161 done:
1162         if (bss->signal > network->signal) {
1163                 network->signal = bss->signal;
1164                 network->best_bss = bss;
1165                 callback_network_changed(network, "Signal");
1166         }
1167
1168         g_hash_table_replace(interface->bss_mapping, bss->path, network);
1169         g_hash_table_replace(network->bss_table, bss->path, bss);
1170
1171         g_hash_table_replace(bss_mapping, bss->path, interface);
1172 }
1173
1174 static void bss_rates(DBusMessageIter *iter, void *user_data)
1175 {
1176         struct g_supplicant_bss *bss = user_data;
1177         dbus_uint32_t rate = 0;
1178
1179         dbus_message_iter_get_basic(iter, &rate);
1180         if (rate == 0)
1181                 return;
1182
1183         if (rate > bss->maxrate)
1184                 bss->maxrate = rate;
1185 }
1186
1187 static void bss_keymgmt(DBusMessageIter *iter, void *user_data)
1188 {
1189         struct g_supplicant_bss *bss = user_data;
1190         const char *str = NULL;
1191         int i;
1192
1193         dbus_message_iter_get_basic(iter, &str);
1194         if (str == NULL)
1195                 return;
1196
1197         for (i = 0; keymgmt_map[i].str != NULL; i++)
1198                 if (strcmp(str, keymgmt_map[i].str) == 0) {
1199                         bss->keymgmt |= keymgmt_map[i].val;
1200                         break;
1201                 }
1202 }
1203
1204 static void bss_group(DBusMessageIter *iter, void *user_data)
1205 {
1206         struct g_supplicant_bss *bss = user_data;
1207         const char *str = NULL;
1208         int i;
1209
1210         dbus_message_iter_get_basic(iter, &str);
1211         if (str == NULL)
1212                 return;
1213
1214         for (i = 0; group_map[i].str != NULL; i++)
1215                 if (strcmp(str, group_map[i].str) == 0) {
1216                         bss->group |= group_map[i].val;
1217                         break;
1218                 }
1219 }
1220
1221 static void bss_pairwise(DBusMessageIter *iter, void *user_data)
1222 {
1223         struct g_supplicant_bss *bss = user_data;
1224         const char *str = NULL;
1225         int i;
1226
1227         dbus_message_iter_get_basic(iter, &str);
1228         if (str == NULL)
1229                 return;
1230
1231         for (i = 0; pairwise_map[i].str != NULL; i++)
1232                 if (strcmp(str, pairwise_map[i].str) == 0) {
1233                         bss->pairwise |= pairwise_map[i].val;
1234                         break;
1235                 }
1236 }
1237
1238 static void bss_wpa(const char *key, DBusMessageIter *iter,
1239                         void *user_data)
1240 {
1241         if (g_strcmp0(key, "KeyMgmt") == 0)
1242                 supplicant_dbus_array_foreach(iter, bss_keymgmt, user_data);
1243         else if (g_strcmp0(key, "Group") == 0)
1244                 supplicant_dbus_array_foreach(iter, bss_group, user_data);
1245         else if (g_strcmp0(key, "Pairwise") == 0)
1246                 supplicant_dbus_array_foreach(iter, bss_pairwise, user_data);
1247
1248 }
1249
1250 static unsigned int get_tlv(unsigned char *ie, unsigned int ie_size,
1251                                                         unsigned int type)
1252 {
1253         unsigned int len = 0;
1254
1255         while (len + 4 < ie_size) {
1256                 unsigned int hi = ie[len];
1257                 unsigned int lo = ie[len + 1];
1258                 unsigned int tmp_type = (hi << 8) + lo;
1259                 unsigned int v_len = 0;
1260
1261                 /* hi and lo are used to recreate an unsigned int
1262                  * based on 2 8bits length unsigned int. */
1263
1264                 hi = ie[len + 2];
1265                 lo = ie[len + 3];
1266                 v_len = (hi << 8) + lo;
1267
1268                 if (tmp_type == type) {
1269                         unsigned int ret_value = 0;
1270                         unsigned char *value = (unsigned char *)&ret_value;
1271
1272                         SUPPLICANT_DBG("IE: match type 0x%x", type);
1273
1274                         /* Verifying length relevance */
1275                         if (v_len > sizeof(unsigned int) ||
1276                                 len + 4 + v_len > ie_size)
1277                                 break;
1278
1279                         memcpy(value, ie + len + 4, v_len);
1280
1281                         SUPPLICANT_DBG("returning 0x%x", ret_value);
1282                         return ret_value;
1283                 }
1284
1285                 len += v_len + 4;
1286         }
1287
1288         SUPPLICANT_DBG("returning 0");
1289         return 0;
1290 }
1291
1292 static void bss_process_ies(DBusMessageIter *iter, void *user_data)
1293 {
1294         struct g_supplicant_bss *bss = user_data;
1295         const unsigned char WPS_OUI[] = { 0x00, 0x50, 0xf2, 0x04 };
1296         unsigned char *ie, *ie_end;
1297         DBusMessageIter array;
1298         unsigned int value;
1299         int ie_len;
1300
1301 #define WMM_WPA1_WPS_INFO 221
1302 #define WPS_INFO_MIN_LEN  6
1303 #define WPS_VERSION_TLV   0x104A
1304 #define WPS_STATE_TLV     0x1044
1305 #define WPS_METHODS_TLV   0x1012
1306 #define WPS_REGISTRAR_TLV 0x1041
1307 #define WPS_VERSION       0x10
1308 #define WPS_PBC           0x04
1309 #define WPS_PIN           0x00
1310 #define WPS_CONFIGURED    0x02
1311
1312         dbus_message_iter_recurse(iter, &array);
1313         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1314
1315         if (ie == NULL || ie_len < 2)
1316                 return;
1317
1318         for (ie_end = ie + ie_len; ie < ie_end && ie + ie[1] + 1 <= ie_end;
1319                                                         ie += ie[1] + 2) {
1320
1321                 if (ie[0] != WMM_WPA1_WPS_INFO || ie[1] < WPS_INFO_MIN_LEN ||
1322                         memcmp(ie+2, WPS_OUI, sizeof(WPS_OUI)) != 0)
1323                         continue;
1324
1325                 SUPPLICANT_DBG("IE: match WPS_OUI");
1326
1327                 value = get_tlv(&ie[6], ie[1], WPS_STATE_TLV);
1328                 if (get_tlv(&ie[6], ie[1], WPS_VERSION_TLV) == WPS_VERSION &&
1329                                                                 value != 0) {
1330                         bss->keymgmt |= G_SUPPLICANT_KEYMGMT_WPS;
1331
1332                         if (value == WPS_CONFIGURED)
1333                                 bss->wps_capabilities |=
1334                                         G_SUPPLICANT_WPS_CONFIGURED;
1335                 }
1336
1337                 value = get_tlv(&ie[6], ie[1], WPS_METHODS_TLV);
1338                 if (value != 0) {
1339                         if (GUINT16_FROM_BE(value) == WPS_PBC)
1340                                 bss->wps_capabilities |= G_SUPPLICANT_WPS_PBC;
1341                         if (GUINT16_FROM_BE(value) == WPS_PIN)
1342                                 bss->wps_capabilities |= G_SUPPLICANT_WPS_PIN;
1343                 } else
1344                         bss->wps_capabilities |=
1345                                 G_SUPPLICANT_WPS_PBC | G_SUPPLICANT_WPS_PIN;
1346
1347                 /* If the AP sends this it means it's advertizing
1348                  * as a registrar and the WPS process is launched
1349                  * on its side */
1350                 if (get_tlv(&ie[6], ie[1], WPS_REGISTRAR_TLV) != 0)
1351                         bss->wps_capabilities |= G_SUPPLICANT_WPS_REGISTRAR;
1352
1353                 SUPPLICANT_DBG("WPS Methods 0x%x", bss->wps_capabilities);
1354         }
1355 }
1356
1357 static void bss_compute_security(struct g_supplicant_bss *bss)
1358 {
1359         if (bss->ieee8021x == TRUE)
1360                 bss->security = G_SUPPLICANT_SECURITY_IEEE8021X;
1361         else if (bss->psk == TRUE)
1362                 bss->security = G_SUPPLICANT_SECURITY_PSK;
1363         else if (bss->privacy == TRUE)
1364                 bss->security = G_SUPPLICANT_SECURITY_WEP;
1365         else
1366                 bss->security = G_SUPPLICANT_SECURITY_NONE;
1367 }
1368
1369
1370 static void bss_property(const char *key, DBusMessageIter *iter,
1371                                                         void *user_data)
1372 {
1373         struct g_supplicant_bss *bss = user_data;
1374
1375         if (bss->interface == NULL)
1376                 return;
1377
1378         SUPPLICANT_DBG("key %s", key);
1379
1380         if (key == NULL)
1381                 return;
1382
1383         if (g_strcmp0(key, "BSSID") == 0) {
1384                 DBusMessageIter array;
1385                 unsigned char *addr;
1386                 int addr_len;
1387
1388                 dbus_message_iter_recurse(iter, &array);
1389                 dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
1390
1391                 if (addr_len == 6)
1392                         memcpy(bss->bssid, addr, addr_len);
1393         } else if (g_strcmp0(key, "SSID") == 0) {
1394                 DBusMessageIter array;
1395                 unsigned char *ssid;
1396                 int ssid_len;
1397
1398                 dbus_message_iter_recurse(iter, &array);
1399                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
1400
1401                 if (ssid_len > 0 && ssid_len < 33) {
1402                         memcpy(bss->ssid, ssid, ssid_len);
1403                         bss->ssid_len = ssid_len;
1404                 } else {
1405                         memset(bss->ssid, 0, sizeof(bss->ssid));
1406                         bss->ssid_len = 0;
1407                 }
1408         } else if (g_strcmp0(key, "Capabilities") == 0) {
1409                 dbus_uint16_t capabilities = 0x0000;
1410
1411                 dbus_message_iter_get_basic(iter, &capabilities);
1412
1413                 if (capabilities & IEEE80211_CAP_ESS)
1414                         bss->mode = G_SUPPLICANT_MODE_INFRA;
1415                 else if (capabilities & IEEE80211_CAP_IBSS)
1416                         bss->mode = G_SUPPLICANT_MODE_IBSS;
1417
1418                 if (capabilities & IEEE80211_CAP_PRIVACY)
1419                         bss->privacy = TRUE;
1420         } else if (g_strcmp0(key, "Mode") == 0) {
1421                 const char *mode = NULL;
1422
1423                 dbus_message_iter_get_basic(iter, &mode);
1424                 bss->mode = string2mode(mode);
1425         } else if (g_strcmp0(key, "Frequency") == 0) {
1426                 dbus_uint16_t frequency = 0;
1427
1428                 dbus_message_iter_get_basic(iter, &frequency);
1429                 bss->frequency = frequency;
1430         } else if (g_strcmp0(key, "Signal") == 0) {
1431                 dbus_int16_t signal = 0;
1432
1433                 dbus_message_iter_get_basic(iter, &signal);
1434
1435                 bss->signal = signal;
1436         } else if (g_strcmp0(key, "Level") == 0) {
1437                 dbus_int32_t level = 0;
1438
1439                 dbus_message_iter_get_basic(iter, &level);
1440         } else if (g_strcmp0(key, "Rates") == 0) {
1441                 supplicant_dbus_array_foreach(iter, bss_rates, bss);
1442         } else if (g_strcmp0(key, "MaxRate") == 0) {
1443                 dbus_uint32_t maxrate = 0;
1444
1445                 dbus_message_iter_get_basic(iter, &maxrate);
1446                 if (maxrate != 0)
1447                         bss->maxrate = maxrate;
1448         } else if (g_strcmp0(key, "Privacy") == 0) {
1449                 dbus_bool_t privacy = FALSE;
1450
1451                 dbus_message_iter_get_basic(iter, &privacy);
1452                 bss->privacy = privacy;
1453         } else if ((g_strcmp0(key, "RSN") == 0) ||
1454                         (g_strcmp0(key, "WPA") == 0)) {
1455                 supplicant_dbus_property_foreach(iter, bss_wpa, bss);
1456
1457                 if (bss->keymgmt &
1458                         (G_SUPPLICANT_KEYMGMT_WPA_EAP |
1459                                 G_SUPPLICANT_KEYMGMT_WPA_FT_EAP |
1460                                 G_SUPPLICANT_KEYMGMT_WPA_EAP_256))
1461                         bss->ieee8021x = TRUE;
1462
1463                 if (bss->keymgmt &
1464                         (G_SUPPLICANT_KEYMGMT_WPA_PSK |
1465                                 G_SUPPLICANT_KEYMGMT_WPA_FT_PSK |
1466                                 G_SUPPLICANT_KEYMGMT_WPA_PSK_256))
1467                         bss->psk = TRUE;
1468         } else if (g_strcmp0(key, "IEs") == 0)
1469                 bss_process_ies(iter, bss);
1470         else
1471                 SUPPLICANT_DBG("key %s type %c",
1472                                 key, dbus_message_iter_get_arg_type(iter));
1473 }
1474
1475 static struct g_supplicant_bss *interface_bss_added(DBusMessageIter *iter,
1476                                                         void *user_data)
1477 {
1478         GSupplicantInterface *interface = user_data;
1479         GSupplicantNetwork *network;
1480         struct g_supplicant_bss *bss;
1481         const char *path = NULL;
1482
1483         SUPPLICANT_DBG("");
1484
1485         dbus_message_iter_get_basic(iter, &path);
1486         if (path == NULL)
1487                 return NULL;
1488
1489         if (g_strcmp0(path, "/") == 0)
1490                 return NULL;
1491
1492         SUPPLICANT_DBG("%s", path);
1493
1494         network = g_hash_table_lookup(interface->bss_mapping, path);
1495         if (network != NULL) {
1496                 bss = g_hash_table_lookup(network->bss_table, path);
1497                 if (bss != NULL)
1498                         return NULL;
1499         }
1500
1501         bss = g_try_new0(struct g_supplicant_bss, 1);
1502         if (bss == NULL)
1503                 return NULL;
1504
1505         bss->interface = interface;
1506         bss->path = g_strdup(path);
1507
1508         return bss;
1509 }
1510
1511 static void interface_bss_added_with_keys(DBusMessageIter *iter,
1512                                                 void *user_data)
1513 {
1514         struct g_supplicant_bss *bss;
1515
1516         SUPPLICANT_DBG("");
1517
1518         bss = interface_bss_added(iter, user_data);
1519         if (bss == NULL)
1520                 return;
1521
1522         dbus_message_iter_next(iter);
1523
1524         if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_INVALID)
1525                 return;
1526
1527         supplicant_dbus_property_foreach(iter, bss_property, bss);
1528
1529         bss_compute_security(bss);
1530         add_or_replace_bss_to_network(bss);
1531 }
1532
1533 static void interface_bss_added_without_keys(DBusMessageIter *iter,
1534                                                 void *user_data)
1535 {
1536         struct g_supplicant_bss *bss;
1537
1538         SUPPLICANT_DBG("");
1539
1540         bss = interface_bss_added(iter, user_data);
1541         if (bss == NULL)
1542                 return;
1543
1544         supplicant_dbus_property_get_all(bss->path,
1545                                         SUPPLICANT_INTERFACE ".BSS",
1546                                                         bss_property, bss);
1547
1548         bss_compute_security(bss);
1549         add_or_replace_bss_to_network(bss);
1550 }
1551
1552 static void update_signal(gpointer key, gpointer value,
1553                                                 gpointer user_data)
1554 {
1555         struct g_supplicant_bss *bss = value;
1556         GSupplicantNetwork *network = user_data;
1557
1558         if (bss->signal > network->signal) {
1559                 network->signal = bss->signal;
1560                 network->best_bss = bss;
1561         }
1562 }
1563
1564 static void update_network_signal(GSupplicantNetwork *network)
1565 {
1566         if (g_hash_table_size(network->bss_table) <= 1)
1567                 return;
1568
1569         g_hash_table_foreach(network->bss_table,
1570                                 update_signal, network);
1571
1572         SUPPLICANT_DBG("New network signal %d", network->signal);
1573 }
1574
1575 static void interface_bss_removed(DBusMessageIter *iter, void *user_data)
1576 {
1577         GSupplicantInterface *interface = user_data;
1578         GSupplicantNetwork *network;
1579         const char *path = NULL;
1580
1581         dbus_message_iter_get_basic(iter, &path);
1582         if (path == NULL)
1583                 return;
1584
1585         network = g_hash_table_lookup(interface->bss_mapping, path);
1586         if (network == NULL)
1587                 return;
1588
1589         g_hash_table_remove(bss_mapping, path);
1590
1591         g_hash_table_remove(interface->bss_mapping, path);
1592         g_hash_table_remove(network->bss_table, path);
1593
1594         update_network_signal(network);
1595
1596         if (g_hash_table_size(network->bss_table) == 0)
1597                 g_hash_table_remove(interface->network_table, network->group);
1598 }
1599
1600 static void interface_property(const char *key, DBusMessageIter *iter,
1601                                                         void *user_data)
1602 {
1603         GSupplicantInterface *interface = user_data;
1604
1605         if (interface == NULL)
1606                 return;
1607
1608         SUPPLICANT_DBG("%s", key);
1609
1610         if (key == NULL) {
1611                 debug_strvalmap("KeyMgmt capability", keymgmt_map,
1612                                                 interface->keymgmt_capa);
1613                 debug_strvalmap("AuthAlg capability", authalg_capa_map,
1614                                                 interface->authalg_capa);
1615                 debug_strvalmap("Protocol capability", proto_capa_map,
1616                                                 interface->proto_capa);
1617                 debug_strvalmap("Pairwise capability", pairwise_map,
1618                                                 interface->pairwise_capa);
1619                 debug_strvalmap("Group capability", group_map,
1620                                                 interface->group_capa);
1621                 debug_strvalmap("Scan capability", scan_capa_map,
1622                                                 interface->scan_capa);
1623                 debug_strvalmap("Mode capability", mode_capa_map,
1624                                                 interface->mode_capa);
1625
1626                 interface->ready = TRUE;
1627                 callback_interface_added(interface);
1628                 return;
1629         }
1630
1631         if (g_strcmp0(key, "Capabilities") == 0) {
1632                 supplicant_dbus_property_foreach(iter, interface_capability,
1633                                                                 interface);
1634         } else if (g_strcmp0(key, "State") == 0) {
1635                 const char *str = NULL;
1636
1637                 dbus_message_iter_get_basic(iter, &str);
1638                 if (str != NULL)
1639                         if (string2state(str) != interface->state) {
1640                                 interface->state = string2state(str);
1641                                 callback_interface_state(interface);
1642                         }
1643
1644                 SUPPLICANT_DBG("state %s (%d)", str, interface->state);
1645         } else if (g_strcmp0(key, "Scanning") == 0) {
1646                 dbus_bool_t scanning = FALSE;
1647
1648                 dbus_message_iter_get_basic(iter, &scanning);
1649                 interface->scanning = scanning;
1650
1651                 if (interface->ready == TRUE) {
1652                         if (interface->scanning == TRUE)
1653                                 callback_scan_started(interface);
1654                         else
1655                                 callback_scan_finished(interface);
1656                 }
1657         } else if (g_strcmp0(key, "ApScan") == 0) {
1658                 int apscan = 1;
1659
1660                 dbus_message_iter_get_basic(iter, &apscan);
1661                 interface->apscan = apscan;
1662         } else if (g_strcmp0(key, "Ifname") == 0) {
1663                 const char *str = NULL;
1664
1665                 dbus_message_iter_get_basic(iter, &str);
1666                 if (str != NULL) {
1667                         g_free(interface->ifname);
1668                         interface->ifname = g_strdup(str);
1669                 }
1670         } else if (g_strcmp0(key, "Driver") == 0) {
1671                 const char *str = NULL;
1672
1673                 dbus_message_iter_get_basic(iter, &str);
1674                 if (str != NULL) {
1675                         g_free(interface->driver);
1676                         interface->driver = g_strdup(str);
1677                 }
1678         } else if (g_strcmp0(key, "BridgeIfname") == 0) {
1679                 const char *str = NULL;
1680
1681                 dbus_message_iter_get_basic(iter, &str);
1682                 if (str != NULL) {
1683                         g_free(interface->bridge);
1684                         interface->bridge = g_strdup(str);
1685                 }
1686         } else if (g_strcmp0(key, "CurrentBSS") == 0) {
1687                 interface_bss_added_without_keys(iter, interface);
1688         } else if (g_strcmp0(key, "CurrentNetwork") == 0) {
1689                 interface_network_added(iter, interface);
1690         } else if (g_strcmp0(key, "BSSs") == 0) {
1691                 supplicant_dbus_array_foreach(iter, interface_bss_added_without_keys,
1692                                                                 interface);
1693         } else if (g_strcmp0(key, "Blobs") == 0) {
1694                 /* Nothing */
1695         } else if (g_strcmp0(key, "Networks") == 0) {
1696                 supplicant_dbus_array_foreach(iter, interface_network_added,
1697                                                                 interface);
1698         } else
1699                 SUPPLICANT_DBG("key %s type %c",
1700                                 key, dbus_message_iter_get_arg_type(iter));
1701 }
1702
1703 static void scan_network_update(DBusMessageIter *iter, void *user_data)
1704 {
1705         GSupplicantInterface *interface = user_data;
1706         GSupplicantNetwork *network;
1707         char *path;
1708
1709         if (iter == NULL)
1710                 return;
1711
1712         dbus_message_iter_get_basic(iter, &path);
1713
1714         if (path == NULL)
1715                 return;
1716
1717         if (g_strcmp0(path, "/") == 0)
1718                 return;
1719
1720         /* Update the network details based on scan BSS data */
1721         network = g_hash_table_lookup(interface->bss_mapping, path);
1722         if (network != NULL)
1723                 callback_network_added(network);
1724 }
1725
1726 static void scan_bss_data(const char *key, DBusMessageIter *iter,
1727                                 void *user_data)
1728 {
1729         GSupplicantInterface *interface = user_data;
1730
1731         if (iter)
1732                 supplicant_dbus_array_foreach(iter, scan_network_update,
1733                                                 interface);
1734
1735         if (interface->scan_callback != NULL)
1736                 interface->scan_callback(0, interface, interface->scan_data);
1737
1738         interface->scan_callback = NULL;
1739         interface->scan_data = NULL;
1740 }
1741
1742 static GSupplicantInterface *interface_alloc(const char *path)
1743 {
1744         GSupplicantInterface *interface;
1745
1746         interface = g_try_new0(GSupplicantInterface, 1);
1747         if (interface == NULL)
1748                 return NULL;
1749
1750         interface->path = g_strdup(path);
1751
1752         interface->network_table = g_hash_table_new_full(g_str_hash,
1753                                         g_str_equal, NULL, remove_network);
1754
1755         interface->net_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1756                                                                 NULL, NULL);
1757         interface->bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1758                                                                 NULL, NULL);
1759
1760         g_hash_table_replace(interface_table, interface->path, interface);
1761
1762         return interface;
1763 }
1764
1765 static void interface_added(DBusMessageIter *iter, void *user_data)
1766 {
1767         GSupplicantInterface *interface;
1768         const char *path = NULL;
1769
1770         SUPPLICANT_DBG("");
1771
1772         dbus_message_iter_get_basic(iter, &path);
1773         if (path == NULL)
1774                 return;
1775
1776         if (g_strcmp0(path, "/") == 0)
1777                 return;
1778
1779         interface = g_hash_table_lookup(interface_table, path);
1780         if (interface != NULL)
1781                 return;
1782
1783         interface = interface_alloc(path);
1784         if (interface == NULL)
1785                 return;
1786
1787         dbus_message_iter_next(iter);
1788         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1789                 supplicant_dbus_property_foreach(iter, interface_property,
1790                                                                 interface);
1791                 interface_property(NULL, NULL, interface);
1792                 return;
1793         }
1794
1795         supplicant_dbus_property_get_all(path,
1796                                         SUPPLICANT_INTERFACE ".Interface",
1797                                                 interface_property, interface);
1798 }
1799
1800 static void interface_removed(DBusMessageIter *iter, void *user_data)
1801 {
1802         const char *path = NULL;
1803
1804         dbus_message_iter_get_basic(iter, &path);
1805         if (path == NULL)
1806                 return;
1807
1808         g_hash_table_remove(interface_table, path);
1809 }
1810
1811 static void eap_method(DBusMessageIter *iter, void *user_data)
1812 {
1813         const char *str = NULL;
1814         int i;
1815
1816         dbus_message_iter_get_basic(iter, &str);
1817         if (str == NULL)
1818                 return;
1819
1820         for (i = 0; eap_method_map[i].str != NULL; i++)
1821                 if (strcmp(str, eap_method_map[i].str) == 0) {
1822                         eap_methods |= eap_method_map[i].val;
1823                         break;
1824                 }
1825 }
1826
1827 static void service_property(const char *key, DBusMessageIter *iter,
1828                                                         void *user_data)
1829 {
1830         if (key == NULL) {
1831                 callback_system_ready();
1832                 return;
1833         }
1834
1835         if (g_strcmp0(key, "DebugLevel") == 0) {
1836                 const char *str = NULL;
1837                 int i;
1838
1839                 dbus_message_iter_get_basic(iter, &str);
1840                 for (i = 0; debug_strings[i] != NULL; i++)
1841                         if (g_strcmp0(debug_strings[i], str) == 0) {
1842                                 debug_level = i;
1843                                 break;
1844                         }
1845                 SUPPLICANT_DBG("Debug level %d", debug_level);
1846         } else if (g_strcmp0(key, "DebugTimestamp") == 0) {
1847                 dbus_message_iter_get_basic(iter, &debug_timestamp);
1848                 SUPPLICANT_DBG("Debug timestamp %u", debug_timestamp);
1849         } else if (g_strcmp0(key, "DebugShowKeys") == 0) {
1850                 dbus_message_iter_get_basic(iter, &debug_showkeys);
1851                 SUPPLICANT_DBG("Debug show keys %u", debug_showkeys);
1852         } else if (g_strcmp0(key, "Interfaces") == 0) {
1853                 supplicant_dbus_array_foreach(iter, interface_added, NULL);
1854         } else if (g_strcmp0(key, "EapMethods") == 0) {
1855                 supplicant_dbus_array_foreach(iter, eap_method, NULL);
1856                 debug_strvalmap("EAP method", eap_method_map, eap_methods);
1857         } else if (g_strcmp0(key, "Country") == 0) {
1858                 const char *country = NULL;
1859
1860                 dbus_message_iter_get_basic(iter, &country);
1861                 SUPPLICANT_DBG("Country %s", country);
1862         } else
1863                 SUPPLICANT_DBG("key %s type %c",
1864                                 key, dbus_message_iter_get_arg_type(iter));
1865 }
1866
1867 static void signal_name_owner_changed(const char *path, DBusMessageIter *iter)
1868 {
1869         const char *name = NULL, *old = NULL, *new = NULL;
1870
1871         SUPPLICANT_DBG("");
1872
1873         if (g_strcmp0(path, DBUS_PATH_DBUS) != 0)
1874                 return;
1875
1876         dbus_message_iter_get_basic(iter, &name);
1877         if (name == NULL)
1878                 return;
1879
1880         if (g_strcmp0(name, SUPPLICANT_SERVICE) != 0)
1881                 return;
1882
1883         dbus_message_iter_next(iter);
1884         dbus_message_iter_get_basic(iter, &old);
1885         dbus_message_iter_next(iter);
1886         dbus_message_iter_get_basic(iter, &new);
1887
1888         if (old == NULL || new == NULL)
1889                 return;
1890
1891         if (strlen(old) > 0 && strlen(new) == 0) {
1892                 system_available = FALSE;
1893                 g_hash_table_remove_all(bss_mapping);
1894                 g_hash_table_remove_all(interface_table);
1895                 callback_system_killed();
1896         }
1897
1898         if (strlen(new) > 0 && strlen(old) == 0) {
1899                 system_available = TRUE;
1900                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
1901                                                         SUPPLICANT_INTERFACE,
1902                                                         service_property, NULL);
1903         }
1904 }
1905
1906 static void signal_properties_changed(const char *path, DBusMessageIter *iter)
1907 {
1908         SUPPLICANT_DBG("");
1909
1910         if (g_strcmp0(path, SUPPLICANT_PATH) != 0)
1911                 return;
1912
1913         supplicant_dbus_property_foreach(iter, service_property, NULL);
1914 }
1915
1916 static void signal_interface_added(const char *path, DBusMessageIter *iter)
1917 {
1918         SUPPLICANT_DBG("path %s %s", path, SUPPLICANT_PATH);
1919
1920         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1921                 interface_added(iter, NULL);
1922 }
1923
1924 static void signal_interface_removed(const char *path, DBusMessageIter *iter)
1925 {
1926         SUPPLICANT_DBG("");
1927
1928         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1929                 interface_removed(iter, NULL);
1930 }
1931
1932 static void signal_interface_changed(const char *path, DBusMessageIter *iter)
1933 {
1934         GSupplicantInterface *interface;
1935
1936         SUPPLICANT_DBG("");
1937
1938         interface = g_hash_table_lookup(interface_table, path);
1939         if (interface == NULL)
1940                 return;
1941
1942         supplicant_dbus_property_foreach(iter, interface_property, interface);
1943 }
1944
1945 static void signal_scan_done(const char *path, DBusMessageIter *iter)
1946 {
1947         GSupplicantInterface *interface;
1948         dbus_bool_t success = FALSE;
1949
1950         SUPPLICANT_DBG("");
1951
1952         interface = g_hash_table_lookup(interface_table, path);
1953         if (interface == NULL)
1954                 return;
1955
1956         dbus_message_iter_get_basic(iter, &success);
1957
1958         /*
1959          * If scan is unsuccessful return -EIO else get the scanned BSSs
1960          * and update the network details accordingly
1961          */
1962         if (success == FALSE) {
1963                 if (interface->scan_callback != NULL)
1964                         interface->scan_callback(-EIO, interface,
1965                                                 interface->scan_data);
1966
1967                 interface->scan_callback = NULL;
1968                 interface->scan_data = NULL;
1969
1970                 return;
1971         }
1972
1973         supplicant_dbus_property_get(path, SUPPLICANT_INTERFACE ".Interface",
1974                                         "BSSs", scan_bss_data, interface);
1975 }
1976
1977 static void signal_bss_added(const char *path, DBusMessageIter *iter)
1978 {
1979         GSupplicantInterface *interface;
1980
1981         SUPPLICANT_DBG("");
1982
1983         interface = g_hash_table_lookup(interface_table, path);
1984         if (interface == NULL)
1985                 return;
1986
1987         interface_bss_added_with_keys(iter, interface);
1988 }
1989
1990 static void signal_bss_removed(const char *path, DBusMessageIter *iter)
1991 {
1992         GSupplicantInterface *interface;
1993
1994         SUPPLICANT_DBG("");
1995
1996         interface = g_hash_table_lookup(interface_table, path);
1997         if (interface == NULL)
1998                 return;
1999
2000         interface_bss_removed(iter, interface);
2001 }
2002
2003 static void signal_network_added(const char *path, DBusMessageIter *iter)
2004 {
2005         GSupplicantInterface *interface;
2006
2007         SUPPLICANT_DBG("");
2008
2009         interface = g_hash_table_lookup(interface_table, path);
2010         if (interface == NULL)
2011                 return;
2012
2013         interface_network_added(iter, interface);
2014 }
2015
2016 static void signal_network_removed(const char *path, DBusMessageIter *iter)
2017 {
2018         GSupplicantInterface *interface;
2019
2020         SUPPLICANT_DBG("");
2021
2022         interface = g_hash_table_lookup(interface_table, path);
2023         if (interface == NULL)
2024                 return;
2025
2026         interface_network_removed(iter, interface);
2027 }
2028
2029 static void signal_bss_changed(const char *path, DBusMessageIter *iter)
2030 {
2031         GSupplicantInterface *interface;
2032         GSupplicantNetwork *network;
2033         GSupplicantSecurity old_security;
2034         struct g_supplicant_bss *bss;
2035
2036         SUPPLICANT_DBG("");
2037
2038         interface = g_hash_table_lookup(bss_mapping, path);
2039         if (interface == NULL)
2040                 return;
2041
2042         network = g_hash_table_lookup(interface->bss_mapping, path);
2043         if (network == NULL)
2044                 return;
2045
2046         bss = g_hash_table_lookup(network->bss_table, path);
2047         if (bss == NULL)
2048                 return;
2049
2050         supplicant_dbus_property_foreach(iter, bss_property, bss);
2051
2052         old_security = network->security;
2053         bss_compute_security(bss);
2054
2055         if (old_security != bss->security) {
2056                 struct g_supplicant_bss *new_bss;
2057
2058                 SUPPLICANT_DBG("New network security for %s", bss->ssid);
2059
2060                 /* Security change policy:
2061                  * - we first copy the current bss into a new one with
2062                  * its own pointer (path)
2063                  * - we remove the current bss related nework which will
2064                  * tell the plugin about such removal. This is done due
2065                  * to the fact that a security change means a group change
2066                  * so a complete network change.
2067                  * (current bss becomes invalid as well)
2068                  * - we add the new bss: it adds new network and tell the
2069                  * plugin about it. */
2070
2071                 new_bss = g_try_new0(struct g_supplicant_bss, 1);
2072                 if (new_bss == NULL)
2073                         return;
2074
2075                 memcpy(new_bss, bss, sizeof(struct g_supplicant_bss));
2076                 new_bss->path = g_strdup(bss->path);
2077
2078                 g_hash_table_remove(interface->network_table, network->group);
2079
2080                 add_or_replace_bss_to_network(new_bss);
2081
2082                 return;
2083         }
2084
2085         if (bss->signal == network->signal)
2086                 return;
2087
2088         /*
2089          * If the new signal is lower than the SSID signal, we need
2090          * to check for the new maximum.
2091          */
2092         if (bss->signal < network->signal) {
2093                 if (bss != network->best_bss)
2094                         return;
2095                 network->signal = bss->signal;
2096                 update_network_signal(network);
2097         } else {
2098                 network->signal = bss->signal;
2099                 network->best_bss = bss;
2100         }
2101
2102         SUPPLICANT_DBG("New network signal for %s %d dBm", network->ssid, network->signal);
2103
2104         callback_network_changed(network, "Signal");
2105 }
2106
2107 static void wps_credentials(const char *key, DBusMessageIter *iter,
2108                         void *user_data)
2109 {
2110         GSupplicantInterface *interface = user_data;
2111
2112         if (key == NULL)
2113                 return;
2114
2115         SUPPLICANT_DBG("key %s", key);
2116
2117         if (g_strcmp0(key, "Key") == 0) {
2118                 DBusMessageIter array;
2119                 unsigned char *key;
2120                 int key_len;
2121
2122                 dbus_message_iter_recurse(iter, &array);
2123                 dbus_message_iter_get_fixed_array(&array, &key, &key_len);
2124
2125                 g_free(interface->wps_cred.key);
2126                 interface->wps_cred.key = g_try_malloc0(
2127                                                 sizeof(char) * key_len+1);
2128
2129                 if (interface->wps_cred.key == NULL)
2130                         return;
2131
2132                 memcpy(interface->wps_cred.key, key, sizeof(char) * key_len);
2133
2134                 SUPPLICANT_DBG("WPS key present");
2135         } else if (g_strcmp0(key, "SSID") == 0) {
2136                 DBusMessageIter array;
2137                 unsigned char *ssid;
2138                 int ssid_len;
2139
2140                 dbus_message_iter_recurse(iter, &array);
2141                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
2142
2143                 if (ssid_len > 0 && ssid_len < 33) {
2144                         memcpy(interface->wps_cred.ssid, ssid, ssid_len);
2145                         interface->wps_cred.ssid_len = ssid_len;
2146                 } else {
2147                         memset(interface->wps_cred.ssid, 0, 32);
2148                         interface->wps_cred.ssid_len = 0;
2149                 }
2150         }
2151 }
2152
2153 static void signal_wps_credentials(const char *path, DBusMessageIter *iter)
2154 {
2155         GSupplicantInterface *interface;
2156
2157         SUPPLICANT_DBG("");
2158
2159         interface = g_hash_table_lookup(interface_table, path);
2160         if (interface == NULL)
2161                 return;
2162
2163         supplicant_dbus_property_foreach(iter, wps_credentials, interface);
2164 }
2165
2166 static void wps_event_args(const char *key, DBusMessageIter *iter,
2167                         void *user_data)
2168 {
2169         GSupplicantInterface *interface = user_data;
2170
2171         if (key == NULL || interface == NULL)
2172                 return;
2173
2174         SUPPLICANT_DBG("Arg Key %s", key);
2175 }
2176
2177 static void signal_wps_event(const char *path, DBusMessageIter *iter)
2178 {
2179         GSupplicantInterface *interface;
2180         const char *name = NULL;
2181
2182         SUPPLICANT_DBG("");
2183
2184         interface = g_hash_table_lookup(interface_table, path);
2185         if (interface == NULL)
2186                 return;
2187
2188         dbus_message_iter_get_basic(iter, &name);
2189
2190         SUPPLICANT_DBG("Name: %s", name);
2191
2192         if (g_strcmp0(name, "success") == 0)
2193                 interface->wps_state = G_SUPPLICANT_WPS_STATE_SUCCESS;
2194         else if (g_strcmp0(name, "failed") == 0)
2195                 interface->wps_state = G_SUPPLICANT_WPS_STATE_FAIL;
2196         else
2197                 interface->wps_state = G_SUPPLICANT_WPS_STATE_UNKNOWN;
2198
2199         if (!dbus_message_iter_has_next(iter))
2200                 return;
2201
2202         dbus_message_iter_next(iter);
2203
2204         supplicant_dbus_property_foreach(iter, wps_event_args, interface);
2205 }
2206
2207 static struct {
2208         const char *interface;
2209         const char *member;
2210         void (*function) (const char *path, DBusMessageIter *iter);
2211 } signal_map[] = {
2212         { DBUS_INTERFACE_DBUS,  "NameOwnerChanged",  signal_name_owner_changed },
2213
2214         { SUPPLICANT_INTERFACE, "PropertiesChanged", signal_properties_changed },
2215         { SUPPLICANT_INTERFACE, "InterfaceAdded",    signal_interface_added    },
2216         { SUPPLICANT_INTERFACE, "InterfaceCreated",  signal_interface_added    },
2217         { SUPPLICANT_INTERFACE, "InterfaceRemoved",  signal_interface_removed  },
2218
2219         { SUPPLICANT_INTERFACE ".Interface", "PropertiesChanged", signal_interface_changed },
2220         { SUPPLICANT_INTERFACE ".Interface", "ScanDone",          signal_scan_done         },
2221         { SUPPLICANT_INTERFACE ".Interface", "BSSAdded",          signal_bss_added         },
2222         { SUPPLICANT_INTERFACE ".Interface", "BSSRemoved",        signal_bss_removed       },
2223         { SUPPLICANT_INTERFACE ".Interface", "NetworkAdded",      signal_network_added     },
2224         { SUPPLICANT_INTERFACE ".Interface", "NetworkRemoved",    signal_network_removed   },
2225
2226         { SUPPLICANT_INTERFACE ".BSS", "PropertiesChanged", signal_bss_changed   },
2227
2228         { SUPPLICANT_INTERFACE ".Interface.WPS", "Credentials", signal_wps_credentials },
2229         { SUPPLICANT_INTERFACE ".Interface.WPS", "Event",       signal_wps_event       },
2230
2231         { }
2232 };
2233
2234 static DBusHandlerResult g_supplicant_filter(DBusConnection *conn,
2235                                         DBusMessage *message, void *data)
2236 {
2237         DBusMessageIter iter;
2238         const char *path;
2239         int i;
2240
2241         path = dbus_message_get_path(message);
2242         if (path == NULL)
2243                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2244
2245         if (dbus_message_iter_init(message, &iter) == FALSE)
2246                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2247
2248         for (i = 0; signal_map[i].interface != NULL; i++) {
2249                 if (dbus_message_has_interface(message,
2250                                         signal_map[i].interface) == FALSE)
2251                         continue;
2252
2253                 if (dbus_message_has_member(message,
2254                                         signal_map[i].member) == FALSE)
2255                         continue;
2256
2257                 signal_map[i].function(path, &iter);
2258                 break;
2259         }
2260
2261         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2262 }
2263
2264 struct supplicant_regdom {
2265         GSupplicantCountryCallback callback;
2266         const void *user_data;
2267 };
2268
2269 static void country_result(const char *error,
2270                                 DBusMessageIter *iter, void *user_data)
2271 {
2272         struct supplicant_regdom *regdom = user_data;
2273         char *alpha2;
2274
2275         SUPPLICANT_DBG("Country setting result");
2276
2277         if (user_data == NULL)
2278                 return;
2279
2280         if (error == NULL) {
2281                 alpha2 = (char *)regdom->user_data;
2282         } else {
2283                 SUPPLICANT_DBG("Country setting failure %s", error);
2284                 alpha2 = NULL;
2285         }
2286
2287         if (regdom->callback)
2288                 regdom->callback(alpha2);
2289
2290         g_free(regdom);
2291 }
2292
2293 static void country_params(DBusMessageIter *iter, void *user_data)
2294 {
2295         struct supplicant_regdom *regdom = user_data;
2296         const char *country;
2297
2298         country = regdom->user_data;
2299
2300         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &country);
2301 }
2302
2303 int g_supplicant_set_country(const char *alpha2,
2304                                 GSupplicantCountryCallback callback,
2305                                         const void *user_data)
2306 {
2307         struct supplicant_regdom *regdom;
2308
2309         SUPPLICANT_DBG("Country setting %s", alpha2);
2310
2311         if (system_available == FALSE)
2312                 return -EFAULT;
2313
2314         regdom = dbus_malloc0(sizeof(*regdom));
2315         if (regdom == NULL)
2316                 return -ENOMEM;
2317
2318         regdom->callback = callback;
2319         regdom->user_data = user_data;
2320
2321         return supplicant_dbus_property_set(SUPPLICANT_PATH, SUPPLICANT_INTERFACE,
2322                                         "Country", DBUS_TYPE_STRING_AS_STRING,
2323                                         country_params, country_result,
2324                                                 regdom);
2325 }
2326
2327 struct interface_data {
2328         GSupplicantInterface *interface;
2329         GSupplicantInterfaceCallback callback;
2330         void *user_data;
2331 };
2332
2333 struct interface_create_data {
2334         const char *ifname;
2335         const char *driver;
2336         const char *bridge;
2337         GSupplicantInterface *interface;
2338         GSupplicantInterfaceCallback callback;
2339         void *user_data;
2340 };
2341
2342 struct interface_connect_data {
2343         GSupplicantInterface *interface;
2344         GSupplicantInterfaceCallback callback;
2345         GSupplicantSSID *ssid;
2346         void *user_data;
2347 };
2348
2349 struct interface_scan_data {
2350         GSupplicantInterface *interface;
2351         GSupplicantInterfaceCallback callback;
2352         GSupplicantScanParams *scan_params;
2353         void *user_data;
2354 };
2355
2356 static void interface_create_property(const char *key, DBusMessageIter *iter,
2357                                                         void *user_data)
2358 {
2359         struct interface_create_data *data = user_data;
2360         GSupplicantInterface *interface = data->interface;
2361
2362         if (key == NULL) {
2363                 if (data->callback != NULL)
2364                         data->callback(0, data->interface, data->user_data);
2365
2366                 dbus_free(data);
2367         }
2368
2369         interface_property(key, iter, interface);
2370 }
2371
2372 static void interface_create_result(const char *error,
2373                                 DBusMessageIter *iter, void *user_data)
2374 {
2375         struct interface_create_data *data = user_data;
2376         const char *path = NULL;
2377         int err;
2378
2379         SUPPLICANT_DBG("");
2380
2381         if (error != NULL) {
2382                 g_critical("error %s", error);
2383                 err = -EIO;
2384                 goto done;
2385         }
2386
2387         dbus_message_iter_get_basic(iter, &path);
2388         if (path == NULL) {
2389                 err = -EINVAL;
2390                 goto done;
2391         }
2392
2393         if (system_available == FALSE) {
2394                 err = -EFAULT;
2395                 goto done;
2396         }
2397
2398         data->interface = g_hash_table_lookup(interface_table, path);
2399         if (data->interface == NULL) {
2400                 data->interface = interface_alloc(path);
2401                 if (data->interface == NULL) {
2402                         err = -ENOMEM;
2403                         goto done;
2404                 }
2405         }
2406
2407         err = supplicant_dbus_property_get_all(path,
2408                                         SUPPLICANT_INTERFACE ".Interface",
2409                                         interface_create_property, data);
2410         if (err == 0)
2411                 return;
2412
2413 done:
2414         if (data->callback != NULL)
2415                 data->callback(err, NULL, data->user_data);
2416
2417         dbus_free(data);
2418 }
2419
2420 static void interface_create_params(DBusMessageIter *iter, void *user_data)
2421 {
2422         struct interface_create_data *data = user_data;
2423         DBusMessageIter dict;
2424
2425         SUPPLICANT_DBG("");
2426
2427         supplicant_dbus_dict_open(iter, &dict);
2428
2429         supplicant_dbus_dict_append_basic(&dict, "Ifname",
2430                                         DBUS_TYPE_STRING, &data->ifname);
2431
2432         if (data->driver != NULL)
2433                 supplicant_dbus_dict_append_basic(&dict, "Driver",
2434                                         DBUS_TYPE_STRING, &data->driver);
2435
2436         if (data->bridge != NULL)
2437                 supplicant_dbus_dict_append_basic(&dict, "BridgeIfname",
2438                                         DBUS_TYPE_STRING, &data->bridge);
2439
2440         supplicant_dbus_dict_close(iter, &dict);
2441 }
2442
2443 static void interface_get_result(const char *error,
2444                                 DBusMessageIter *iter, void *user_data)
2445 {
2446         struct interface_create_data *data = user_data;
2447         GSupplicantInterface *interface;
2448         const char *path = NULL;
2449         int err;
2450
2451         SUPPLICANT_DBG("");
2452
2453         if (error != NULL) {
2454                 SUPPLICANT_DBG("Interface not created yet");
2455                 goto create;
2456         }
2457
2458         dbus_message_iter_get_basic(iter, &path);
2459         if (path == NULL) {
2460                 err = -EINVAL;
2461                 goto done;
2462         }
2463
2464         interface = g_hash_table_lookup(interface_table, path);
2465         if (interface == NULL) {
2466                 err = -ENOENT;
2467                 goto done;
2468         }
2469
2470         if (data->callback != NULL)
2471                 data->callback(0, interface, data->user_data);
2472
2473         dbus_free(data);
2474
2475         return;
2476
2477 create:
2478         if (system_available == FALSE) {
2479                 err = -EFAULT;
2480                 goto done;
2481         }
2482
2483         SUPPLICANT_DBG("Creating interface");
2484
2485         err = supplicant_dbus_method_call(SUPPLICANT_PATH,
2486                                                 SUPPLICANT_INTERFACE,
2487                                                 "CreateInterface",
2488                                                 interface_create_params,
2489                                                 interface_create_result, data);
2490         if (err == 0)
2491                 return;
2492
2493 done:
2494         if (data->callback != NULL)
2495                 data->callback(err, NULL, data->user_data);
2496
2497         dbus_free(data);
2498 }
2499
2500 static void interface_get_params(DBusMessageIter *iter, void *user_data)
2501 {
2502         struct interface_create_data *data = user_data;
2503
2504         SUPPLICANT_DBG("");
2505
2506         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &data->ifname);
2507 }
2508
2509 int g_supplicant_interface_create(const char *ifname, const char *driver,
2510                                         const char *bridge,
2511                                         GSupplicantInterfaceCallback callback,
2512                                                         void *user_data)
2513 {
2514         struct interface_create_data *data;
2515
2516         SUPPLICANT_DBG("ifname %s", ifname);
2517
2518         if (ifname == NULL)
2519                 return -EINVAL;
2520
2521         if (system_available == FALSE)
2522                 return -EFAULT;
2523
2524         data = dbus_malloc0(sizeof(*data));
2525         if (data == NULL)
2526                 return -ENOMEM;
2527
2528         data->ifname = ifname;
2529         data->driver = driver;
2530         data->bridge = bridge;
2531         data->callback = callback;
2532         data->user_data = user_data;
2533
2534         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2535                                                 SUPPLICANT_INTERFACE,
2536                                                 "GetInterface",
2537                                                 interface_get_params,
2538                                                 interface_get_result, data);
2539 }
2540
2541 static void interface_remove_result(const char *error,
2542                                 DBusMessageIter *iter, void *user_data)
2543 {
2544         struct interface_data *data = user_data;
2545         int err;
2546
2547         if (error != NULL) {
2548                 err = -EIO;
2549                 goto done;
2550         }
2551
2552         if (system_available == FALSE) {
2553                 err = -EFAULT;
2554                 goto done;
2555         }
2556
2557         /*
2558          * The gsupplicant interface is already freed by the InterfaceRemoved
2559          * signal callback. Simply invoke the interface_data callback.
2560          */
2561         err = 0;
2562
2563 done:
2564         if (data->callback != NULL)
2565                 data->callback(err, NULL, data->user_data);
2566
2567         dbus_free(data);
2568 }
2569
2570
2571 static void interface_remove_params(DBusMessageIter *iter, void *user_data)
2572 {
2573         struct interface_data *data = user_data;
2574
2575         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2576                                                         &data->interface->path);
2577 }
2578
2579
2580 int g_supplicant_interface_remove(GSupplicantInterface *interface,
2581                         GSupplicantInterfaceCallback callback,
2582                                                         void *user_data)
2583 {
2584         struct interface_data *data;
2585
2586         if (interface == NULL)
2587                 return -EINVAL;
2588
2589         if (system_available == FALSE)
2590                 return -EFAULT;
2591
2592         data = dbus_malloc0(sizeof(*data));
2593         if (data == NULL)
2594                 return -ENOMEM;
2595
2596         data->interface = interface;
2597         data->callback = callback;
2598         data->user_data = user_data;
2599
2600         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2601                                                 SUPPLICANT_INTERFACE,
2602                                                 "RemoveInterface",
2603                                                 interface_remove_params,
2604                                                 interface_remove_result, data);
2605 }
2606
2607 static void interface_scan_result(const char *error,
2608                                 DBusMessageIter *iter, void *user_data)
2609 {
2610         struct interface_scan_data *data = user_data;
2611
2612         if (error != NULL) {
2613                 SUPPLICANT_DBG("error %s", error);
2614
2615                 if (data->callback != NULL)
2616                         data->callback(-EIO, data->interface, data->user_data);
2617         } else {
2618                 data->interface->scan_callback = data->callback;
2619                 data->interface->scan_data = data->user_data;
2620         }
2621
2622         if (data != NULL && data->scan_params != NULL)
2623                 g_supplicant_free_scan_params(data->scan_params);
2624
2625         dbus_free(data);
2626 }
2627
2628 static void add_scan_frequency(DBusMessageIter *iter, unsigned int freq)
2629 {
2630         DBusMessageIter data;
2631         unsigned int width = 0; /* Not used by wpa_supplicant atm */
2632
2633         dbus_message_iter_open_container(iter, DBUS_TYPE_STRUCT, NULL, &data);
2634
2635         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &freq);
2636         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &width);
2637
2638         dbus_message_iter_close_container(iter, &data);
2639 }
2640
2641 static void add_scan_frequencies(DBusMessageIter *iter,
2642                                                 void *user_data)
2643 {
2644         GSupplicantScanParams *scan_data = user_data;
2645         unsigned int freq;
2646         int i;
2647
2648         for (i = 0; i < scan_data->num_ssids; i++) {
2649                 freq = scan_data->freqs[i];
2650                 if (!freq)
2651                         break;
2652
2653                 add_scan_frequency(iter, freq);
2654         }
2655 }
2656
2657 static void append_ssid(DBusMessageIter *iter,
2658                         const void *ssid, unsigned int len)
2659 {
2660         DBusMessageIter array;
2661
2662         dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
2663         DBUS_TYPE_BYTE_AS_STRING, &array);
2664
2665         dbus_message_iter_append_fixed_array(&array, DBUS_TYPE_BYTE,
2666                                                                 &ssid, len);
2667         dbus_message_iter_close_container(iter, &array);
2668 }
2669
2670 static void append_ssids(DBusMessageIter *iter, void *user_data)
2671 {
2672         GSupplicantScanParams *scan_data = user_data;
2673         GSList *list;
2674
2675         for (list = scan_data->ssids; list; list = list->next) {
2676                 struct scan_ssid *scan_ssid = list->data;
2677
2678                 append_ssid(iter, scan_ssid->ssid, scan_ssid->ssid_len);
2679         }
2680 }
2681
2682 static void supplicant_add_scan_frequency(DBusMessageIter *dict,
2683                 supplicant_dbus_array_function function,
2684                                         void *user_data)
2685 {
2686         GSupplicantScanParams *scan_params = user_data;
2687         DBusMessageIter entry, value, array;
2688         const char *key = "Channels";
2689
2690         if (scan_params->freqs && scan_params->freqs[0] != 0) {
2691                 dbus_message_iter_open_container(dict, DBUS_TYPE_DICT_ENTRY,
2692                                                 NULL, &entry);
2693
2694                 dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &key);
2695
2696                 dbus_message_iter_open_container(&entry, DBUS_TYPE_VARIANT,
2697                                         DBUS_TYPE_ARRAY_AS_STRING
2698                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2699                                         DBUS_TYPE_UINT32_AS_STRING
2700                                         DBUS_TYPE_UINT32_AS_STRING
2701                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2702                                         &value);
2703
2704                 dbus_message_iter_open_container(&value, DBUS_TYPE_ARRAY,
2705                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2706                                         DBUS_TYPE_UINT32_AS_STRING
2707                                         DBUS_TYPE_UINT32_AS_STRING
2708                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2709                                         &array);
2710
2711                 if (function)
2712                         function(&array, user_data);
2713
2714                 dbus_message_iter_close_container(&value, &array);
2715                 dbus_message_iter_close_container(&entry, &value);
2716                 dbus_message_iter_close_container(dict, &entry);
2717         }
2718 }
2719
2720 static void interface_scan_params(DBusMessageIter *iter, void *user_data)
2721 {
2722         DBusMessageIter dict;
2723         const char *type = "passive";
2724         struct interface_scan_data *data = user_data;
2725
2726         supplicant_dbus_dict_open(iter, &dict);
2727
2728         if (data && data->scan_params) {
2729                 type = "active";
2730
2731                 supplicant_dbus_dict_append_basic(&dict, "Type",
2732                                         DBUS_TYPE_STRING, &type);
2733
2734                 supplicant_dbus_dict_append_array(&dict, "SSIDs",
2735                                                 DBUS_TYPE_STRING,
2736                                                 append_ssids,
2737                                                 data->scan_params);
2738
2739                 supplicant_add_scan_frequency(&dict, add_scan_frequencies,
2740                                                 data->scan_params);
2741         } else
2742                 supplicant_dbus_dict_append_basic(&dict, "Type",
2743                                         DBUS_TYPE_STRING, &type);
2744
2745         supplicant_dbus_dict_close(iter, &dict);
2746 }
2747
2748 int g_supplicant_interface_scan(GSupplicantInterface *interface,
2749                                 GSupplicantScanParams *scan_data,
2750                                 GSupplicantInterfaceCallback callback,
2751                                                         void *user_data)
2752 {
2753         struct interface_scan_data *data;
2754         int ret;
2755
2756         if (interface == NULL)
2757                 return -EINVAL;
2758
2759         if (system_available == FALSE)
2760                 return -EFAULT;
2761
2762         if (interface->scanning == TRUE)
2763                 return -EALREADY;
2764
2765         switch (interface->state) {
2766         case G_SUPPLICANT_STATE_AUTHENTICATING:
2767         case G_SUPPLICANT_STATE_ASSOCIATING:
2768         case G_SUPPLICANT_STATE_ASSOCIATED:
2769         case G_SUPPLICANT_STATE_4WAY_HANDSHAKE:
2770         case G_SUPPLICANT_STATE_GROUP_HANDSHAKE:
2771                 return -EBUSY;
2772         case G_SUPPLICANT_STATE_UNKNOWN:
2773         case G_SUPPLICANT_STATE_DISCONNECTED:
2774         case G_SUPPLICANT_STATE_INACTIVE:
2775         case G_SUPPLICANT_STATE_SCANNING:
2776         case G_SUPPLICANT_STATE_COMPLETED:
2777                 break;
2778         }
2779
2780         data = dbus_malloc0(sizeof(*data));
2781         if (data == NULL)
2782                 return -ENOMEM;
2783
2784         data->interface = interface;
2785         data->callback = callback;
2786         data->user_data = user_data;
2787         data->scan_params = scan_data;
2788
2789         ret = supplicant_dbus_method_call(interface->path,
2790                         SUPPLICANT_INTERFACE ".Interface", "Scan",
2791                         interface_scan_params, interface_scan_result, data);
2792
2793         if (ret < 0)
2794                 dbus_free(data);
2795
2796         return ret;
2797 }
2798
2799 static int parse_supplicant_error(DBusMessageIter *iter)
2800 {
2801         int err = -ECANCELED;
2802         char *key;
2803
2804         /* If the given passphrase is malformed wpa_s returns
2805          * "invalid message format" but this error should be interpreted as
2806          * invalid-key.
2807          */
2808         while (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
2809                 dbus_message_iter_get_basic(iter, &key);
2810                 if (strncmp(key, "psk", 3) == 0 ||
2811                                 strncmp(key, "wep_key", 7) == 0 ||
2812                                 strcmp(key, "invalid message format") == 0) {
2813                         err = -ENOKEY;
2814                         break;
2815                 }
2816                 dbus_message_iter_next(iter);
2817         }
2818
2819         return err;
2820 }
2821
2822 static void interface_select_network_result(const char *error,
2823                                 DBusMessageIter *iter, void *user_data)
2824 {
2825         struct interface_connect_data *data = user_data;
2826         int err;
2827
2828         SUPPLICANT_DBG("");
2829
2830         err = 0;
2831         if (error != NULL) {
2832                 SUPPLICANT_DBG("SelectNetwork error %s", error);
2833                 err = parse_supplicant_error(iter);
2834         }
2835
2836         if (data->callback != NULL)
2837                 data->callback(err, data->interface, data->user_data);
2838
2839         g_free(data->ssid);
2840         dbus_free(data);
2841 }
2842
2843 static void interface_select_network_params(DBusMessageIter *iter,
2844                                                         void *user_data)
2845 {
2846         struct interface_connect_data *data = user_data;
2847         GSupplicantInterface *interface = data->interface;
2848
2849         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2850                                         &interface->network_path);
2851 }
2852
2853 static void interface_add_network_result(const char *error,
2854                                 DBusMessageIter *iter, void *user_data)
2855 {
2856         struct interface_connect_data *data = user_data;
2857         GSupplicantInterface *interface = data->interface;
2858         const char *path;
2859         int err;
2860
2861         if (error != NULL)
2862                 goto error;
2863
2864         dbus_message_iter_get_basic(iter, &path);
2865         if (path == NULL)
2866                 goto error;
2867
2868         SUPPLICANT_DBG("PATH: %s", path);
2869
2870         g_free(interface->network_path);
2871         interface->network_path = g_strdup(path);
2872
2873         supplicant_dbus_method_call(data->interface->path,
2874                         SUPPLICANT_INTERFACE ".Interface", "SelectNetwork",
2875                         interface_select_network_params,
2876                         interface_select_network_result, data);
2877
2878         return;
2879
2880 error:
2881         SUPPLICANT_DBG("AddNetwork error %s", error);
2882         err = parse_supplicant_error(iter);
2883         if (data->callback != NULL)
2884                 data->callback(err, data->interface, data->user_data);
2885
2886         g_free(interface->network_path);
2887         interface->network_path = NULL;
2888         g_free(data->ssid);
2889         g_free(data);
2890 }
2891
2892 static void add_network_security_wep(DBusMessageIter *dict,
2893                                         GSupplicantSSID *ssid)
2894 {
2895         const char *auth_alg = "OPEN SHARED";
2896         const char *key_index = "0";
2897
2898         supplicant_dbus_dict_append_basic(dict, "auth_alg",
2899                                         DBUS_TYPE_STRING, &auth_alg);
2900
2901         if (ssid->passphrase) {
2902                 int size = strlen(ssid->passphrase);
2903                 if (size == 10 || size == 26) {
2904                         unsigned char *key = g_try_malloc(13);
2905                         char tmp[3];
2906                         int i;
2907
2908                         memset(tmp, 0, sizeof(tmp));
2909                         if (key == NULL)
2910                                 size = 0;
2911
2912                         for (i = 0; i < size / 2; i++) {
2913                                 memcpy(tmp, ssid->passphrase + (i * 2), 2);
2914                                 key[i] = (unsigned char) strtol(tmp, NULL, 16);
2915                         }
2916
2917                         supplicant_dbus_dict_append_fixed_array(dict,
2918                                                         "wep_key0",
2919                                                         DBUS_TYPE_BYTE,
2920                                                         &key, size / 2);
2921                         g_free(key);
2922                 } else if (size == 5 || size == 13) {
2923                         unsigned char *key = g_try_malloc(13);
2924                         int i;
2925
2926                         if (key == NULL)
2927                                 size = 0;
2928
2929                         for (i = 0; i < size; i++)
2930                                 key[i] = (unsigned char) ssid->passphrase[i];
2931
2932                         supplicant_dbus_dict_append_fixed_array(dict,
2933                                                                 "wep_key0",
2934                                                                 DBUS_TYPE_BYTE,
2935                                                                 &key, size);
2936                         g_free(key);
2937                 } else
2938                         supplicant_dbus_dict_append_basic(dict,
2939                                                         "wep_key0",
2940                                                         DBUS_TYPE_STRING,
2941                                                         &ssid->passphrase);
2942
2943                 supplicant_dbus_dict_append_basic(dict, "wep_tx_keyidx",
2944                                         DBUS_TYPE_STRING, &key_index);
2945         }
2946 }
2947
2948 static dbus_bool_t is_psk_raw_key(const char *psk)
2949 {
2950         int i;
2951
2952         /* A raw key is always 64 bytes length... */
2953         if (strlen(psk) != 64)
2954                 return FALSE;
2955
2956         /* ... and its content is in hex representation */
2957         for (i = 0; i < 64; i++)
2958                 if (!isxdigit((unsigned char) psk[i]))
2959                         return FALSE;
2960
2961         return TRUE;
2962 }
2963
2964 static void add_network_security_psk(DBusMessageIter *dict,
2965                                         GSupplicantSSID *ssid)
2966 {
2967         if (ssid->passphrase && strlen(ssid->passphrase) > 0) {
2968                 if (is_psk_raw_key(ssid->passphrase) == TRUE)
2969                         supplicant_dbus_dict_append_fixed_array(dict,
2970                                                         "psk", DBUS_TYPE_BYTE,
2971                                                         &ssid->passphrase, 64);
2972                 else
2973                         supplicant_dbus_dict_append_basic(dict, "psk",
2974                                                         DBUS_TYPE_STRING,
2975                                                         &ssid->passphrase);
2976         }
2977 }
2978
2979 static void add_network_security_tls(DBusMessageIter *dict,
2980                                         GSupplicantSSID *ssid)
2981 {
2982         /*
2983          * For TLS, we at least need:
2984          *              The client certificate
2985          *              The client private key file
2986          *              The client private key file password
2987          *
2988          * The Authority certificate is optional.
2989          */
2990         if (ssid->client_cert_path == NULL)
2991                 return;
2992
2993         if (ssid->private_key_path == NULL)
2994                 return;
2995
2996         if (ssid->private_key_passphrase == NULL)
2997                 return;
2998
2999         if (ssid->ca_cert_path)
3000                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
3001                                         DBUS_TYPE_STRING, &ssid->ca_cert_path);
3002
3003         supplicant_dbus_dict_append_basic(dict, "private_key",
3004                                                 DBUS_TYPE_STRING,
3005                                                 &ssid->private_key_path);
3006         supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
3007                                                 DBUS_TYPE_STRING,
3008                                                 &ssid->private_key_passphrase);
3009         supplicant_dbus_dict_append_basic(dict, "client_cert",
3010                                                 DBUS_TYPE_STRING,
3011                                                 &ssid->client_cert_path);
3012 }
3013
3014 static void add_network_security_peap(DBusMessageIter *dict,
3015                                         GSupplicantSSID *ssid)
3016 {
3017         char *phase2_auth;
3018
3019         /*
3020          * For PEAP/TTLS, we at least need
3021          *              The authority certificate
3022          *              The 2nd phase authentication method
3023          *              The 2nd phase passphrase
3024          *
3025          * The Client certificate is optional although strongly recommended
3026          * When setting it, we need in addition
3027          *              The Client private key file
3028          *              The Client private key file password
3029          */
3030         if (ssid->passphrase == NULL)
3031                 return;
3032
3033         if (ssid->phase2_auth == NULL)
3034                 return;
3035
3036         if (ssid->client_cert_path) {
3037                 if (ssid->private_key_path == NULL)
3038                         return;
3039
3040                 if (ssid->private_key_passphrase == NULL)
3041                         return;
3042
3043                 supplicant_dbus_dict_append_basic(dict, "client_cert",
3044                                                 DBUS_TYPE_STRING,
3045                                                 &ssid->client_cert_path);
3046
3047                 supplicant_dbus_dict_append_basic(dict, "private_key",
3048                                                 DBUS_TYPE_STRING,
3049                                                 &ssid->private_key_path);
3050
3051                 supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
3052                                                 DBUS_TYPE_STRING,
3053                                                 &ssid->private_key_passphrase);
3054
3055         }
3056
3057         if (g_str_has_prefix(ssid->phase2_auth, "EAP-") == TRUE) {
3058                 phase2_auth = g_strdup_printf("autheap=%s",
3059                                         ssid->phase2_auth + strlen("EAP-"));
3060         } else
3061                 phase2_auth = g_strdup_printf("auth=%s", ssid->phase2_auth);
3062
3063         supplicant_dbus_dict_append_basic(dict, "password",
3064                                                 DBUS_TYPE_STRING,
3065                                                 &ssid->passphrase);
3066
3067         if (ssid->ca_cert_path)
3068                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
3069                                                 DBUS_TYPE_STRING,
3070                                                 &ssid->ca_cert_path);
3071
3072         supplicant_dbus_dict_append_basic(dict, "phase2",
3073                                                 DBUS_TYPE_STRING,
3074                                                 &phase2_auth);
3075
3076         g_free(phase2_auth);
3077 }
3078
3079 static void add_network_security_eap(DBusMessageIter *dict,
3080                                         GSupplicantSSID *ssid)
3081 {
3082         char *eap_value;
3083
3084         if (ssid->eap == NULL || ssid->identity == NULL)
3085                 return;
3086
3087         if (g_strcmp0(ssid->eap, "tls") == 0) {
3088                 add_network_security_tls(dict, ssid);
3089         } else if (g_strcmp0(ssid->eap, "peap") == 0 ||
3090                                 g_strcmp0(ssid->eap, "ttls") == 0) {
3091                 add_network_security_peap(dict, ssid);
3092         } else
3093                 return;
3094
3095         eap_value = g_ascii_strup(ssid->eap, -1);
3096
3097         supplicant_dbus_dict_append_basic(dict, "eap",
3098                                                 DBUS_TYPE_STRING,
3099                                                 &eap_value);
3100         supplicant_dbus_dict_append_basic(dict, "identity",
3101                                                 DBUS_TYPE_STRING,
3102                                                 &ssid->identity);
3103
3104         g_free(eap_value);
3105 }
3106
3107 static void add_network_security_ciphers(DBusMessageIter *dict,
3108                                                 GSupplicantSSID *ssid)
3109 {
3110         unsigned int p_cipher, g_cipher, i;
3111         char *pairwise, *group;
3112         char *pair_ciphers[4];
3113         char *group_ciphers[5];
3114
3115         p_cipher = ssid->pairwise_cipher;
3116         g_cipher = ssid->group_cipher;
3117
3118         if (p_cipher == 0 && g_cipher == 0)
3119                 return;
3120
3121         i = 0;
3122
3123         if (p_cipher & G_SUPPLICANT_PAIRWISE_CCMP)
3124                 pair_ciphers[i++] = "CCMP";
3125
3126         if (p_cipher & G_SUPPLICANT_PAIRWISE_TKIP)
3127                 pair_ciphers[i++] = "TKIP";
3128
3129         if (p_cipher & G_SUPPLICANT_PAIRWISE_NONE)
3130                 pair_ciphers[i++] = "NONE";
3131
3132         pair_ciphers[i] = NULL;
3133
3134         i = 0;
3135
3136         if (g_cipher & G_SUPPLICANT_GROUP_CCMP)
3137                 group_ciphers[i++] = "CCMP";
3138
3139         if (g_cipher & G_SUPPLICANT_GROUP_TKIP)
3140                 group_ciphers[i++] = "TKIP";
3141
3142         if (g_cipher & G_SUPPLICANT_GROUP_WEP104)
3143                 group_ciphers[i++] = "WEP104";
3144
3145         if (g_cipher & G_SUPPLICANT_GROUP_WEP40)
3146                 group_ciphers[i++] = "WEP40";
3147
3148         group_ciphers[i] = NULL;
3149
3150         pairwise = g_strjoinv(" ", pair_ciphers);
3151         group = g_strjoinv(" ", group_ciphers);
3152
3153         SUPPLICANT_DBG("cipher %s %s", pairwise, group);
3154
3155         supplicant_dbus_dict_append_basic(dict, "pairwise",
3156                                                 DBUS_TYPE_STRING,
3157                                                 &pairwise);
3158         supplicant_dbus_dict_append_basic(dict, "group",
3159                                                 DBUS_TYPE_STRING,
3160                                                 &group);
3161
3162         g_free(pairwise);
3163         g_free(group);
3164 }
3165
3166 static void add_network_security_proto(DBusMessageIter *dict,
3167                                                 GSupplicantSSID *ssid)
3168 {
3169         unsigned int protocol, i;
3170         char *proto;
3171         char *protos[3];
3172
3173         protocol = ssid->protocol;
3174
3175         if (protocol == 0)
3176                 return;
3177
3178         i = 0;
3179
3180         if (protocol & G_SUPPLICANT_PROTO_RSN)
3181                 protos[i++] = "RSN";
3182
3183         if (protocol & G_SUPPLICANT_PROTO_WPA)
3184                 protos[i++] = "WPA";
3185
3186         protos[i] = NULL;
3187
3188         proto = g_strjoinv(" ", protos);
3189
3190         SUPPLICANT_DBG("proto %s", proto);
3191
3192         supplicant_dbus_dict_append_basic(dict, "proto",
3193                                                 DBUS_TYPE_STRING,
3194                                                 &proto);
3195
3196         g_free(proto);
3197 }
3198
3199 static void add_network_security(DBusMessageIter *dict, GSupplicantSSID *ssid)
3200 {
3201         char *key_mgmt;
3202
3203         switch (ssid->security) {
3204         case G_SUPPLICANT_SECURITY_UNKNOWN:
3205         case G_SUPPLICANT_SECURITY_NONE:
3206         case G_SUPPLICANT_SECURITY_WEP:
3207                 key_mgmt = "NONE";
3208                 add_network_security_wep(dict, ssid);
3209                 add_network_security_ciphers(dict, ssid);
3210                 break;
3211         case G_SUPPLICANT_SECURITY_PSK:
3212                 key_mgmt = "WPA-PSK";
3213                 add_network_security_psk(dict, ssid);
3214                 add_network_security_ciphers(dict, ssid);
3215                 add_network_security_proto(dict, ssid);
3216                 break;
3217         case G_SUPPLICANT_SECURITY_IEEE8021X:
3218                 key_mgmt = "WPA-EAP";
3219                 add_network_security_eap(dict, ssid);
3220                 add_network_security_ciphers(dict, ssid);
3221                 add_network_security_proto(dict, ssid);
3222                 break;
3223         }
3224
3225         supplicant_dbus_dict_append_basic(dict, "key_mgmt",
3226                                 DBUS_TYPE_STRING, &key_mgmt);
3227 }
3228
3229 static void add_network_mode(DBusMessageIter *dict, GSupplicantSSID *ssid)
3230 {
3231         dbus_uint32_t mode;
3232
3233         switch (ssid->mode) {
3234         case G_SUPPLICANT_MODE_UNKNOWN:
3235         case G_SUPPLICANT_MODE_INFRA:
3236                 mode = 0;
3237                 break;
3238         case G_SUPPLICANT_MODE_IBSS:
3239                 mode = 1;
3240                 break;
3241         case G_SUPPLICANT_MODE_MASTER:
3242                 mode = 2;
3243                 break;
3244         }
3245
3246         supplicant_dbus_dict_append_basic(dict, "mode",
3247                                 DBUS_TYPE_UINT32, &mode);
3248 }
3249
3250 static void interface_add_network_params(DBusMessageIter *iter, void *user_data)
3251 {
3252         DBusMessageIter dict;
3253         struct interface_connect_data *data = user_data;
3254         GSupplicantSSID *ssid = data->ssid;
3255
3256         supplicant_dbus_dict_open(iter, &dict);
3257
3258         if (ssid->scan_ssid)
3259                 supplicant_dbus_dict_append_basic(&dict, "scan_ssid",
3260                                          DBUS_TYPE_UINT32, &ssid->scan_ssid);
3261
3262         if (ssid->freq)
3263                 supplicant_dbus_dict_append_basic(&dict, "frequency",
3264                                          DBUS_TYPE_UINT32, &ssid->freq);
3265
3266         if (ssid->bgscan != NULL)
3267                 supplicant_dbus_dict_append_basic(&dict, "bgscan",
3268                                         DBUS_TYPE_STRING, &ssid->bgscan);
3269
3270         add_network_mode(&dict, ssid);
3271
3272         add_network_security(&dict, ssid);
3273
3274         supplicant_dbus_dict_append_fixed_array(&dict, "ssid",
3275                                         DBUS_TYPE_BYTE, &ssid->ssid,
3276                                                 ssid->ssid_len);
3277
3278         supplicant_dbus_dict_close(iter, &dict);
3279 }
3280
3281 static void interface_wps_start_result(const char *error,
3282                                 DBusMessageIter *iter, void *user_data)
3283 {
3284         struct interface_connect_data *data = user_data;
3285
3286         SUPPLICANT_DBG("");
3287         if (error != NULL)
3288                 SUPPLICANT_DBG("error: %s", error);
3289
3290         g_free(data->ssid);
3291         dbus_free(data);
3292 }
3293
3294 static void interface_add_wps_params(DBusMessageIter *iter, void *user_data)
3295 {
3296         struct interface_connect_data *data = user_data;
3297         GSupplicantSSID *ssid = data->ssid;
3298         const char *role = "enrollee", *type;
3299         DBusMessageIter dict;
3300
3301         SUPPLICANT_DBG("");
3302
3303         supplicant_dbus_dict_open(iter, &dict);
3304
3305         supplicant_dbus_dict_append_basic(&dict, "Role",
3306                                                 DBUS_TYPE_STRING, &role);
3307
3308         type = "pbc";
3309         if (ssid->pin_wps != NULL) {
3310                 type = "pin";
3311                 supplicant_dbus_dict_append_basic(&dict, "Pin",
3312                                         DBUS_TYPE_STRING, &ssid->pin_wps);
3313         }
3314
3315         supplicant_dbus_dict_append_basic(&dict, "Type",
3316                                         DBUS_TYPE_STRING, &type);
3317
3318         supplicant_dbus_dict_close(iter, &dict);
3319 }
3320
3321 static void wps_start(const char *error, DBusMessageIter *iter, void *user_data)
3322 {
3323         struct interface_connect_data *data = user_data;
3324
3325         SUPPLICANT_DBG("");
3326
3327         if (error != NULL) {
3328                 SUPPLICANT_DBG("error: %s", error);
3329                 g_free(data->ssid);
3330                 dbus_free(data);
3331                 return;
3332         }
3333
3334         supplicant_dbus_method_call(data->interface->path,
3335                         SUPPLICANT_INTERFACE ".Interface.WPS", "Start",
3336                         interface_add_wps_params,
3337                         interface_wps_start_result, data);
3338 }
3339
3340 static void wps_process_credentials(DBusMessageIter *iter, void *user_data)
3341 {
3342         dbus_bool_t credentials = TRUE;
3343
3344         SUPPLICANT_DBG("");
3345
3346         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &credentials);
3347 }
3348
3349
3350 int g_supplicant_interface_connect(GSupplicantInterface *interface,
3351                                 GSupplicantSSID *ssid,
3352                                 GSupplicantInterfaceCallback callback,
3353                                                         void *user_data)
3354 {
3355         struct interface_connect_data *data;
3356         int ret;
3357
3358         if (interface == NULL)
3359                 return -EINVAL;
3360
3361         if (system_available == FALSE)
3362                 return -EFAULT;
3363
3364         /* TODO: Check if we're already connected and switch */
3365
3366         data = dbus_malloc0(sizeof(*data));
3367         if (data == NULL)
3368                 return -ENOMEM;
3369
3370         data->interface = interface;
3371         data->callback = callback;
3372         data->ssid = ssid;
3373         data->user_data = user_data;
3374
3375         if (ssid->use_wps == TRUE) {
3376                 g_free(interface->wps_cred.key);
3377                 memset(&interface->wps_cred, 0,
3378                                 sizeof(struct _GSupplicantWpsCredentials));
3379
3380                 ret = supplicant_dbus_property_set(interface->path,
3381                         SUPPLICANT_INTERFACE ".Interface.WPS",
3382                         "ProcessCredentials", DBUS_TYPE_BOOLEAN_AS_STRING,
3383                         wps_process_credentials, wps_start, data);
3384         } else
3385                 ret = supplicant_dbus_method_call(interface->path,
3386                         SUPPLICANT_INTERFACE ".Interface", "AddNetwork",
3387                         interface_add_network_params,
3388                         interface_add_network_result, data);
3389
3390         if (ret < 0)
3391                 return ret;
3392
3393         return -EINPROGRESS;
3394 }
3395
3396 static void network_remove_result(const char *error,
3397                                 DBusMessageIter *iter, void *user_data)
3398 {
3399         struct interface_data *data = user_data;
3400         int result = 0;
3401
3402         SUPPLICANT_DBG("");
3403
3404         if (error != NULL)
3405                 result = -EIO;
3406
3407         if (data->callback != NULL)
3408                 data->callback(result, data->interface, data->user_data);
3409
3410         dbus_free(data);
3411 }
3412
3413 static void network_remove_params(DBusMessageIter *iter, void *user_data)
3414 {
3415         struct interface_data *data = user_data;
3416         const char *path = data->interface->network_path;
3417
3418         SUPPLICANT_DBG("path %s", path);
3419
3420         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path);
3421 }
3422
3423 static int network_remove(struct interface_data *data)
3424 {
3425         GSupplicantInterface *interface = data->interface;
3426
3427         SUPPLICANT_DBG("");
3428
3429         return supplicant_dbus_method_call(interface->path,
3430                         SUPPLICANT_INTERFACE ".Interface", "RemoveNetwork",
3431                         network_remove_params, network_remove_result, data);
3432 }
3433
3434 static void interface_disconnect_result(const char *error,
3435                                 DBusMessageIter *iter, void *user_data)
3436 {
3437         struct interface_data *data = user_data;
3438
3439         SUPPLICANT_DBG("");
3440
3441         if (error != NULL && data->callback != NULL)
3442                 data->callback(-EIO, data->interface, data->user_data);
3443
3444         /* If we are disconnecting from previous WPS successful
3445          * association. i.e.: it did not went through AddNetwork,
3446          * and interface->network_path was never set. */
3447         if (data->interface->network_path == NULL) {
3448                 dbus_free(data);
3449                 return;
3450         }
3451
3452         network_remove(data);
3453 }
3454
3455 int g_supplicant_interface_disconnect(GSupplicantInterface *interface,
3456                                         GSupplicantInterfaceCallback callback,
3457                                                         void *user_data)
3458 {
3459         struct interface_data *data;
3460
3461         SUPPLICANT_DBG("");
3462
3463         if (interface == NULL)
3464                 return -EINVAL;
3465
3466         if (system_available == FALSE)
3467                 return -EFAULT;
3468
3469         data = dbus_malloc0(sizeof(*data));
3470         if (data == NULL)
3471                 return -ENOMEM;
3472
3473         data->interface = interface;
3474         data->callback = callback;
3475         data->user_data = user_data;
3476
3477         return supplicant_dbus_method_call(interface->path,
3478                         SUPPLICANT_INTERFACE ".Interface", "Disconnect",
3479                                 NULL, interface_disconnect_result, data);
3480 }
3481
3482
3483 static const char *g_supplicant_rule0 = "type=signal,"
3484                                         "path=" DBUS_PATH_DBUS ","
3485                                         "sender=" DBUS_SERVICE_DBUS ","
3486                                         "interface=" DBUS_INTERFACE_DBUS ","
3487                                         "member=NameOwnerChanged,"
3488                                         "arg0=" SUPPLICANT_SERVICE;
3489 static const char *g_supplicant_rule1 = "type=signal,"
3490                         "interface=" SUPPLICANT_INTERFACE;
3491 static const char *g_supplicant_rule2 = "type=signal,"
3492                         "interface=" SUPPLICANT_INTERFACE ".Interface";
3493 static const char *g_supplicant_rule3 = "type=signal,"
3494                         "interface=" SUPPLICANT_INTERFACE ".Interface.WPS";
3495 static const char *g_supplicant_rule4 = "type=signal,"
3496                         "interface=" SUPPLICANT_INTERFACE ".BSS";
3497 static const char *g_supplicant_rule5 = "type=signal,"
3498                         "interface=" SUPPLICANT_INTERFACE ".Network";
3499
3500 static void invoke_introspect_method(void)
3501 {
3502         DBusMessage *message;
3503
3504         message = dbus_message_new_method_call(SUPPLICANT_SERVICE,
3505                                         SUPPLICANT_PATH,
3506                                         DBUS_INTERFACE_INTROSPECTABLE,
3507                                         "Introspect");
3508
3509         if (message == NULL)
3510                 return;
3511
3512         dbus_message_set_no_reply(message, TRUE);
3513         dbus_connection_send(connection, message, NULL);
3514         dbus_message_unref(message);
3515 }
3516
3517 int g_supplicant_register(const GSupplicantCallbacks *callbacks)
3518 {
3519         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
3520         if (connection == NULL)
3521                 return -EIO;
3522
3523         if (dbus_connection_add_filter(connection,
3524                                 g_supplicant_filter, NULL, NULL) == FALSE) {
3525                 dbus_connection_unref(connection);
3526                 connection = NULL;
3527                 return -EIO;
3528         }
3529
3530         callbacks_pointer = callbacks;
3531         eap_methods = 0;
3532
3533         interface_table = g_hash_table_new_full(g_str_hash, g_str_equal,
3534                                                 NULL, remove_interface);
3535
3536         bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
3537                                                                 NULL, NULL);
3538
3539         supplicant_dbus_setup(connection);
3540
3541         dbus_bus_add_match(connection, g_supplicant_rule0, NULL);
3542         dbus_bus_add_match(connection, g_supplicant_rule1, NULL);
3543         dbus_bus_add_match(connection, g_supplicant_rule2, NULL);
3544         dbus_bus_add_match(connection, g_supplicant_rule3, NULL);
3545         dbus_bus_add_match(connection, g_supplicant_rule4, NULL);
3546         dbus_bus_add_match(connection, g_supplicant_rule5, NULL);
3547         dbus_connection_flush(connection);
3548
3549         if (dbus_bus_name_has_owner(connection,
3550                                         SUPPLICANT_SERVICE, NULL) == TRUE) {
3551                 system_available = TRUE;
3552                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
3553                                                 SUPPLICANT_INTERFACE,
3554                                                 service_property, NULL);
3555         } else
3556                 invoke_introspect_method();
3557
3558         return 0;
3559 }
3560
3561 static void unregister_interface_remove_params(DBusMessageIter *iter,
3562                                                 void *user_data)
3563 {
3564         const char *path = user_data;
3565
3566         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
3567                                                         &path);
3568 }
3569
3570
3571 static void unregister_remove_interface(gpointer key, gpointer value,
3572                                                 gpointer user_data)
3573 {
3574         GSupplicantInterface *interface = value;
3575
3576         supplicant_dbus_method_call(SUPPLICANT_PATH,
3577                                         SUPPLICANT_INTERFACE,
3578                                         "RemoveInterface",
3579                                         unregister_interface_remove_params,
3580                                                 NULL, interface->path);
3581 }
3582
3583 void g_supplicant_unregister(const GSupplicantCallbacks *callbacks)
3584 {
3585         SUPPLICANT_DBG("");
3586
3587         if (connection != NULL) {
3588                 dbus_bus_remove_match(connection, g_supplicant_rule5, NULL);
3589                 dbus_bus_remove_match(connection, g_supplicant_rule4, NULL);
3590                 dbus_bus_remove_match(connection, g_supplicant_rule3, NULL);
3591                 dbus_bus_remove_match(connection, g_supplicant_rule2, NULL);
3592                 dbus_bus_remove_match(connection, g_supplicant_rule1, NULL);
3593                 dbus_bus_remove_match(connection, g_supplicant_rule0, NULL);
3594                 dbus_connection_flush(connection);
3595
3596                 dbus_connection_remove_filter(connection,
3597                                                 g_supplicant_filter, NULL);
3598         }
3599
3600         if (bss_mapping != NULL) {
3601                 g_hash_table_destroy(bss_mapping);
3602                 bss_mapping = NULL;
3603         }
3604
3605         if (system_available == TRUE)
3606                 callback_system_killed();
3607
3608         if (interface_table != NULL) {
3609                 g_hash_table_foreach(interface_table,
3610                                         unregister_remove_interface, NULL);
3611                 g_hash_table_destroy(interface_table);
3612                 interface_table = NULL;
3613         }
3614
3615         if (connection != NULL) {
3616                 dbus_connection_unref(connection);
3617                 connection = NULL;
3618         }
3619
3620         callbacks_pointer = NULL;
3621         eap_methods = 0;
3622 }