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