gsupplicant/supplicant.c

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