gsupplicant/supplicant.c

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