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