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