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