gsupplicant/supplicant.c

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