tools/supplicant.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-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 <string.h>
  28 #include <stdint.h>
  29 #include <syslog.h>
  30
  31 #include <glib.h>
  32 #include <gdbus.h>
  33
  34 #include "supplicant-dbus.h"
  35 #include "supplicant.h"
  36
  37 #define DBG(fmt, arg...) do { \
  38         syslog(LOG_DEBUG, "%s() " fmt, __FUNCTION__ , ## arg); \
  39 } while (0)
  40
  41 #define TIMEOUT 5000
  42
  43 #define IEEE80211_CAP_ESS       0x0001
  44 #define IEEE80211_CAP_IBSS      0x0002
  45 #define IEEE80211_CAP_PRIVACY   0x0010
  46
  47 static DBusConnection *connection;
  48
  49 static const struct supplicant_callbacks *callbacks_pointer;
  50
  51 static dbus_bool_t system_available = FALSE;
  52 static dbus_bool_t system_ready = FALSE;
  53
  54 static dbus_int32_t debug_level = 0;
  55 static dbus_bool_t debug_timestamp = FALSE;
  56 static dbus_bool_t debug_showkeys = FALSE;
  57
  58 static const char *debug_strings[] = {
  59         "msgdump", "debug", "info", "warning", "error", NULL
  60 };
  61
  62 static unsigned int eap_methods;
  63
  64 struct strvalmap {
  65         const char *str;
  66         unsigned int val;
  67 };
  68
  69 static struct strvalmap eap_method_map[] = {
  70         { "MD5",        SUPPLICANT_EAP_METHOD_MD5       },
  71         { "TLS",        SUPPLICANT_EAP_METHOD_TLS       },
  72         { "MSCHAPV2",   SUPPLICANT_EAP_METHOD_MSCHAPV2  },
  73         { "PEAP",       SUPPLICANT_EAP_METHOD_PEAP      },
  74         { "TTLS",       SUPPLICANT_EAP_METHOD_TTLS      },
  75         { "GTC",        SUPPLICANT_EAP_METHOD_GTC       },
  76         { "OTP",        SUPPLICANT_EAP_METHOD_OTP       },
  77         { "LEAP",       SUPPLICANT_EAP_METHOD_LEAP      },
  78         { "WSC",        SUPPLICANT_EAP_METHOD_WSC       },
  79         { }
  80 };
  81
  82 static struct strvalmap keymgmt_capa_map[] = {
  83         { "none",       SUPPLICANT_CAPABILITY_KEYMGMT_NONE      },
  84         { "ieee8021x",  SUPPLICANT_CAPABILITY_KEYMGMT_IEEE8021X },
  85         { "wpa-none",   SUPPLICANT_CAPABILITY_KEYMGMT_WPA_NONE  },
  86         { "wpa-psk",    SUPPLICANT_CAPABILITY_KEYMGMT_WPA_PSK   },
  87         { "wpa-eap",    SUPPLICANT_CAPABILITY_KEYMGMT_WPA_EAP   },
  88         { "wps",        SUPPLICANT_CAPABILITY_KEYMGMT_WPS       },
  89         { }
  90 };
  91
  92 static struct strvalmap authalg_capa_map[] = {
  93         { "open",       SUPPLICANT_CAPABILITY_AUTHALG_OPEN      },
  94         { "shared",     SUPPLICANT_CAPABILITY_AUTHALG_SHARED    },
  95         { "leap",       SUPPLICANT_CAPABILITY_AUTHALG_LEAP      },
  96         { }
  97 };
  98
  99 static struct strvalmap proto_capa_map[] = {
 100         { "wpa",        SUPPLICANT_CAPABILITY_PROTO_WPA         },
 101         { "rsn",        SUPPLICANT_CAPABILITY_PROTO_RSN         },
 102         { }
 103 };
 104
 105 static struct strvalmap group_capa_map[] = {
 106         { "wep40",      SUPPLICANT_CAPABILITY_GROUP_WEP40       },
 107         { "wep104",     SUPPLICANT_CAPABILITY_GROUP_WEP104      },
 108         { "tkip",       SUPPLICANT_CAPABILITY_GROUP_TKIP        },
 109         { "ccmp",       SUPPLICANT_CAPABILITY_GROUP_CCMP        },
 110         { }
 111 };
 112
 113 static struct strvalmap pairwise_capa_map[] = {
 114         { "none",       SUPPLICANT_CAPABILITY_PAIRWISE_NONE     },
 115         { "tkip",       SUPPLICANT_CAPABILITY_PAIRWISE_TKIP     },
 116         { "ccmp",       SUPPLICANT_CAPABILITY_PAIRWISE_CCMP     },
 117         { }
 118 };
 119
 120 static struct strvalmap scan_capa_map[] = {
 121         { "active",     SUPPLICANT_CAPABILITY_SCAN_ACTIVE       },
 122         { "passive",    SUPPLICANT_CAPABILITY_SCAN_PASSIVE      },
 123         { "ssid",       SUPPLICANT_CAPABILITY_SCAN_SSID         },
 124         { }
 125 };
 126
 127 static struct strvalmap mode_capa_map[] = {
 128         { "infrastructure",     SUPPLICANT_CAPABILITY_MODE_INFRA        },
 129         { "ad-hoc",             SUPPLICANT_CAPABILITY_MODE_IBSS         },
 130         { "ap",                 SUPPLICANT_CAPABILITY_MODE_AP           },
 131         { }
 132 };
 133
 134 static GHashTable *interface_table;
 135 static GHashTable *bss_mapping;
 136
 137 struct supplicant_interface {
 138         char *path;
 139         unsigned int keymgmt_capa;
 140         unsigned int authalg_capa;
 141         unsigned int proto_capa;
 142         unsigned int group_capa;
 143         unsigned int pairwise_capa;
 144         unsigned int scan_capa;
 145         unsigned int mode_capa;
 146         dbus_bool_t ready;
 147         enum supplicant_state state;
 148         dbus_bool_t scanning;
 149         supplicant_interface_scan_callback scan_callback;
 150         void *scan_data;
 151         int apscan;
 152         char *ifname;
 153         char *driver;
 154         char *bridge;
 155         GHashTable *network_table;
 156         GHashTable *net_mapping;
 157         GHashTable *bss_mapping;
 158 };
 159
 160 struct supplicant_network {
 161         struct supplicant_interface *interface;
 162         char *path;
 163         char *group;
 164         char *name;
 165         enum supplicant_mode mode;
 166         GHashTable *bss_table;
 167         GHashTable *config_table;
 168 };
 169
 170 struct supplicant_bss {
 171         struct supplicant_interface *interface;
 172         char *path;
 173         unsigned char bssid[6];
 174         unsigned char ssid[32];
 175         unsigned int ssid_len;
 176         dbus_uint16_t frequency;
 177         dbus_uint32_t maxrate;
 178         enum supplicant_mode mode;
 179         enum supplicant_security security;
 180         dbus_bool_t privacy;
 181         dbus_bool_t psk;
 182         dbus_bool_t ieee8021x;
 183 };
 184
 185 static enum supplicant_mode string2mode(const char *mode)
 186 {
 187         if (mode == NULL)
 188                 return SUPPLICANT_MODE_UNKNOWN;
 189
 190         if (g_str_equal(mode, "infrastructure") == TRUE)
 191                 return SUPPLICANT_MODE_INFRA;
 192         else if (g_str_equal(mode, "ad-hoc") == TRUE)
 193                 return SUPPLICANT_MODE_IBSS;
 194
 195         return SUPPLICANT_MODE_UNKNOWN;
 196 }
 197
 198 static const char *mode2string(enum supplicant_mode mode)
 199 {
 200         switch (mode) {
 201         case SUPPLICANT_MODE_UNKNOWN:
 202                 break;
 203         case SUPPLICANT_MODE_INFRA:
 204                 return "infra";
 205         case SUPPLICANT_MODE_IBSS:
 206                 return "adhoc";
 207         }
 208
 209         return NULL;
 210 }
 211
 212 static const char *security2string(enum supplicant_security security)
 213 {
 214         switch (security) {
 215         case SUPPLICANT_SECURITY_UNKNOWN:
 216                 break;
 217         case SUPPLICANT_SECURITY_NONE:
 218                 return "none";
 219         case SUPPLICANT_SECURITY_WEP:
 220                 return "wep";
 221         case SUPPLICANT_SECURITY_PSK:
 222                 return "psk";
 223         case SUPPLICANT_SECURITY_IEEE8021X:
 224                 return "ieee8021x";
 225         }
 226
 227         return NULL;
 228 }
 229
 230 static enum supplicant_state string2state(const char *state)
 231 {
 232         if (state == NULL)
 233                 return SUPPLICANT_STATE_UNKNOWN;
 234
 235         if (g_str_equal(state, "unknown") == TRUE)
 236                 return SUPPLICANT_STATE_UNKNOWN;
 237         else if (g_str_equal(state, "disconnected") == TRUE)
 238                 return SUPPLICANT_STATE_DISCONNECTED;
 239         else if (g_str_equal(state, "inactive") == TRUE)
 240                 return SUPPLICANT_STATE_INACTIVE;
 241         else if (g_str_equal(state, "scanning") == TRUE)
 242                 return SUPPLICANT_STATE_SCANNING;
 243         else if (g_str_equal(state, "authenticating") == TRUE)
 244                 return SUPPLICANT_STATE_AUTHENTICATING;
 245         else if (g_str_equal(state, "associating") == TRUE)
 246                 return SUPPLICANT_STATE_ASSOCIATING;
 247         else if (g_str_equal(state, "associated") == TRUE)
 248                 return SUPPLICANT_STATE_ASSOCIATED;
 249         else if (g_str_equal(state, "group_handshake") == TRUE)
 250                 return SUPPLICANT_STATE_GROUP_HANDSHAKE;
 251         else if (g_str_equal(state, "4way_handshake") == TRUE)
 252                 return SUPPLICANT_STATE_4WAY_HANDSHAKE;
 253         else if (g_str_equal(state, "completed") == TRUE)
 254                 return SUPPLICANT_STATE_COMPLETED;
 255
 256         return SUPPLICANT_STATE_UNKNOWN;
 257 }
 258
 259 static void callback_system_ready(void)
 260 {
 261         if (system_ready == TRUE)
 262                 return;
 263
 264         system_ready = TRUE;
 265
 266         if (callbacks_pointer == NULL)
 267                 return;
 268
 269         if (callbacks_pointer->system_ready == NULL)
 270                 return;
 271
 272         callbacks_pointer->system_ready();
 273 }
 274
 275 static void callback_system_killed(void)
 276 {
 277         system_ready = FALSE;
 278
 279         if (callbacks_pointer == NULL)
 280                 return;
 281
 282         if (callbacks_pointer->system_killed == NULL)
 283                 return;
 284
 285         callbacks_pointer->system_killed();
 286 }
 287
 288 static void callback_interface_added(struct supplicant_interface *interface)
 289 {
 290         if (callbacks_pointer == NULL)
 291                 return;
 292
 293         if (callbacks_pointer->interface_added == NULL)
 294                 return;
 295
 296         callbacks_pointer->interface_added(interface);
 297 }
 298
 299 static void callback_interface_removed(struct supplicant_interface *interface)
 300 {
 301         if (callbacks_pointer == NULL)
 302                 return;
 303
 304         if (callbacks_pointer->interface_removed == NULL)
 305                 return;
 306
 307         callbacks_pointer->interface_removed(interface);
 308 }
 309
 310 static void callback_scan_started(struct supplicant_interface *interface)
 311 {
 312         if (callbacks_pointer == NULL)
 313                 return;
 314
 315         if (callbacks_pointer->scan_started == NULL)
 316                 return;
 317
 318         callbacks_pointer->scan_started(interface);
 319 }
 320
 321 static void callback_scan_finished(struct supplicant_interface *interface)
 322 {
 323         if (callbacks_pointer == NULL)
 324                 return;
 325
 326         if (callbacks_pointer->scan_finished == NULL)
 327                 return;
 328
 329         callbacks_pointer->scan_finished(interface);
 330 }
 331
 332 static void callback_network_added(struct supplicant_network *network)
 333 {
 334         if (callbacks_pointer == NULL)
 335                 return;
 336
 337         if (callbacks_pointer->network_added == NULL)
 338                 return;
 339
 340         callbacks_pointer->network_added(network);
 341 }
 342
 343 static void callback_network_removed(struct supplicant_network *network)
 344 {
 345         if (callbacks_pointer == NULL)
 346                 return;
 347
 348         if (callbacks_pointer->network_removed == NULL)
 349                 return;
 350
 351         callbacks_pointer->network_removed(network);
 352 }
 353
 354 static void remove_interface(gpointer data)
 355 {
 356         struct supplicant_interface *interface = data;
 357
 358         g_hash_table_destroy(interface->bss_mapping);
 359         g_hash_table_destroy(interface->net_mapping);
 360         g_hash_table_destroy(interface->network_table);
 361
 362         callback_interface_removed(interface);
 363
 364         g_free(interface->path);
 365         g_free(interface->ifname);
 366         g_free(interface->driver);
 367         g_free(interface->bridge);
 368         g_free(interface);
 369 }
 370
 371 static void remove_network(gpointer data)
 372 {
 373         struct supplicant_network *network = data;
 374
 375         g_hash_table_destroy(network->bss_table);
 376
 377         callback_network_removed(network);
 378
 379         g_hash_table_destroy(network->config_table);
 380
 381         g_free(network->group);
 382         g_free(network->name);
 383         g_free(network);
 384 }
 385
 386 static void remove_bss(gpointer data)
 387 {
 388         struct supplicant_bss *bss = data;
 389
 390         g_free(bss->path);
 391         g_free(bss);
 392 }
 393
 394 static void debug_strvalmap(const char *label, struct strvalmap *map,
 395                                                         unsigned int val)
 396 {
 397         int i;
 398
 399         for (i = 0; map[i].str != NULL; i++) {
 400                 if (val & map[i].val)
 401                         DBG("%s: %s", label, map[i].str);
 402         }
 403 }
 404
 405 static void interface_capability_keymgmt(DBusMessageIter *iter, void *user_data)
 406 {
 407         struct supplicant_interface *interface = user_data;
 408         const char *str = NULL;
 409         int i;
 410
 411         dbus_message_iter_get_basic(iter, &str);
 412         if (str == NULL)
 413                 return;
 414
 415         for (i = 0; keymgmt_capa_map[i].str != NULL; i++)
 416                 if (strcmp(str, keymgmt_capa_map[i].str) == 0) {
 417                         interface->keymgmt_capa |= keymgmt_capa_map[i].val;
 418                         break;
 419                 }
 420 }
 421
 422 static void interface_capability_authalg(DBusMessageIter *iter, void *user_data)
 423 {
 424         struct supplicant_interface *interface = user_data;
 425         const char *str = NULL;
 426         int i;
 427
 428         dbus_message_iter_get_basic(iter, &str);
 429         if (str == NULL)
 430                 return;
 431
 432         for (i = 0; authalg_capa_map[i].str != NULL; i++)
 433                 if (strcmp(str, authalg_capa_map[i].str) == 0) {
 434                         interface->authalg_capa |= authalg_capa_map[i].val;
 435                         break;
 436                 }
 437 }
 438
 439 static void interface_capability_proto(DBusMessageIter *iter, void *user_data)
 440 {
 441         struct supplicant_interface *interface = user_data;
 442         const char *str = NULL;
 443         int i;
 444
 445         dbus_message_iter_get_basic(iter, &str);
 446         if (str == NULL)
 447                 return;
 448
 449         for (i = 0; proto_capa_map[i].str != NULL; i++)
 450                 if (strcmp(str, proto_capa_map[i].str) == 0) {
 451                         interface->proto_capa |= proto_capa_map[i].val;
 452                         break;
 453                 }
 454 }
 455
 456 static void interface_capability_pairwise(DBusMessageIter *iter, void *user_data)
 457 {
 458         struct supplicant_interface *interface = user_data;
 459         const char *str = NULL;
 460         int i;
 461
 462         dbus_message_iter_get_basic(iter, &str);
 463         if (str == NULL)
 464                 return;
 465
 466         for (i = 0; pairwise_capa_map[i].str != NULL; i++)
 467                 if (strcmp(str, pairwise_capa_map[i].str) == 0) {
 468                         interface->pairwise_capa |= pairwise_capa_map[i].val;
 469                         break;
 470                 }
 471 }
 472
 473 static void interface_capability_group(DBusMessageIter *iter, void *user_data)
 474 {
 475         struct supplicant_interface *interface = user_data;
 476         const char *str = NULL;
 477         int i;
 478
 479         dbus_message_iter_get_basic(iter, &str);
 480         if (str == NULL)
 481                 return;
 482
 483         for (i = 0; group_capa_map[i].str != NULL; i++)
 484                 if (strcmp(str, group_capa_map[i].str) == 0) {
 485                         interface->group_capa |= group_capa_map[i].val;
 486                         break;
 487                 }
 488 }
 489
 490 static void interface_capability_scan(DBusMessageIter *iter, void *user_data)
 491 {
 492         struct supplicant_interface *interface = user_data;
 493         const char *str = NULL;
 494         int i;
 495
 496         dbus_message_iter_get_basic(iter, &str);
 497         if (str == NULL)
 498                 return;
 499
 500         for (i = 0; scan_capa_map[i].str != NULL; i++)
 501                 if (strcmp(str, scan_capa_map[i].str) == 0) {
 502                         interface->scan_capa |= scan_capa_map[i].val;
 503                         break;
 504                 }
 505 }
 506
 507 static void interface_capability_mode(DBusMessageIter *iter, void *user_data)
 508 {
 509         struct supplicant_interface *interface = user_data;
 510         const char *str = NULL;
 511         int i;
 512
 513         dbus_message_iter_get_basic(iter, &str);
 514         if (str == NULL)
 515                 return;
 516
 517         for (i = 0; mode_capa_map[i].str != NULL; i++)
 518                 if (strcmp(str, mode_capa_map[i].str) == 0) {
 519                         interface->mode_capa |= mode_capa_map[i].val;
 520                         break;
 521                 }
 522 }
 523
 524 static void interface_capability(const char *key, DBusMessageIter *iter,
 525                                                         void *user_data)
 526 {
 527         struct supplicant_interface *interface = user_data;
 528
 529         if (key == NULL)
 530                 return;
 531
 532         if (g_strcmp0(key, "KeyMgmt") == 0)
 533                 supplicant_dbus_array_foreach(iter,
 534                                 interface_capability_keymgmt, interface);
 535         else if (g_strcmp0(key, "AuthAlg") == 0)
 536                 supplicant_dbus_array_foreach(iter,
 537                                 interface_capability_authalg, interface);
 538         else if (g_strcmp0(key, "Protocol") == 0)
 539                 supplicant_dbus_array_foreach(iter,
 540                                 interface_capability_proto, interface);
 541         else if (g_strcmp0(key, "Pairwise") == 0)
 542                 supplicant_dbus_array_foreach(iter,
 543                                 interface_capability_pairwise, interface);
 544         else if (g_strcmp0(key, "Group") == 0)
 545                 supplicant_dbus_array_foreach(iter,
 546                                 interface_capability_group, interface);
 547         else if (g_strcmp0(key, "Scan") == 0)
 548                 supplicant_dbus_array_foreach(iter,
 549                                 interface_capability_scan, interface);
 550         else if (g_strcmp0(key, "Modes") == 0)
 551                 supplicant_dbus_array_foreach(iter,
 552                                 interface_capability_mode, interface);
 553         else
 554                 DBG("key %s type %c",
 555                                 key, dbus_message_iter_get_arg_type(iter));
 556 }
 557
 558 const char *supplicant_interface_get_ifname(struct supplicant_interface *interface)
 559 {
 560         if (interface == NULL)
 561                 return NULL;
 562
 563         return interface->ifname;
 564 }
 565
 566 const char *supplicant_interface_get_driver(struct supplicant_interface *interface)
 567 {
 568         if (interface == NULL)
 569                 return NULL;
 570
 571         return interface->driver;
 572 }
 573
 574 struct supplicant_interface *supplicant_network_get_interface(struct supplicant_network *network)
 575 {
 576         if (network == NULL)
 577                 return NULL;
 578
 579         return network->interface;
 580 }
 581
 582 const char *supplicant_network_get_name(struct supplicant_network *network)
 583 {
 584         if (network == NULL || network->name == NULL)
 585                 return "";
 586
 587         return network->name;
 588 }
 589
 590 const char *supplicant_network_get_identifier(struct supplicant_network *network)
 591 {
 592         if (network == NULL || network->group == NULL)
 593                 return "";
 594
 595         return network->group;
 596 }
 597
 598 enum supplicant_mode supplicant_network_get_mode(struct supplicant_network *network)
 599 {
 600         if (network == NULL)
 601                 return SUPPLICANT_MODE_UNKNOWN;
 602
 603         return network->mode;
 604 }
 605
 606 static void merge_network(struct supplicant_network *network)
 607 {
 608         GString *str;
 609         const char *ssid, *mode, *key_mgmt;
 610         unsigned int i, ssid_len;
 611         char *group;
 612
 613         ssid = g_hash_table_lookup(network->config_table, "ssid");
 614         mode = g_hash_table_lookup(network->config_table, "mode");
 615         key_mgmt = g_hash_table_lookup(network->config_table, "key_mgmt");
 616
 617         DBG("ssid %s mode %s", ssid, mode);
 618
 619         if (ssid != NULL)
 620                 ssid_len = strlen(ssid);
 621         else
 622                 ssid_len = 0;
 623
 624         str = g_string_sized_new((ssid_len * 2) + 24);
 625         if (str == NULL)
 626                 return;
 627
 628         for (i = 0; i < ssid_len; i++)
 629                 g_string_append_printf(str, "%02x", ssid[i]);
 630
 631         if (g_strcmp0(mode, "0") == 0)
 632                 g_string_append_printf(str, "_infra");
 633         else if (g_strcmp0(mode, "1") == 0)
 634                 g_string_append_printf(str, "_adhoc");
 635
 636         if (g_strcmp0(key_mgmt, "WPA-PSK") == 0)
 637                 g_string_append_printf(str, "_psk");
 638
 639         group = g_string_free(str, FALSE);
 640
 641         DBG("%s", group);
 642
 643         g_free(group);
 644
 645         g_hash_table_destroy(network->config_table);
 646
 647         g_free(network->path);
 648         g_free(network);
 649 }
 650
 651 static void network_property(const char *key, DBusMessageIter *iter,
 652                                                         void *user_data)
 653 {
 654         struct supplicant_network *network = user_data;
 655
 656         if (network->interface == NULL)
 657                 return;
 658
 659         if (key == NULL) {
 660                 merge_network(network);
 661                 return;
 662         }
 663
 664         if (g_strcmp0(key, "Enabled") == 0) {
 665                 dbus_bool_t enabled = FALSE;
 666
 667                 dbus_message_iter_get_basic(iter, &enabled);
 668         } else if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
 669                 const char *str = NULL;
 670
 671                 dbus_message_iter_get_basic(iter, &str);
 672                 if (str != NULL)
 673                         g_hash_table_replace(network->config_table,
 674                                                 g_strdup(key), g_strdup(str));
 675         } else
 676                 DBG("key %s type %c",
 677                                 key, dbus_message_iter_get_arg_type(iter));
 678 }
 679
 680 static void interface_network_added(DBusMessageIter *iter, void *user_data)
 681 {
 682         struct supplicant_interface *interface = user_data;
 683         struct supplicant_network *network;
 684         const char *path = NULL;
 685
 686         dbus_message_iter_get_basic(iter, &path);
 687         if (path == NULL)
 688                 return;
 689
 690         if (g_strcmp0(path, "/") == 0)
 691                 return;
 692
 693         network = g_hash_table_lookup(interface->net_mapping, path);
 694         if (network != NULL)
 695                 return;
 696
 697         network = g_try_new0(struct supplicant_network, 1);
 698         if (network == NULL)
 699                 return;
 700
 701         network->interface = interface;
 702         network->path = g_strdup(path);
 703
 704         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
 705                                                         g_free, g_free);
 706
 707         dbus_message_iter_next(iter);
 708         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
 709                 supplicant_dbus_property_foreach(iter, network_property,
 710                                                                 network);
 711                 network_property(NULL, NULL, network);
 712                 return;
 713         }
 714
 715         supplicant_dbus_property_get_all(path,
 716                                 SUPPLICANT_INTERFACE ".Interface.Network",
 717                                                 network_property, network);
 718 }
 719
 720 static void interface_network_removed(DBusMessageIter *iter, void *user_data)
 721 {
 722         struct supplicant_interface *interface = user_data;
 723         struct supplicant_network *network;
 724         const char *path = NULL;
 725
 726         dbus_message_iter_get_basic(iter, &path);
 727         if (path == NULL)
 728                 return;
 729
 730         network = g_hash_table_lookup(interface->net_mapping, path);
 731         if (network == NULL)
 732                 return;
 733
 734         g_hash_table_remove(interface->net_mapping, path);
 735 }
 736
 737 static char *create_name(unsigned char *ssid, int ssid_len)
 738 {
 739         char *name;
 740         int i;
 741
 742         if (ssid_len < 1 || ssid[0] == '\0')
 743                 name = NULL;
 744         else
 745                 name = g_try_malloc0(ssid_len + 1);
 746
 747         if (name == NULL)
 748                 return g_strdup("");
 749
 750         for (i = 0; i < ssid_len; i++) {
 751                 if (g_ascii_isprint(ssid[i]))
 752                         name[i] = ssid[i];
 753                 else
 754                         name[i] = ' ';
 755         }
 756
 757         return name;
 758 }
 759
 760 static char *create_group(struct supplicant_bss *bss)
 761 {
 762         GString *str;
 763         unsigned int i;
 764         const char *mode, *security;
 765
 766         str = g_string_sized_new((bss->ssid_len * 2) + 24);
 767         if (str == NULL)
 768                 return NULL;
 769
 770         if (bss->ssid_len > 0 && bss->ssid[0] != '\0') {
 771                 for (i = 0; i < bss->ssid_len; i++)
 772                         g_string_append_printf(str, "%02x", bss->ssid[i]);
 773         } else
 774                 g_string_append_printf(str, "hidden");
 775
 776         mode = mode2string(bss->mode);
 777         if (mode != NULL)
 778                 g_string_append_printf(str, "_%s", mode);
 779
 780         security = security2string(bss->security);
 781         if (security != NULL)
 782                 g_string_append_printf(str, "_%s", security);
 783
 784         return g_string_free(str, FALSE);
 785 }
 786
 787 static void add_bss_to_network(struct supplicant_bss *bss)
 788 {
 789         struct supplicant_interface *interface = bss->interface;
 790         struct supplicant_network *network;
 791         char *group;
 792
 793         group = create_group(bss);
 794         if (group == NULL)
 795                 return;
 796
 797         network = g_hash_table_lookup(interface->network_table, group);
 798         if (network != NULL) {
 799                 g_free(group);
 800                 goto done;
 801         }
 802
 803         network = g_try_new0(struct supplicant_network, 1);
 804         if (network == NULL) {
 805                 g_free(group);
 806                 return;
 807         }
 808
 809         network->group = group;
 810         network->name = create_name(bss->ssid, bss->ssid_len);
 811         network->mode = bss->mode;
 812
 813         network->bss_table = g_hash_table_new_full(g_str_hash, g_str_equal,
 814                                                         NULL, remove_bss);
 815
 816         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
 817                                                         g_free, g_free);
 818
 819         g_hash_table_replace(interface->network_table,
 820                                                 network->group, network);
 821
 822         callback_network_added(network);
 823
 824 done:
 825         g_hash_table_replace(interface->bss_mapping, bss->path, network);
 826         g_hash_table_replace(network->bss_table, bss->path, bss);
 827
 828         g_hash_table_replace(bss_mapping, bss->path, interface);
 829 }
 830
 831 static unsigned char wifi_oui[3]      = { 0x00, 0x50, 0xf2 };
 832 static unsigned char ieee80211_oui[3] = { 0x00, 0x0f, 0xac };
 833
 834 static void extract_rsn(struct supplicant_bss *bss,
 835                                         const unsigned char *buf, int len)
 836 {
 837         uint16_t count;
 838         int i;
 839
 840         /* Version */
 841         if (len < 2)
 842                 return;
 843
 844         buf += 2;
 845         len -= 2;
 846
 847         /* Group cipher */
 848         if (len < 4)
 849                 return;
 850
 851         buf += 4;
 852         len -= 4;
 853
 854         /* Pairwise cipher */
 855         if (len < 2)
 856                 return;
 857
 858         count = buf[0] | (buf[1] << 8);
 859         if (2 + (count * 4) > len)
 860                 return;
 861
 862         buf += 2 + (count * 4);
 863         len -= 2 + (count * 4);
 864
 865         /* Authentication */
 866         if (len < 2)
 867                 return;
 868
 869         count = buf[0] | (buf[1] << 8);
 870         if (2 + (count * 4) > len)
 871                 return;
 872
 873         for (i = 0; i < count; i++) {
 874                 const unsigned char *ptr = buf + 2 + (i * 4);
 875
 876                 if (memcmp(ptr, wifi_oui, 3) == 0) {
 877                         switch (ptr[3]) {
 878                         case 1:
 879                                 bss->ieee8021x = TRUE;
 880                                 break;
 881                         case 2:
 882                                 bss->psk = TRUE;
 883                                 break;
 884                         }
 885                 } else if (memcmp(ptr, ieee80211_oui, 3) == 0) {
 886                         switch (ptr[3]) {
 887                         case 1:
 888                                 bss->ieee8021x = TRUE;
 889                                 break;
 890                         case 2:
 891                                 bss->psk = TRUE;
 892                                 break;
 893                         }
 894                 }
 895         }
 896
 897 }
 898
 899 static void bss_rates(DBusMessageIter *iter, void *user_data)
 900 {
 901         struct supplicant_bss *bss = user_data;
 902         dbus_uint32_t rate = 0;
 903
 904         dbus_message_iter_get_basic(iter, &rate);
 905         if (rate == 0)
 906                 return;
 907
 908         if (rate > bss->maxrate)
 909                 bss->maxrate = rate;
 910 }
 911
 912 static void bss_property(const char *key, DBusMessageIter *iter,
 913                                                         void *user_data)
 914 {
 915         struct supplicant_bss *bss = user_data;
 916
 917         if (bss->interface == NULL)
 918                 return;
 919
 920         if (key == NULL) {
 921                 if (bss->ieee8021x == TRUE)
 922                         bss->security = SUPPLICANT_SECURITY_IEEE8021X;
 923                 else if (bss->psk == TRUE)
 924                         bss->security = SUPPLICANT_SECURITY_PSK;
 925                 else if (bss->privacy == TRUE)
 926                         bss->security = SUPPLICANT_SECURITY_WEP;
 927                 else
 928                         bss->security = SUPPLICANT_SECURITY_NONE;
 929
 930                 add_bss_to_network(bss);
 931                 return;
 932         }
 933
 934         if (g_strcmp0(key, "BSSID") == 0) {
 935                 DBusMessageIter array;
 936                 unsigned char *addr;
 937                 int addr_len;
 938
 939                 dbus_message_iter_recurse(iter, &array);
 940                 dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
 941
 942                 if (addr_len == 6)
 943                         memcpy(bss->bssid, addr, addr_len);
 944         } else if (g_strcmp0(key, "SSID") == 0) {
 945                 DBusMessageIter array;
 946                 unsigned char *ssid;
 947                 int ssid_len;
 948
 949                 dbus_message_iter_recurse(iter, &array);
 950                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
 951
 952                 if (ssid_len > 0 && ssid_len < 33) {
 953                         memcpy(bss->ssid, ssid, ssid_len);
 954                         bss->ssid_len = ssid_len;
 955                 } else {
 956                         memset(bss->ssid, 0, sizeof(bss->ssid));
 957                         bss->ssid_len = 0;
 958                 }
 959         } else if (g_strcmp0(key, "Capabilities") == 0) {
 960                 dbus_uint16_t capabilities = 0x0000;
 961
 962                 dbus_message_iter_get_basic(iter, &capabilities);
 963
 964                 if (capabilities & IEEE80211_CAP_ESS)
 965                         bss->mode = SUPPLICANT_MODE_INFRA;
 966                 else if (capabilities & IEEE80211_CAP_IBSS)
 967                         bss->mode = SUPPLICANT_MODE_IBSS;
 968
 969                 if (capabilities & IEEE80211_CAP_PRIVACY)
 970                         bss->privacy = TRUE;
 971         } else if (g_strcmp0(key, "Mode") == 0) {
 972                 const char *mode = NULL;
 973
 974                 dbus_message_iter_get_basic(iter, &mode);
 975                 bss->mode = string2mode(mode);
 976         } else if (g_strcmp0(key, "Frequency") == 0) {
 977                 dbus_uint16_t frequency = 0;
 978
 979                 dbus_message_iter_get_basic(iter, &frequency);
 980                 bss->frequency = frequency;
 981         } else if (g_strcmp0(key, "Signal") == 0) {
 982                 dbus_int16_t signal = 0;
 983
 984                 dbus_message_iter_get_basic(iter, &signal);
 985         } else if (g_strcmp0(key, "Level") == 0) {
 986                 dbus_int32_t level = 0;
 987
 988                 dbus_message_iter_get_basic(iter, &level);
 989         } else if (g_strcmp0(key, "Rates") == 0) {
 990                 supplicant_dbus_array_foreach(iter, bss_rates, bss);
 991         } else if (g_strcmp0(key, "MaxRate") == 0) {
 992                 dbus_uint32_t maxrate = 0;
 993
 994                 dbus_message_iter_get_basic(iter, &maxrate);
 995                 if (maxrate != 0)
 996                         bss->maxrate =maxrate;
 997         } else if (g_strcmp0(key, "Privacy") == 0) {
 998                 dbus_bool_t privacy = FALSE;
 999
1000                 dbus_message_iter_get_basic(iter, &privacy);
1001                 bss->privacy = privacy;
1002         } else if (g_strcmp0(key, "RSNIE") == 0) {
1003                 DBusMessageIter array;
1004                 unsigned char *ie;
1005                 int ie_len;
1006
1007                 dbus_message_iter_recurse(iter, &array);
1008                 dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1009
1010                 if (ie_len > 2)
1011                         extract_rsn(bss, ie + 2, ie_len - 2);
1012         } else if (g_strcmp0(key, "WPAIE") == 0) {
1013                 DBusMessageIter array;
1014                 unsigned char *ie;
1015                 int ie_len;
1016
1017                 dbus_message_iter_recurse(iter, &array);
1018                 dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1019
1020                 if (ie_len > 6)
1021                         extract_rsn(bss, ie + 6, ie_len - 6);
1022         } else if (g_strcmp0(key, "WPSIE") == 0) {
1023                 DBusMessageIter array;
1024                 unsigned char *ie;
1025                 int ie_len;
1026
1027                 dbus_message_iter_recurse(iter, &array);
1028                 dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1029         } else
1030                 DBG("key %s type %c",
1031                                 key, dbus_message_iter_get_arg_type(iter));
1032 }
1033
1034 static void interface_bss_added(DBusMessageIter *iter, void *user_data)
1035 {
1036         struct supplicant_interface *interface = user_data;
1037         struct supplicant_network *network;
1038         struct supplicant_bss *bss;
1039         const char *path = NULL;
1040
1041         dbus_message_iter_get_basic(iter, &path);
1042         if (path == NULL)
1043                 return;
1044
1045         if (g_strcmp0(path, "/") == 0)
1046                 return;
1047
1048         network = g_hash_table_lookup(interface->bss_mapping, path);
1049         if (network != NULL) {
1050                 bss = g_hash_table_lookup(network->bss_table, path);
1051                 if (bss != NULL)
1052                         return;
1053         }
1054
1055         bss = g_try_new0(struct supplicant_bss, 1);
1056         if (bss == NULL)
1057                 return;
1058
1059         bss->interface = interface;
1060         bss->path = g_strdup(path);
1061
1062         dbus_message_iter_next(iter);
1063         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1064                 supplicant_dbus_property_foreach(iter, bss_property, bss);
1065                 bss_property(NULL, NULL, bss);
1066                 return;
1067         }
1068
1069         supplicant_dbus_property_get_all(path,
1070                                         SUPPLICANT_INTERFACE ".Interface.BSS",
1071                                                         bss_property, bss);
1072 }
1073
1074 static void interface_bss_removed(DBusMessageIter *iter, void *user_data)
1075 {
1076         struct supplicant_interface *interface = user_data;
1077         struct supplicant_network *network;
1078         const char *path = NULL;
1079
1080         dbus_message_iter_get_basic(iter, &path);
1081         if (path == NULL)
1082                 return;
1083
1084         network = g_hash_table_lookup(interface->bss_mapping, path);
1085         if (network == NULL)
1086                 return;
1087
1088         g_hash_table_remove(bss_mapping, path);
1089
1090         g_hash_table_remove(interface->bss_mapping, path);
1091         g_hash_table_remove(network->bss_table, path);
1092
1093         if (g_hash_table_size(network->bss_table) == 0)
1094                 g_hash_table_remove(interface->network_table, network->group);
1095 }
1096
1097 static void interface_property(const char *key, DBusMessageIter *iter,
1098                                                         void *user_data)
1099 {
1100         struct supplicant_interface *interface = user_data;
1101
1102         if (interface == NULL)
1103                 return;
1104
1105         if (key == NULL) {
1106                 debug_strvalmap("KeyMgmt capability", keymgmt_capa_map,
1107                                                 interface->keymgmt_capa);
1108                 debug_strvalmap("AuthAlg capability", authalg_capa_map,
1109                                                 interface->authalg_capa);
1110                 debug_strvalmap("Protocol capability", proto_capa_map,
1111                                                 interface->proto_capa);
1112                 debug_strvalmap("Pairwise capability", pairwise_capa_map,
1113                                                 interface->pairwise_capa);
1114                 debug_strvalmap("Group capability", group_capa_map,
1115                                                 interface->group_capa);
1116                 debug_strvalmap("Scan capability", scan_capa_map,
1117                                                 interface->scan_capa);
1118                 debug_strvalmap("Mode capability", mode_capa_map,
1119                                                 interface->mode_capa);
1120
1121                 interface->ready = TRUE;
1122                 callback_interface_added(interface);
1123                 return;
1124         }
1125
1126         if (g_strcmp0(key, "Capabilities") == 0) {
1127                 supplicant_dbus_property_foreach(iter, interface_capability,
1128                                                                 interface);
1129         } else if (g_strcmp0(key, "State") == 0) {
1130                 const char *str = NULL;
1131
1132                 dbus_message_iter_get_basic(iter, &str);
1133                 if (str != NULL)
1134                         interface->state = string2state(str);
1135
1136                 DBG("state %s (%d)", str, interface->state);
1137         } else if (g_strcmp0(key, "Scanning") == 0) {
1138                 dbus_bool_t scanning = FALSE;
1139
1140                 dbus_message_iter_get_basic(iter, &scanning);
1141                 interface->scanning = scanning;
1142
1143                 if (interface->ready == TRUE) {
1144                         if (interface->scanning == TRUE)
1145                                 callback_scan_started(interface);
1146                         else
1147                                 callback_scan_finished(interface);
1148                 }
1149         } else if (g_strcmp0(key, "ApScan") == 0) {
1150                 int apscan = 1;
1151
1152                 dbus_message_iter_get_basic(iter, &apscan);
1153                 interface->apscan = apscan;
1154         } else if (g_strcmp0(key, "Ifname") == 0) {
1155                 const char *str = NULL;
1156
1157                 dbus_message_iter_get_basic(iter, &str);
1158                 if (str != NULL)
1159                         interface->ifname = g_strdup(str);
1160         } else if (g_strcmp0(key, "Driver") == 0) {
1161                 const char *str = NULL;
1162
1163                 dbus_message_iter_get_basic(iter, &str);
1164                 if (str != NULL)
1165                         interface->driver = g_strdup(str);
1166         } else if (g_strcmp0(key, "BridgeIfname") == 0) {
1167                 const char *str = NULL;
1168
1169                 dbus_message_iter_get_basic(iter, &str);
1170                 if (str != NULL)
1171                         interface->bridge = g_strdup(str);
1172         } else if (g_strcmp0(key, "CurrentBSS") == 0) {
1173                 interface_bss_added(iter, interface);
1174         } else if (g_strcmp0(key, "CurrentNetwork") == 0) {
1175                 interface_network_added(iter, interface);
1176         } else if (g_strcmp0(key, "BSSs") == 0) {
1177                 supplicant_dbus_array_foreach(iter, interface_bss_added,
1178                                                                 interface);
1179         } else if (g_strcmp0(key, "Blobs") == 0) {
1180         } else if (g_strcmp0(key, "Networks") == 0) {
1181                 supplicant_dbus_array_foreach(iter, interface_network_added,
1182                                                                 interface);
1183         } else
1184                 DBG("key %s type %c",
1185                                 key, dbus_message_iter_get_arg_type(iter));
1186 }
1187
1188 static struct supplicant_interface *interface_alloc(const char *path)
1189 {
1190         struct supplicant_interface *interface;
1191
1192         interface = g_try_new0(struct supplicant_interface, 1);
1193         if (interface == NULL)
1194                 return NULL;
1195
1196         interface->path = g_strdup(path);
1197
1198         interface->network_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1199                                                         NULL, remove_network);
1200
1201         interface->net_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1202                                                                 NULL, NULL);
1203         interface->bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1204                                                                 NULL, NULL);
1205
1206         g_hash_table_replace(interface_table, interface->path, interface);
1207
1208         return interface;
1209 }
1210
1211 static void interface_added(DBusMessageIter *iter, void *user_data)
1212 {
1213         struct supplicant_interface *interface;
1214         const char *path = NULL;
1215
1216         dbus_message_iter_get_basic(iter, &path);
1217         if (path == NULL)
1218                 return;
1219
1220         if (g_strcmp0(path, "/") == 0)
1221                 return;
1222
1223         interface = g_hash_table_lookup(interface_table, path);
1224         if (interface != NULL)
1225                 return;
1226
1227         interface = interface_alloc(path);
1228         if (interface == NULL)
1229                 return;
1230
1231         dbus_message_iter_next(iter);
1232         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1233                 supplicant_dbus_property_foreach(iter, interface_property,
1234                                                                 interface);
1235                 interface_property(NULL, NULL, interface);
1236                 return;
1237         }
1238
1239         supplicant_dbus_property_get_all(path,
1240                                         SUPPLICANT_INTERFACE ".Interface",
1241                                                 interface_property, interface);
1242 }
1243
1244 static void interface_removed(DBusMessageIter *iter, void *user_data)
1245 {
1246         const char *path = NULL;
1247
1248         dbus_message_iter_get_basic(iter, &path);
1249         if (path == NULL)
1250                 return;
1251
1252         g_hash_table_remove(interface_table, path);
1253 }
1254
1255 static void eap_method(DBusMessageIter *iter, void *user_data)
1256 {
1257         const char *str = NULL;
1258         int i;
1259
1260         dbus_message_iter_get_basic(iter, &str);
1261         if (str == NULL)
1262                 return;
1263
1264         for (i = 0; eap_method_map[i].str != NULL; i++)
1265                 if (strcmp(str, eap_method_map[i].str) == 0) {
1266                         eap_methods |= eap_method_map[i].val;
1267                         break;
1268                 }
1269 }
1270
1271 static void service_property(const char *key, DBusMessageIter *iter,
1272                                                         void *user_data)
1273 {
1274         if (key == NULL) {
1275                 callback_system_ready();
1276                 return;
1277         }
1278
1279         if (g_strcmp0(key, "DebugLevel") == 0) {
1280                 const char *str = NULL;
1281                 int i;
1282
1283                 dbus_message_iter_get_basic(iter, &str);
1284                 for (i = 0; debug_strings[i] != NULL; i++)
1285                         if (g_strcmp0(debug_strings[i], str) == 0) {
1286                                 debug_level = i;
1287                                 break;
1288                         }
1289                 DBG("Debug level %d", debug_level);
1290         } else if (g_strcmp0(key, "DebugTimestamp") == 0) {
1291                 dbus_message_iter_get_basic(iter, &debug_timestamp);
1292                 DBG("Debug timestamp %u", debug_timestamp);
1293         } else if (g_strcmp0(key, "DebugShowKeys") == 0) {
1294                 dbus_message_iter_get_basic(iter, &debug_showkeys);
1295                 DBG("Debug show keys %u", debug_showkeys);
1296         } else if (g_strcmp0(key, "Interfaces") == 0) {
1297                 supplicant_dbus_array_foreach(iter, interface_added, NULL);
1298         } else if (g_strcmp0(key, "EapMethods") == 0) {
1299                 supplicant_dbus_array_foreach(iter, eap_method, NULL);
1300                 debug_strvalmap("EAP method", eap_method_map, eap_methods);
1301         } else
1302                 DBG("key %s type %c",
1303                                 key, dbus_message_iter_get_arg_type(iter));
1304 }
1305
1306 static void supplicant_bootstrap(void)
1307 {
1308         supplicant_dbus_property_get_all(SUPPLICANT_PATH,
1309                                                 SUPPLICANT_INTERFACE,
1310                                                 service_property, NULL);
1311 }
1312
1313 static void signal_name_owner_changed(const char *path, DBusMessageIter *iter)
1314 {
1315         const char *name = NULL, *old = NULL, *new = NULL;
1316
1317         if (g_strcmp0(path, DBUS_PATH_DBUS) != 0)
1318                 return;
1319
1320         dbus_message_iter_get_basic(iter, &name);
1321         if (name == NULL)
1322                 return;
1323
1324         if (g_strcmp0(name, SUPPLICANT_SERVICE) != 0)
1325                 return;
1326
1327         dbus_message_iter_next(iter);
1328         dbus_message_iter_get_basic(iter, &old);
1329         dbus_message_iter_next(iter);
1330         dbus_message_iter_get_basic(iter, &new);
1331
1332         if (old == NULL || new == NULL)
1333                 return;
1334
1335         if (strlen(old) > 0 && strlen(new) == 0) {
1336                 system_available = FALSE;
1337                 g_hash_table_remove_all(bss_mapping);
1338                 g_hash_table_remove_all(interface_table);
1339                 callback_system_killed();
1340         }
1341
1342         if (strlen(new) > 0 && strlen(old) == 0) {
1343                 system_available = TRUE;
1344                 supplicant_bootstrap();
1345         }
1346 }
1347
1348 static void signal_properties_changed(const char *path, DBusMessageIter *iter)
1349 {
1350         if (g_strcmp0(path, SUPPLICANT_PATH) != 0)
1351                 return;
1352
1353         supplicant_dbus_property_foreach(iter, service_property, NULL);
1354 }
1355
1356 static void signal_interface_added(const char *path, DBusMessageIter *iter)
1357 {
1358         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1359                 interface_added(iter, NULL);
1360 }
1361
1362 static void signal_interface_removed(const char *path, DBusMessageIter *iter)
1363 {
1364         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1365                 interface_removed(iter, NULL);
1366 }
1367
1368 static void signal_interface_changed(const char *path, DBusMessageIter *iter)
1369 {
1370         struct supplicant_interface *interface;
1371
1372         interface = g_hash_table_lookup(interface_table, path);
1373         if (interface == NULL)
1374                 return;
1375
1376         supplicant_dbus_property_foreach(iter, interface_property, interface);
1377 }
1378
1379 static void signal_scan_done(const char *path, DBusMessageIter *iter)
1380 {
1381         struct supplicant_interface *interface;
1382         dbus_bool_t success = FALSE;
1383
1384         interface = g_hash_table_lookup(interface_table, path);
1385         if (interface == NULL)
1386                 return;
1387
1388         dbus_message_iter_get_basic(iter, &success);
1389
1390         if (interface->scan_callback != NULL) {
1391                 int result = 0;
1392
1393                 if (success == FALSE)
1394                         result = -EIO;
1395
1396                 interface->scan_callback(result, interface->scan_data);
1397         }
1398
1399         interface->scan_callback = NULL;
1400         interface->scan_data = NULL;
1401 }
1402
1403 static void signal_bss_added(const char *path, DBusMessageIter *iter)
1404 {
1405         struct supplicant_interface *interface;
1406
1407         interface = g_hash_table_lookup(interface_table, path);
1408         if (interface == NULL)
1409                 return;
1410
1411         interface_bss_added(iter, interface);
1412 }
1413
1414 static void signal_bss_removed(const char *path, DBusMessageIter *iter)
1415 {
1416         struct supplicant_interface *interface;
1417
1418         interface = g_hash_table_lookup(interface_table, path);
1419         if (interface == NULL)
1420                 return;
1421
1422         interface_bss_removed(iter, interface);
1423 }
1424
1425 static void signal_network_added(const char *path, DBusMessageIter *iter)
1426 {
1427         struct supplicant_interface *interface;
1428
1429         interface = g_hash_table_lookup(interface_table, path);
1430         if (interface == NULL)
1431                 return;
1432
1433         interface_network_added(iter, interface);
1434 }
1435
1436 static void signal_network_removed(const char *path, DBusMessageIter *iter)
1437 {
1438         struct supplicant_interface *interface;
1439
1440         interface = g_hash_table_lookup(interface_table, path);
1441         if (interface == NULL)
1442                 return;
1443
1444         interface_network_removed(iter, interface);
1445 }
1446
1447 static void signal_bss_changed(const char *path, DBusMessageIter *iter)
1448 {
1449         struct supplicant_interface *interface;
1450         struct supplicant_network *network;
1451         struct supplicant_bss *bss;
1452
1453         interface = g_hash_table_lookup(bss_mapping, path);
1454         if (interface == NULL)
1455                 return;
1456
1457         network = g_hash_table_lookup(interface->bss_mapping, path);
1458         if (network == NULL)
1459                 return;
1460
1461         bss = g_hash_table_lookup(network->bss_table, path);
1462         if (bss == NULL)
1463                 return;
1464
1465         supplicant_dbus_property_foreach(iter, bss_property, bss);
1466 }
1467
1468 static struct {
1469         const char *interface;
1470         const char *member;
1471         void (*function) (const char *path, DBusMessageIter *iter);
1472 } signal_map[] = {
1473         { DBUS_INTERFACE_DBUS,  "NameOwnerChanged",  signal_name_owner_changed },
1474
1475         { SUPPLICANT_INTERFACE, "PropertiesChanged", signal_properties_changed },
1476         { SUPPLICANT_INTERFACE, "InterfaceAdded",    signal_interface_added    },
1477         { SUPPLICANT_INTERFACE, "InterfaceCreated",  signal_interface_added    },
1478         { SUPPLICANT_INTERFACE, "InterfaceRemoved",  signal_interface_removed  },
1479
1480         { SUPPLICANT_INTERFACE ".Interface", "PropertiesChanged", signal_interface_changed },
1481         { SUPPLICANT_INTERFACE ".Interface", "ScanDone",          signal_scan_done         },
1482         { SUPPLICANT_INTERFACE ".Interface", "BSSAdded",          signal_bss_added         },
1483         { SUPPLICANT_INTERFACE ".Interface", "BSSRemoved",        signal_bss_removed       },
1484         { SUPPLICANT_INTERFACE ".Interface", "NetworkAdded",      signal_network_added     },
1485         { SUPPLICANT_INTERFACE ".Interface", "NetworkRemoved",    signal_network_removed   },
1486
1487         { SUPPLICANT_INTERFACE ".Interface.BSS", "PropertiesChanged", signal_bss_changed   },
1488
1489         { }
1490 };
1491
1492 static DBusHandlerResult supplicant_filter(DBusConnection *conn,
1493                                         DBusMessage *message, void *data)
1494 {
1495         DBusMessageIter iter;
1496         const char *path;
1497         int i;
1498
1499         path = dbus_message_get_path(message);
1500         if (path == NULL)
1501                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1502
1503         if (dbus_message_iter_init(message, &iter) == FALSE)
1504                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1505
1506         for (i = 0; signal_map[i].interface != NULL; i++) {
1507                 if (dbus_message_has_interface(message,
1508                                         signal_map[i].interface) == FALSE)
1509                         continue;
1510
1511                 if (dbus_message_has_member(message,
1512                                         signal_map[i].member) == FALSE)
1513                         continue;
1514
1515                 signal_map[i].function(path, &iter);
1516                 break;
1517         }
1518
1519         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1520 }
1521
1522 static const char *supplicant_rule0 = "type=signal,"
1523                                         "path=" DBUS_PATH_DBUS ","
1524                                         "sender=" DBUS_SERVICE_DBUS ","
1525                                         "interface=" DBUS_INTERFACE_DBUS ","
1526                                         "member=NameOwnerChanged,"
1527                                         "arg0=" SUPPLICANT_SERVICE;
1528 static const char *supplicant_rule1 = "type=signal,"
1529                         "interface=" SUPPLICANT_INTERFACE;
1530 static const char *supplicant_rule2 = "type=signal,"
1531                         "interface=" SUPPLICANT_INTERFACE ".Interface";
1532 static const char *supplicant_rule3 = "type=signal,"
1533                         "interface=" SUPPLICANT_INTERFACE ".Interface.WPS";
1534 static const char *supplicant_rule4 = "type=signal,"
1535                         "interface=" SUPPLICANT_INTERFACE ".Interface.BSS";
1536 static const char *supplicant_rule5 = "type=signal,"
1537                         "interface=" SUPPLICANT_INTERFACE ".Interface.Network";
1538 static const char *supplicant_rule6 = "type=signal,"
1539                         "interface=" SUPPLICANT_INTERFACE ".Interface.Blob";
1540
1541 int supplicant_register(const struct supplicant_callbacks *callbacks)
1542 {
1543         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
1544         if (connection == NULL)
1545                 return -EIO;
1546
1547         if (dbus_connection_add_filter(connection,
1548                                 supplicant_filter, NULL, NULL) == FALSE) {
1549                 dbus_connection_unref(connection);
1550                 connection = NULL;
1551                 return -EIO;
1552         }
1553
1554         callbacks_pointer = callbacks;
1555         eap_methods = 0;
1556
1557         interface_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1558                                                 NULL, remove_interface);
1559
1560         bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1561                                                                 NULL, NULL);
1562
1563         supplicant_dbus_setup(connection);
1564
1565         dbus_bus_add_match(connection, supplicant_rule0, NULL);
1566         dbus_bus_add_match(connection, supplicant_rule1, NULL);
1567         dbus_bus_add_match(connection, supplicant_rule2, NULL);
1568         dbus_bus_add_match(connection, supplicant_rule3, NULL);
1569         dbus_bus_add_match(connection, supplicant_rule4, NULL);
1570         dbus_bus_add_match(connection, supplicant_rule5, NULL);
1571         dbus_bus_add_match(connection, supplicant_rule6, NULL);
1572         dbus_connection_flush(connection);
1573
1574         if (dbus_bus_name_has_owner(connection,
1575                                         SUPPLICANT_SERVICE, NULL) == TRUE) {
1576                 system_available = TRUE;
1577                 supplicant_bootstrap();
1578         }
1579
1580         return 0;
1581 }
1582
1583 void supplicant_unregister(const struct supplicant_callbacks *callbacks)
1584 {
1585         if (connection != NULL) {
1586                 dbus_bus_remove_match(connection, supplicant_rule6, NULL);
1587                 dbus_bus_remove_match(connection, supplicant_rule5, NULL);
1588                 dbus_bus_remove_match(connection, supplicant_rule4, NULL);
1589                 dbus_bus_remove_match(connection, supplicant_rule3, NULL);
1590                 dbus_bus_remove_match(connection, supplicant_rule2, NULL);
1591                 dbus_bus_remove_match(connection, supplicant_rule1, NULL);
1592                 dbus_bus_remove_match(connection, supplicant_rule0, NULL);
1593                 dbus_connection_flush(connection);
1594
1595                 dbus_connection_remove_filter(connection,
1596                                                 supplicant_filter, NULL);
1597         }
1598
1599         if (bss_mapping != NULL) {
1600                 g_hash_table_destroy(bss_mapping);
1601                 bss_mapping = NULL;
1602         }
1603
1604         if (interface_table != NULL) {
1605                 g_hash_table_destroy(interface_table);
1606                 interface_table = NULL;
1607         }
1608
1609         if (system_available == TRUE)
1610                 callback_system_killed();
1611
1612         if (connection != NULL) {
1613                 dbus_connection_unref(connection);
1614                 connection = NULL;
1615         }
1616
1617         callbacks_pointer = NULL;
1618         eap_methods = 0;
1619 }
1620
1621 static void debug_level_result(const char *error,
1622                                 DBusMessageIter *iter, void *user_data)
1623 {
1624         if (error != NULL)
1625                 DBG("debug level failure: %s", error);
1626 }
1627
1628 static void debug_level_params(DBusMessageIter *iter, void *user_data)
1629 {
1630         guint level = GPOINTER_TO_UINT(user_data);
1631         const char *str;
1632
1633         if (level > 4)
1634                 level = 4;
1635
1636         str = debug_strings[level];
1637
1638         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &str);
1639 }
1640
1641 void supplicant_set_debug_level(unsigned int level)
1642 {
1643         if (system_available == FALSE)
1644                 return;
1645
1646         supplicant_dbus_property_set(SUPPLICANT_PATH, SUPPLICANT_INTERFACE,
1647                                 "DebugLevel", DBUS_TYPE_STRING_AS_STRING,
1648                                 debug_level_params, debug_level_result,
1649                                                 GUINT_TO_POINTER(level));
1650 }
1651
1652 struct interface_create_data {
1653         const char *ifname;
1654         const char *driver;
1655         struct supplicant_interface *interface;
1656         supplicant_interface_create_callback callback;
1657         void *user_data;
1658 };
1659
1660 static void interface_create_property(const char *key, DBusMessageIter *iter,
1661                                                         void *user_data)
1662 {
1663         struct interface_create_data *data = user_data;
1664         struct supplicant_interface *interface = data->interface;
1665
1666         if (key == NULL) {
1667                 if (data->callback != NULL)
1668                         data->callback(0, data->interface, data->user_data);
1669
1670                 dbus_free(data);
1671         }
1672
1673         interface_property(key, iter, interface);
1674 }
1675
1676 static void interface_create_result(const char *error,
1677                                 DBusMessageIter *iter, void *user_data)
1678 {
1679         struct interface_create_data *data = user_data;
1680         const char *path = NULL;
1681         int err;
1682
1683         if (error != NULL) {
1684                 err = -EIO;
1685                 goto done;
1686         }
1687
1688         dbus_message_iter_get_basic(iter, &path);
1689         if (path == NULL) {
1690                 err = -EINVAL;
1691                 goto done;
1692         }
1693
1694         if (system_available == FALSE) {
1695                 err = -EFAULT;
1696                 goto done;
1697         }
1698
1699         data->interface = g_hash_table_lookup(interface_table, path);
1700         if (data->interface == NULL) {
1701                 data->interface = interface_alloc(path);
1702                 if (data->interface == NULL) {
1703                         err = -ENOMEM;
1704                         goto done;
1705                 }
1706         }
1707
1708         err = supplicant_dbus_property_get_all(path,
1709                                         SUPPLICANT_INTERFACE ".Interface",
1710                                         interface_create_property, data);
1711         if (err == 0)
1712                 return;
1713
1714 done:
1715         if (data->callback != NULL)
1716                 data->callback(err, NULL, data->user_data);
1717
1718         dbus_free(data);
1719 }
1720
1721 static void interface_create_params(DBusMessageIter *iter, void *user_data)
1722 {
1723         struct interface_create_data *data = user_data;
1724         DBusMessageIter dict;
1725
1726         supplicant_dbus_dict_open(iter, &dict);
1727
1728         supplicant_dbus_dict_append_basic(&dict, "Ifname",
1729                                         DBUS_TYPE_STRING, &data->ifname);
1730
1731         if (data->driver != NULL)
1732                 supplicant_dbus_dict_append_basic(&dict, "Driver",
1733                                         DBUS_TYPE_STRING, &data->driver);
1734
1735         supplicant_dbus_dict_close(iter, &dict);
1736 }
1737
1738 static void interface_get_result(const char *error,
1739                                 DBusMessageIter *iter, void *user_data)
1740 {
1741         struct interface_create_data *data = user_data;
1742         struct supplicant_interface *interface;
1743         const char *path = NULL;
1744         int err;
1745
1746         if (error != NULL)
1747                 goto create;
1748
1749         dbus_message_iter_get_basic(iter, &path);
1750         if (path == NULL) {
1751                 err = -EINVAL;
1752                 goto done;
1753         }
1754
1755         interface = g_hash_table_lookup(interface_table, path);
1756         if (interface == NULL) {
1757                 err = -ENOENT;
1758                 goto done;
1759         }
1760
1761         if (data->callback != NULL)
1762                 data->callback(0, interface, data->user_data);
1763
1764         dbus_free(data);
1765
1766         return;
1767
1768 create:
1769         if (system_available == FALSE) {
1770                 err = -EFAULT;
1771                 goto done;
1772         }
1773
1774         err = supplicant_dbus_method_call(SUPPLICANT_PATH,
1775                                                 SUPPLICANT_INTERFACE,
1776                                                 "CreateInterface",
1777                                                 interface_create_params,
1778                                                 interface_create_result, data);
1779         if (err == 0)
1780                 return;
1781
1782 done:
1783         if (data->callback != NULL)
1784                 data->callback(err, NULL, data->user_data);
1785
1786         dbus_free(data);
1787 }
1788
1789 static void interface_get_params(DBusMessageIter *iter, void *user_data)
1790 {
1791         struct interface_create_data *data = user_data;
1792
1793         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &data->ifname);
1794 }
1795
1796 int supplicant_interface_create(const char *ifname, const char *driver,
1797                         supplicant_interface_create_callback callback,
1798                                                         void *user_data)
1799 {
1800         struct interface_create_data *data;
1801
1802         if (ifname == NULL)
1803                 return -EINVAL;
1804
1805         if (system_available == FALSE)
1806                 return -EFAULT;
1807
1808         data = dbus_malloc0(sizeof(*data));
1809         if (data == NULL)
1810                 return -ENOMEM;
1811
1812         data->ifname = ifname;
1813         data->driver = driver;
1814         data->callback = callback;
1815         data->user_data = user_data;
1816
1817         return supplicant_dbus_method_call(SUPPLICANT_PATH,
1818                                                 SUPPLICANT_INTERFACE,
1819                                                 "GetInterface",
1820                                                 interface_get_params,
1821                                                 interface_get_result, data);
1822 }
1823
1824 int supplicant_interface_remove(struct supplicant_interface *interface,
1825                         supplicant_interface_remove_callback callback,
1826                                                         void *user_data)
1827 {
1828         if (interface == NULL)
1829                 return -EINVAL;
1830
1831         if (system_available == FALSE)
1832                 return -EFAULT;
1833
1834         return 0;
1835 }
1836
1837 struct interface_scan_data {
1838         struct supplicant_interface *interface;
1839         supplicant_interface_scan_callback callback;
1840         void *user_data;
1841 };
1842
1843 static void interface_scan_result(const char *error,
1844                                 DBusMessageIter *iter, void *user_data)
1845 {
1846         struct interface_scan_data *data = user_data;
1847
1848         if (error != NULL) {
1849                 if (data->callback != NULL)
1850                         data->callback(-EIO, data->user_data);
1851         } else {
1852                 data->interface->scan_callback = data->callback;
1853                 data->interface->scan_data = data->user_data;
1854         }
1855
1856         dbus_free(data);
1857 }
1858
1859 static void interface_scan_params(DBusMessageIter *iter, void *user_data)
1860 {
1861         DBusMessageIter dict;
1862         const char *type = "passive";
1863
1864         supplicant_dbus_dict_open(iter, &dict);
1865
1866         supplicant_dbus_dict_append_basic(&dict, "Type",
1867                                                 DBUS_TYPE_STRING, &type);
1868
1869         supplicant_dbus_dict_close(iter, &dict);
1870 }
1871
1872 int supplicant_interface_scan(struct supplicant_interface *interface,
1873                         supplicant_interface_scan_callback callback,
1874                                                         void *user_data)
1875 {
1876         struct interface_scan_data *data;
1877
1878         if (interface == NULL)
1879                 return -EINVAL;
1880
1881         if (system_available == FALSE)
1882                 return -EFAULT;
1883
1884         if (interface->scanning == TRUE)
1885                 return -EALREADY;
1886
1887         data = dbus_malloc0(sizeof(*data));
1888         if (data == NULL)
1889                 return -ENOMEM;
1890
1891         data->interface = interface;
1892         data->callback = callback;
1893         data->user_data = user_data;
1894
1895         return supplicant_dbus_method_call(interface->path,
1896                         SUPPLICANT_INTERFACE ".Interface", "Scan",
1897                         interface_scan_params, interface_scan_result, data);
1898 }
1899
1900 struct interface_disconnect_data {
1901         supplicant_interface_disconnect_callback callback;
1902         void *user_data;
1903 };
1904
1905 static void interface_disconnect_result(const char *error,
1906                                 DBusMessageIter *iter, void *user_data)
1907 {
1908         struct interface_disconnect_data *data = user_data;
1909         int result = 0;
1910
1911         if (error != NULL)
1912                 result = -EIO;
1913
1914         if (data->callback != NULL)
1915                 data->callback(result, data->user_data);
1916
1917         dbus_free(data);
1918 }
1919
1920 int supplicant_interface_disconnect(struct supplicant_interface *interface,
1921                         supplicant_interface_disconnect_callback callback,
1922                                                         void *user_data)
1923 {
1924         struct interface_disconnect_data *data;
1925
1926         if (interface == NULL)
1927                 return -EINVAL;
1928
1929         if (system_available == FALSE)
1930                 return -EFAULT;
1931
1932         data = dbus_malloc0(sizeof(*data));
1933         if (data == NULL)
1934                 return -ENOMEM;
1935
1936         data->callback = callback;
1937         data->user_data = user_data;
1938
1939         return supplicant_dbus_method_call(interface->path,
1940                         SUPPLICANT_INTERFACE ".Interface", "Disconnect",
1941                                 NULL, interface_disconnect_result, data);
1942 }