gsupplicant/supplicant.c

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