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