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 GSupplicantInterface *g_supplicant_network_get_interface(
 770                                         GSupplicantNetwork *network)
 771 {
 772         if (network == NULL)
 773                 return NULL;
 774
 775         return network->interface;
 776 }
 777
 778 const char *g_supplicant_network_get_name(GSupplicantNetwork *network)
 779 {
 780         if (network == NULL || network->name == NULL)
 781                 return "";
 782
 783         return network->name;
 784 }
 785
 786 const char *g_supplicant_network_get_identifier(GSupplicantNetwork *network)
 787 {
 788         if (network == NULL || network->group == NULL)
 789                 return "";
 790
 791         return network->group;
 792 }
 793
 794 const char *g_supplicant_network_get_path(GSupplicantNetwork *network)
 795 {
 796         if (network == NULL || network->path == NULL)
 797                 return NULL;
 798
 799         return network->path;
 800 }
 801
 802 const char *g_supplicant_network_get_mode(GSupplicantNetwork *network)
 803 {
 804         if (network == NULL)
 805                 return G_SUPPLICANT_MODE_UNKNOWN;
 806
 807         return mode2string(network->mode);
 808 }
 809
 810 const char *g_supplicant_network_get_security(GSupplicantNetwork *network)
 811 {
 812         if (network == NULL)
 813                 return G_SUPPLICANT_SECURITY_UNKNOWN;
 814
 815         return security2string(network->security);
 816 }
 817
 818 const void *g_supplicant_network_get_ssid(GSupplicantNetwork *network,
 819                                                 unsigned int *ssid_len)
 820 {
 821         if (network == NULL || network->ssid == NULL) {
 822                 *ssid_len = 0;
 823                 return NULL;
 824         }
 825
 826         *ssid_len = network->ssid_len;
 827         return network->ssid;
 828 }
 829
 830 dbus_int16_t g_supplicant_network_get_signal(GSupplicantNetwork *network)
 831 {
 832         if (network == NULL)
 833                 return 0;
 834
 835         return network->signal;
 836 }
 837
 838 dbus_uint16_t g_supplicant_network_get_frequency(GSupplicantNetwork *network)
 839 {
 840         if (network == NULL)
 841                 return 0;
 842
 843         return network->frequency;
 844 }
 845
 846 dbus_bool_t g_supplicant_network_get_wps(GSupplicantNetwork *network)
 847 {
 848         if (network == NULL)
 849                 return FALSE;
 850
 851         return network->wps;
 852 }
 853
 854 static void merge_network(GSupplicantNetwork *network)
 855 {
 856         GString *str;
 857         const char *ssid, *mode, *key_mgmt;
 858         unsigned int i, ssid_len;
 859         char *group;
 860
 861         ssid = g_hash_table_lookup(network->config_table, "ssid");
 862         mode = g_hash_table_lookup(network->config_table, "mode");
 863         key_mgmt = g_hash_table_lookup(network->config_table, "key_mgmt");
 864
 865         SUPPLICANT_DBG("ssid %s mode %s", ssid, mode);
 866
 867         if (ssid != NULL)
 868                 ssid_len = strlen(ssid);
 869         else
 870                 ssid_len = 0;
 871
 872         str = g_string_sized_new((ssid_len * 2) + 24);
 873         if (str == NULL)
 874                 return;
 875
 876         for (i = 0; i < ssid_len; i++)
 877                 g_string_append_printf(str, "%02x", ssid[i]);
 878
 879         if (g_strcmp0(mode, "0") == 0)
 880                 g_string_append_printf(str, "_managed");
 881         else if (g_strcmp0(mode, "1") == 0)
 882                 g_string_append_printf(str, "_adhoc");
 883
 884         if (g_strcmp0(key_mgmt, "WPA-PSK") == 0)
 885                 g_string_append_printf(str, "_psk");
 886
 887         group = g_string_free(str, FALSE);
 888
 889         SUPPLICANT_DBG("%s", group);
 890
 891         g_free(group);
 892
 893         g_hash_table_destroy(network->config_table);
 894
 895         g_free(network->path);
 896         g_free(network);
 897 }
 898
 899 static void network_property(const char *key, DBusMessageIter *iter,
 900                                                         void *user_data)
 901 {
 902         GSupplicantNetwork *network = user_data;
 903
 904         if (network->interface == NULL)
 905                 return;
 906
 907         if (key == NULL) {
 908                 merge_network(network);
 909                 return;
 910         }
 911
 912         if (g_strcmp0(key, "Enabled") == 0) {
 913                 dbus_bool_t enabled = FALSE;
 914
 915                 dbus_message_iter_get_basic(iter, &enabled);
 916         } else if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
 917                 const char *str = NULL;
 918
 919                 dbus_message_iter_get_basic(iter, &str);
 920                 if (str != NULL) {
 921                         g_hash_table_replace(network->config_table,
 922                                                 g_strdup(key), g_strdup(str));
 923                 }
 924         } else
 925                 SUPPLICANT_DBG("key %s type %c",
 926                                 key, dbus_message_iter_get_arg_type(iter));
 927 }
 928
 929 static void interface_network_added(DBusMessageIter *iter, void *user_data)
 930 {
 931         GSupplicantInterface *interface = user_data;
 932         GSupplicantNetwork *network;
 933         const char *path = NULL;
 934
 935         SUPPLICANT_DBG("");
 936
 937         dbus_message_iter_get_basic(iter, &path);
 938         if (path == NULL)
 939                 return;
 940
 941         if (g_strcmp0(path, "/") == 0)
 942                 return;
 943
 944         network = g_hash_table_lookup(interface->net_mapping, path);
 945         if (network != NULL)
 946                 return;
 947
 948         network = g_try_new0(GSupplicantNetwork, 1);
 949         if (network == NULL)
 950                 return;
 951
 952         network->interface = interface;
 953         network->path = g_strdup(path);
 954
 955         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
 956                                                         g_free, g_free);
 957
 958         dbus_message_iter_next(iter);
 959         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
 960                 supplicant_dbus_property_foreach(iter, network_property,
 961                                                                 network);
 962                 network_property(NULL, NULL, network);
 963                 return;
 964         }
 965
 966         supplicant_dbus_property_get_all(path,
 967                                 SUPPLICANT_INTERFACE ".Network",
 968                                                 network_property, network);
 969 }
 970
 971 static void interface_network_removed(DBusMessageIter *iter, void *user_data)
 972 {
 973         GSupplicantInterface *interface = user_data;
 974         GSupplicantNetwork *network;
 975         const char *path = NULL;
 976
 977         dbus_message_iter_get_basic(iter, &path);
 978         if (path == NULL)
 979                 return;
 980
 981         network = g_hash_table_lookup(interface->net_mapping, path);
 982         if (network == NULL)
 983                 return;
 984
 985         g_hash_table_remove(interface->net_mapping, path);
 986 }
 987
 988 static char *create_name(unsigned char *ssid, int ssid_len)
 989 {
 990         char *name;
 991         int i;
 992
 993         if (ssid_len < 1 || ssid[0] == '\0')
 994                 name = NULL;
 995         else
 996                 name = g_try_malloc0(ssid_len + 1);
 997
 998         if (name == NULL)
 999                 return g_strdup("");
1000
1001         for (i = 0; i < ssid_len; i++) {
1002                 if (g_ascii_isprint(ssid[i]))
1003                         name[i] = ssid[i];
1004                 else
1005                         name[i] = ' ';
1006         }
1007
1008         return name;
1009 }
1010
1011 static char *create_group(struct g_supplicant_bss *bss)
1012 {
1013         GString *str;
1014         unsigned int i;
1015         const char *mode, *security;
1016
1017         str = g_string_sized_new((bss->ssid_len * 2) + 24);
1018         if (str == NULL)
1019                 return NULL;
1020
1021         if (bss->ssid_len > 0 && bss->ssid[0] != '\0') {
1022                 for (i = 0; i < bss->ssid_len; i++)
1023                         g_string_append_printf(str, "%02x", bss->ssid[i]);
1024         } else
1025                 g_string_append_printf(str, "hidden");
1026
1027         mode = mode2string(bss->mode);
1028         if (mode != NULL)
1029                 g_string_append_printf(str, "_%s", mode);
1030
1031         security = security2string(bss->security);
1032         if (security != NULL)
1033                 g_string_append_printf(str, "_%s", security);
1034
1035         return g_string_free(str, FALSE);
1036 }
1037
1038 static void add_bss_to_network(struct g_supplicant_bss *bss)
1039 {
1040         GSupplicantInterface *interface = bss->interface;
1041         GSupplicantNetwork *network;
1042         char *group;
1043
1044         group = create_group(bss);
1045         if (group == NULL)
1046                 return;
1047
1048         network = g_hash_table_lookup(interface->network_table, group);
1049         if (network != NULL) {
1050                 g_free(group);
1051                 goto done;
1052         }
1053
1054         network = g_try_new0(GSupplicantNetwork, 1);
1055         if (network == NULL) {
1056                 g_free(group);
1057                 return;
1058         }
1059
1060         network->interface = interface;
1061         if (network->path == NULL)
1062                 network->path = g_strdup(bss->path);
1063         network->group = group;
1064         network->name = create_name(bss->ssid, bss->ssid_len);
1065         network->mode = bss->mode;
1066         network->security = bss->security;
1067         network->ssid_len = bss->ssid_len;
1068         memcpy(network->ssid, bss->ssid, bss->ssid_len);
1069         network->signal = bss->signal;
1070         network->frequency = bss->frequency;
1071         network->best_bss = bss;
1072
1073         network->wps = FALSE;
1074         if ((bss->keymgmt & G_SUPPLICANT_KEYMGMT_WPS) != 0)
1075                 network->wps = TRUE;
1076
1077         network->bss_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1078                                                         NULL, remove_bss);
1079
1080         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1081                                                         g_free, g_free);
1082
1083         g_hash_table_replace(interface->network_table,
1084                                                 network->group, network);
1085
1086         callback_network_added(network);
1087
1088 done:
1089         if (bss->signal > network->signal) {
1090                 network->signal = bss->signal;
1091                 network->best_bss = bss;
1092                 callback_network_changed(network, "Signal");
1093         }
1094
1095         g_hash_table_replace(interface->bss_mapping, bss->path, network);
1096         g_hash_table_replace(network->bss_table, bss->path, bss);
1097
1098         g_hash_table_replace(bss_mapping, bss->path, interface);
1099 }
1100
1101 static void bss_rates(DBusMessageIter *iter, void *user_data)
1102 {
1103         struct g_supplicant_bss *bss = user_data;
1104         dbus_uint32_t rate = 0;
1105
1106         dbus_message_iter_get_basic(iter, &rate);
1107         if (rate == 0)
1108                 return;
1109
1110         if (rate > bss->maxrate)
1111                 bss->maxrate = rate;
1112 }
1113
1114 static void bss_keymgmt(DBusMessageIter *iter, void *user_data)
1115 {
1116         struct g_supplicant_bss *bss = user_data;
1117         const char *str = NULL;
1118         int i;
1119
1120         dbus_message_iter_get_basic(iter, &str);
1121         if (str == NULL)
1122                 return;
1123
1124         for (i = 0; keymgmt_map[i].str != NULL; i++)
1125                 if (strcmp(str, keymgmt_map[i].str) == 0) {
1126                         bss->keymgmt |= keymgmt_map[i].val;
1127                         break;
1128                 }
1129 }
1130
1131 static void bss_group(DBusMessageIter *iter, void *user_data)
1132 {
1133         struct g_supplicant_bss *bss = user_data;
1134         const char *str = NULL;
1135         int i;
1136
1137         dbus_message_iter_get_basic(iter, &str);
1138         if (str == NULL)
1139                 return;
1140
1141         for (i = 0; group_map[i].str != NULL; i++)
1142                 if (strcmp(str, group_map[i].str) == 0) {
1143                         bss->group |= group_map[i].val;
1144                         break;
1145                 }
1146 }
1147
1148 static void bss_pairwise(DBusMessageIter *iter, void *user_data)
1149 {
1150         struct g_supplicant_bss *bss = user_data;
1151         const char *str = NULL;
1152         int i;
1153
1154         dbus_message_iter_get_basic(iter, &str);
1155         if (str == NULL)
1156                 return;
1157
1158         for (i = 0; pairwise_map[i].str != NULL; i++)
1159                 if (strcmp(str, pairwise_map[i].str) == 0) {
1160                         bss->pairwise |= pairwise_map[i].val;
1161                         break;
1162                 }
1163 }
1164
1165 static void bss_wpa(const char *key, DBusMessageIter *iter,
1166                         void *user_data)
1167 {
1168         if (g_strcmp0(key, "KeyMgmt") == 0)
1169                 supplicant_dbus_array_foreach(iter, bss_keymgmt, user_data);
1170         else if (g_strcmp0(key, "Group") == 0)
1171                 supplicant_dbus_array_foreach(iter, bss_group, user_data);
1172         else if (g_strcmp0(key, "Pairwise") == 0)
1173                 supplicant_dbus_array_foreach(iter, bss_pairwise, user_data);
1174
1175 }
1176
1177 static unsigned int get_tlv(unsigned char *ie, unsigned int ie_size,
1178                                                         unsigned int type)
1179 {
1180         unsigned int len = 0;
1181
1182         while (len + 4 < ie_size) {
1183                 unsigned int hi = ie[len];
1184                 unsigned int lo = ie[len + 1];
1185                 unsigned int tmp_type = (hi << 8) + lo;
1186                 unsigned int v_len = 0;
1187
1188                 /* hi and lo are used to recreate an unsigned int
1189                  * based on 2 8bits length unsigned int. */
1190
1191                 hi = ie[len + 2];
1192                 lo = ie[len + 3];
1193                 v_len = (hi << 8) + lo;
1194
1195                 if (tmp_type == type) {
1196                         unsigned int ret_value = 0;
1197                         unsigned char *value = (unsigned char *)&ret_value;
1198
1199                         SUPPLICANT_DBG("IE: match type 0x%x", type);
1200
1201                         /* Verifying length relevance */
1202                         if (v_len > sizeof(unsigned int) ||
1203                                 len + 4 + v_len > ie_size)
1204                                 break;
1205
1206                         memcpy(value, ie + len + 4, v_len);
1207
1208                         SUPPLICANT_DBG("returning 0x%x", ret_value);
1209                         return ret_value;
1210                 }
1211
1212                 len += v_len + 4;
1213         }
1214
1215         SUPPLICANT_DBG("returning 0");
1216         return 0;
1217 }
1218
1219 static void bss_process_ies(DBusMessageIter *iter, void *user_data)
1220 {
1221         struct g_supplicant_bss *bss = user_data;
1222         const unsigned char WPS_OUI[] = { 0x00, 0x50, 0xf2, 0x04 };
1223         unsigned char *ie, *ie_end;
1224         DBusMessageIter array;
1225         int ie_len;
1226
1227 #define WMM_WPA1_WPS_INFO 221
1228 #define WPS_INFO_MIN_LEN  6
1229 #define WPS_VERSION_TLV   0x104A
1230 #define WPS_STATE_TLV     0x1044
1231 #define WPS_VERSION       0x10
1232
1233         dbus_message_iter_recurse(iter, &array);
1234         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1235
1236         if (ie == NULL || ie_len < 2)
1237                 return;
1238
1239         for (ie_end = ie + ie_len; ie < ie_end && ie + ie[1] + 1 <= ie_end;
1240                                                         ie += ie[1] + 2) {
1241
1242                 if (ie[0] != WMM_WPA1_WPS_INFO || ie[1] < WPS_INFO_MIN_LEN ||
1243                         memcmp(ie+2, WPS_OUI, sizeof(WPS_OUI)) != 0)
1244                         continue;
1245
1246                 SUPPLICANT_DBG("IE: match WPS_OUI");
1247
1248                 if (get_tlv(&ie[6], ie[1],
1249                                 WPS_VERSION_TLV) == WPS_VERSION &&
1250                         get_tlv(&ie[6], ie[1],
1251                                 WPS_STATE_TLV) != 0)
1252                         bss->keymgmt |= G_SUPPLICANT_KEYMGMT_WPS;
1253         }
1254 }
1255
1256 static void bss_property(const char *key, DBusMessageIter *iter,
1257                                                         void *user_data)
1258 {
1259         struct g_supplicant_bss *bss = user_data;
1260
1261         if (bss->interface == NULL)
1262                 return;
1263
1264         SUPPLICANT_DBG("key %s", key);
1265
1266         if (key == NULL) {
1267                 if (bss->ieee8021x == TRUE)
1268                         bss->security = G_SUPPLICANT_SECURITY_IEEE8021X;
1269                 else if (bss->psk == TRUE)
1270                         bss->security = G_SUPPLICANT_SECURITY_PSK;
1271                 else if (bss->privacy == TRUE)
1272                         bss->security = G_SUPPLICANT_SECURITY_WEP;
1273                 else
1274                         bss->security = G_SUPPLICANT_SECURITY_NONE;
1275
1276                 add_bss_to_network(bss);
1277                 return;
1278         }
1279
1280         if (g_strcmp0(key, "BSSID") == 0) {
1281                 DBusMessageIter array;
1282                 unsigned char *addr;
1283                 int addr_len;
1284
1285                 dbus_message_iter_recurse(iter, &array);
1286                 dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
1287
1288                 if (addr_len == 6)
1289                         memcpy(bss->bssid, addr, addr_len);
1290         } else if (g_strcmp0(key, "SSID") == 0) {
1291                 DBusMessageIter array;
1292                 unsigned char *ssid;
1293                 int ssid_len;
1294
1295                 dbus_message_iter_recurse(iter, &array);
1296                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
1297
1298                 if (ssid_len > 0 && ssid_len < 33) {
1299                         memcpy(bss->ssid, ssid, ssid_len);
1300                         bss->ssid_len = ssid_len;
1301                 } else {
1302                         memset(bss->ssid, 0, sizeof(bss->ssid));
1303                         bss->ssid_len = 0;
1304                 }
1305         } else if (g_strcmp0(key, "Capabilities") == 0) {
1306                 dbus_uint16_t capabilities = 0x0000;
1307
1308                 dbus_message_iter_get_basic(iter, &capabilities);
1309
1310                 if (capabilities & IEEE80211_CAP_ESS)
1311                         bss->mode = G_SUPPLICANT_MODE_INFRA;
1312                 else if (capabilities & IEEE80211_CAP_IBSS)
1313                         bss->mode = G_SUPPLICANT_MODE_IBSS;
1314
1315                 if (capabilities & IEEE80211_CAP_PRIVACY)
1316                         bss->privacy = TRUE;
1317         } else if (g_strcmp0(key, "Mode") == 0) {
1318                 const char *mode = NULL;
1319
1320                 dbus_message_iter_get_basic(iter, &mode);
1321                 bss->mode = string2mode(mode);
1322         } else if (g_strcmp0(key, "Frequency") == 0) {
1323                 dbus_uint16_t frequency = 0;
1324
1325                 dbus_message_iter_get_basic(iter, &frequency);
1326                 bss->frequency = frequency;
1327         } else if (g_strcmp0(key, "Signal") == 0) {
1328                 dbus_int16_t signal = 0;
1329
1330                 dbus_message_iter_get_basic(iter, &signal);
1331
1332                 bss->signal = signal;
1333         } else if (g_strcmp0(key, "Level") == 0) {
1334                 dbus_int32_t level = 0;
1335
1336                 dbus_message_iter_get_basic(iter, &level);
1337         } else if (g_strcmp0(key, "Rates") == 0) {
1338                 supplicant_dbus_array_foreach(iter, bss_rates, bss);
1339         } else if (g_strcmp0(key, "MaxRate") == 0) {
1340                 dbus_uint32_t maxrate = 0;
1341
1342                 dbus_message_iter_get_basic(iter, &maxrate);
1343                 if (maxrate != 0)
1344                         bss->maxrate = maxrate;
1345         } else if (g_strcmp0(key, "Privacy") == 0) {
1346                 dbus_bool_t privacy = FALSE;
1347
1348                 dbus_message_iter_get_basic(iter, &privacy);
1349                 bss->privacy = privacy;
1350         } else if ((g_strcmp0(key, "RSN") == 0) ||
1351                         (g_strcmp0(key, "WPA") == 0)) {
1352                 supplicant_dbus_property_foreach(iter, bss_wpa, bss);
1353
1354                 if (bss->keymgmt &
1355                         (G_SUPPLICANT_KEYMGMT_WPA_EAP |
1356                                 G_SUPPLICANT_KEYMGMT_WPA_FT_EAP |
1357                                 G_SUPPLICANT_KEYMGMT_WPA_EAP_256))
1358                         bss->ieee8021x = TRUE;
1359
1360                 if (bss->keymgmt &
1361                         (G_SUPPLICANT_KEYMGMT_WPA_PSK |
1362                                 G_SUPPLICANT_KEYMGMT_WPA_FT_PSK |
1363                                 G_SUPPLICANT_KEYMGMT_WPA_PSK_256))
1364                         bss->psk = TRUE;
1365         } else if (g_strcmp0(key, "IEs") == 0)
1366                 bss_process_ies(iter, bss);
1367         else
1368                 SUPPLICANT_DBG("key %s type %c",
1369                                 key, dbus_message_iter_get_arg_type(iter));
1370 }
1371
1372 static struct g_supplicant_bss *interface_bss_added(DBusMessageIter *iter,
1373                                                         void *user_data)
1374 {
1375         GSupplicantInterface *interface = user_data;
1376         GSupplicantNetwork *network;
1377         struct g_supplicant_bss *bss;
1378         const char *path = NULL;
1379
1380         SUPPLICANT_DBG("");
1381
1382         dbus_message_iter_get_basic(iter, &path);
1383         if (path == NULL)
1384                 return NULL;
1385
1386         if (g_strcmp0(path, "/") == 0)
1387                 return NULL;
1388
1389         SUPPLICANT_DBG("%s", path);
1390
1391         network = g_hash_table_lookup(interface->bss_mapping, path);
1392         if (network != NULL) {
1393                 bss = g_hash_table_lookup(network->bss_table, path);
1394                 if (bss != NULL)
1395                         return NULL;
1396         }
1397
1398         bss = g_try_new0(struct g_supplicant_bss, 1);
1399         if (bss == NULL)
1400                 return NULL;
1401
1402         bss->interface = interface;
1403         bss->path = g_strdup(path);
1404
1405         return bss;
1406 }
1407
1408 static void interface_bss_added_with_keys(DBusMessageIter *iter,
1409                                                 void *user_data)
1410 {
1411         struct g_supplicant_bss *bss;
1412
1413         SUPPLICANT_DBG("");
1414
1415         bss = interface_bss_added(iter, user_data);
1416         if (bss == NULL)
1417                 return;
1418
1419         dbus_message_iter_next(iter);
1420
1421         if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_INVALID)
1422                 return;
1423
1424         supplicant_dbus_property_foreach(iter, bss_property, bss);
1425         bss_property(NULL, NULL, bss);
1426 }
1427
1428 static void interface_bss_added_without_keys(DBusMessageIter *iter,
1429                                                 void *user_data)
1430 {
1431         struct g_supplicant_bss *bss;
1432
1433         SUPPLICANT_DBG("");
1434
1435         bss = interface_bss_added(iter, user_data);
1436         if (bss == NULL)
1437                 return;
1438
1439         supplicant_dbus_property_get_all(bss->path,
1440                                         SUPPLICANT_INTERFACE ".BSS",
1441                                                         bss_property, bss);
1442 }
1443
1444 static void update_signal(gpointer key, gpointer value,
1445                                                 gpointer user_data)
1446 {
1447         struct g_supplicant_bss *bss = value;
1448         GSupplicantNetwork *network = user_data;
1449
1450         if (bss->signal > network->signal) {
1451                 network->signal = bss->signal;
1452                 network->best_bss = bss;
1453         }
1454 }
1455
1456 static void update_network_signal(GSupplicantNetwork *network)
1457 {
1458         if (g_hash_table_size(network->bss_table) <= 1)
1459                 return;
1460
1461         g_hash_table_foreach(network->bss_table,
1462                                 update_signal, network);
1463
1464         SUPPLICANT_DBG("New network signal %d", network->signal);
1465 }
1466
1467 static void interface_bss_removed(DBusMessageIter *iter, void *user_data)
1468 {
1469         GSupplicantInterface *interface = user_data;
1470         GSupplicantNetwork *network;
1471         const char *path = NULL;
1472
1473         dbus_message_iter_get_basic(iter, &path);
1474         if (path == NULL)
1475                 return;
1476
1477         network = g_hash_table_lookup(interface->bss_mapping, path);
1478         if (network == NULL)
1479                 return;
1480
1481         g_hash_table_remove(bss_mapping, path);
1482
1483         g_hash_table_remove(interface->bss_mapping, path);
1484         g_hash_table_remove(network->bss_table, path);
1485
1486         update_network_signal(network);
1487
1488         if (g_hash_table_size(network->bss_table) == 0)
1489                 g_hash_table_remove(interface->network_table, network->group);
1490 }
1491
1492 static void interface_property(const char *key, DBusMessageIter *iter,
1493                                                         void *user_data)
1494 {
1495         GSupplicantInterface *interface = user_data;
1496
1497         if (interface == NULL)
1498                 return;
1499
1500         SUPPLICANT_DBG("%s", key);
1501
1502         if (key == NULL) {
1503                 debug_strvalmap("KeyMgmt capability", keymgmt_map,
1504                                                 interface->keymgmt_capa);
1505                 debug_strvalmap("AuthAlg capability", authalg_capa_map,
1506                                                 interface->authalg_capa);
1507                 debug_strvalmap("Protocol capability", proto_capa_map,
1508                                                 interface->proto_capa);
1509                 debug_strvalmap("Pairwise capability", pairwise_map,
1510                                                 interface->pairwise_capa);
1511                 debug_strvalmap("Group capability", group_map,
1512                                                 interface->group_capa);
1513                 debug_strvalmap("Scan capability", scan_capa_map,
1514                                                 interface->scan_capa);
1515                 debug_strvalmap("Mode capability", mode_capa_map,
1516                                                 interface->mode_capa);
1517
1518                 interface->ready = TRUE;
1519                 callback_interface_added(interface);
1520                 return;
1521         }
1522
1523         if (g_strcmp0(key, "Capabilities") == 0) {
1524                 supplicant_dbus_property_foreach(iter, interface_capability,
1525                                                                 interface);
1526         } else if (g_strcmp0(key, "State") == 0) {
1527                 const char *str = NULL;
1528
1529                 dbus_message_iter_get_basic(iter, &str);
1530                 if (str != NULL)
1531                         if (string2state(str) != interface->state) {
1532                                 interface->state = string2state(str);
1533                                 callback_interface_state(interface);
1534                         }
1535
1536                 SUPPLICANT_DBG("state %s (%d)", str, interface->state);
1537         } else if (g_strcmp0(key, "Scanning") == 0) {
1538                 dbus_bool_t scanning = FALSE;
1539
1540                 dbus_message_iter_get_basic(iter, &scanning);
1541                 interface->scanning = scanning;
1542
1543                 if (interface->ready == TRUE) {
1544                         if (interface->scanning == TRUE)
1545                                 callback_scan_started(interface);
1546                         else
1547                                 callback_scan_finished(interface);
1548                 }
1549         } else if (g_strcmp0(key, "ApScan") == 0) {
1550                 int apscan = 1;
1551
1552                 dbus_message_iter_get_basic(iter, &apscan);
1553                 interface->apscan = apscan;
1554         } else if (g_strcmp0(key, "Ifname") == 0) {
1555                 const char *str = NULL;
1556
1557                 dbus_message_iter_get_basic(iter, &str);
1558                 if (str != NULL) {
1559                         g_free(interface->ifname);
1560                         interface->ifname = g_strdup(str);
1561                 }
1562         } else if (g_strcmp0(key, "Driver") == 0) {
1563                 const char *str = NULL;
1564
1565                 dbus_message_iter_get_basic(iter, &str);
1566                 if (str != NULL) {
1567                         g_free(interface->driver);
1568                         interface->driver = g_strdup(str);
1569                 }
1570         } else if (g_strcmp0(key, "BridgeIfname") == 0) {
1571                 const char *str = NULL;
1572
1573                 dbus_message_iter_get_basic(iter, &str);
1574                 if (str != NULL) {
1575                         g_free(interface->bridge);
1576                         interface->bridge = g_strdup(str);
1577                 }
1578         } else if (g_strcmp0(key, "CurrentBSS") == 0) {
1579                 interface_bss_added_without_keys(iter, interface);
1580         } else if (g_strcmp0(key, "CurrentNetwork") == 0) {
1581                 interface_network_added(iter, interface);
1582         } else if (g_strcmp0(key, "BSSs") == 0) {
1583                 supplicant_dbus_array_foreach(iter, interface_bss_added_without_keys,
1584                                                                 interface);
1585         } else if (g_strcmp0(key, "Blobs") == 0) {
1586                 /* Nothing */
1587         } else if (g_strcmp0(key, "Networks") == 0) {
1588                 supplicant_dbus_array_foreach(iter, interface_network_added,
1589                                                                 interface);
1590         } else
1591                 SUPPLICANT_DBG("key %s type %c",
1592                                 key, dbus_message_iter_get_arg_type(iter));
1593 }
1594
1595 static void scan_network_update(DBusMessageIter *iter, void *user_data)
1596 {
1597         GSupplicantInterface *interface = user_data;
1598         GSupplicantNetwork *network;
1599         char *path;
1600
1601         if (iter == NULL)
1602                 return;
1603
1604         dbus_message_iter_get_basic(iter, &path);
1605
1606         if (path == NULL)
1607                 return;
1608
1609         if (g_strcmp0(path, "/") == 0)
1610                 return;
1611
1612         /* Update the network details based on scan BSS data */
1613         network = g_hash_table_lookup(interface->bss_mapping, path);
1614         if (network != NULL)
1615                 callback_network_added(network);
1616 }
1617
1618 static void scan_bss_data(const char *key, DBusMessageIter *iter,
1619                                 void *user_data)
1620 {
1621         GSupplicantInterface *interface = user_data;
1622
1623         if (iter)
1624                 supplicant_dbus_array_foreach(iter, scan_network_update,
1625                                                 interface);
1626
1627         if (interface->scan_callback != NULL)
1628                 interface->scan_callback(0, interface, interface->scan_data);
1629
1630         interface->scan_callback = NULL;
1631         interface->scan_data = NULL;
1632 }
1633
1634 static GSupplicantInterface *interface_alloc(const char *path)
1635 {
1636         GSupplicantInterface *interface;
1637
1638         interface = g_try_new0(GSupplicantInterface, 1);
1639         if (interface == NULL)
1640                 return NULL;
1641
1642         interface->path = g_strdup(path);
1643
1644         interface->network_table = g_hash_table_new_full(g_str_hash,
1645                                         g_str_equal, NULL, remove_network);
1646
1647         interface->net_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1648                                                                 NULL, NULL);
1649         interface->bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1650                                                                 NULL, NULL);
1651
1652         g_hash_table_replace(interface_table, interface->path, interface);
1653
1654         return interface;
1655 }
1656
1657 static void interface_added(DBusMessageIter *iter, void *user_data)
1658 {
1659         GSupplicantInterface *interface;
1660         const char *path = NULL;
1661
1662         SUPPLICANT_DBG("");
1663
1664         dbus_message_iter_get_basic(iter, &path);
1665         if (path == NULL)
1666                 return;
1667
1668         if (g_strcmp0(path, "/") == 0)
1669                 return;
1670
1671         interface = g_hash_table_lookup(interface_table, path);
1672         if (interface != NULL)
1673                 return;
1674
1675         interface = interface_alloc(path);
1676         if (interface == NULL)
1677                 return;
1678
1679         dbus_message_iter_next(iter);
1680         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1681                 supplicant_dbus_property_foreach(iter, interface_property,
1682                                                                 interface);
1683                 interface_property(NULL, NULL, interface);
1684                 return;
1685         }
1686
1687         supplicant_dbus_property_get_all(path,
1688                                         SUPPLICANT_INTERFACE ".Interface",
1689                                                 interface_property, interface);
1690 }
1691
1692 static void interface_removed(DBusMessageIter *iter, void *user_data)
1693 {
1694         const char *path = NULL;
1695
1696         dbus_message_iter_get_basic(iter, &path);
1697         if (path == NULL)
1698                 return;
1699
1700         g_hash_table_remove(interface_table, path);
1701 }
1702
1703 static void eap_method(DBusMessageIter *iter, void *user_data)
1704 {
1705         const char *str = NULL;
1706         int i;
1707
1708         dbus_message_iter_get_basic(iter, &str);
1709         if (str == NULL)
1710                 return;
1711
1712         for (i = 0; eap_method_map[i].str != NULL; i++)
1713                 if (strcmp(str, eap_method_map[i].str) == 0) {
1714                         eap_methods |= eap_method_map[i].val;
1715                         break;
1716                 }
1717 }
1718
1719 static void service_property(const char *key, DBusMessageIter *iter,
1720                                                         void *user_data)
1721 {
1722         if (key == NULL) {
1723                 callback_system_ready();
1724                 return;
1725         }
1726
1727         if (g_strcmp0(key, "DebugLevel") == 0) {
1728                 const char *str = NULL;
1729                 int i;
1730
1731                 dbus_message_iter_get_basic(iter, &str);
1732                 for (i = 0; debug_strings[i] != NULL; i++)
1733                         if (g_strcmp0(debug_strings[i], str) == 0) {
1734                                 debug_level = i;
1735                                 break;
1736                         }
1737                 SUPPLICANT_DBG("Debug level %d", debug_level);
1738         } else if (g_strcmp0(key, "DebugTimestamp") == 0) {
1739                 dbus_message_iter_get_basic(iter, &debug_timestamp);
1740                 SUPPLICANT_DBG("Debug timestamp %u", debug_timestamp);
1741         } else if (g_strcmp0(key, "DebugShowKeys") == 0) {
1742                 dbus_message_iter_get_basic(iter, &debug_showkeys);
1743                 SUPPLICANT_DBG("Debug show keys %u", debug_showkeys);
1744         } else if (g_strcmp0(key, "Interfaces") == 0) {
1745                 supplicant_dbus_array_foreach(iter, interface_added, NULL);
1746         } else if (g_strcmp0(key, "EapMethods") == 0) {
1747                 supplicant_dbus_array_foreach(iter, eap_method, NULL);
1748                 debug_strvalmap("EAP method", eap_method_map, eap_methods);
1749         } else if (g_strcmp0(key, "Country") == 0) {
1750                 const char *country = NULL;
1751
1752                 dbus_message_iter_get_basic(iter, &country);
1753                 SUPPLICANT_DBG("Country %s", country);
1754         } else
1755                 SUPPLICANT_DBG("key %s type %c",
1756                                 key, dbus_message_iter_get_arg_type(iter));
1757 }
1758
1759 static void signal_name_owner_changed(const char *path, DBusMessageIter *iter)
1760 {
1761         const char *name = NULL, *old = NULL, *new = NULL;
1762
1763         SUPPLICANT_DBG("");
1764
1765         if (g_strcmp0(path, DBUS_PATH_DBUS) != 0)
1766                 return;
1767
1768         dbus_message_iter_get_basic(iter, &name);
1769         if (name == NULL)
1770                 return;
1771
1772         if (g_strcmp0(name, SUPPLICANT_SERVICE) != 0)
1773                 return;
1774
1775         dbus_message_iter_next(iter);
1776         dbus_message_iter_get_basic(iter, &old);
1777         dbus_message_iter_next(iter);
1778         dbus_message_iter_get_basic(iter, &new);
1779
1780         if (old == NULL || new == NULL)
1781                 return;
1782
1783         if (strlen(old) > 0 && strlen(new) == 0) {
1784                 system_available = FALSE;
1785                 g_hash_table_remove_all(bss_mapping);
1786                 g_hash_table_remove_all(interface_table);
1787                 callback_system_killed();
1788         }
1789
1790         if (strlen(new) > 0 && strlen(old) == 0) {
1791                 system_available = TRUE;
1792                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
1793                                                         SUPPLICANT_INTERFACE,
1794                                                         service_property, NULL);
1795         }
1796 }
1797
1798 static void signal_properties_changed(const char *path, DBusMessageIter *iter)
1799 {
1800         SUPPLICANT_DBG("");
1801
1802         if (g_strcmp0(path, SUPPLICANT_PATH) != 0)
1803                 return;
1804
1805         supplicant_dbus_property_foreach(iter, service_property, NULL);
1806 }
1807
1808 static void signal_interface_added(const char *path, DBusMessageIter *iter)
1809 {
1810         SUPPLICANT_DBG("path %s %s", path, SUPPLICANT_PATH);
1811
1812         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1813                 interface_added(iter, NULL);
1814 }
1815
1816 static void signal_interface_removed(const char *path, DBusMessageIter *iter)
1817 {
1818         SUPPLICANT_DBG("");
1819
1820         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1821                 interface_removed(iter, NULL);
1822 }
1823
1824 static void signal_interface_changed(const char *path, DBusMessageIter *iter)
1825 {
1826         GSupplicantInterface *interface;
1827
1828         SUPPLICANT_DBG("");
1829
1830         interface = g_hash_table_lookup(interface_table, path);
1831         if (interface == NULL)
1832                 return;
1833
1834         supplicant_dbus_property_foreach(iter, interface_property, interface);
1835 }
1836
1837 static void signal_scan_done(const char *path, DBusMessageIter *iter)
1838 {
1839         GSupplicantInterface *interface;
1840         dbus_bool_t success = FALSE;
1841
1842         SUPPLICANT_DBG("");
1843
1844         interface = g_hash_table_lookup(interface_table, path);
1845         if (interface == NULL)
1846                 return;
1847
1848         dbus_message_iter_get_basic(iter, &success);
1849
1850         /*
1851          * If scan is unsuccessful return -EIO else get the scanned BSSs
1852          * and update the network details accordingly
1853          */
1854         if (success == FALSE) {
1855                 if (interface->scan_callback != NULL)
1856                         interface->scan_callback(-EIO, interface,
1857                                                 interface->scan_data);
1858
1859                 interface->scan_callback = NULL;
1860                 interface->scan_data = NULL;
1861
1862                 return;
1863         }
1864
1865         supplicant_dbus_property_get(path, SUPPLICANT_INTERFACE ".Interface",
1866                                         "BSSs", scan_bss_data, interface);
1867 }
1868
1869 static void signal_bss_added(const char *path, DBusMessageIter *iter)
1870 {
1871         GSupplicantInterface *interface;
1872
1873         SUPPLICANT_DBG("");
1874
1875         interface = g_hash_table_lookup(interface_table, path);
1876         if (interface == NULL)
1877                 return;
1878
1879         interface_bss_added_with_keys(iter, interface);
1880 }
1881
1882 static void signal_bss_removed(const char *path, DBusMessageIter *iter)
1883 {
1884         GSupplicantInterface *interface;
1885
1886         SUPPLICANT_DBG("");
1887
1888         interface = g_hash_table_lookup(interface_table, path);
1889         if (interface == NULL)
1890                 return;
1891
1892         interface_bss_removed(iter, interface);
1893 }
1894
1895 static void signal_network_added(const char *path, DBusMessageIter *iter)
1896 {
1897         GSupplicantInterface *interface;
1898
1899         SUPPLICANT_DBG("");
1900
1901         interface = g_hash_table_lookup(interface_table, path);
1902         if (interface == NULL)
1903                 return;
1904
1905         interface_network_added(iter, interface);
1906 }
1907
1908 static void signal_network_removed(const char *path, DBusMessageIter *iter)
1909 {
1910         GSupplicantInterface *interface;
1911
1912         SUPPLICANT_DBG("");
1913
1914         interface = g_hash_table_lookup(interface_table, path);
1915         if (interface == NULL)
1916                 return;
1917
1918         interface_network_removed(iter, interface);
1919 }
1920
1921 static void signal_bss_changed(const char *path, DBusMessageIter *iter)
1922 {
1923         GSupplicantInterface *interface;
1924         GSupplicantNetwork *network;
1925         struct g_supplicant_bss *bss;
1926
1927         SUPPLICANT_DBG("");
1928
1929         interface = g_hash_table_lookup(bss_mapping, path);
1930         if (interface == NULL)
1931                 return;
1932
1933         network = g_hash_table_lookup(interface->bss_mapping, path);
1934         if (network == NULL)
1935                 return;
1936
1937         bss = g_hash_table_lookup(network->bss_table, path);
1938         if (bss == NULL)
1939                 return;
1940
1941         supplicant_dbus_property_foreach(iter, bss_property, bss);
1942
1943         if (bss->signal == network->signal)
1944                 return;
1945
1946         /*
1947          * If the new signal is lower than the SSID signal, we need
1948          * to check for the new maximum.
1949          */
1950         if (bss->signal < network->signal) {
1951                 if (bss != network->best_bss)
1952                         return;
1953                 network->signal = bss->signal;
1954                 update_network_signal(network);
1955         } else {
1956                 network->signal = bss->signal;
1957                 network->best_bss = bss;
1958         }
1959
1960         SUPPLICANT_DBG("New network signal for %s %d dBm", network->ssid, network->signal);
1961
1962         callback_network_changed(network, "Signal");
1963 }
1964
1965 static void wps_credentials(const char *key, DBusMessageIter *iter,
1966                         void *user_data)
1967 {
1968         GSupplicantInterface *interface = user_data;
1969
1970         if (key == NULL)
1971                 return;
1972
1973         SUPPLICANT_DBG("key %s", key);
1974
1975         if (g_strcmp0(key, "Key") == 0) {
1976                 DBusMessageIter array;
1977                 unsigned char *key;
1978                 int key_len;
1979
1980                 dbus_message_iter_recurse(iter, &array);
1981                 dbus_message_iter_get_fixed_array(&array, &key, &key_len);
1982
1983                 g_free(interface->wps_cred.key);
1984                 interface->wps_cred.key = g_try_malloc0(
1985                                                 sizeof(char) * key_len+1);
1986
1987                 if (interface->wps_cred.key == NULL)
1988                         return;
1989
1990                 memcpy(interface->wps_cred.key, key, sizeof(char) * key_len);
1991
1992                 SUPPLICANT_DBG("WPS key present");
1993         } else if (g_strcmp0(key, "SSID") == 0) {
1994                 DBusMessageIter array;
1995                 unsigned char *ssid;
1996                 int ssid_len;
1997
1998                 dbus_message_iter_recurse(iter, &array);
1999                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
2000
2001                 if (ssid_len > 0 && ssid_len < 33) {
2002                         memcpy(interface->wps_cred.ssid, ssid, ssid_len);
2003                         interface->wps_cred.ssid_len = ssid_len;
2004                 } else {
2005                         memset(interface->wps_cred.ssid, 0, 32);
2006                         interface->wps_cred.ssid_len = 0;
2007                 }
2008         }
2009 }
2010
2011 static void signal_wps_credentials(const char *path, DBusMessageIter *iter)
2012 {
2013         GSupplicantInterface *interface;
2014
2015         SUPPLICANT_DBG("");
2016
2017         interface = g_hash_table_lookup(interface_table, path);
2018         if (interface == NULL)
2019                 return;
2020
2021         supplicant_dbus_property_foreach(iter, wps_credentials, interface);
2022 }
2023
2024 static void wps_event_args(const char *key, DBusMessageIter *iter,
2025                         void *user_data)
2026 {
2027         GSupplicantInterface *interface = user_data;
2028
2029         if (key == NULL || interface == NULL)
2030                 return;
2031
2032         SUPPLICANT_DBG("Arg Key %s", key);
2033 }
2034
2035 static void signal_wps_event(const char *path, DBusMessageIter *iter)
2036 {
2037         GSupplicantInterface *interface;
2038         const char *name = NULL;
2039
2040         SUPPLICANT_DBG("");
2041
2042         interface = g_hash_table_lookup(interface_table, path);
2043         if (interface == NULL)
2044                 return;
2045
2046         dbus_message_iter_get_basic(iter, &name);
2047
2048         SUPPLICANT_DBG("Name: %s", name);
2049
2050         if (g_strcmp0(name, "success") == 0)
2051                 interface->wps_state = G_SUPPLICANT_WPS_STATE_SUCCESS;
2052         else if (g_strcmp0(name, "failed") == 0)
2053                 interface->wps_state = G_SUPPLICANT_WPS_STATE_FAIL;
2054         else
2055                 interface->wps_state = G_SUPPLICANT_WPS_STATE_UNKNOWN;
2056
2057         if (!dbus_message_iter_has_next(iter))
2058                 return;
2059
2060         dbus_message_iter_next(iter);
2061
2062         supplicant_dbus_property_foreach(iter, wps_event_args, interface);
2063 }
2064
2065 static struct {
2066         const char *interface;
2067         const char *member;
2068         void (*function) (const char *path, DBusMessageIter *iter);
2069 } signal_map[] = {
2070         { DBUS_INTERFACE_DBUS,  "NameOwnerChanged",  signal_name_owner_changed },
2071
2072         { SUPPLICANT_INTERFACE, "PropertiesChanged", signal_properties_changed },
2073         { SUPPLICANT_INTERFACE, "InterfaceAdded",    signal_interface_added    },
2074         { SUPPLICANT_INTERFACE, "InterfaceCreated",  signal_interface_added    },
2075         { SUPPLICANT_INTERFACE, "InterfaceRemoved",  signal_interface_removed  },
2076
2077         { SUPPLICANT_INTERFACE ".Interface", "PropertiesChanged", signal_interface_changed },
2078         { SUPPLICANT_INTERFACE ".Interface", "ScanDone",          signal_scan_done         },
2079         { SUPPLICANT_INTERFACE ".Interface", "BSSAdded",          signal_bss_added         },
2080         { SUPPLICANT_INTERFACE ".Interface", "BSSRemoved",        signal_bss_removed       },
2081         { SUPPLICANT_INTERFACE ".Interface", "NetworkAdded",      signal_network_added     },
2082         { SUPPLICANT_INTERFACE ".Interface", "NetworkRemoved",    signal_network_removed   },
2083
2084         { SUPPLICANT_INTERFACE ".BSS", "PropertiesChanged", signal_bss_changed   },
2085
2086         { SUPPLICANT_INTERFACE ".Interface.WPS", "Credentials", signal_wps_credentials },
2087         { SUPPLICANT_INTERFACE ".Interface.WPS", "Event",       signal_wps_event       },
2088
2089         { }
2090 };
2091
2092 static DBusHandlerResult g_supplicant_filter(DBusConnection *conn,
2093                                         DBusMessage *message, void *data)
2094 {
2095         DBusMessageIter iter;
2096         const char *path;
2097         int i;
2098
2099         path = dbus_message_get_path(message);
2100         if (path == NULL)
2101                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2102
2103         if (dbus_message_iter_init(message, &iter) == FALSE)
2104                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2105
2106         for (i = 0; signal_map[i].interface != NULL; i++) {
2107                 if (dbus_message_has_interface(message,
2108                                         signal_map[i].interface) == FALSE)
2109                         continue;
2110
2111                 if (dbus_message_has_member(message,
2112                                         signal_map[i].member) == FALSE)
2113                         continue;
2114
2115                 signal_map[i].function(path, &iter);
2116                 break;
2117         }
2118
2119         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2120 }
2121
2122 struct supplicant_regdom {
2123         GSupplicantCountryCallback callback;
2124         const void *user_data;
2125 };
2126
2127 static void country_result(const char *error,
2128                                 DBusMessageIter *iter, void *user_data)
2129 {
2130         struct supplicant_regdom *regdom = user_data;
2131         char *alpha2;
2132
2133         SUPPLICANT_DBG("Country setting result");
2134
2135         if (user_data == NULL)
2136                 return;
2137
2138         if (error == NULL) {
2139                 alpha2 = (char *)regdom->user_data;
2140         } else {
2141                 SUPPLICANT_DBG("Country setting failure %s", error);
2142                 alpha2 = NULL;
2143         }
2144
2145         if (regdom->callback)
2146                 regdom->callback(alpha2);
2147
2148         g_free(regdom);
2149 }
2150
2151 static void country_params(DBusMessageIter *iter, void *user_data)
2152 {
2153         struct supplicant_regdom *regdom = user_data;
2154         const char *country;
2155
2156         country = regdom->user_data;
2157
2158         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &country);
2159 }
2160
2161 int g_supplicant_set_country(const char *alpha2,
2162                                 GSupplicantCountryCallback callback,
2163                                         const void *user_data)
2164 {
2165         struct supplicant_regdom *regdom;
2166
2167         SUPPLICANT_DBG("Country setting %s", alpha2);
2168
2169         if (system_available == FALSE)
2170                 return -EFAULT;
2171
2172         regdom = dbus_malloc0(sizeof(*regdom));
2173         if (regdom == NULL)
2174                 return -ENOMEM;
2175
2176         regdom->callback = callback;
2177         regdom->user_data = user_data;
2178
2179         return supplicant_dbus_property_set(SUPPLICANT_PATH, SUPPLICANT_INTERFACE,
2180                                         "Country", DBUS_TYPE_STRING_AS_STRING,
2181                                         country_params, country_result,
2182                                                 regdom);
2183 }
2184
2185 struct interface_data {
2186         GSupplicantInterface *interface;
2187         GSupplicantInterfaceCallback callback;
2188         void *user_data;
2189 };
2190
2191 struct interface_create_data {
2192         const char *ifname;
2193         const char *driver;
2194         const char *bridge;
2195         GSupplicantInterface *interface;
2196         GSupplicantInterfaceCallback callback;
2197         void *user_data;
2198 };
2199
2200 struct interface_connect_data {
2201         GSupplicantInterface *interface;
2202         GSupplicantInterfaceCallback callback;
2203         GSupplicantSSID *ssid;
2204         void *user_data;
2205 };
2206
2207 struct interface_scan_data {
2208         GSupplicantInterface *interface;
2209         GSupplicantInterfaceCallback callback;
2210         GSupplicantScanParams *scan_params;
2211         void *user_data;
2212 };
2213
2214 static void interface_create_property(const char *key, DBusMessageIter *iter,
2215                                                         void *user_data)
2216 {
2217         struct interface_create_data *data = user_data;
2218         GSupplicantInterface *interface = data->interface;
2219
2220         if (key == NULL) {
2221                 if (data->callback != NULL)
2222                         data->callback(0, data->interface, data->user_data);
2223
2224                 dbus_free(data);
2225         }
2226
2227         interface_property(key, iter, interface);
2228 }
2229
2230 static void interface_create_result(const char *error,
2231                                 DBusMessageIter *iter, void *user_data)
2232 {
2233         struct interface_create_data *data = user_data;
2234         const char *path = NULL;
2235         int err;
2236
2237         SUPPLICANT_DBG("");
2238
2239         if (error != NULL) {
2240                 g_critical("error %s", error);
2241                 err = -EIO;
2242                 goto done;
2243         }
2244
2245         dbus_message_iter_get_basic(iter, &path);
2246         if (path == NULL) {
2247                 err = -EINVAL;
2248                 goto done;
2249         }
2250
2251         if (system_available == FALSE) {
2252                 err = -EFAULT;
2253                 goto done;
2254         }
2255
2256         data->interface = g_hash_table_lookup(interface_table, path);
2257         if (data->interface == NULL) {
2258                 data->interface = interface_alloc(path);
2259                 if (data->interface == NULL) {
2260                         err = -ENOMEM;
2261                         goto done;
2262                 }
2263         }
2264
2265         err = supplicant_dbus_property_get_all(path,
2266                                         SUPPLICANT_INTERFACE ".Interface",
2267                                         interface_create_property, data);
2268         if (err == 0)
2269                 return;
2270
2271 done:
2272         if (data->callback != NULL)
2273                 data->callback(err, NULL, data->user_data);
2274
2275         dbus_free(data);
2276 }
2277
2278 static void interface_create_params(DBusMessageIter *iter, void *user_data)
2279 {
2280         struct interface_create_data *data = user_data;
2281         DBusMessageIter dict;
2282
2283         SUPPLICANT_DBG("");
2284
2285         supplicant_dbus_dict_open(iter, &dict);
2286
2287         supplicant_dbus_dict_append_basic(&dict, "Ifname",
2288                                         DBUS_TYPE_STRING, &data->ifname);
2289
2290         if (data->driver != NULL)
2291                 supplicant_dbus_dict_append_basic(&dict, "Driver",
2292                                         DBUS_TYPE_STRING, &data->driver);
2293
2294         if (data->bridge != NULL)
2295                 supplicant_dbus_dict_append_basic(&dict, "BridgeIfname",
2296                                         DBUS_TYPE_STRING, &data->bridge);
2297
2298         supplicant_dbus_dict_close(iter, &dict);
2299 }
2300
2301 static void interface_get_result(const char *error,
2302                                 DBusMessageIter *iter, void *user_data)
2303 {
2304         struct interface_create_data *data = user_data;
2305         GSupplicantInterface *interface;
2306         const char *path = NULL;
2307         int err;
2308
2309         SUPPLICANT_DBG("");
2310
2311         if (error != NULL) {
2312                 SUPPLICANT_DBG("Interface not created yet");
2313                 err = -EIO;
2314                 goto create;
2315         }
2316
2317         dbus_message_iter_get_basic(iter, &path);
2318         if (path == NULL) {
2319                 err = -EINVAL;
2320                 goto done;
2321         }
2322
2323         interface = g_hash_table_lookup(interface_table, path);
2324         if (interface == NULL) {
2325                 err = -ENOENT;
2326                 goto done;
2327         }
2328
2329         if (data->callback != NULL)
2330                 data->callback(0, interface, data->user_data);
2331
2332         dbus_free(data);
2333
2334         return;
2335
2336 create:
2337         if (system_available == FALSE) {
2338                 err = -EFAULT;
2339                 goto done;
2340         }
2341
2342         SUPPLICANT_DBG("Creating interface");
2343
2344         err = supplicant_dbus_method_call(SUPPLICANT_PATH,
2345                                                 SUPPLICANT_INTERFACE,
2346                                                 "CreateInterface",
2347                                                 interface_create_params,
2348                                                 interface_create_result, data);
2349         if (err == 0)
2350                 return;
2351
2352 done:
2353         if (data->callback != NULL)
2354                 data->callback(err, NULL, data->user_data);
2355
2356         dbus_free(data);
2357 }
2358
2359 static void interface_get_params(DBusMessageIter *iter, void *user_data)
2360 {
2361         struct interface_create_data *data = user_data;
2362
2363         SUPPLICANT_DBG("");
2364
2365         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &data->ifname);
2366 }
2367
2368 int g_supplicant_interface_create(const char *ifname, const char *driver,
2369                                         const char *bridge,
2370                                         GSupplicantInterfaceCallback callback,
2371                                                         void *user_data)
2372 {
2373         struct interface_create_data *data;
2374
2375         SUPPLICANT_DBG("ifname %s", ifname);
2376
2377         if (ifname == NULL)
2378                 return -EINVAL;
2379
2380         if (system_available == FALSE)
2381                 return -EFAULT;
2382
2383         data = dbus_malloc0(sizeof(*data));
2384         if (data == NULL)
2385                 return -ENOMEM;
2386
2387         data->ifname = ifname;
2388         data->driver = driver;
2389         data->bridge = bridge;
2390         data->callback = callback;
2391         data->user_data = user_data;
2392
2393         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2394                                                 SUPPLICANT_INTERFACE,
2395                                                 "GetInterface",
2396                                                 interface_get_params,
2397                                                 interface_get_result, data);
2398 }
2399
2400 static void interface_remove_result(const char *error,
2401                                 DBusMessageIter *iter, void *user_data)
2402 {
2403         struct interface_data *data = user_data;
2404         int err;
2405
2406         if (error != NULL) {
2407                 err = -EIO;
2408                 goto done;
2409         }
2410
2411         if (system_available == FALSE) {
2412                 err = -EFAULT;
2413                 goto done;
2414         }
2415
2416         /*
2417          * The gsupplicant interface is already freed by the InterfaceRemoved
2418          * signal callback. Simply invoke the interface_data callback.
2419          */
2420         err = 0;
2421
2422 done:
2423         if (data->callback != NULL)
2424                 data->callback(err, NULL, data->user_data);
2425
2426         dbus_free(data);
2427 }
2428
2429
2430 static void interface_remove_params(DBusMessageIter *iter, void *user_data)
2431 {
2432         struct interface_data *data = user_data;
2433
2434         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2435                                                         &data->interface->path);
2436 }
2437
2438
2439 int g_supplicant_interface_remove(GSupplicantInterface *interface,
2440                         GSupplicantInterfaceCallback callback,
2441                                                         void *user_data)
2442 {
2443         struct interface_data *data;
2444
2445         if (interface == NULL)
2446                 return -EINVAL;
2447
2448         if (system_available == FALSE)
2449                 return -EFAULT;
2450
2451         data = dbus_malloc0(sizeof(*data));
2452         if (data == NULL)
2453                 return -ENOMEM;
2454
2455         data->interface = interface;
2456         data->callback = callback;
2457         data->user_data = user_data;
2458
2459         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2460                                                 SUPPLICANT_INTERFACE,
2461                                                 "RemoveInterface",
2462                                                 interface_remove_params,
2463                                                 interface_remove_result, data);
2464 }
2465
2466 static void interface_scan_result(const char *error,
2467                                 DBusMessageIter *iter, void *user_data)
2468 {
2469         struct interface_scan_data *data = user_data;
2470
2471         if (error != NULL) {
2472                 SUPPLICANT_DBG("error %s", error);
2473
2474                 if (data->callback != NULL)
2475                         data->callback(-EIO, data->interface, data->user_data);
2476         } else {
2477                 data->interface->scan_callback = data->callback;
2478                 data->interface->scan_data = data->user_data;
2479         }
2480
2481         if (data != NULL && data->scan_params != NULL)
2482                 g_free(data->scan_params);
2483
2484         dbus_free(data);
2485 }
2486
2487 static void add_scan_frequency(DBusMessageIter *iter, unsigned int freq)
2488 {
2489         DBusMessageIter data;
2490         unsigned int width = 0; /* Not used by wpa_supplicant atm */
2491
2492         dbus_message_iter_open_container(iter, DBUS_TYPE_STRUCT, NULL, &data);
2493
2494         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &freq);
2495         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &width);
2496
2497         dbus_message_iter_close_container(iter, &data);
2498 }
2499
2500 static void add_scan_frequencies(DBusMessageIter *iter,
2501                                                 void *user_data)
2502 {
2503         GSupplicantScanParams *scan_data = user_data;
2504         unsigned int freq;
2505         int i;
2506
2507         for (i = 0; i < G_SUPPLICANT_MAX_FAST_SCAN; i++) {
2508                 freq = scan_data->freqs[i];
2509                 if (!freq)
2510                         break;
2511
2512                 add_scan_frequency(iter, freq);
2513         }
2514 }
2515
2516 static void append_ssid(DBusMessageIter *iter,
2517                         const void *ssid, unsigned int len)
2518 {
2519         DBusMessageIter array;
2520
2521         dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
2522         DBUS_TYPE_BYTE_AS_STRING, &array);
2523
2524         dbus_message_iter_append_fixed_array(&array, DBUS_TYPE_BYTE,
2525                                                                 &ssid, len);
2526         dbus_message_iter_close_container(iter, &array);
2527 }
2528
2529 static void append_ssids(DBusMessageIter *iter, void *user_data)
2530 {
2531         GSupplicantScanParams *scan_data = user_data;
2532         int i;
2533
2534         for (i = 0; i < scan_data->num_ssids; i++)
2535                 append_ssid(iter, scan_data->ssids[i].ssid,
2536                                         scan_data->ssids[i].ssid_len);
2537 }
2538
2539 static void supplicant_add_scan_frequency(DBusMessageIter *dict,
2540                 supplicant_dbus_array_function function,
2541                                         void *user_data)
2542 {
2543         GSupplicantScanParams *scan_params = user_data;
2544         DBusMessageIter entry, value, array;
2545         const char *key = "Channels";
2546
2547         if (scan_params->freqs[0] != 0) {
2548                 dbus_message_iter_open_container(dict, DBUS_TYPE_DICT_ENTRY,
2549                                                 NULL, &entry);
2550
2551                 dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &key);
2552
2553                 dbus_message_iter_open_container(&entry, DBUS_TYPE_VARIANT,
2554                                         DBUS_TYPE_ARRAY_AS_STRING
2555                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2556                                         DBUS_TYPE_UINT32_AS_STRING
2557                                         DBUS_TYPE_UINT32_AS_STRING
2558                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2559                                         &value);
2560
2561                 dbus_message_iter_open_container(&value, DBUS_TYPE_ARRAY,
2562                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2563                                         DBUS_TYPE_UINT32_AS_STRING
2564                                         DBUS_TYPE_UINT32_AS_STRING
2565                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2566                                         &array);
2567
2568                 if (function)
2569                         function(&array, user_data);
2570
2571                 dbus_message_iter_close_container(&value, &array);
2572                 dbus_message_iter_close_container(&entry, &value);
2573                 dbus_message_iter_close_container(dict, &entry);
2574         }
2575 }
2576
2577 static void interface_scan_params(DBusMessageIter *iter, void *user_data)
2578 {
2579         DBusMessageIter dict;
2580         const char *type = "passive";
2581         struct interface_scan_data *data = user_data;
2582
2583         supplicant_dbus_dict_open(iter, &dict);
2584
2585         if (data && data->scan_params) {
2586                 type = "active";
2587
2588                 supplicant_dbus_dict_append_basic(&dict, "Type",
2589                                         DBUS_TYPE_STRING, &type);
2590
2591                 supplicant_dbus_dict_append_array(&dict, "SSIDs",
2592                                                 DBUS_TYPE_STRING,
2593                                                 append_ssids,
2594                                                 data->scan_params);
2595
2596                 supplicant_add_scan_frequency(&dict, add_scan_frequencies,
2597                                                 data->scan_params);
2598         } else
2599                 supplicant_dbus_dict_append_basic(&dict, "Type",
2600                                         DBUS_TYPE_STRING, &type);
2601
2602         supplicant_dbus_dict_close(iter, &dict);
2603 }
2604
2605 int g_supplicant_interface_scan(GSupplicantInterface *interface,
2606                                 GSupplicantScanParams *scan_data,
2607                                 GSupplicantInterfaceCallback callback,
2608                                                         void *user_data)
2609 {
2610         struct interface_scan_data *data;
2611         int ret;
2612
2613         if (interface == NULL)
2614                 return -EINVAL;
2615
2616         if (system_available == FALSE)
2617                 return -EFAULT;
2618
2619         if (interface->scanning == TRUE)
2620                 return -EALREADY;
2621
2622         switch (interface->state) {
2623         case G_SUPPLICANT_STATE_AUTHENTICATING:
2624         case G_SUPPLICANT_STATE_ASSOCIATING:
2625         case G_SUPPLICANT_STATE_ASSOCIATED:
2626         case G_SUPPLICANT_STATE_4WAY_HANDSHAKE:
2627         case G_SUPPLICANT_STATE_GROUP_HANDSHAKE:
2628                 return -EBUSY;
2629         case G_SUPPLICANT_STATE_UNKNOWN:
2630         case G_SUPPLICANT_STATE_DISCONNECTED:
2631         case G_SUPPLICANT_STATE_INACTIVE:
2632         case G_SUPPLICANT_STATE_SCANNING:
2633         case G_SUPPLICANT_STATE_COMPLETED:
2634                 break;
2635         }
2636
2637         data = dbus_malloc0(sizeof(*data));
2638         if (data == NULL)
2639                 return -ENOMEM;
2640
2641         data->interface = interface;
2642         data->callback = callback;
2643         data->user_data = user_data;
2644         data->scan_params = scan_data;
2645
2646         ret = supplicant_dbus_method_call(interface->path,
2647                         SUPPLICANT_INTERFACE ".Interface", "Scan",
2648                         interface_scan_params, interface_scan_result, data);
2649
2650         if (ret < 0)
2651                 dbus_free(data);
2652
2653         return ret;
2654 }
2655
2656 static int parse_supplicant_error(DBusMessageIter *iter)
2657 {
2658         int err = -ECANCELED;
2659         char *key;
2660
2661         while (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
2662                 dbus_message_iter_get_basic(iter, &key);
2663                 if (strncmp(key, "psk", 4) == 0 ||
2664                         strncmp(key, "wep_key", 7) == 0) {
2665                         err = -ENOKEY;
2666                         break;
2667                 }
2668                 dbus_message_iter_next(iter);
2669         }
2670
2671         return err;
2672 }
2673
2674 static void interface_select_network_result(const char *error,
2675                                 DBusMessageIter *iter, void *user_data)
2676 {
2677         struct interface_connect_data *data = user_data;
2678         int err;
2679
2680         SUPPLICANT_DBG("");
2681
2682         err = 0;
2683         if (error != NULL) {
2684                 SUPPLICANT_DBG("SelectNetwork error %s", error);
2685                 err = parse_supplicant_error(iter);
2686         }
2687
2688         if (data->callback != NULL)
2689                 data->callback(err, data->interface, data->user_data);
2690
2691         g_free(data->ssid);
2692         dbus_free(data);
2693 }
2694
2695 static void interface_select_network_params(DBusMessageIter *iter,
2696                                                         void *user_data)
2697 {
2698         struct interface_connect_data *data = user_data;
2699         GSupplicantInterface *interface = data->interface;
2700
2701         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2702                                         &interface->network_path);
2703 }
2704
2705 static void interface_add_network_result(const char *error,
2706                                 DBusMessageIter *iter, void *user_data)
2707 {
2708         struct interface_connect_data *data = user_data;
2709         GSupplicantInterface *interface = data->interface;
2710         const char *path;
2711         int err;
2712
2713         if (error != NULL)
2714                 goto error;
2715
2716         dbus_message_iter_get_basic(iter, &path);
2717         if (path == NULL)
2718                 goto error;
2719
2720         SUPPLICANT_DBG("PATH: %s", path);
2721
2722         g_free(interface->network_path);
2723         interface->network_path = g_strdup(path);
2724
2725         supplicant_dbus_method_call(data->interface->path,
2726                         SUPPLICANT_INTERFACE ".Interface", "SelectNetwork",
2727                         interface_select_network_params,
2728                         interface_select_network_result, data);
2729
2730         return;
2731
2732 error:
2733         SUPPLICANT_DBG("AddNetwork error %s", error);
2734         err = parse_supplicant_error(iter);
2735         if (data->callback != NULL)
2736                 data->callback(err, data->interface, data->user_data);
2737
2738         g_free(interface->network_path);
2739         interface->network_path = NULL;
2740         g_free(data->ssid);
2741         g_free(data);
2742 }
2743
2744 static void add_network_security_wep(DBusMessageIter *dict,
2745                                         GSupplicantSSID *ssid)
2746 {
2747         const char *auth_alg = "OPEN SHARED";
2748         const char *key_index = "0";
2749
2750         supplicant_dbus_dict_append_basic(dict, "auth_alg",
2751                                         DBUS_TYPE_STRING, &auth_alg);
2752
2753         if (ssid->passphrase) {
2754                 int size = strlen(ssid->passphrase);
2755                 if (size == 10 || size == 26) {
2756                         unsigned char *key = g_try_malloc(13);
2757                         char tmp[3];
2758                         int i;
2759
2760                         memset(tmp, 0, sizeof(tmp));
2761                         if (key == NULL)
2762                                 size = 0;
2763
2764                         for (i = 0; i < size / 2; i++) {
2765                                 memcpy(tmp, ssid->passphrase + (i * 2), 2);
2766                                 key[i] = (unsigned char) strtol(tmp, NULL, 16);
2767                         }
2768
2769                         supplicant_dbus_dict_append_fixed_array(dict,
2770                                                         "wep_key0",
2771                                                         DBUS_TYPE_BYTE,
2772                                                         &key, size / 2);
2773                         g_free(key);
2774                 } else if (size == 5 || size == 13) {
2775                         unsigned char *key = g_try_malloc(13);
2776                         int i;
2777
2778                         if (key == NULL)
2779                                 size = 0;
2780
2781                         for (i = 0; i < size; i++)
2782                                 key[i] = (unsigned char) ssid->passphrase[i];
2783
2784                         supplicant_dbus_dict_append_fixed_array(dict,
2785                                                                 "wep_key0",
2786                                                                 DBUS_TYPE_BYTE,
2787                                                                 &key, size);
2788                         g_free(key);
2789                 } else
2790                         supplicant_dbus_dict_append_basic(dict,
2791                                                         "wep_key0",
2792                                                         DBUS_TYPE_STRING,
2793                                                         &ssid->passphrase);
2794
2795                 supplicant_dbus_dict_append_basic(dict, "wep_tx_keyidx",
2796                                         DBUS_TYPE_STRING, &key_index);
2797         }
2798 }
2799
2800 static dbus_bool_t is_psk_raw_key(const char *psk)
2801 {
2802         int i;
2803
2804         /* A raw key is always 64 bytes length... */
2805         if (strlen(psk) != 64)
2806                 return FALSE;
2807
2808         /* ... and its content is in hex representation */
2809         for (i = 0; i < 64; i++)
2810                 if (!isxdigit((unsigned char) psk[i]))
2811                         return FALSE;
2812
2813         return TRUE;
2814 }
2815
2816 static void add_network_security_psk(DBusMessageIter *dict,
2817                                         GSupplicantSSID *ssid)
2818 {
2819         if (ssid->passphrase && strlen(ssid->passphrase) > 0) {
2820
2821                 if (is_psk_raw_key(ssid->passphrase) == TRUE)
2822                         supplicant_dbus_property_append_fixed_array(dict,
2823                                                         "psk", DBUS_TYPE_BYTE,
2824                                                         &ssid->passphrase, 64);
2825                 else
2826                         supplicant_dbus_dict_append_basic(dict, "psk",
2827                                                         DBUS_TYPE_STRING,
2828                                                         &ssid->passphrase);
2829         }
2830 }
2831
2832 static void add_network_security_tls(DBusMessageIter *dict,
2833                                         GSupplicantSSID *ssid)
2834 {
2835         /*
2836          * For TLS, we at least need:
2837          *              The client certificate
2838          *              The client private key file
2839          *              The client private key file password
2840          *
2841          * The Authority certificate is optional.
2842          */
2843         if (ssid->client_cert_path == NULL)
2844                 return;
2845
2846         if (ssid->private_key_path == NULL)
2847                 return;
2848
2849         if (ssid->private_key_passphrase == NULL)
2850                 return;
2851
2852         if (ssid->ca_cert_path)
2853                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
2854                                         DBUS_TYPE_STRING, &ssid->ca_cert_path);
2855
2856         supplicant_dbus_dict_append_basic(dict, "private_key",
2857                                                 DBUS_TYPE_STRING,
2858                                                 &ssid->private_key_path);
2859         supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
2860                                                 DBUS_TYPE_STRING,
2861                                                 &ssid->private_key_passphrase);
2862         supplicant_dbus_dict_append_basic(dict, "client_cert",
2863                                                 DBUS_TYPE_STRING,
2864                                                 &ssid->client_cert_path);
2865 }
2866
2867 static void add_network_security_peap(DBusMessageIter *dict,
2868                                         GSupplicantSSID *ssid)
2869 {
2870         char *phase2_auth;
2871
2872         /*
2873          * For PEAP/TTLS, we at least need
2874          *              The authority certificate
2875          *              The 2nd phase authentication method
2876          *              The 2nd phase passphrase
2877          *
2878          * The Client certificate is optional although strongly recommended
2879          * When setting it, we need in addition
2880          *              The Client private key file
2881          *              The Client private key file password
2882          */
2883         if (ssid->passphrase == NULL)
2884                 return;
2885
2886         if (ssid->phase2_auth == NULL)
2887                 return;
2888
2889         if (ssid->client_cert_path) {
2890                 if (ssid->private_key_path == NULL)
2891                         return;
2892
2893                 if (ssid->private_key_passphrase == NULL)
2894                         return;
2895
2896                 supplicant_dbus_dict_append_basic(dict, "client_cert",
2897                                                 DBUS_TYPE_STRING,
2898                                                 &ssid->client_cert_path);
2899
2900                 supplicant_dbus_dict_append_basic(dict, "private_key",
2901                                                 DBUS_TYPE_STRING,
2902                                                 &ssid->private_key_path);
2903
2904                 supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
2905                                                 DBUS_TYPE_STRING,
2906                                                 &ssid->private_key_passphrase);
2907
2908         }
2909
2910         if (g_str_has_prefix(ssid->phase2_auth, "EAP-") == TRUE) {
2911                 phase2_auth = g_strdup_printf("autheap=%s",
2912                                         ssid->phase2_auth + strlen("EAP-"));
2913         } else
2914                 phase2_auth = g_strdup_printf("auth=%s", ssid->phase2_auth);
2915
2916         supplicant_dbus_dict_append_basic(dict, "password",
2917                                                 DBUS_TYPE_STRING,
2918                                                 &ssid->passphrase);
2919
2920         if (ssid->ca_cert_path)
2921                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
2922                                                 DBUS_TYPE_STRING,
2923                                                 &ssid->ca_cert_path);
2924
2925         supplicant_dbus_dict_append_basic(dict, "phase2",
2926                                                 DBUS_TYPE_STRING,
2927                                                 &phase2_auth);
2928
2929         g_free(phase2_auth);
2930 }
2931
2932 static void add_network_security_eap(DBusMessageIter *dict,
2933                                         GSupplicantSSID *ssid)
2934 {
2935         char *eap_value;
2936
2937         if (ssid->eap == NULL || ssid->identity == NULL)
2938                 return;
2939
2940         if (g_strcmp0(ssid->eap, "tls") == 0) {
2941                 add_network_security_tls(dict, ssid);
2942         } else if (g_strcmp0(ssid->eap, "peap") == 0 ||
2943                                 g_strcmp0(ssid->eap, "ttls") == 0) {
2944                 add_network_security_peap(dict, ssid);
2945         } else
2946                 return;
2947
2948         eap_value = g_ascii_strup(ssid->eap, -1);
2949
2950         supplicant_dbus_dict_append_basic(dict, "eap",
2951                                                 DBUS_TYPE_STRING,
2952                                                 &eap_value);
2953         supplicant_dbus_dict_append_basic(dict, "identity",
2954                                                 DBUS_TYPE_STRING,
2955                                                 &ssid->identity);
2956
2957         g_free(eap_value);
2958 }
2959
2960 static void add_network_security_ciphers(DBusMessageIter *dict,
2961                                                 GSupplicantSSID *ssid)
2962 {
2963         unsigned int p_cipher, g_cipher, i;
2964         char *pairwise, *group;
2965         char *pair_ciphers[4];
2966         char *group_ciphers[5];
2967
2968         p_cipher = ssid->pairwise_cipher;
2969         g_cipher = ssid->group_cipher;
2970
2971         if (p_cipher == 0 && g_cipher == 0)
2972                 return;
2973
2974         i = 0;
2975
2976         if (p_cipher & G_SUPPLICANT_PAIRWISE_CCMP)
2977                 pair_ciphers[i++] = "CCMP";
2978
2979         if (p_cipher & G_SUPPLICANT_PAIRWISE_TKIP)
2980                 pair_ciphers[i++] = "TKIP";
2981
2982         if (p_cipher & G_SUPPLICANT_PAIRWISE_NONE)
2983                 pair_ciphers[i++] = "NONE";
2984
2985         pair_ciphers[i] = NULL;
2986
2987         i = 0;
2988
2989         if (g_cipher & G_SUPPLICANT_GROUP_CCMP)
2990                 group_ciphers[i++] = "CCMP";
2991
2992         if (g_cipher & G_SUPPLICANT_GROUP_TKIP)
2993                 group_ciphers[i++] = "TKIP";
2994
2995         if (g_cipher & G_SUPPLICANT_GROUP_WEP104)
2996                 group_ciphers[i++] = "WEP104";
2997
2998         if (g_cipher & G_SUPPLICANT_GROUP_WEP40)
2999                 group_ciphers[i++] = "WEP40";
3000
3001         group_ciphers[i] = NULL;
3002
3003         pairwise = g_strjoinv(" ", pair_ciphers);
3004         group = g_strjoinv(" ", group_ciphers);
3005
3006         SUPPLICANT_DBG("cipher %s %s", pairwise, group);
3007
3008         supplicant_dbus_dict_append_basic(dict, "pairwise",
3009                                                 DBUS_TYPE_STRING,
3010                                                 &pairwise);
3011         supplicant_dbus_dict_append_basic(dict, "group",
3012                                                 DBUS_TYPE_STRING,
3013                                                 &group);
3014
3015         g_free(pairwise);
3016         g_free(group);
3017 }
3018
3019 static void add_network_security_proto(DBusMessageIter *dict,
3020                                                 GSupplicantSSID *ssid)
3021 {
3022         unsigned int protocol, i;
3023         char *proto;
3024         char *protos[3];
3025
3026         protocol = ssid->protocol;
3027
3028         if (protocol == 0)
3029                 return;
3030
3031         i = 0;
3032
3033         if (protocol & G_SUPPLICANT_PROTO_RSN)
3034                 protos[i++] = "RSN";
3035
3036         if (protocol & G_SUPPLICANT_PROTO_WPA)
3037                 protos[i++] = "WPA";
3038
3039         protos[i] = NULL;
3040
3041         proto = g_strjoinv(" ", protos);
3042
3043         SUPPLICANT_DBG("proto %s", proto);
3044
3045         supplicant_dbus_dict_append_basic(dict, "proto",
3046                                                 DBUS_TYPE_STRING,
3047                                                 &proto);
3048
3049         g_free(proto);
3050 }
3051
3052 static void add_network_security(DBusMessageIter *dict, GSupplicantSSID *ssid)
3053 {
3054         char *key_mgmt;
3055
3056         switch (ssid->security) {
3057         case G_SUPPLICANT_SECURITY_UNKNOWN:
3058         case G_SUPPLICANT_SECURITY_NONE:
3059         case G_SUPPLICANT_SECURITY_WEP:
3060                 key_mgmt = "NONE";
3061                 add_network_security_wep(dict, ssid);
3062                 add_network_security_ciphers(dict, ssid);
3063                 break;
3064         case G_SUPPLICANT_SECURITY_PSK:
3065                 key_mgmt = "WPA-PSK";
3066                 add_network_security_psk(dict, ssid);
3067                 add_network_security_ciphers(dict, ssid);
3068                 add_network_security_proto(dict, ssid);
3069                 break;
3070         case G_SUPPLICANT_SECURITY_IEEE8021X:
3071                 key_mgmt = "WPA-EAP";
3072                 add_network_security_eap(dict, ssid);
3073                 add_network_security_ciphers(dict, ssid);
3074                 add_network_security_proto(dict, ssid);
3075                 break;
3076         }
3077
3078         supplicant_dbus_dict_append_basic(dict, "key_mgmt",
3079                                 DBUS_TYPE_STRING, &key_mgmt);
3080 }
3081
3082 static void add_network_mode(DBusMessageIter *dict, GSupplicantSSID *ssid)
3083 {
3084         dbus_uint32_t mode;
3085
3086         switch (ssid->mode) {
3087         case G_SUPPLICANT_MODE_UNKNOWN:
3088         case G_SUPPLICANT_MODE_INFRA:
3089                 mode = 0;
3090                 break;
3091         case G_SUPPLICANT_MODE_IBSS:
3092                 mode = 1;
3093                 break;
3094         case G_SUPPLICANT_MODE_MASTER:
3095                 mode = 2;
3096                 break;
3097         }
3098
3099         supplicant_dbus_dict_append_basic(dict, "mode",
3100                                 DBUS_TYPE_UINT32, &mode);
3101 }
3102
3103 static void interface_add_network_params(DBusMessageIter *iter, void *user_data)
3104 {
3105         DBusMessageIter dict;
3106         struct interface_connect_data *data = user_data;
3107         GSupplicantSSID *ssid = data->ssid;
3108
3109         supplicant_dbus_dict_open(iter, &dict);
3110
3111         if (ssid->scan_ssid)
3112                 supplicant_dbus_dict_append_basic(&dict, "scan_ssid",
3113                                          DBUS_TYPE_UINT32, &ssid->scan_ssid);
3114
3115         if (ssid->freq)
3116                 supplicant_dbus_dict_append_basic(&dict, "frequency",
3117                                          DBUS_TYPE_UINT32, &ssid->freq);
3118
3119         add_network_mode(&dict, ssid);
3120
3121         add_network_security(&dict, ssid);
3122
3123         supplicant_dbus_dict_append_fixed_array(&dict, "ssid",
3124                                         DBUS_TYPE_BYTE, &ssid->ssid,
3125                                                 ssid->ssid_len);
3126
3127         supplicant_dbus_dict_close(iter, &dict);
3128 }
3129
3130 static void interface_wps_start_result(const char *error,
3131                                 DBusMessageIter *iter, void *user_data)
3132 {
3133         struct interface_connect_data *data = user_data;
3134
3135         SUPPLICANT_DBG("");
3136         if (error != NULL)
3137                 SUPPLICANT_DBG("error: %s", error);
3138
3139         g_free(data->ssid);
3140         dbus_free(data);
3141 }
3142
3143 static void interface_add_wps_params(DBusMessageIter *iter, void *user_data)
3144 {
3145         struct interface_connect_data *data = user_data;
3146         GSupplicantSSID *ssid = data->ssid;
3147         const char *role = "enrollee", *type;
3148         DBusMessageIter dict;
3149
3150         SUPPLICANT_DBG("");
3151
3152         supplicant_dbus_dict_open(iter, &dict);
3153
3154         supplicant_dbus_dict_append_basic(&dict, "Role",
3155                                                 DBUS_TYPE_STRING, &role);
3156
3157         type = "pbc";
3158         if (ssid->pin_wps != NULL) {
3159                 type = "pin";
3160                 supplicant_dbus_dict_append_basic(&dict, "Pin",
3161                                         DBUS_TYPE_STRING, &ssid->pin_wps);
3162         }
3163
3164         supplicant_dbus_dict_append_basic(&dict, "Type",
3165                                         DBUS_TYPE_STRING, &type);
3166
3167         supplicant_dbus_dict_close(iter, &dict);
3168 }
3169
3170 static void wps_start(const char *error, DBusMessageIter *iter, void *user_data)
3171 {
3172         struct interface_connect_data *data = user_data;
3173
3174         SUPPLICANT_DBG("");
3175
3176         if (error != NULL) {
3177                 SUPPLICANT_DBG("error: %s", error);
3178                 g_free(data->ssid);
3179                 dbus_free(data);
3180                 return;
3181         }
3182
3183         supplicant_dbus_method_call(data->interface->path,
3184                         SUPPLICANT_INTERFACE ".Interface.WPS", "Start",
3185                         interface_add_wps_params,
3186                         interface_wps_start_result, data);
3187 }
3188
3189 static void wps_process_credentials(DBusMessageIter *iter, void *user_data)
3190 {
3191         dbus_bool_t credentials = TRUE;
3192
3193         SUPPLICANT_DBG("");
3194
3195         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &credentials);
3196 }
3197
3198
3199 int g_supplicant_interface_connect(GSupplicantInterface *interface,
3200                                 GSupplicantSSID *ssid,
3201                                 GSupplicantInterfaceCallback callback,
3202                                                         void *user_data)
3203 {
3204         struct interface_connect_data *data;
3205         int ret;
3206
3207         if (interface == NULL)
3208                 return -EINVAL;
3209
3210         if (system_available == FALSE)
3211                 return -EFAULT;
3212
3213         /* TODO: Check if we're already connected and switch */
3214
3215         data = dbus_malloc0(sizeof(*data));
3216         if (data == NULL)
3217                 return -ENOMEM;
3218
3219         data->interface = interface;
3220         data->callback = callback;
3221         data->ssid = ssid;
3222         data->user_data = user_data;
3223
3224         if (ssid->use_wps == TRUE) {
3225                 g_free(interface->wps_cred.key);
3226                 memset(&interface->wps_cred, 0,
3227                                 sizeof(struct _GSupplicantWpsCredentials));
3228
3229                 ret = supplicant_dbus_property_set(interface->path,
3230                         SUPPLICANT_INTERFACE ".Interface.WPS",
3231                         "ProcessCredentials", DBUS_TYPE_BOOLEAN_AS_STRING,
3232                         wps_process_credentials, wps_start, data);
3233         } else
3234                 ret = supplicant_dbus_method_call(interface->path,
3235                         SUPPLICANT_INTERFACE ".Interface", "AddNetwork",
3236                         interface_add_network_params,
3237                         interface_add_network_result, data);
3238
3239         if (ret < 0)
3240                 return ret;
3241
3242         return -EINPROGRESS;
3243 }
3244
3245 static void network_remove_result(const char *error,
3246                                 DBusMessageIter *iter, void *user_data)
3247 {
3248         struct interface_data *data = user_data;
3249         int result = 0;
3250
3251         SUPPLICANT_DBG("");
3252
3253         if (error != NULL)
3254                 result = -EIO;
3255
3256         if (data->callback != NULL)
3257                 data->callback(result, data->interface, data->user_data);
3258
3259         dbus_free(data);
3260 }
3261
3262 static void network_remove_params(DBusMessageIter *iter, void *user_data)
3263 {
3264         struct interface_data *data = user_data;
3265         const char *path = data->interface->network_path;
3266
3267         SUPPLICANT_DBG("path %s", path);
3268
3269         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path);
3270 }
3271
3272 static int network_remove(struct interface_data *data)
3273 {
3274         GSupplicantInterface *interface = data->interface;
3275
3276         SUPPLICANT_DBG("");
3277
3278         return supplicant_dbus_method_call(interface->path,
3279                         SUPPLICANT_INTERFACE ".Interface", "RemoveNetwork",
3280                         network_remove_params, network_remove_result, data);
3281 }
3282
3283 static void interface_disconnect_result(const char *error,
3284                                 DBusMessageIter *iter, void *user_data)
3285 {
3286         struct interface_data *data = user_data;
3287
3288         SUPPLICANT_DBG("");
3289
3290         if (error != NULL && data->callback != NULL)
3291                 data->callback(-EIO, data->interface, data->user_data);
3292
3293         /* If we are disconnecting from previous WPS successful
3294          * association. i.e.: it did not went through AddNetwork,
3295          * and interface->network_path was never set. */
3296         if (data->interface->network_path == NULL)
3297                 return;
3298
3299         network_remove(data);
3300 }
3301
3302 int g_supplicant_interface_disconnect(GSupplicantInterface *interface,
3303                                         GSupplicantInterfaceCallback callback,
3304                                                         void *user_data)
3305 {
3306         struct interface_data *data;
3307
3308         SUPPLICANT_DBG("");
3309
3310         if (interface == NULL)
3311                 return -EINVAL;
3312
3313         if (system_available == FALSE)
3314                 return -EFAULT;
3315
3316         data = dbus_malloc0(sizeof(*data));
3317         if (data == NULL)
3318                 return -ENOMEM;
3319
3320         data->interface = interface;
3321         data->callback = callback;
3322         data->user_data = user_data;
3323
3324         return supplicant_dbus_method_call(interface->path,
3325                         SUPPLICANT_INTERFACE ".Interface", "Disconnect",
3326                                 NULL, interface_disconnect_result, data);
3327 }
3328
3329
3330 static const char *g_supplicant_rule0 = "type=signal,"
3331                                         "path=" DBUS_PATH_DBUS ","
3332                                         "sender=" DBUS_SERVICE_DBUS ","
3333                                         "interface=" DBUS_INTERFACE_DBUS ","
3334                                         "member=NameOwnerChanged,"
3335                                         "arg0=" SUPPLICANT_SERVICE;
3336 static const char *g_supplicant_rule1 = "type=signal,"
3337                         "interface=" SUPPLICANT_INTERFACE;
3338 static const char *g_supplicant_rule2 = "type=signal,"
3339                         "interface=" SUPPLICANT_INTERFACE ".Interface";
3340 static const char *g_supplicant_rule3 = "type=signal,"
3341                         "interface=" SUPPLICANT_INTERFACE ".Interface.WPS";
3342 static const char *g_supplicant_rule4 = "type=signal,"
3343                         "interface=" SUPPLICANT_INTERFACE ".BSS";
3344 static const char *g_supplicant_rule5 = "type=signal,"
3345                         "interface=" SUPPLICANT_INTERFACE ".Network";
3346
3347 static void invoke_introspect_method(void)
3348 {
3349         DBusMessage *message;
3350
3351         message = dbus_message_new_method_call(SUPPLICANT_SERVICE,
3352                                         SUPPLICANT_PATH,
3353                                         DBUS_INTERFACE_INTROSPECTABLE,
3354                                         "Introspect");
3355
3356         if (message == NULL)
3357                 return;
3358
3359         dbus_message_set_no_reply(message, TRUE);
3360         dbus_connection_send(connection, message, NULL);
3361         dbus_message_unref(message);
3362 }
3363
3364 int g_supplicant_register(const GSupplicantCallbacks *callbacks)
3365 {
3366         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
3367         if (connection == NULL)
3368                 return -EIO;
3369
3370         if (dbus_connection_add_filter(connection,
3371                                 g_supplicant_filter, NULL, NULL) == FALSE) {
3372                 dbus_connection_unref(connection);
3373                 connection = NULL;
3374                 return -EIO;
3375         }
3376
3377         callbacks_pointer = callbacks;
3378         eap_methods = 0;
3379
3380         interface_table = g_hash_table_new_full(g_str_hash, g_str_equal,
3381                                                 NULL, remove_interface);
3382
3383         bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
3384                                                                 NULL, NULL);
3385
3386         supplicant_dbus_setup(connection);
3387
3388         dbus_bus_add_match(connection, g_supplicant_rule0, NULL);
3389         dbus_bus_add_match(connection, g_supplicant_rule1, NULL);
3390         dbus_bus_add_match(connection, g_supplicant_rule2, NULL);
3391         dbus_bus_add_match(connection, g_supplicant_rule3, NULL);
3392         dbus_bus_add_match(connection, g_supplicant_rule4, NULL);
3393         dbus_bus_add_match(connection, g_supplicant_rule5, NULL);
3394         dbus_connection_flush(connection);
3395
3396         if (dbus_bus_name_has_owner(connection,
3397                                         SUPPLICANT_SERVICE, NULL) == TRUE) {
3398                 system_available = TRUE;
3399                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
3400                                                 SUPPLICANT_INTERFACE,
3401                                                 service_property, NULL);
3402         } else
3403                 invoke_introspect_method();
3404
3405         return 0;
3406 }
3407
3408 static void unregister_interface_remove_params(DBusMessageIter *iter,
3409                                                 void *user_data)
3410 {
3411         const char *path = user_data;
3412
3413         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
3414                                                         &path);
3415 }
3416
3417
3418 static void unregister_remove_interface(gpointer key, gpointer value,
3419                                                 gpointer user_data)
3420 {
3421         GSupplicantInterface *interface = value;
3422
3423         supplicant_dbus_method_call(SUPPLICANT_PATH,
3424                                         SUPPLICANT_INTERFACE,
3425                                         "RemoveInterface",
3426                                         unregister_interface_remove_params,
3427                                                 NULL, interface->path);
3428 }
3429
3430 void g_supplicant_unregister(const GSupplicantCallbacks *callbacks)
3431 {
3432         SUPPLICANT_DBG("");
3433
3434         if (connection != NULL) {
3435                 dbus_bus_remove_match(connection, g_supplicant_rule5, NULL);
3436                 dbus_bus_remove_match(connection, g_supplicant_rule4, NULL);
3437                 dbus_bus_remove_match(connection, g_supplicant_rule3, NULL);
3438                 dbus_bus_remove_match(connection, g_supplicant_rule2, NULL);
3439                 dbus_bus_remove_match(connection, g_supplicant_rule1, NULL);
3440                 dbus_bus_remove_match(connection, g_supplicant_rule0, NULL);
3441                 dbus_connection_flush(connection);
3442
3443                 dbus_connection_remove_filter(connection,
3444                                                 g_supplicant_filter, NULL);
3445         }
3446
3447         if (bss_mapping != NULL) {
3448                 g_hash_table_destroy(bss_mapping);
3449                 bss_mapping = NULL;
3450         }
3451
3452         if (system_available == TRUE)
3453                 callback_system_killed();
3454
3455         if (interface_table != NULL) {
3456                 g_hash_table_foreach(interface_table,
3457                                         unregister_remove_interface, NULL);
3458                 g_hash_table_destroy(interface_table);
3459                 interface_table = NULL;
3460         }
3461
3462         if (connection != NULL) {
3463                 dbus_connection_unref(connection);
3464                 connection = NULL;
3465         }
3466
3467         callbacks_pointer = NULL;
3468         eap_methods = 0;
3469 }