plugins/supplicant.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2010  Intel Corporation. All rights reserved.
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License version 2 as
   9  *  published by the Free Software Foundation.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  19  *
  20  */
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <stdio.h>
  27 #include <unistd.h>
  28 #include <errno.h>
  29 #include <stdlib.h>
  30 #include <string.h>
  31 #include <sys/ioctl.h>
  32 #include <sys/socket.h>
  33 #include <linux/if_arp.h>
  34 #include <linux/wireless.h>
  35 #include <net/ethernet.h>
  36
  37 #include <gdbus.h>
  38
  39 #define CONNMAN_API_SUBJECT_TO_CHANGE
  40 #include <connman/device.h>
  41 #include <connman/option.h>
  42 #include <connman/inet.h>
  43 #include <connman/dbus.h>
  44 #include <connman/wifi.h>
  45 #include <connman/log.h>
  46
  47 #include "supplicant.h"
  48
  49 #define TIMEOUT 5000
  50
  51 #define IEEE80211_CAP_ESS       0x0001
  52 #define IEEE80211_CAP_IBSS      0x0002
  53 #define IEEE80211_CAP_PRIVACY   0x0010
  54
  55 #define SUPPLICANT_NAME  "fi.epitest.hostap.WPASupplicant"
  56 #define SUPPLICANT_INTF  "fi.epitest.hostap.WPASupplicant"
  57 #define SUPPLICANT_PATH  "/fi/epitest/hostap/WPASupplicant"
  58
  59 /* Taken from "WPA Supplicant - Common definitions" */
  60 enum supplicant_state {
  61         /**
  62          * WPA_DISCONNECTED - Disconnected state
  63          *
  64          * This state indicates that client is not associated, but is likely to
  65          * start looking for an access point. This state is entered when a
  66          * connection is lost.
  67          */
  68         WPA_DISCONNECTED,
  69
  70         /**
  71          * WPA_INACTIVE - Inactive state (wpa_supplicant disabled)
  72          *
  73          * This state is entered if there are no enabled networks in the
  74          * configuration. wpa_supplicant is not trying to associate with a new
  75          * network and external interaction (e.g., ctrl_iface call to add or
  76          * enable a network) is needed to start association.
  77          */
  78         WPA_INACTIVE,
  79
  80         /**
  81          * WPA_SCANNING - Scanning for a network
  82          *
  83          * This state is entered when wpa_supplicant starts scanning for a
  84          * network.
  85          */
  86         WPA_SCANNING,
  87
  88         /**
  89          * WPA_ASSOCIATING - Trying to associate with a BSS/SSID
  90          *
  91          * This state is entered when wpa_supplicant has found a suitable BSS
  92          * to associate with and the driver is configured to try to associate
  93          * with this BSS in ap_scan=1 mode. When using ap_scan=2 mode, this
  94          * state is entered when the driver is configured to try to associate
  95          * with a network using the configured SSID and security policy.
  96          */
  97         WPA_ASSOCIATING,
  98
  99         /**
 100          * WPA_ASSOCIATED - Association completed
 101          *
 102          * This state is entered when the driver reports that association has
 103          * been successfully completed with an AP. If IEEE 802.1X is used
 104          * (with or without WPA/WPA2), wpa_supplicant remains in this state
 105          * until the IEEE 802.1X/EAPOL authentication has been completed.
 106          */
 107         WPA_ASSOCIATED,
 108
 109         /**
 110          * WPA_4WAY_HANDSHAKE - WPA 4-Way Key Handshake in progress
 111          *
 112          * This state is entered when WPA/WPA2 4-Way Handshake is started. In
 113          * case of WPA-PSK, this happens when receiving the first EAPOL-Key
 114          * frame after association. In case of WPA-EAP, this state is entered
 115          * when the IEEE 802.1X/EAPOL authentication has been completed.
 116          */
 117         WPA_4WAY_HANDSHAKE,
 118
 119         /**
 120          * WPA_GROUP_HANDSHAKE - WPA Group Key Handshake in progress
 121          *
 122          * This state is entered when 4-Way Key Handshake has been completed
 123          * (i.e., when the supplicant sends out message 4/4) and when Group
 124          * Key rekeying is started by the AP (i.e., when supplicant receives
 125          * message 1/2).
 126          */
 127         WPA_GROUP_HANDSHAKE,
 128
 129         /**
 130          * WPA_COMPLETED - All authentication completed
 131          *
 132          * This state is entered when the full authentication process is
 133          * completed. In case of WPA2, this happens when the 4-Way Handshake is
 134          * successfully completed. With WPA, this state is entered after the
 135          * Group Key Handshake; with IEEE 802.1X (non-WPA) connection is
 136          * completed after dynamic keys are received (or if not used, after
 137          * the EAP authentication has been completed). With static WEP keys and
 138          * plaintext connections, this state is entered when an association
 139          * has been completed.
 140          *
 141          * This state indicates that the supplicant has completed its
 142          * processing for the association phase and that data connection is
 143          * fully configured.
 144          */
 145         WPA_COMPLETED,
 146
 147         /**
 148          * WPA_INVALID - Invalid state (parsing error)
 149          *
 150          * This state is returned if the string input is invalid. It is not
 151          * an official wpa_supplicant state.
 152          */
 153         WPA_INVALID,
 154 };
 155
 156 struct supplicant_result {
 157         char *path;
 158         char *name;
 159         unsigned char *addr;
 160         unsigned int addr_len;
 161         unsigned char *ssid;
 162         unsigned int ssid_len;
 163         dbus_uint16_t capabilities;
 164         gboolean adhoc;
 165         gboolean has_wep;
 166         gboolean has_psk;
 167         gboolean has_8021x;
 168         gboolean has_wpa;
 169         gboolean has_rsn;
 170         gboolean has_wps;
 171         dbus_int32_t frequency;
 172         dbus_int32_t quality;
 173         dbus_int32_t noise;
 174         dbus_int32_t level;
 175         dbus_int32_t maxrate;
 176 };
 177
 178 struct supplicant_block {
 179         unsigned char *ssid;
 180         char *netpath;
 181         gboolean enabled;
 182         int num_scans;
 183 };
 184
 185 struct supplicant_task {
 186         int ifindex;
 187         char *ifname;
 188         gboolean cfg80211;
 189         struct connman_device *device;
 190         struct connman_network *network;
 191         struct connman_network *pending_network;
 192         char *path;
 193         char *netpath;
 194         gboolean hidden_found;
 195         GHashTable *hidden_blocks;
 196         gboolean created;
 197         enum supplicant_state state;
 198         gboolean scanning;
 199         GSList *scan_results;
 200         DBusPendingCall *scan_call;
 201         DBusPendingCall *result_call;
 202         struct iw_range *range;
 203         gboolean disconnecting;
 204 };
 205
 206 static GSList *task_list = NULL;
 207
 208 static DBusConnection *connection;
 209
 210 static void free_task(struct supplicant_task *task)
 211 {
 212         DBG("task %p", task);
 213
 214         g_free(task->ifname);
 215         g_free(task->path);
 216         g_free(task);
 217 }
 218
 219 static void remove_block(gpointer user_data)
 220 {
 221         struct supplicant_block *block = user_data;
 222
 223         DBG("");
 224
 225         g_free(block->ssid);
 226         g_free(block->netpath);
 227 }
 228
 229 static struct supplicant_task *find_task_by_index(int index)
 230 {
 231         GSList *list;
 232
 233         for (list = task_list; list; list = list->next) {
 234                 struct supplicant_task *task = list->data;
 235
 236                 if (task->ifindex == index)
 237                         return task;
 238         }
 239
 240         return NULL;
 241 }
 242
 243 static struct supplicant_task *find_task_by_path(const char *path)
 244 {
 245         GSList *list;
 246
 247         for (list = task_list; list; list = list->next) {
 248                 struct supplicant_task *task = list->data;
 249
 250                 if (g_strcmp0(task->path, path) == 0)
 251                         return task;
 252         }
 253
 254         return NULL;
 255 }
 256
 257 static int get_range(struct supplicant_task *task)
 258 {
 259         struct iwreq wrq;
 260         int fd, err;
 261
 262         fd = socket(PF_INET, SOCK_DGRAM, 0);
 263         if (fd < 0)
 264                 return -1;
 265
 266         memset(&wrq, 0, sizeof(struct iwreq));
 267         strncpy(wrq.ifr_name, task->ifname, IFNAMSIZ);
 268         wrq.u.data.pointer = task->range;
 269         wrq.u.data.length = sizeof(struct iw_range);
 270
 271         err = ioctl(fd, SIOCGIWRANGE, &wrq);
 272
 273         close(fd);
 274
 275         if (err < 0)
 276                 task->range->max_qual.updated |= IW_QUAL_ALL_INVALID;
 277
 278         connman_info("%s {scan} capabilities 0x%02x", task->ifname,
 279                                                 task->range->scan_capa);
 280
 281         connman_info("%s {quality} flags 0x%02x", task->ifname,
 282                                         task->range->max_qual.updated);
 283
 284         return err;
 285 }
 286
 287 static int get_bssid(struct connman_device *device,
 288                                 unsigned char *bssid, unsigned int *bssid_len)
 289 {
 290         struct iwreq wrq;
 291         char *ifname;
 292         int ifindex;
 293         int fd, err;
 294
 295         ifindex = connman_device_get_index(device);
 296         if (ifindex < 0)
 297                 return -EINVAL;
 298
 299         ifname = connman_inet_ifname(ifindex);
 300         if (ifname == NULL)
 301                 return -EINVAL;
 302
 303         fd = socket(PF_INET, SOCK_DGRAM, 0);
 304         if (fd < 0) {
 305                 g_free(ifname);
 306                 return -EINVAL;
 307         }
 308
 309         memset(&wrq, 0, sizeof(wrq));
 310         strncpy(wrq.ifr_name, ifname, IFNAMSIZ);
 311
 312         err = ioctl(fd, SIOCGIWAP, &wrq);
 313
 314         g_free(ifname);
 315         close(fd);
 316
 317         if (err < 0)
 318                 return -EIO;
 319
 320         memcpy(bssid, wrq.u.ap_addr.sa_data, ETH_ALEN);
 321         *bssid_len = ETH_ALEN;
 322
 323         return 0;
 324 }
 325
 326 static int enable_network(struct supplicant_task *task, const char *netpath,
 327                           connman_bool_t enable)
 328 {
 329         DBusMessage *message, *reply;
 330         DBusError error;
 331         char *enable_string;
 332
 333         DBG("enable %d", enable);
 334
 335         enable_string = enable ? "enable" : "disable";
 336
 337         message = dbus_message_new_method_call(SUPPLICANT_NAME, netpath,
 338                                 SUPPLICANT_INTF ".Network", enable_string);
 339         if (message == NULL)
 340                 return -ENOMEM;
 341
 342         dbus_message_set_auto_start(message, FALSE);
 343
 344         dbus_error_init(&error);
 345
 346         reply = dbus_connection_send_with_reply_and_block(connection,
 347                                                         message, -1, &error);
 348         if (reply == NULL) {
 349                 if (dbus_error_is_set(&error) == TRUE) {
 350                         connman_error("%s", error.message);
 351                         dbus_error_free(&error);
 352                 } else
 353                         connman_error("Failed to select network");
 354                 dbus_message_unref(message);
 355                 return -EIO;
 356         }
 357
 358         dbus_message_unref(reply);
 359
 360         dbus_message_unref(message);
 361
 362         return 0;
 363 }
 364
 365 static int set_hidden_network(struct supplicant_task *task, const char *netpath,
 366                                 const unsigned char *ssid, int ssid_len)
 367 {
 368         DBusMessage *message, *reply;
 369         DBusMessageIter array, dict;
 370         DBusError error;
 371         dbus_uint32_t scan_ssid = 1;
 372         const char *invalid_address = "ff:ff:ff:ff:ff:ff";
 373
 374         message = dbus_message_new_method_call(SUPPLICANT_NAME, netpath,
 375                                         SUPPLICANT_INTF ".Network", "set");
 376         if (message == NULL)
 377                 return -ENOMEM;
 378
 379         dbus_message_set_auto_start(message, FALSE);
 380
 381         dbus_message_iter_init_append(message, &array);
 382
 383         connman_dbus_dict_open(&array, &dict);
 384
 385         connman_dbus_dict_append_basic(&dict, "scan_ssid",
 386                                          DBUS_TYPE_UINT32, &scan_ssid);
 387
 388         connman_dbus_dict_append_fixed_array(&dict, "ssid",
 389                                         DBUS_TYPE_BYTE, &ssid, ssid_len);
 390
 391         /*
 392          * We're setting an invalid BSSID to prevent wpa_s from associating
 393          * automatically to this block once it's found.
 394          */
 395         connman_dbus_dict_append_basic(&dict, "bssid",
 396                                         DBUS_TYPE_STRING, &invalid_address);
 397
 398         connman_dbus_dict_close(&array, &dict);
 399
 400         dbus_error_init(&error);
 401
 402         reply = dbus_connection_send_with_reply_and_block(connection,
 403                                                         message, -1, &error);
 404         if (reply == NULL) {
 405                 if (dbus_error_is_set(&error) == TRUE) {
 406                         connman_error("%s", error.message);
 407                         dbus_error_free(&error);
 408                 } else
 409                         connman_error("Failed to set network options");
 410                 dbus_message_unref(message);
 411                 return -EIO;
 412         }
 413
 414         dbus_message_unref(reply);
 415
 416         dbus_message_unref(message);
 417
 418         return 0;
 419 }
 420
 421 static void block_reset(gpointer key, gpointer value, gpointer user_data)
 422 {
 423         struct supplicant_block *block = value;
 424         struct supplicant_task *task = user_data;
 425
 426         block->num_scans = 0;
 427         if (block->enabled)
 428                 enable_network(task, block->netpath, FALSE);
 429
 430         block->enabled = FALSE;
 431 }
 432
 433 #define MAX_BLOCK_SCANS 2
 434 static void hidden_block_enable(struct supplicant_task *task)
 435 {
 436         GHashTableIter iter;
 437         gpointer key, value;
 438         struct supplicant_block *block;
 439
 440         DBG("network %p", task->network);
 441
 442         if (g_hash_table_size(task->hidden_blocks) == 0)
 443                 return;
 444
 445         /*
 446          * If we're associated or associating, we no longer need to
 447          * look for hidden networks.
 448          */
 449         if (task->network)
 450                 return;
 451
 452         /*
 453          * We go through the block list and:
 454          * - If we scanned it more than twice, we disable it and move
 455          *   on to the next block.
 456          * - If the next block is not enabled, we enable it, start
 457          *   the scan counter, and return. This routine will be called
 458          *   again when the next scan results are available.
 459          * - If we're done with all the blocks there, we just reset them.
 460          */
 461         g_hash_table_iter_init(&iter, task->hidden_blocks);
 462         while (g_hash_table_iter_next(&iter, &key, &value)) {
 463                 block = value;
 464
 465                 DBG("%s num of scans %d enabled %d",
 466                         block->ssid, block->num_scans, block->enabled);
 467
 468                 if (block->num_scans > MAX_BLOCK_SCANS) {
 469                         if (block->enabled == FALSE)
 470                                 continue;
 471
 472                         enable_network(task, block->netpath, FALSE);
 473                         block->enabled = FALSE;
 474                         continue;
 475                 }
 476
 477                 if (block->enabled == FALSE) {
 478                         enable_network(task, block->netpath, TRUE);
 479                         block->enabled = TRUE;
 480                 }
 481
 482                 block->num_scans++;
 483
 484                 return;
 485         }
 486
 487         g_hash_table_foreach(task->hidden_blocks, block_reset, task);
 488 }
 489
 490 static int add_hidden_network(struct supplicant_task *task,
 491                                 const unsigned char *ssid, int ssid_len)
 492 {
 493         DBusMessage *message, *reply;
 494         DBusError error;
 495         const char *path;
 496         struct supplicant_block *block;
 497         char *netpath = NULL;
 498         int ret, i;
 499
 500         DBG("task %p", task);
 501
 502         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 503                                 SUPPLICANT_INTF ".Interface", "addNetwork");
 504         if (message == NULL)
 505                 return -ENOMEM;
 506
 507         dbus_message_set_auto_start(message, FALSE);
 508
 509         dbus_error_init(&error);
 510
 511         reply = dbus_connection_send_with_reply_and_block(connection,
 512                                                         message, -1, &error);
 513         if (reply == NULL) {
 514                 if (dbus_error_is_set(&error) == TRUE) {
 515                         connman_error("%s", error.message);
 516                         dbus_error_free(&error);
 517                 } else
 518                         connman_error("Failed to add network");
 519                 dbus_message_unref(message);
 520                 return -EIO;
 521         }
 522
 523         dbus_error_init(&error);
 524
 525         if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
 526                                                 DBUS_TYPE_INVALID) == FALSE) {
 527                 if (dbus_error_is_set(&error) == TRUE) {
 528                         connman_error("%s", error.message);
 529                         dbus_error_free(&error);
 530                 } else
 531                         connman_error("Wrong arguments for network");
 532                 dbus_message_unref(reply);
 533                 return -EIO;
 534         }
 535
 536         netpath = g_strdup(path);
 537
 538         ret = set_hidden_network(task, netpath, ssid, ssid_len);
 539         if (ret < 0)
 540                 goto done;
 541
 542         block = g_try_new0(struct supplicant_block, 1);
 543         if (block == NULL)
 544                 goto done;
 545
 546         block->ssid = g_try_malloc0(ssid_len + 1);
 547         if (block->ssid == NULL) {
 548                 g_free(block);
 549                 goto done;
 550         }
 551
 552         for (i = 0; i < ssid_len; i++) {
 553                 if (g_ascii_isprint(ssid[i]))
 554                         block->ssid[i] = ssid[i];
 555                 else
 556                         block->ssid[i] = ' ';
 557         }
 558
 559         block->netpath = netpath;
 560         block->enabled = FALSE;
 561         block->num_scans = 0;
 562
 563         DBG("path %s ssid %s", block->netpath, block->ssid);
 564
 565         g_hash_table_replace(task->hidden_blocks, block->ssid, block);
 566
 567         return 0;
 568 done:
 569         g_free(netpath);
 570
 571         dbus_message_unref(reply);
 572
 573         dbus_message_unref(message);
 574
 575         return ret;
 576 }
 577
 578 static void add_interface_reply(DBusPendingCall *call, void *user_data)
 579 {
 580         struct supplicant_task *task = user_data;
 581         DBusMessage *reply;
 582         DBusError error;
 583         const char *path;
 584         char **hex_ssids, *hex_ssid;
 585         int i;
 586
 587         DBG("task %p", task);
 588
 589         reply = dbus_pending_call_steal_reply(call);
 590
 591         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR)
 592                 goto failed;
 593
 594         dbus_error_init(&error);
 595
 596         if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
 597                                                 DBUS_TYPE_INVALID) == FALSE) {
 598                 if (dbus_error_is_set(&error) == TRUE) {
 599                         connman_error("%s", error.message);
 600                         dbus_error_free(&error);
 601                 } else
 602                         connman_error("Wrong arguments for add interface");
 603                 goto failed;
 604         }
 605
 606         DBG("path %s", path);
 607
 608         task->path = g_strdup(path);
 609         task->created = TRUE;
 610
 611         connman_device_set_powered(task->device, TRUE);
 612
 613         dbus_message_unref(reply);
 614
 615         dbus_pending_call_unref(call);
 616
 617         hex_ssids = connman_wifi_load_ssid();
 618         if (hex_ssids == NULL)
 619                 return;
 620
 621         for (i = 0; hex_ssids[i]; i++) {
 622                 unsigned char *ssid;
 623                 unsigned int j, k = 0, hex;
 624                 size_t hex_ssid_len;
 625
 626                 hex_ssid = hex_ssids[i];
 627                 hex_ssid_len = strlen(hex_ssid);
 628
 629                 ssid = g_try_malloc0(hex_ssid_len / 2 + 1);
 630                 if (ssid == NULL)
 631                         break;
 632
 633                 for (j = 0, k = 0; j < hex_ssid_len; j += 2) {
 634                         sscanf(hex_ssid + j, "%02x", &hex);
 635                         ssid[k++] = hex;
 636                 }
 637
 638                 if (add_hidden_network(task, ssid, hex_ssid_len / 2) < 0)
 639                         break;
 640         }
 641
 642         g_strfreev(hex_ssids);
 643
 644         return;
 645
 646 failed:
 647         dbus_message_unref(reply);
 648
 649         dbus_pending_call_unref(call);
 650
 651         task_list = g_slist_remove(task_list, task);
 652
 653         connman_device_unref(task->device);
 654
 655         free_task(task);
 656 }
 657
 658 static int add_interface(struct supplicant_task *task)
 659 {
 660         const char *driver = connman_option_get_string("wifi");
 661         DBusMessage *message;
 662         DBusMessageIter array, dict;
 663         DBusPendingCall *call;
 664
 665         DBG("task %p", task);
 666
 667         message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
 668                                         SUPPLICANT_INTF, "addInterface");
 669         if (message == NULL)
 670                 return -ENOMEM;
 671
 672         dbus_message_set_auto_start(message, FALSE);
 673
 674         dbus_message_iter_init_append(message, &array);
 675
 676         dbus_message_iter_append_basic(&array,
 677                                         DBUS_TYPE_STRING, &task->ifname);
 678
 679         connman_dbus_dict_open(&array, &dict);
 680
 681         connman_dbus_dict_append_basic(&dict, "driver",
 682                                                 DBUS_TYPE_STRING, &driver);
 683
 684         connman_dbus_dict_close(&array, &dict);
 685
 686         if (dbus_connection_send_with_reply(connection, message,
 687                                                 &call, TIMEOUT) == FALSE) {
 688                 connman_error("Failed to add interface");
 689                 dbus_message_unref(message);
 690                 return -EIO;
 691         }
 692
 693         if (call == NULL) {
 694                 connman_error("D-Bus connection not available");
 695                 dbus_message_unref(message);
 696                 return -EIO;
 697         }
 698
 699         dbus_pending_call_set_notify(call, add_interface_reply, task, NULL);
 700
 701         dbus_message_unref(message);
 702
 703         return -EINPROGRESS;
 704 }
 705
 706 static void get_interface_reply(DBusPendingCall *call, void *user_data)
 707 {
 708         struct supplicant_task *task = user_data;
 709         DBusMessage *reply;
 710         DBusError error;
 711         const char *path;
 712
 713         DBG("task %p", task);
 714
 715         reply = dbus_pending_call_steal_reply(call);
 716
 717         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR) {
 718                 add_interface(task);
 719                 goto done;
 720         }
 721
 722         dbus_error_init(&error);
 723
 724         if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
 725                                                 DBUS_TYPE_INVALID) == FALSE) {
 726                 if (dbus_error_is_set(&error) == TRUE) {
 727                         connman_error("%s", error.message);
 728                         dbus_error_free(&error);
 729                 } else
 730                         connman_error("Wrong arguments for get interface");
 731                 goto done;
 732         }
 733
 734         DBG("path %s", path);
 735
 736         task->path = g_strdup(path);
 737         task->created = FALSE;
 738
 739         connman_device_set_powered(task->device, TRUE);
 740
 741 done:
 742         dbus_message_unref(reply);
 743
 744         dbus_pending_call_unref(call);
 745 }
 746
 747 static int create_interface(struct supplicant_task *task)
 748 {
 749         DBusMessage *message;
 750         DBusPendingCall *call;
 751
 752         DBG("task %p", task);
 753
 754         message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
 755                                         SUPPLICANT_INTF, "getInterface");
 756         if (message == NULL)
 757                 return -ENOMEM;
 758
 759         dbus_message_set_auto_start(message, FALSE);
 760
 761         dbus_message_append_args(message, DBUS_TYPE_STRING, &task->ifname,
 762                                                         DBUS_TYPE_INVALID);
 763
 764         if (dbus_connection_send_with_reply(connection, message,
 765                                                 &call, TIMEOUT) == FALSE) {
 766                 connman_error("Failed to get interface");
 767                 dbus_message_unref(message);
 768                 return -EIO;
 769         }
 770
 771         if (call == NULL) {
 772                 connman_error("D-Bus connection not available");
 773                 dbus_message_unref(message);
 774                 return -EIO;
 775         }
 776
 777         dbus_pending_call_set_notify(call, get_interface_reply, task, NULL);
 778
 779         dbus_message_unref(message);
 780
 781         return -EINPROGRESS;
 782 }
 783
 784 static void remove_interface_reply(DBusPendingCall *call, void *user_data)
 785 {
 786         struct supplicant_task *task = user_data;
 787         DBusMessage *reply;
 788
 789         DBG("task %p", task);
 790
 791         reply = dbus_pending_call_steal_reply(call);
 792
 793         connman_device_set_powered(task->device, FALSE);
 794
 795         connman_device_unref(task->device);
 796
 797         connman_inet_ifdown(task->ifindex);
 798
 799         free_task(task);
 800
 801         dbus_message_unref(reply);
 802
 803         dbus_pending_call_unref(call);
 804 }
 805
 806 static int remove_interface(struct supplicant_task *task)
 807 {
 808         DBusMessage *message;
 809         DBusPendingCall *call;
 810
 811         DBG("task %p", task);
 812
 813         if (task->path == NULL)
 814                 return 0;
 815
 816 #if 0
 817         if (task->created == FALSE) {
 818                 connman_device_set_powered(task->device, FALSE);
 819                 return 0;
 820         }
 821 #endif
 822
 823         message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
 824                                         SUPPLICANT_INTF, "removeInterface");
 825         if (message == NULL)
 826                 return -ENOMEM;
 827
 828         dbus_message_set_auto_start(message, FALSE);
 829
 830         dbus_message_append_args(message, DBUS_TYPE_OBJECT_PATH, &task->path,
 831                                                         DBUS_TYPE_INVALID);
 832
 833         if (dbus_connection_send_with_reply(connection, message,
 834                                                 &call, TIMEOUT) == FALSE) {
 835                 connman_error("Failed to remove interface");
 836                 dbus_message_unref(message);
 837                 return -EIO;
 838         }
 839
 840         if (call == NULL) {
 841                 connman_error("D-Bus connection not available");
 842                 dbus_message_unref(message);
 843                 return -EIO;
 844         }
 845
 846         dbus_pending_call_set_notify(call, remove_interface_reply, task, NULL);
 847
 848         dbus_message_unref(message);
 849
 850         return -EINPROGRESS;
 851 }
 852
 853 static int set_ap_scan(struct supplicant_task *task)
 854 {
 855         DBusMessage *message, *reply;
 856         DBusError error;
 857         guint32 ap_scan = 1;
 858
 859         DBG("task %p", task);
 860
 861         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 862                                 SUPPLICANT_INTF ".Interface", "setAPScan");
 863         if (message == NULL)
 864                 return -ENOMEM;
 865
 866         dbus_message_set_auto_start(message, FALSE);
 867
 868         dbus_message_append_args(message, DBUS_TYPE_UINT32, &ap_scan,
 869                                                         DBUS_TYPE_INVALID);
 870
 871         dbus_error_init(&error);
 872
 873         reply = dbus_connection_send_with_reply_and_block(connection,
 874                                                         message, -1, &error);
 875         if (reply == NULL) {
 876                 if (dbus_error_is_set(&error) == TRUE) {
 877                         connman_error("%s", error.message);
 878                         dbus_error_free(&error);
 879                 } else
 880                         connman_error("Failed to set AP scan");
 881                 dbus_message_unref(message);
 882                 return -EIO;
 883         }
 884
 885         dbus_message_unref(message);
 886
 887         dbus_message_unref(reply);
 888
 889         return 0;
 890 }
 891
 892 static int add_network(struct supplicant_task *task)
 893 {
 894         DBusMessage *message, *reply;
 895         DBusError error;
 896         const char *path;
 897
 898         DBG("task %p", task);
 899
 900         if (task->netpath != NULL)
 901                 return -EALREADY;
 902
 903         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 904                                 SUPPLICANT_INTF ".Interface", "addNetwork");
 905         if (message == NULL)
 906                 return -ENOMEM;
 907
 908         dbus_message_set_auto_start(message, FALSE);
 909
 910         dbus_error_init(&error);
 911
 912         reply = dbus_connection_send_with_reply_and_block(connection,
 913                                                         message, -1, &error);
 914         if (reply == NULL) {
 915                 if (dbus_error_is_set(&error) == TRUE) {
 916                         connman_error("%s", error.message);
 917                         dbus_error_free(&error);
 918                 } else
 919                         connman_error("Failed to add network");
 920                 dbus_message_unref(message);
 921                 return -EIO;
 922         }
 923
 924         dbus_message_unref(message);
 925
 926         dbus_error_init(&error);
 927
 928         if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
 929                                                 DBUS_TYPE_INVALID) == FALSE) {
 930                 if (dbus_error_is_set(&error) == TRUE) {
 931                         connman_error("%s", error.message);
 932                         dbus_error_free(&error);
 933                 } else
 934                         connman_error("Wrong arguments for network");
 935                 dbus_message_unref(reply);
 936                 return -EIO;
 937         }
 938
 939         DBG("path %s", path);
 940
 941         task->netpath = g_strdup(path);
 942
 943         dbus_message_unref(reply);
 944
 945         return 0;
 946 }
 947
 948 static int remove_network(struct supplicant_task *task)
 949 {
 950         DBusMessage *message, *reply;
 951         DBusError error;
 952
 953         DBG("task %p", task);
 954
 955         if (task->netpath == NULL || task->path == NULL)
 956                 return -EINVAL;
 957
 958         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 959                                 SUPPLICANT_INTF ".Interface", "removeNetwork");
 960         if (message == NULL)
 961                 return -ENOMEM;
 962
 963         dbus_message_set_auto_start(message, FALSE);
 964
 965         dbus_message_append_args(message, DBUS_TYPE_OBJECT_PATH, &task->netpath,
 966                                                         DBUS_TYPE_INVALID);
 967
 968         dbus_error_init(&error);
 969
 970         reply = dbus_connection_send_with_reply_and_block(connection,
 971                                                         message, -1, &error);
 972         if (reply == NULL) {
 973                 if (dbus_error_is_set(&error) == TRUE) {
 974                         connman_error("%s", error.message);
 975                         dbus_error_free(&error);
 976                 } else
 977                         connman_error("Failed to remove network");
 978                 dbus_message_unref(message);
 979                 return -EIO;
 980         }
 981
 982         dbus_message_unref(message);
 983
 984         dbus_message_unref(reply);
 985
 986         g_free(task->netpath);
 987         task->netpath = NULL;
 988
 989         return 0;
 990 }
 991
 992 static int select_network(struct supplicant_task *task)
 993 {
 994         DBusMessage *message, *reply;
 995         DBusError error;
 996
 997         DBG("task %p", task);
 998
 999         if (task->netpath == NULL)
1000                 return -EINVAL;
1001
1002         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
1003                                 SUPPLICANT_INTF ".Interface", "selectNetwork");
1004         if (message == NULL)
1005                 return -ENOMEM;
1006
1007         dbus_message_set_auto_start(message, FALSE);
1008
1009         dbus_message_append_args(message, DBUS_TYPE_OBJECT_PATH, &task->netpath,
1010                                                         DBUS_TYPE_INVALID);
1011
1012         dbus_error_init(&error);
1013
1014         reply = dbus_connection_send_with_reply_and_block(connection,
1015                                                         message, -1, &error);
1016         if (reply == NULL) {
1017                 if (dbus_error_is_set(&error) == TRUE) {
1018                         connman_error("%s", error.message);
1019                         dbus_error_free(&error);
1020                 } else
1021                         connman_error("Failed to select network");
1022                 dbus_message_unref(message);
1023                 return -EIO;
1024         }
1025
1026         dbus_message_unref(message);
1027
1028         dbus_message_unref(reply);
1029
1030         return 0;
1031 }
1032
1033 static int disconnect_network(struct supplicant_task *task)
1034 {
1035         DBusMessage *message, *reply;
1036         DBusError error;
1037
1038         DBG("task %p", task);
1039
1040         if (task->path == NULL)
1041                 return -EINVAL;
1042
1043         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
1044                                 SUPPLICANT_INTF ".Interface", "disconnect");
1045         if (message == NULL)
1046                 return -ENOMEM;
1047
1048         dbus_message_set_auto_start(message, FALSE);
1049
1050         dbus_error_init(&error);
1051
1052         reply = dbus_connection_send_with_reply_and_block(connection,
1053                                                         message, -1, &error);
1054         if (reply == NULL) {
1055                 if (dbus_error_is_set(&error) == TRUE) {
1056                         connman_error("%s", error.message);
1057                         dbus_error_free(&error);
1058                 } else
1059                         connman_error("Failed to disconnect network");
1060                 dbus_message_unref(message);
1061                 return -EIO;
1062         }
1063
1064         dbus_message_unref(message);
1065
1066         dbus_message_unref(reply);
1067
1068         return 0;
1069 }
1070
1071 static int set_network_tls(struct connman_network *network,
1072                            DBusMessageIter *dict)
1073 {
1074         const char *private_key, *client_cert, *ca_cert;
1075         const char *private_key_password;
1076
1077         /*
1078          * For TLS, we at least need:
1079          *              The client certificate
1080          *              The client private key file
1081          *              The client private key file password
1082          *
1083          * The Authority certificate is optional.
1084          */
1085         client_cert = connman_network_get_string(network,
1086                                                 "WiFi.ClientCertFile");
1087         if (client_cert == NULL) {
1088                 connman_error("Error in TLS authentication: "
1089                               "a ClientCertFile must be defined\n");
1090                 return -EINVAL;
1091         }
1092
1093         private_key = connman_network_get_string(network,
1094                                                 "WiFi.PrivateKeyFile");
1095         if (private_key == NULL) {
1096                 connman_error("Error in TLS authentication: "
1097                               "a PrivateKeyFile must be defined\n");
1098                 return -EINVAL;
1099         }
1100
1101         private_key_password = connman_network_get_string(network,
1102                                                 "WiFi.PrivateKeyPassphrase");
1103         if (private_key_password == NULL) {
1104                 connman_error("Error in TLS authentication: "
1105                               "a PrivateKeyPassphrase must be defined\n");
1106                 return -EINVAL;
1107         }
1108
1109         ca_cert = connman_network_get_string(network, "WiFi.CACertFile");
1110         if (ca_cert)
1111                 connman_dbus_dict_append_basic(dict, "ca_cert",
1112                                                 DBUS_TYPE_STRING, &ca_cert);
1113         else
1114                 connman_info("No CACertFile has been provided "
1115                              "to do the TLS authentication\n");
1116
1117         DBG("client cert %s private key %s", client_cert, private_key);
1118
1119         connman_dbus_dict_append_basic(dict, "private_key",
1120                                                 DBUS_TYPE_STRING, &private_key);
1121         connman_dbus_dict_append_basic(dict, "private_key_passwd",
1122                                                         DBUS_TYPE_STRING,
1123                                                         &private_key_password);
1124         connman_dbus_dict_append_basic(dict, "client_cert",
1125                                                 DBUS_TYPE_STRING, &client_cert);
1126
1127         return 0;
1128 }
1129
1130 static int set_network_peap(struct connman_network *network,
1131                             DBusMessageIter *dict, const char *passphrase)
1132 {
1133         const char *client_cert, *ca_cert, *phase2;
1134         char *phase2_auth;
1135
1136         /*
1137          * For PEAP/TTLS, we at least need
1138          *              The authority certificate
1139          *              The 2nd phase authentication method
1140          *              The 2nd phase passphrase
1141          *
1142          * The Client certificate is optional although strongly required
1143          * When setting it, we need in addition
1144          *              The Client private key file
1145          *              The Client private key file password
1146          */
1147         if (passphrase == NULL) {
1148                 connman_error("Error in PEAP/TTLS authentication: "
1149                               "a phase2 passphrase must be defined\n");
1150                 return -EINVAL;
1151         }
1152
1153         ca_cert = connman_network_get_string(network, "WiFi.CACertFile");
1154         if (ca_cert == NULL) {
1155                 connman_error("Error in PEAP/TTLS authentication: "
1156                               "CACertFile must be defined\n");
1157                 return -EINVAL;
1158         }
1159
1160         phase2 = connman_network_get_string(network, "WiFi.Phase2");
1161         if (phase2 == NULL) {
1162                 connman_error("Error in PEAP/TTLS authentication: "
1163                               "Phase2 must be defined\n");
1164                 return -EINVAL;
1165         }
1166
1167         DBG("CA cert %s phase2 auth %s", ca_cert, phase2);
1168
1169         client_cert = connman_network_get_string(network,
1170                                                         "WiFi.ClientCertFile");
1171         if (client_cert) {
1172                 const char *private_key, *private_key_password;
1173
1174                 private_key = connman_network_get_string(network,
1175                                                         "WiFi.PrivateKeyFile");
1176                 if (private_key == NULL) {
1177                         connman_error("Error in PEAP/TTLS authentication: "
1178                                       "with ClientCertFile, "
1179                                       "PrivateKeyFile must be defined\n");
1180                         return -EINVAL;
1181                 }
1182
1183                 private_key_password =
1184                         connman_network_get_string(network,
1185                                                 "WiFi.PrivateKeyPassphrase");
1186                 if (private_key_password == NULL) {
1187                         connman_error("Error in PEAP/TTLS authentication: "
1188                                       "with ClientCertFile, "
1189                                       "PrivateKeyPassphrase must be defined\n");
1190                         return -EINVAL;
1191                 }
1192
1193                 connman_dbus_dict_append_basic(dict, "client_cert",
1194                                                 DBUS_TYPE_STRING, &client_cert);
1195
1196                 connman_dbus_dict_append_basic(dict, "private_key",
1197                                                 DBUS_TYPE_STRING, &private_key);
1198
1199                 connman_dbus_dict_append_basic(dict, "private_key_passwd",
1200                                                         DBUS_TYPE_STRING,
1201                                                         &private_key_password);
1202
1203                 DBG("client cert %s private key %s", client_cert, private_key);
1204         } else
1205                 connman_info("No client certificate has been provided "
1206                              "to do the PEAP/TTLS authentication\n");
1207
1208         phase2_auth = g_strdup_printf("\"auth=%s\"", phase2);
1209
1210         connman_dbus_dict_append_basic(dict, "password",
1211                                                 DBUS_TYPE_STRING, &passphrase);
1212
1213         connman_dbus_dict_append_basic(dict, "ca_cert",
1214                                                 DBUS_TYPE_STRING, &ca_cert);
1215
1216         connman_dbus_dict_append_basic(dict, "phase2",
1217                                                 DBUS_TYPE_STRING, &phase2_auth);
1218
1219         g_free(phase2_auth);
1220
1221         return 0;
1222 }
1223
1224 static int set_network(struct supplicant_task *task,
1225                                 const unsigned char *network, int len,
1226                                 const char *address, const char *security,
1227                                                         const char *passphrase)
1228 {
1229         DBusMessage *message, *reply;
1230         DBusMessageIter array, dict;
1231         DBusError error;
1232         dbus_uint32_t scan_ssid = 1;
1233
1234         DBG("task %p", task);
1235
1236         if (task->netpath == NULL)
1237                 return -EINVAL;
1238
1239         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->netpath,
1240                                         SUPPLICANT_INTF ".Network", "set");
1241         if (message == NULL)
1242                 return -ENOMEM;
1243
1244         dbus_message_set_auto_start(message, FALSE);
1245
1246         dbus_message_iter_init_append(message, &array);
1247
1248         connman_dbus_dict_open(&array, &dict);
1249
1250         connman_dbus_dict_append_basic(&dict, "scan_ssid",
1251                                          DBUS_TYPE_UINT32, &scan_ssid);
1252
1253         if (network)
1254                 connman_dbus_dict_append_fixed_array(&dict, "ssid",
1255                                                 DBUS_TYPE_BYTE, &network, len);
1256         else if (address)
1257                 connman_dbus_dict_append_basic(&dict, "bssid",
1258                                                 DBUS_TYPE_STRING, &address);
1259
1260         if (g_ascii_strcasecmp(security, "psk") == 0 ||
1261                                 g_ascii_strcasecmp(security, "wpa") == 0 ||
1262                                 g_ascii_strcasecmp(security, "rsn") == 0) {
1263                 const char *key_mgmt = "WPA-PSK";
1264                 connman_dbus_dict_append_basic(&dict, "key_mgmt",
1265                                                 DBUS_TYPE_STRING, &key_mgmt);
1266
1267                 if (passphrase && strlen(passphrase) > 0)
1268                         connman_dbus_dict_append_basic(&dict, "psk",
1269                                                 DBUS_TYPE_STRING, &passphrase);
1270         } else if (g_ascii_strcasecmp(security, "ieee8021x") == 0) {
1271                 struct connman_network *network = task->network;
1272                 const char *key_mgmt = "WPA-EAP", *eap, *identity;
1273                 char *eap_value;
1274
1275                 /*
1276                  * If our private key password is unset,
1277                  * we use the supplied passphrase. That is needed
1278                  * for PEAP where 2 passphrases (identity and client
1279                  * cert may have to be provided.
1280                  */
1281                 if (connman_network_get_string(network,
1282                                         "WiFi.PrivateKeyPassphrase") == NULL)
1283                         connman_network_set_string(network,
1284                                                 "WiFi.PrivateKeyPassphrase",
1285                                                                 passphrase);
1286
1287                 eap = connman_network_get_string(network, "WiFi.EAP");
1288                 if (eap == NULL)
1289                         goto invalid;
1290
1291                 /* We must have an identity for both PEAP and TLS */
1292                 identity = connman_network_get_string(network, "WiFi.Identity");
1293                 if (identity == NULL)
1294                         goto invalid;
1295
1296                 DBG("key_mgmt %s eap %s identity %s", key_mgmt, eap, identity);
1297
1298                 if (g_strcmp0(eap, "tls") == 0) {
1299                         int err;
1300
1301                         err = set_network_tls(network, &dict);
1302                         if (err < 0) {
1303                                 dbus_message_unref(message);
1304                                 return err;
1305                         }
1306                 } else if (g_strcmp0(eap, "peap") == 0 ||
1307                                    g_strcmp0(eap, "ttls") == 0) {
1308                         int err;
1309
1310                         err = set_network_peap(network, &dict, passphrase);
1311                         if (err < 0) {
1312                                 dbus_message_unref(message);
1313                                 return err;
1314                         }
1315                 } else {
1316                         connman_error("Unknown EAP %s", eap);
1317                         goto invalid;
1318                 }
1319
1320                 /* wpa_supplicant only accepts upper case EAPs */
1321                 eap_value = g_ascii_strup(eap, -1);
1322
1323                 connman_dbus_dict_append_basic(&dict, "key_mgmt",
1324                                                         DBUS_TYPE_STRING,
1325                                                         &key_mgmt);
1326                 connman_dbus_dict_append_basic(&dict, "eap",
1327                                                         DBUS_TYPE_STRING,
1328                                                         &eap_value);
1329                 connman_dbus_dict_append_basic(&dict, "identity",
1330                                                         DBUS_TYPE_STRING,
1331                                                         &identity);
1332
1333                 g_free(eap_value);
1334
1335         } else if (g_ascii_strcasecmp(security, "wep") == 0) {
1336                 const char *key_mgmt = "NONE";
1337                 const char *auth_alg = "OPEN";
1338                 const char *key_index = "0";
1339
1340                 if (task->cfg80211 == TRUE)
1341                         auth_alg = "OPEN SHARED";
1342
1343                 connman_dbus_dict_append_basic(&dict, "auth_alg",
1344                                                 DBUS_TYPE_STRING, &auth_alg);
1345
1346                 connman_dbus_dict_append_basic(&dict, "key_mgmt",
1347                                                 DBUS_TYPE_STRING, &key_mgmt);
1348
1349                 if (passphrase) {
1350                         int size = strlen(passphrase);
1351                         if (size == 10 || size == 26) {
1352                                 unsigned char *key = malloc(13);
1353                                 char tmp[3];
1354                                 int i;
1355                                 memset(tmp, 0, sizeof(tmp));
1356                                 if (key == NULL)
1357                                         size = 0;
1358                                 for (i = 0; i < size / 2; i++) {
1359                                         memcpy(tmp, passphrase + (i * 2), 2);
1360                                         key[i] = (unsigned char) strtol(tmp,
1361                                                                 NULL, 16);
1362                                 }
1363                                 connman_dbus_dict_append_fixed_array(&dict,
1364                                                 "wep_key0", DBUS_TYPE_BYTE,
1365                                                         &key, size / 2);
1366                                 free(key);
1367                         } else if (size == 5 || size == 13) {
1368                                 unsigned char *key = malloc(13);
1369                                 int i;
1370                                 if (key == NULL)
1371                                         size = 0;
1372                                 for (i = 0; i < size; i++)
1373                                         key[i] = (unsigned char) passphrase[i];
1374                                 connman_dbus_dict_append_fixed_array(&dict,
1375                                                 "wep_key0", DBUS_TYPE_BYTE,
1376                                                                 &key, size);
1377                                 free(key);
1378                         } else
1379                                 connman_dbus_dict_append_basic(&dict,
1380                                                 "wep_key0", DBUS_TYPE_STRING,
1381                                                                 &passphrase);
1382
1383                         connman_dbus_dict_append_basic(&dict, "wep_tx_keyidx",
1384                                                 DBUS_TYPE_STRING, &key_index);
1385                 }
1386         } else {
1387                 const char *key_mgmt = "NONE";
1388                 connman_dbus_dict_append_basic(&dict, "key_mgmt",
1389                                                 DBUS_TYPE_STRING, &key_mgmt);
1390         }
1391
1392         connman_dbus_dict_close(&array, &dict);
1393
1394         dbus_error_init(&error);
1395
1396         reply = dbus_connection_send_with_reply_and_block(connection,
1397                                                         message, -1, &error);
1398         if (reply == NULL) {
1399                 if (dbus_error_is_set(&error) == TRUE) {
1400                         connman_error("%s", error.message);
1401                         dbus_error_free(&error);
1402                 } else
1403                         connman_error("Failed to set network options");
1404                 dbus_message_unref(message);
1405                 return -EIO;
1406         }
1407
1408         dbus_message_unref(message);
1409
1410         dbus_message_unref(reply);
1411
1412         return 0;
1413
1414 invalid:
1415         dbus_message_unref(message);
1416         return -EINVAL;
1417 }
1418
1419 static void scan_reply(DBusPendingCall *call, void *user_data)
1420 {
1421         struct supplicant_task *task = user_data;
1422         DBusMessage *reply;
1423
1424         DBG("task %p", task);
1425
1426         task->scan_call = NULL;
1427
1428         reply = dbus_pending_call_steal_reply(call);
1429
1430         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR) {
1431                 connman_device_set_scanning(task->device, FALSE);
1432                 goto done;
1433         }
1434
1435         if (task->scanning == TRUE)
1436                 connman_device_set_scanning(task->device, TRUE);
1437
1438 done:
1439         dbus_message_unref(reply);
1440
1441         dbus_pending_call_unref(call);
1442 }
1443
1444
1445 static int initiate_scan(struct supplicant_task *task)
1446 {
1447         DBusMessage *message;
1448
1449         DBG("task %p", task);
1450
1451         if (task->path == NULL)
1452                 return -EINVAL;
1453
1454         if (task->scan_call != NULL)
1455                 return -EALREADY;
1456
1457         connman_info("%s initiating scan", task->ifname);
1458
1459         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
1460                                         SUPPLICANT_INTF ".Interface", "scan");
1461         if (message == NULL)
1462                 return -ENOMEM;
1463
1464         dbus_message_set_auto_start(message, FALSE);
1465
1466         if (dbus_connection_send_with_reply(connection, message,
1467                                         &task->scan_call, TIMEOUT) == FALSE) {
1468                 connman_error("Failed to initiate scan");
1469                 dbus_message_unref(message);
1470                 return -EIO;
1471         }
1472
1473         if (task->scan_call == NULL) {
1474                 connman_error("D-Bus connection not available");
1475                 dbus_message_unref(message);
1476                 return -EIO;
1477         }
1478
1479         dbus_pending_call_set_notify(task->scan_call, scan_reply, task, NULL);
1480
1481         dbus_message_unref(message);
1482
1483         return -EINPROGRESS;
1484 }
1485
1486 static struct {
1487         char *name;
1488         char *value;
1489 } special_ssid[] = {
1490         { "<hidden>", "hidden"  },
1491         { "default",  "linksys" },
1492         { "wireless"  },
1493         { "linksys"   },
1494         { "netgear"   },
1495         { "dlink"     },
1496         { "2wire"     },
1497         { "compaq"    },
1498         { "tsunami"   },
1499         { "comcomcom", "3com"     },
1500         { "3Com",      "3com"     },
1501         { "Symbol",    "symbol"   },
1502         { "Motorola",  "motorola" },
1503         { "Wireless" , "wireless" },
1504         { "WLAN",      "wlan"     },
1505         { }
1506 };
1507
1508 static char *build_group(const char *addr, const char *name,
1509                         const unsigned char *ssid, unsigned int ssid_len,
1510                                         const char *mode, const char *security)
1511 {
1512         GString *str;
1513         unsigned int i;
1514
1515         if (addr == NULL)
1516                 return NULL;
1517
1518         str = g_string_sized_new((ssid_len * 2) + 24);
1519         if (str == NULL)
1520                 return NULL;
1521
1522         if (ssid == NULL) {
1523                 g_string_append_printf(str, "hidden_%s", addr);
1524                 goto done;
1525         }
1526
1527         for (i = 0; special_ssid[i].name; i++) {
1528                 if (g_strcmp0(special_ssid[i].name, name) == 0) {
1529                         if (special_ssid[i].value == NULL)
1530                                 g_string_append_printf(str, "%s_%s",
1531                                                                 name, addr);
1532                         else
1533                                 g_string_append_printf(str, "%s_%s",
1534                                                 special_ssid[i].value, addr);
1535                         goto done;
1536                 }
1537         }
1538
1539         if (ssid_len > 0 && ssid[0] != '\0') {
1540                 for (i = 0; i < ssid_len; i++)
1541                         g_string_append_printf(str, "%02x", ssid[i]);
1542         } else
1543                 g_string_append_printf(str, "hidden_%s", addr);
1544
1545 done:
1546         g_string_append_printf(str, "_%s_%s", mode, security);
1547
1548         return g_string_free(str, FALSE);
1549 }
1550
1551 static void extract_addr(DBusMessageIter *value,
1552                                         struct supplicant_result *result)
1553 {
1554         DBusMessageIter array;
1555         struct ether_addr eth;
1556         unsigned char *addr;
1557         int addr_len;
1558
1559         dbus_message_iter_recurse(value, &array);
1560         dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
1561
1562         if (addr_len != 6)
1563                 return;
1564
1565         result->addr = g_try_malloc(addr_len);
1566         if (result->addr == NULL)
1567                 return;
1568
1569         memcpy(result->addr, addr, addr_len);
1570         result->addr_len = addr_len;
1571
1572         result->path = g_try_malloc0(13);
1573         if (result->path == NULL)
1574                 return;
1575
1576         memcpy(&eth, addr, sizeof(eth));
1577         snprintf(result->path, 13, "%02x%02x%02x%02x%02x%02x",
1578                                                 eth.ether_addr_octet[0],
1579                                                 eth.ether_addr_octet[1],
1580                                                 eth.ether_addr_octet[2],
1581                                                 eth.ether_addr_octet[3],
1582                                                 eth.ether_addr_octet[4],
1583                                                 eth.ether_addr_octet[5]);
1584 }
1585
1586 static void extract_ssid(DBusMessageIter *value,
1587                                         struct supplicant_result *result)
1588 {
1589         DBusMessageIter array;
1590         unsigned char *ssid;
1591         int ssid_len, i;
1592
1593         dbus_message_iter_recurse(value, &array);
1594         dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
1595
1596         if (ssid_len < 1)
1597                 return;
1598
1599         if (ssid[0] == '\0')
1600                 return;
1601
1602         result->ssid = g_try_malloc(ssid_len);
1603         if (result->ssid == NULL)
1604                 return;
1605
1606         memcpy(result->ssid, ssid, ssid_len);
1607         result->ssid_len = ssid_len;
1608
1609         result->name = g_try_malloc0(ssid_len + 1);
1610         if (result->name == NULL)
1611                 return;
1612
1613         for (i = 0; i < ssid_len; i++) {
1614                 if (g_ascii_isprint(ssid[i]))
1615                         result->name[i] = ssid[i];
1616                 else
1617                         result->name[i] = ' ';
1618         }
1619 }
1620
1621 static unsigned char wifi_oui[3]      = { 0x00, 0x50, 0xf2 };
1622 static unsigned char ieee80211_oui[3] = { 0x00, 0x0f, 0xac };
1623
1624 static void extract_rsn(struct supplicant_result *result,
1625                                         const unsigned char *buf, int len)
1626 {
1627         uint16_t count;
1628         int i;
1629
1630         /* Version */
1631         if (len < 2)
1632                 return;
1633
1634         buf += 2;
1635         len -= 2;
1636
1637         /* Group cipher */
1638         if (len < 4)
1639                 return;
1640
1641         buf += 4;
1642         len -= 4;
1643
1644         /* Pairwise cipher */
1645         if (len < 2)
1646                 return;
1647
1648         count = buf[0] | (buf[1] << 8);
1649         if (2 + (count * 4) > len)
1650                 return;
1651
1652         buf += 2 + (count * 4);
1653         len -= 2 + (count * 4);
1654
1655         /* Authentication */
1656         if (len < 2)
1657                 return;
1658
1659         count = buf[0] | (buf[1] << 8);
1660         if (2 + (count * 4) > len)
1661                 return;
1662
1663         for (i = 0; i < count; i++) {
1664                 const unsigned char *ptr = buf + 2 + (i * 4);
1665
1666                 if (memcmp(ptr, wifi_oui, 3) == 0) {
1667                         switch (ptr[3]) {
1668                         case 1:
1669                                 result->has_8021x = TRUE;
1670                                 break;
1671                         case 2:
1672                                 result->has_psk = TRUE;
1673                                 break;
1674                         }
1675                 } else if (memcmp(ptr, ieee80211_oui, 3) == 0) {
1676                         switch (ptr[3]) {
1677                         case 1:
1678                                 result->has_8021x = TRUE;
1679                                 break;
1680                         case 2:
1681                                 result->has_psk = TRUE;
1682                                 break;
1683                         }
1684                 }
1685         }
1686
1687         buf += 2 + (count * 4);
1688         len -= 2 + (count * 4);
1689 }
1690
1691 static void extract_wpaie(DBusMessageIter *value,
1692                                         struct supplicant_result *result)
1693 {
1694         DBusMessageIter array;
1695         unsigned char *ie;
1696         int ie_len;
1697
1698         dbus_message_iter_recurse(value, &array);
1699         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1700
1701         if (ie_len > 6) {
1702                 result->has_wpa = TRUE;
1703                 extract_rsn(result, ie + 6, ie_len - 6);
1704         }
1705 }
1706
1707 static void extract_rsnie(DBusMessageIter *value,
1708                                         struct supplicant_result *result)
1709 {
1710         DBusMessageIter array;
1711         unsigned char *ie;
1712         int ie_len;
1713
1714         dbus_message_iter_recurse(value, &array);
1715         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1716
1717         if (ie_len > 2) {
1718                 result->has_rsn = TRUE;
1719                 extract_rsn(result, ie + 2, ie_len - 2);
1720         }
1721 }
1722
1723 static void extract_wpsie(DBusMessageIter *value,
1724                                         struct supplicant_result *result)
1725 {
1726         DBusMessageIter array;
1727         unsigned char *ie;
1728         int ie_len;
1729
1730         dbus_message_iter_recurse(value, &array);
1731         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1732
1733         if (ie_len > 0)
1734                 result->has_wps = TRUE;
1735 }
1736
1737 static void extract_capabilites(DBusMessageIter *value,
1738                                         struct supplicant_result *result)
1739 {
1740         dbus_message_iter_get_basic(value, &result->capabilities);
1741
1742         if (result->capabilities & IEEE80211_CAP_ESS)
1743                 result->adhoc = FALSE;
1744         else if (result->capabilities & IEEE80211_CAP_IBSS)
1745                 result->adhoc = TRUE;
1746
1747         if (result->capabilities & IEEE80211_CAP_PRIVACY)
1748                 result->has_wep = TRUE;
1749 }
1750
1751 static unsigned char calculate_strength(struct supplicant_task *task,
1752                                         struct supplicant_result *result)
1753 {
1754         if (result->quality == -1 || task->range->max_qual.qual == 0) {
1755                 unsigned char strength;
1756
1757                 if (result->level > 0)
1758                         strength = 100 - result->level;
1759                 else
1760                         strength = 120 + result->level;
1761
1762                 if (strength > 100)
1763                         strength = 100;
1764
1765                 return strength;
1766         }
1767
1768         return (result->quality * 100) / task->range->max_qual.qual;
1769 }
1770
1771 static unsigned short calculate_channel(struct supplicant_result *result)
1772 {
1773         if (result->frequency < 0)
1774                 return 0;
1775
1776         return (result->frequency - 2407) / 5;
1777 }
1778
1779 static void get_properties(struct supplicant_task *task);
1780
1781 static void properties_reply(DBusPendingCall *call, void *user_data)
1782 {
1783         struct supplicant_task *task = user_data;
1784         struct supplicant_result result;
1785         struct supplicant_block *block;
1786         struct connman_network *network;
1787         DBusMessage *reply;
1788         DBusMessageIter array, dict;
1789         unsigned char strength;
1790         unsigned short channel, frequency;
1791         const char *mode, *security;
1792         char *group = NULL;
1793
1794         DBG("task %p", task);
1795
1796         reply = dbus_pending_call_steal_reply(call);
1797
1798         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR)
1799                 goto unref;
1800
1801         memset(&result, 0, sizeof(result));
1802         result.frequency = -1;
1803         result.quality = -1;
1804         result.level = 0;
1805         result.noise = 0;
1806
1807         dbus_message_iter_init(reply, &array);
1808
1809         dbus_message_iter_recurse(&array, &dict);
1810
1811         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1812                 DBusMessageIter entry, value;
1813                 const char *key;
1814
1815                 dbus_message_iter_recurse(&dict, &entry);
1816                 dbus_message_iter_get_basic(&entry, &key);
1817
1818                 dbus_message_iter_next(&entry);
1819
1820                 dbus_message_iter_recurse(&entry, &value);
1821
1822                 //type = dbus_message_iter_get_arg_type(&value);
1823                 //dbus_message_iter_get_basic(&value, &val);
1824
1825                 /*
1826                  * bssid        : a (97)
1827                  * ssid         : a (97)
1828                  * wpaie        : a (97)
1829                  * rsnie        : a (97)
1830                  * wpsie        : a (97)
1831                  * frequency    : i (105)
1832                  * capabilities : q (113)
1833                  * quality      : i (105)
1834                  * noise        : i (105)
1835                  * level        : i (105)
1836                  * maxrate      : i (105)
1837                  */
1838
1839                 if (g_str_equal(key, "bssid") == TRUE)
1840                         extract_addr(&value, &result);
1841                 else if (g_str_equal(key, "ssid") == TRUE)
1842                         extract_ssid(&value, &result);
1843                 else if (g_str_equal(key, "wpaie") == TRUE)
1844                         extract_wpaie(&value, &result);
1845                 else if (g_str_equal(key, "rsnie") == TRUE)
1846                         extract_rsnie(&value, &result);
1847                 else if (g_str_equal(key, "wpsie") == TRUE)
1848                         extract_wpsie(&value, &result);
1849                 else if (g_str_equal(key, "capabilities") == TRUE)
1850                         extract_capabilites(&value, &result);
1851                 else if (g_str_equal(key, "frequency") == TRUE)
1852                         dbus_message_iter_get_basic(&value, &result.frequency);
1853                 else if (g_str_equal(key, "quality") == TRUE)
1854                         dbus_message_iter_get_basic(&value, &result.quality);
1855                 else if (g_str_equal(key, "noise") == TRUE)
1856                         dbus_message_iter_get_basic(&value, &result.noise);
1857                 else if (g_str_equal(key, "level") == TRUE)
1858                         dbus_message_iter_get_basic(&value, &result.level);
1859                 else if (g_str_equal(key, "maxrate") == TRUE)
1860                         dbus_message_iter_get_basic(&value, &result.maxrate);
1861
1862                 dbus_message_iter_next(&dict);
1863         }
1864
1865         DBG("capabilties %u frequency %d "
1866                         "quality %d noise %d level %d maxrate %d",
1867                                         result.capabilities, result.frequency,
1868                                                 result.quality, result.noise,
1869                                                 result.level, result.maxrate);
1870
1871         if (result.path == NULL)
1872                 goto done;
1873
1874         if (result.path[0] == '\0')
1875                 goto done;
1876
1877         if (result.name) {
1878                 block = g_hash_table_lookup(task->hidden_blocks, result.name);
1879                 if (block) {
1880                         enable_network(task, block->netpath, FALSE);
1881                         g_hash_table_remove(task->hidden_blocks, block->ssid);
1882                 }
1883         }
1884
1885         if (result.ssid == NULL)
1886                 task->hidden_found = TRUE;
1887
1888         if (result.frequency > 0 && result.frequency < 14)
1889                 result.frequency = 2407 + (5 * result.frequency);
1890         else if (result.frequency == 14)
1891                 result.frequency = 2484;
1892
1893         strength = calculate_strength(task, &result);
1894         channel  = calculate_channel(&result);
1895
1896         frequency = (result.frequency < 0) ? 0 : result.frequency;
1897
1898         if (result.has_8021x == TRUE)
1899                 security = "ieee8021x";
1900         else if (result.has_psk == TRUE)
1901                 security = "psk";
1902         else if (result.has_wep == TRUE)
1903                 security = "wep";
1904         else
1905                 security = "none";
1906
1907         mode = (result.adhoc == TRUE) ? "adhoc" : "managed";
1908
1909         group = build_group(result.path, result.name,
1910                                         result.ssid, result.ssid_len,
1911                                                         mode, security);
1912
1913         if (result.has_psk == TRUE) {
1914                 if (result.has_rsn == TRUE)
1915                         security = "rsn";
1916                 else if (result.has_wpa == TRUE)
1917                         security = "wpa";
1918         }
1919
1920         network = connman_device_get_network(task->device, result.path);
1921         if (network == NULL) {
1922                 int index;
1923
1924                 network = connman_network_create(result.path,
1925                                                 CONNMAN_NETWORK_TYPE_WIFI);
1926                 if (network == NULL)
1927                         goto done;
1928
1929                 index = connman_device_get_index(task->device);
1930                 connman_network_set_index(network, index);
1931
1932                 connman_network_set_protocol(network,
1933                                                 CONNMAN_NETWORK_PROTOCOL_IP);
1934
1935                 connman_network_set_address(network, result.addr,
1936                                                         result.addr_len);
1937
1938                 if (connman_device_add_network(task->device, network) < 0) {
1939                         connman_network_unref(network);
1940                         goto done;
1941                 }
1942         }
1943
1944         if (result.name != NULL && result.name[0] != '\0')
1945                 connman_network_set_name(network, result.name);
1946
1947         if (result.ssid_len != 0)
1948                 connman_network_set_blob(network, "WiFi.SSID",
1949                                                 result.ssid, result.ssid_len);
1950
1951         connman_network_set_string(network, "WiFi.Mode", mode);
1952
1953         DBG("%s (%s %s) strength %d (%s)",
1954                                 result.name, mode, security, strength,
1955                                 (result.has_wps == TRUE) ? "WPS" : "no WPS");
1956
1957         connman_network_set_available(network, TRUE);
1958         connman_network_set_strength(network, strength);
1959
1960         connman_network_set_uint16(network, "Frequency", frequency);
1961         connman_network_set_uint16(network, "WiFi.Channel", channel);
1962         connman_network_set_string(network, "WiFi.Security", security);
1963
1964         if (result.ssid != NULL)
1965                 connman_network_set_group(network, group);
1966
1967 done:
1968         g_free(group);
1969
1970         g_free(result.path);
1971         g_free(result.addr);
1972         g_free(result.name);
1973         g_free(result.ssid);
1974
1975 unref:
1976         dbus_message_unref(reply);
1977
1978         dbus_pending_call_unref(call);
1979
1980         get_properties(task);
1981 }
1982
1983 static void get_properties(struct supplicant_task *task)
1984 {
1985         DBusMessage *message;
1986         char *path;
1987
1988         path = g_slist_nth_data(task->scan_results, 0);
1989         if (path == NULL) {
1990                 if (task->hidden_found == TRUE) {
1991                         /*
1992                          * We're done with regular scanning, let's enable
1993                          * the missing network blocks if there are hidden
1994                          * SSIDs around.
1995                          */
1996                         hidden_block_enable(task);
1997                 }
1998                 goto noscan;
1999         }
2000
2001         message = dbus_message_new_method_call(SUPPLICANT_NAME, path,
2002                                                 SUPPLICANT_INTF ".BSSID",
2003                                                                 "properties");
2004
2005         task->scan_results = g_slist_remove(task->scan_results, path);
2006         g_free(path);
2007
2008         if (message == NULL)
2009                 goto noscan;
2010
2011         dbus_message_set_auto_start(message, FALSE);
2012
2013         if (dbus_connection_send_with_reply(connection, message,
2014                                 &task->result_call, TIMEOUT) == FALSE) {
2015                 connman_error("Failed to get network properties");
2016                 dbus_message_unref(message);
2017                 goto noscan;
2018         }
2019
2020         if (task->result_call == NULL) {
2021                 connman_error("D-Bus connection not available");
2022                 dbus_message_unref(message);
2023                 goto noscan;
2024         }
2025
2026         dbus_pending_call_set_notify(task->result_call,
2027                                         properties_reply, task, NULL);
2028
2029         dbus_message_unref(message);
2030
2031         return;
2032
2033 noscan:
2034         task->result_call = NULL;
2035
2036         if (task->scanning == TRUE) {
2037                 connman_device_set_scanning(task->device, FALSE);
2038                 task->scanning = FALSE;
2039         }
2040 }
2041
2042 static void scan_results_reply(DBusPendingCall *call, void *user_data)
2043 {
2044         struct supplicant_task *task = user_data;
2045         DBusMessage *reply;
2046         DBusError error;
2047         char **results;
2048         int i, num_results;
2049
2050         DBG("task %p", task);
2051
2052         reply = dbus_pending_call_steal_reply(call);
2053
2054         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR)
2055                 goto done;
2056
2057         dbus_error_init(&error);
2058
2059         if (dbus_message_get_args(reply, &error,
2060                                 DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
2061                                                 &results, &num_results,
2062                                                 DBUS_TYPE_INVALID) == FALSE) {
2063                 if (dbus_error_is_set(&error) == TRUE) {
2064                         connman_error("%s", error.message);
2065                         dbus_error_free(&error);
2066                 } else
2067                         connman_error("Wrong arguments for scan result");
2068                 goto done;
2069         }
2070
2071         if (num_results == 0)
2072                 goto done;
2073
2074         for (i = 0; i < num_results; i++) {
2075                 char *path = g_strdup(results[i]);
2076                 if (path == NULL)
2077                         continue;
2078
2079                 task->scan_results = g_slist_append(task->scan_results, path);
2080         }
2081
2082         task->hidden_found = FALSE;
2083
2084         g_strfreev(results);
2085
2086         dbus_message_unref(reply);
2087
2088         dbus_pending_call_unref(call);
2089
2090         get_properties(task);
2091
2092         return;
2093
2094 done:
2095         dbus_message_unref(reply);
2096
2097         dbus_pending_call_unref(call);
2098
2099         task->result_call = NULL;
2100
2101         if (task->scanning == TRUE) {
2102                 connman_device_set_scanning(task->device, FALSE);
2103                 task->scanning = FALSE;
2104         }
2105 }
2106
2107 static void scan_results_available(struct supplicant_task *task)
2108 {
2109         DBusMessage *message;
2110
2111         DBG("task %p", task);
2112
2113         if (task->result_call != NULL)
2114                 return;
2115
2116         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
2117                                                 SUPPLICANT_INTF ".Interface",
2118                                                         "scanResults");
2119         if (message == NULL)
2120                 return;
2121
2122         dbus_message_set_auto_start(message, FALSE);
2123
2124         if (dbus_connection_send_with_reply(connection, message,
2125                                 &task->result_call, TIMEOUT) == FALSE) {
2126                 connman_error("Failed to request scan result");
2127                 goto done;
2128         }
2129
2130         if (task->result_call == NULL) {
2131                 connman_error("D-Bus connection not available");
2132                 goto done;
2133         }
2134
2135         if (task->scanning == TRUE)
2136                 connman_device_set_scanning(task->device, TRUE);
2137
2138         dbus_pending_call_set_notify(task->result_call,
2139                                         scan_results_reply, task, NULL);
2140
2141 done:
2142         dbus_message_unref(message);
2143 }
2144
2145 static enum supplicant_state string2state(const char *state)
2146 {
2147         if (g_str_equal(state, "INACTIVE") == TRUE)
2148                 return WPA_INACTIVE;
2149         else if (g_str_equal(state, "SCANNING") == TRUE)
2150                 return WPA_SCANNING;
2151         else if (g_str_equal(state, "ASSOCIATING") == TRUE)
2152                 return WPA_ASSOCIATING;
2153         else if (g_str_equal(state, "ASSOCIATED") == TRUE)
2154                 return WPA_ASSOCIATED;
2155         else if (g_str_equal(state, "GROUP_HANDSHAKE") == TRUE)
2156                 return WPA_GROUP_HANDSHAKE;
2157         else if (g_str_equal(state, "4WAY_HANDSHAKE") == TRUE)
2158                 return WPA_4WAY_HANDSHAKE;
2159         else if (g_str_equal(state, "COMPLETED") == TRUE)
2160                 return WPA_COMPLETED;
2161         else if (g_str_equal(state, "DISCONNECTED") == TRUE)
2162                 return WPA_DISCONNECTED;
2163         else
2164                 return WPA_INVALID;
2165 }
2166
2167 static int task_connect(struct supplicant_task *task)
2168 {
2169         const char *address, *security, *passphrase;
2170         const void *ssid;
2171         unsigned int ssid_len;
2172         int err;
2173
2174         g_hash_table_foreach(task->hidden_blocks, block_reset, task);
2175
2176         connman_inet_ifup(task->ifindex);
2177
2178         address = connman_network_get_string(task->network, "Address");
2179         security = connman_network_get_string(task->network, "WiFi.Security");
2180         passphrase = connman_network_get_string(task->network, "WiFi.Passphrase");
2181
2182         ssid = connman_network_get_blob(task->network, "WiFi.SSID", &ssid_len);
2183
2184         DBG("address %s security %s", address, security);
2185
2186         if (security == NULL)
2187                 return -EINVAL;
2188
2189         if (passphrase == NULL && g_str_equal(security, "none") == FALSE &&
2190                                 g_str_equal(security, "ieee8021x") == FALSE)
2191                 return -EINVAL;
2192
2193         remove_network(task);
2194
2195         set_ap_scan(task);
2196
2197         add_network(task);
2198
2199         err = set_network(task, ssid, ssid_len, address, security, passphrase);
2200         if (err < 0)
2201                 return err;
2202
2203         err = select_network(task);
2204         if (err < 0)
2205                 return err;
2206
2207         return -EINPROGRESS;
2208 }
2209
2210 static void scanning(struct supplicant_task *task, DBusMessage *msg)
2211 {
2212         DBusError error;
2213         dbus_bool_t scanning;
2214
2215         dbus_error_init(&error);
2216
2217         if (dbus_message_get_args(msg, &error, DBUS_TYPE_BOOLEAN, &scanning,
2218                                                 DBUS_TYPE_INVALID) == FALSE) {
2219                 if (dbus_error_is_set(&error) == TRUE) {
2220                         connman_error("%s", error.message);
2221                         dbus_error_free(&error);
2222                 } else
2223                         connman_error("Wrong arguments for scanning");
2224                 return;
2225         }
2226
2227         connman_info("%s scanning %s", task->ifname,
2228                                 scanning == TRUE ? "started" : "finished");
2229
2230         if (scanning == TRUE)
2231                 task->scanning = TRUE;
2232 }
2233
2234 static void state_change(struct supplicant_task *task, DBusMessage *msg)
2235 {
2236         DBusError error;
2237         const char *newstate, *oldstate;
2238         unsigned char bssid[ETH_ALEN];
2239         unsigned int bssid_len;
2240         enum supplicant_state state, prevstate;
2241
2242         dbus_error_init(&error);
2243
2244         if (dbus_message_get_args(msg, &error, DBUS_TYPE_STRING, &newstate,
2245                                                 DBUS_TYPE_STRING, &oldstate,
2246                                                 DBUS_TYPE_INVALID) == FALSE) {
2247                 if (dbus_error_is_set(&error) == TRUE) {
2248                         connman_error("%s", error.message);
2249                         dbus_error_free(&error);
2250                 } else
2251                         connman_error("Wrong arguments for state change");
2252                 return;
2253         }
2254
2255         DBG("state %s ==> %s", oldstate, newstate);
2256
2257         connman_info("%s %s%s", task->ifname, newstate,
2258                                 task->scanning == TRUE ? " (scanning)" : "");
2259
2260         state = string2state(newstate);
2261         if (state == WPA_INVALID)
2262                 return;
2263
2264         prevstate = task->state;
2265         task->state = state;
2266
2267         if (task->network == NULL)
2268                 return;
2269
2270         switch (task->state) {
2271         case WPA_COMPLETED:
2272                 switch (prevstate) {
2273                 case WPA_ASSOCIATED:
2274                 case WPA_GROUP_HANDSHAKE:
2275                         break;
2276                 default:
2277                         goto badstate;
2278                 }
2279
2280                 /* reset scan trigger and schedule background scan */
2281                 connman_device_schedule_scan(task->device);
2282
2283                 if (get_bssid(task->device, bssid, &bssid_len) == 0)
2284                         connman_network_set_address(task->network,
2285                                                         bssid, bssid_len);
2286
2287                 /* carrier on */
2288                 connman_network_set_connected(task->network, TRUE);
2289                 break;
2290
2291         case WPA_ASSOCIATING:
2292                 switch (prevstate) {
2293                 case WPA_COMPLETED:
2294                         break;
2295                 case WPA_SCANNING:
2296                         connman_network_set_associating(task->network, TRUE);
2297                         break;
2298                 default:
2299                         goto badstate;
2300                 }
2301                 break;
2302
2303         case WPA_INACTIVE:
2304                 switch (prevstate) {
2305                 case WPA_SCANNING:
2306                 case WPA_DISCONNECTED:
2307                         break;
2308                 default:
2309                         goto badstate;
2310                 }
2311                 /* fall through */
2312
2313         case WPA_DISCONNECTED:
2314                 /* carrier off */
2315                 connman_network_set_connected(task->network, FALSE);
2316
2317                 if (task->disconnecting == TRUE) {
2318                         connman_network_unref(task->network);
2319                         task->disconnecting = FALSE;
2320
2321                         if (task->pending_network != NULL) {
2322                                 task->network = task->pending_network;
2323                                 task->pending_network = NULL;
2324                                 task_connect(task);
2325                         } else
2326                                 task->network = NULL;
2327                 }
2328                 break;
2329
2330         default:
2331                 connman_network_set_associating(task->network, FALSE);
2332                 break;
2333         }
2334
2335         return;
2336
2337 badstate:
2338         connman_error("%s invalid state change %s -> %s", task->ifname,
2339                                                         oldstate, newstate);
2340 }
2341
2342 static gboolean supplicant_filter(DBusConnection *conn,
2343                                                 DBusMessage *msg, void *data)
2344 {
2345         struct supplicant_task *task;
2346         const char *member, *path;
2347
2348         member = dbus_message_get_member(msg);
2349         if (member == NULL)
2350                 return TRUE;
2351
2352         path = dbus_message_get_path(msg);
2353         if (path == NULL)
2354                 return TRUE;
2355
2356         task = find_task_by_path(path);
2357         if (task == NULL)
2358                 return TRUE;
2359
2360         DBG("task %p member %s", task, member);
2361
2362         if (g_str_equal(member, "ScanResultsAvailable") == TRUE)
2363                 scan_results_available(task);
2364         else if (g_str_equal(member, "Scanning") == TRUE)
2365                 scanning(task, msg);
2366         else if (g_str_equal(member, "StateChange") == TRUE)
2367                 state_change(task, msg);
2368
2369         return TRUE;
2370 }
2371
2372 int supplicant_start(struct connman_device *device)
2373 {
2374         struct supplicant_task *task;
2375         int err;
2376
2377         DBG("device %p", device);
2378
2379         task = g_try_new0(struct supplicant_task, 1);
2380         if (task == NULL)
2381                 return -ENOMEM;
2382
2383         task->ifindex = connman_device_get_index(device);
2384         task->ifname = connman_inet_ifname(task->ifindex);
2385
2386         if (task->ifname == NULL) {
2387                 err = -ENOMEM;
2388                 goto failed;
2389         }
2390
2391         task->cfg80211 = connman_inet_is_cfg80211(task->ifindex);
2392         if (task->cfg80211 == FALSE)
2393                 connman_warn("Enabling quirks for unsupported driver");
2394
2395         task->range = g_try_malloc0(sizeof(struct iw_range));
2396         if (task->range == NULL) {
2397                 err = -ENOMEM;
2398                 goto failed;
2399         }
2400
2401         err = get_range(task);
2402         if (err < 0)
2403                 goto failed;
2404
2405         task->device = connman_device_ref(device);
2406
2407         task->created = FALSE;
2408         task->scanning = FALSE;
2409         task->state = WPA_INVALID;
2410         task->disconnecting = FALSE;
2411         task->pending_network = NULL;
2412         task->hidden_blocks = g_hash_table_new_full(g_str_hash, g_str_equal,
2413                                                         NULL, remove_block);
2414         task_list = g_slist_append(task_list, task);
2415
2416         return create_interface(task);
2417
2418 failed:
2419         g_free(task->range);
2420         g_free(task->ifname);
2421         g_free(task);
2422
2423         return err;
2424 }
2425
2426 int supplicant_stop(struct connman_device *device)
2427 {
2428         int index = connman_device_get_index(device);
2429         struct supplicant_task *task;
2430
2431         DBG("device %p", device);
2432
2433         task = find_task_by_index(index);
2434         if (task == NULL)
2435                 return -ENODEV;
2436
2437         g_free(task->range);
2438
2439         task_list = g_slist_remove(task_list, task);
2440         g_hash_table_destroy(task->hidden_blocks);
2441
2442         if (task->scan_call != NULL) {
2443                 dbus_pending_call_cancel(task->scan_call);
2444                 task->scan_call = NULL;
2445         }
2446
2447         if (task->result_call != NULL) {
2448                 dbus_pending_call_cancel(task->result_call);
2449                 task->result_call = NULL;
2450         }
2451
2452         if (task->scanning == TRUE)
2453                 connman_device_set_scanning(task->device, FALSE);
2454
2455         remove_network(task);
2456
2457         disconnect_network(task);
2458
2459         return remove_interface(task);
2460 }
2461
2462 int supplicant_scan(struct connman_device *device)
2463 {
2464         int index = connman_device_get_index(device);
2465         struct supplicant_task *task;
2466         int err;
2467
2468         DBG("device %p", device);
2469
2470         task = find_task_by_index(index);
2471         if (task == NULL)
2472                 return -ENODEV;
2473
2474         switch (task->state) {
2475         case WPA_SCANNING:
2476                 return -EALREADY;
2477         case WPA_ASSOCIATING:
2478         case WPA_ASSOCIATED:
2479         case WPA_4WAY_HANDSHAKE:
2480         case WPA_GROUP_HANDSHAKE:
2481                 return -EBUSY;
2482         default:
2483                 break;
2484         }
2485
2486         task->scanning = TRUE;
2487
2488         err = initiate_scan(task);
2489         if (err < 0) {
2490                 if (err == -EINPROGRESS)
2491                         return 0;
2492
2493                 task->scanning = FALSE;
2494                 return err;
2495         }
2496
2497         connman_device_set_scanning(task->device, TRUE);
2498
2499         return 0;
2500 }
2501
2502 int supplicant_connect(struct connman_network *network)
2503 {
2504         struct supplicant_task *task;
2505         int index;
2506
2507         DBG("network %p", network);
2508
2509         index = connman_network_get_index(network);
2510
2511         task = find_task_by_index(index);
2512         if (task == NULL)
2513                 return -ENODEV;
2514
2515         if (task->disconnecting == TRUE)
2516                 task->pending_network = connman_network_ref(network);
2517         else {
2518                 task->network = connman_network_ref(network);
2519                 return task_connect(task);
2520         }
2521
2522         return -EINPROGRESS;
2523 }
2524
2525 int supplicant_disconnect(struct connman_network *network)
2526 {
2527         struct supplicant_task *task;
2528         int index;
2529
2530         DBG("network %p", network);
2531
2532         index = connman_network_get_index(network);
2533
2534         task = find_task_by_index(index);
2535         if (task == NULL)
2536                 return -ENODEV;
2537
2538         if (task->disconnecting == TRUE)
2539                 return -EALREADY;
2540
2541         if (task->network != network)
2542                 return -EINVAL;
2543
2544         remove_network(task);
2545
2546         disconnect_network(task);
2547
2548         task->disconnecting = TRUE;
2549
2550         return 0;
2551 }
2552
2553 void supplicant_remove_network(struct connman_network *network)
2554 {
2555         struct supplicant_task *task;
2556         int index;
2557
2558         DBG("network %p", network);
2559
2560         index = connman_network_get_index(network);
2561
2562         task = find_task_by_index(index);
2563         if (task == NULL)
2564                 return;
2565
2566         if (task->network != network)
2567                 return;
2568
2569         remove_network(task);
2570 }
2571
2572 static void supplicant_activate(DBusConnection *conn)
2573 {
2574         DBusMessage *message;
2575
2576         DBG("conn %p", conn);
2577
2578         message = dbus_message_new_method_call(SUPPLICANT_NAME, "/",
2579                                 DBUS_INTERFACE_INTROSPECTABLE, "Introspect");
2580         if (message == NULL)
2581                 return;
2582
2583         dbus_message_set_no_reply(message, TRUE);
2584
2585         dbus_connection_send(conn, message, NULL);
2586
2587         dbus_message_unref(message);
2588 }
2589
2590 static GSList *driver_list = NULL;
2591
2592 static void supplicant_probe(DBusConnection *conn, void *user_data)
2593 {
2594         GSList *list;
2595
2596         DBG("conn %p", conn);
2597
2598         for (list = driver_list; list; list = list->next) {
2599                 struct supplicant_driver *driver = list->data;
2600
2601                 DBG("driver %p name %s", driver, driver->name);
2602
2603                 if (driver->probe)
2604                         driver->probe();
2605         }
2606 }
2607
2608 static void supplicant_remove(DBusConnection *conn, void *user_data)
2609 {
2610         GSList *list;
2611
2612         DBG("conn %p", conn);
2613
2614         for (list = driver_list; list; list = list->next) {
2615                 struct supplicant_driver *driver = list->data;
2616
2617                 DBG("driver %p name %s", driver, driver->name);
2618
2619                 if (driver->remove)
2620                         driver->remove();
2621         }
2622 }
2623
2624 static guint watch;
2625 static guint iface_watch;
2626
2627 static int supplicant_create(void)
2628 {
2629         if (g_slist_length(driver_list) > 0)
2630                 return 0;
2631
2632         connection = connman_dbus_get_connection();
2633         if (connection == NULL)
2634                 return -EIO;
2635
2636         DBG("connection %p", connection);
2637
2638         watch = g_dbus_add_service_watch(connection, SUPPLICANT_NAME,
2639                         supplicant_probe, supplicant_remove, NULL, NULL);
2640
2641         iface_watch = g_dbus_add_signal_watch(connection, NULL, NULL,
2642                                                 SUPPLICANT_INTF ".Interface",
2643                                                 NULL, supplicant_filter,
2644                                                 NULL, NULL);
2645
2646         if (watch == 0 || iface_watch == 0) {
2647                 g_dbus_remove_watch(connection, watch);
2648                 g_dbus_remove_watch(connection, iface_watch);
2649                 return -EIO;
2650         }
2651
2652         return 0;
2653 }
2654
2655 static void supplicant_destroy(void)
2656 {
2657         if (g_slist_length(driver_list) > 0)
2658                 return;
2659
2660         DBG("connection %p", connection);
2661
2662         g_dbus_remove_watch(connection, watch);
2663         g_dbus_remove_watch(connection, iface_watch);
2664
2665         dbus_connection_unref(connection);
2666         connection = NULL;
2667 }
2668
2669 int supplicant_register(struct supplicant_driver *driver)
2670 {
2671         int err;
2672
2673         DBG("driver %p name %s", driver, driver->name);
2674
2675         err = supplicant_create();
2676         if (err < 0)
2677                 return err;
2678
2679         driver_list = g_slist_append(driver_list, driver);
2680
2681         supplicant_activate(connection);
2682
2683         return 0;
2684 }
2685
2686 void supplicant_unregister(struct supplicant_driver *driver)
2687 {
2688         DBG("driver %p name %s", driver, driver->name);
2689
2690         supplicant_remove(connection, NULL);
2691
2692         driver_list = g_slist_remove(driver_list, driver);
2693
2694         supplicant_destroy();
2695 }