plugins/supplicant.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2009  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/log.h>
  45
  46 #include "supplicant.h"
  47
  48 #define TIMEOUT 5000
  49
  50 #define IEEE80211_CAP_ESS       0x0001
  51 #define IEEE80211_CAP_IBSS      0x0002
  52 #define IEEE80211_CAP_PRIVACY   0x0010
  53
  54 #define SUPPLICANT_NAME  "fi.epitest.hostap.WPASupplicant"
  55 #define SUPPLICANT_INTF  "fi.epitest.hostap.WPASupplicant"
  56 #define SUPPLICANT_PATH  "/fi/epitest/hostap/WPASupplicant"
  57
  58 /* Taken from "WPA Supplicant - Common definitions" */
  59 enum supplicant_state {
  60         /**
  61          * WPA_DISCONNECTED - Disconnected state
  62          *
  63          * This state indicates that client is not associated, but is likely to
  64          * start looking for an access point. This state is entered when a
  65          * connection is lost.
  66          */
  67         WPA_DISCONNECTED,
  68
  69         /**
  70          * WPA_INACTIVE - Inactive state (wpa_supplicant disabled)
  71          *
  72          * This state is entered if there are no enabled networks in the
  73          * configuration. wpa_supplicant is not trying to associate with a new
  74          * network and external interaction (e.g., ctrl_iface call to add or
  75          * enable a network) is needed to start association.
  76          */
  77         WPA_INACTIVE,
  78
  79         /**
  80          * WPA_SCANNING - Scanning for a network
  81          *
  82          * This state is entered when wpa_supplicant starts scanning for a
  83          * network.
  84          */
  85         WPA_SCANNING,
  86
  87         /**
  88          * WPA_ASSOCIATING - Trying to associate with a BSS/SSID
  89          *
  90          * This state is entered when wpa_supplicant has found a suitable BSS
  91          * to associate with and the driver is configured to try to associate
  92          * with this BSS in ap_scan=1 mode. When using ap_scan=2 mode, this
  93          * state is entered when the driver is configured to try to associate
  94          * with a network using the configured SSID and security policy.
  95          */
  96         WPA_ASSOCIATING,
  97
  98         /**
  99          * WPA_ASSOCIATED - Association completed
 100          *
 101          * This state is entered when the driver reports that association has
 102          * been successfully completed with an AP. If IEEE 802.1X is used
 103          * (with or without WPA/WPA2), wpa_supplicant remains in this state
 104          * until the IEEE 802.1X/EAPOL authentication has been completed.
 105          */
 106         WPA_ASSOCIATED,
 107
 108         /**
 109          * WPA_4WAY_HANDSHAKE - WPA 4-Way Key Handshake in progress
 110          *
 111          * This state is entered when WPA/WPA2 4-Way Handshake is started. In
 112          * case of WPA-PSK, this happens when receiving the first EAPOL-Key
 113          * frame after association. In case of WPA-EAP, this state is entered
 114          * when the IEEE 802.1X/EAPOL authentication has been completed.
 115          */
 116         WPA_4WAY_HANDSHAKE,
 117
 118         /**
 119          * WPA_GROUP_HANDSHAKE - WPA Group Key Handshake in progress
 120          *
 121          * This state is entered when 4-Way Key Handshake has been completed
 122          * (i.e., when the supplicant sends out message 4/4) and when Group
 123          * Key rekeying is started by the AP (i.e., when supplicant receives
 124          * message 1/2).
 125          */
 126         WPA_GROUP_HANDSHAKE,
 127
 128         /**
 129          * WPA_COMPLETED - All authentication completed
 130          *
 131          * This state is entered when the full authentication process is
 132          * completed. In case of WPA2, this happens when the 4-Way Handshake is
 133          * successfully completed. With WPA, this state is entered after the
 134          * Group Key Handshake; with IEEE 802.1X (non-WPA) connection is
 135          * completed after dynamic keys are received (or if not used, after
 136          * the EAP authentication has been completed). With static WEP keys and
 137          * plaintext connections, this state is entered when an association
 138          * has been completed.
 139          *
 140          * This state indicates that the supplicant has completed its
 141          * processing for the association phase and that data connection is
 142          * fully configured.
 143          */
 144         WPA_COMPLETED,
 145
 146         /**
 147          * WPA_INVALID - Invalid state (parsing error)
 148          *
 149          * This state is returned if the string input is invalid. It is not
 150          * an official wpa_supplicant state.
 151          */
 152         WPA_INVALID,
 153 };
 154
 155 struct supplicant_result {
 156         char *path;
 157         char *name;
 158         unsigned char *addr;
 159         unsigned int addr_len;
 160         unsigned char *ssid;
 161         unsigned int ssid_len;
 162         dbus_uint16_t capabilities;
 163         gboolean adhoc;
 164         gboolean has_wep;
 165         gboolean has_wpa;
 166         gboolean has_rsn;
 167         gboolean has_wps;
 168         dbus_int32_t frequency;
 169         dbus_int32_t quality;
 170         dbus_int32_t noise;
 171         dbus_int32_t level;
 172         dbus_int32_t maxrate;
 173 };
 174
 175 struct supplicant_task {
 176         int ifindex;
 177         char *ifname;
 178         gboolean mac80211;
 179         struct connman_device *device;
 180         struct connman_network *network;
 181         struct connman_network *pending_network;
 182         char *path;
 183         char *netpath;
 184         gboolean created;
 185         enum supplicant_state state;
 186         gboolean scanning;
 187         GSList *scan_results;
 188         DBusPendingCall *scan_call;
 189         DBusPendingCall *result_call;
 190         struct iw_range *range;
 191         gboolean disconnecting;
 192 };
 193
 194 static GSList *task_list = NULL;
 195
 196 static DBusConnection *connection;
 197
 198 static void free_task(struct supplicant_task *task)
 199 {
 200         DBG("task %p", task);
 201
 202         g_free(task->ifname);
 203         g_free(task->path);
 204         g_free(task);
 205 }
 206
 207 static struct supplicant_task *find_task_by_index(int index)
 208 {
 209         GSList *list;
 210
 211         for (list = task_list; list; list = list->next) {
 212                 struct supplicant_task *task = list->data;
 213
 214                 if (task->ifindex == index)
 215                         return task;
 216         }
 217
 218         return NULL;
 219 }
 220
 221 static struct supplicant_task *find_task_by_path(const char *path)
 222 {
 223         GSList *list;
 224
 225         for (list = task_list; list; list = list->next) {
 226                 struct supplicant_task *task = list->data;
 227
 228                 if (g_strcmp0(task->path, path) == 0)
 229                         return task;
 230         }
 231
 232         return NULL;
 233 }
 234
 235 static int get_range(struct supplicant_task *task)
 236 {
 237         struct iwreq wrq;
 238         int fd, err;
 239
 240         fd = socket(PF_INET, SOCK_DGRAM, 0);
 241         if (fd < 0)
 242                 return -1;
 243
 244         memset(&wrq, 0, sizeof(struct iwreq));
 245         strncpy(wrq.ifr_name, task->ifname, IFNAMSIZ);
 246         wrq.u.data.pointer = task->range;
 247         wrq.u.data.length = sizeof(struct iw_range);
 248
 249         err = ioctl(fd, SIOCGIWRANGE, &wrq);
 250
 251         close(fd);
 252
 253         return err;
 254 }
 255
 256 static int get_bssid(struct connman_device *device,
 257                                 unsigned char *bssid, unsigned int *bssid_len)
 258 {
 259         struct iwreq wrq;
 260         char *ifname;
 261         int ifindex;
 262         int fd, err;
 263
 264         ifindex = connman_device_get_index(device);
 265         if (ifindex < 0)
 266                 return -EINVAL;
 267
 268         ifname = connman_inet_ifname(ifindex);
 269         if (ifname == NULL)
 270                 return -EINVAL;
 271
 272         fd = socket(PF_INET, SOCK_DGRAM, 0);
 273         if (fd < 0) {
 274                 g_free(ifname);
 275                 return -EINVAL;
 276         }
 277
 278         memset(&wrq, 0, sizeof(wrq));
 279         strncpy(wrq.ifr_name, ifname, IFNAMSIZ);
 280
 281         err = ioctl(fd, SIOCGIWAP, &wrq);
 282
 283         g_free(ifname);
 284         close(fd);
 285
 286         if (err < 0)
 287                 return -EIO;
 288
 289         memcpy(bssid, wrq.u.ap_addr.sa_data, ETH_ALEN);
 290         *bssid_len = ETH_ALEN;
 291
 292         return 0;
 293 }
 294
 295 static void add_interface_reply(DBusPendingCall *call, void *user_data)
 296 {
 297         struct supplicant_task *task = user_data;
 298         DBusMessage *reply;
 299         DBusError error;
 300         const char *path;
 301
 302         DBG("task %p", task);
 303
 304         reply = dbus_pending_call_steal_reply(call);
 305         if (reply == NULL)
 306                 return;
 307
 308         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR)
 309                 goto failed;
 310
 311         dbus_error_init(&error);
 312
 313         if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
 314                                                 DBUS_TYPE_INVALID) == FALSE) {
 315                 if (dbus_error_is_set(&error) == TRUE) {
 316                         connman_error("%s", error.message);
 317                         dbus_error_free(&error);
 318                 } else
 319                         connman_error("Wrong arguments for add interface");
 320                 goto failed;
 321         }
 322
 323         DBG("path %s", path);
 324
 325         task->path = g_strdup(path);
 326         task->created = TRUE;
 327
 328         connman_device_set_powered(task->device, TRUE);
 329
 330         dbus_message_unref(reply);
 331
 332         return;
 333
 334 failed:
 335         dbus_message_unref(reply);
 336
 337         task_list = g_slist_remove(task_list, task);
 338
 339         connman_device_unref(task->device);
 340
 341         free_task(task);
 342 }
 343
 344 static int add_interface(struct supplicant_task *task)
 345 {
 346         const char *driver = connman_option_get_string("wifi");
 347         DBusMessage *message;
 348         DBusMessageIter array, dict;
 349         DBusPendingCall *call;
 350
 351         DBG("task %p", task);
 352
 353         message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
 354                                         SUPPLICANT_INTF, "addInterface");
 355         if (message == NULL)
 356                 return -ENOMEM;
 357
 358         dbus_message_set_auto_start(message, FALSE);
 359
 360         dbus_message_iter_init_append(message, &array);
 361
 362         dbus_message_iter_append_basic(&array,
 363                                         DBUS_TYPE_STRING, &task->ifname);
 364
 365         dbus_message_iter_open_container(&array, DBUS_TYPE_ARRAY,
 366                         DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING
 367                         DBUS_TYPE_STRING_AS_STRING DBUS_TYPE_VARIANT_AS_STRING
 368                         DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict);
 369
 370         connman_dbus_dict_append_variant(&dict, "driver",
 371                                                 DBUS_TYPE_STRING, &driver);
 372
 373         dbus_message_iter_close_container(&array, &dict);
 374
 375         if (dbus_connection_send_with_reply(connection, message,
 376                                                 &call, TIMEOUT) == FALSE) {
 377                 connman_error("Failed to add interface");
 378                 dbus_message_unref(message);
 379                 return -EIO;
 380         }
 381
 382         if (call == NULL) {
 383                 connman_error("D-Bus connection not available");
 384                 dbus_message_unref(message);
 385                 return -EIO;
 386         }
 387
 388         dbus_pending_call_set_notify(call, add_interface_reply, task, NULL);
 389
 390         dbus_message_unref(message);
 391
 392         return -EINPROGRESS;
 393 }
 394
 395 static void get_interface_reply(DBusPendingCall *call, void *user_data)
 396 {
 397         struct supplicant_task *task = user_data;
 398         DBusMessage *reply;
 399         DBusError error;
 400         const char *path;
 401
 402         DBG("task %p", task);
 403
 404         reply = dbus_pending_call_steal_reply(call);
 405         if (reply == NULL)
 406                 return;
 407
 408         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR) {
 409                 add_interface(task);
 410                 goto done;
 411         }
 412
 413         dbus_error_init(&error);
 414
 415         if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
 416                                                 DBUS_TYPE_INVALID) == FALSE) {
 417                 if (dbus_error_is_set(&error) == TRUE) {
 418                         connman_error("%s", error.message);
 419                         dbus_error_free(&error);
 420                 } else
 421                         connman_error("Wrong arguments for get interface");
 422                 goto done;
 423         }
 424
 425         DBG("path %s", path);
 426
 427         task->path = g_strdup(path);
 428         task->created = FALSE;
 429
 430         connman_device_set_powered(task->device, TRUE);
 431
 432 done:
 433         dbus_message_unref(reply);
 434 }
 435
 436 static int create_interface(struct supplicant_task *task)
 437 {
 438         DBusMessage *message;
 439         DBusPendingCall *call;
 440
 441         DBG("task %p", task);
 442
 443         message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
 444                                         SUPPLICANT_INTF, "getInterface");
 445         if (message == NULL)
 446                 return -ENOMEM;
 447
 448         dbus_message_set_auto_start(message, FALSE);
 449
 450         dbus_message_append_args(message, DBUS_TYPE_STRING, &task->ifname,
 451                                                         DBUS_TYPE_INVALID);
 452
 453         if (dbus_connection_send_with_reply(connection, message,
 454                                                 &call, TIMEOUT) == FALSE) {
 455                 connman_error("Failed to get interface");
 456                 dbus_message_unref(message);
 457                 return -EIO;
 458         }
 459
 460         if (call == NULL) {
 461                 connman_error("D-Bus connection not available");
 462                 dbus_message_unref(message);
 463                 return -EIO;
 464         }
 465
 466         dbus_pending_call_set_notify(call, get_interface_reply, task, NULL);
 467
 468         dbus_message_unref(message);
 469
 470         return -EINPROGRESS;
 471 }
 472
 473 static void remove_interface_reply(DBusPendingCall *call, void *user_data)
 474 {
 475         struct supplicant_task *task = user_data;
 476         DBusMessage *reply;
 477
 478         DBG("task %p", task);
 479
 480         reply = dbus_pending_call_steal_reply(call);
 481
 482         connman_device_set_powered(task->device, FALSE);
 483
 484         connman_device_unref(task->device);
 485
 486         connman_inet_ifdown(task->ifindex);
 487
 488         free_task(task);
 489
 490         dbus_message_unref(reply);
 491 }
 492
 493 static int remove_interface(struct supplicant_task *task)
 494 {
 495         DBusMessage *message;
 496         DBusPendingCall *call;
 497
 498         DBG("task %p", task);
 499
 500 #if 0
 501         if (task->created == FALSE) {
 502                 connman_device_set_powered(task->device, FALSE);
 503                 return 0;
 504         }
 505 #endif
 506
 507         message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
 508                                         SUPPLICANT_INTF, "removeInterface");
 509         if (message == NULL)
 510                 return -ENOMEM;
 511
 512         dbus_message_set_auto_start(message, FALSE);
 513
 514         dbus_message_append_args(message, DBUS_TYPE_OBJECT_PATH, &task->path,
 515                                                         DBUS_TYPE_INVALID);
 516
 517         if (dbus_connection_send_with_reply(connection, message,
 518                                                 &call, TIMEOUT) == FALSE) {
 519                 connman_error("Failed to remove interface");
 520                 dbus_message_unref(message);
 521                 return -EIO;
 522         }
 523
 524         if (call == NULL) {
 525                 connman_error("D-Bus connection not available");
 526                 dbus_message_unref(message);
 527                 return -EIO;
 528         }
 529
 530         dbus_pending_call_set_notify(call, remove_interface_reply, task, NULL);
 531
 532         dbus_message_unref(message);
 533
 534         return -EINPROGRESS;
 535 }
 536
 537 static int set_ap_scan(struct supplicant_task *task)
 538 {
 539         DBusMessage *message, *reply;
 540         DBusError error;
 541         guint32 ap_scan = 1;
 542
 543         DBG("task %p", task);
 544
 545         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 546                                 SUPPLICANT_INTF ".Interface", "setAPScan");
 547         if (message == NULL)
 548                 return -ENOMEM;
 549
 550         dbus_message_set_auto_start(message, FALSE);
 551
 552         dbus_message_append_args(message, DBUS_TYPE_UINT32, &ap_scan,
 553                                                         DBUS_TYPE_INVALID);
 554
 555         dbus_error_init(&error);
 556
 557         reply = dbus_connection_send_with_reply_and_block(connection,
 558                                                         message, -1, &error);
 559         if (reply == NULL) {
 560                 if (dbus_error_is_set(&error) == TRUE) {
 561                         connman_error("%s", error.message);
 562                         dbus_error_free(&error);
 563                 } else
 564                         connman_error("Failed to set AP scan");
 565                 dbus_message_unref(message);
 566                 return -EIO;
 567         }
 568
 569         dbus_message_unref(message);
 570
 571         dbus_message_unref(reply);
 572
 573         return 0;
 574 }
 575
 576 static int add_network(struct supplicant_task *task)
 577 {
 578         DBusMessage *message, *reply;
 579         DBusError error;
 580         const char *path;
 581
 582         DBG("task %p", task);
 583
 584         if (task->netpath != NULL)
 585                 return -EALREADY;
 586
 587         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 588                                 SUPPLICANT_INTF ".Interface", "addNetwork");
 589         if (message == NULL)
 590                 return -ENOMEM;
 591
 592         dbus_message_set_auto_start(message, FALSE);
 593
 594         dbus_error_init(&error);
 595
 596         reply = dbus_connection_send_with_reply_and_block(connection,
 597                                                         message, -1, &error);
 598         if (reply == NULL) {
 599                 if (dbus_error_is_set(&error) == TRUE) {
 600                         connman_error("%s", error.message);
 601                         dbus_error_free(&error);
 602                 } else
 603                         connman_error("Failed to add network");
 604                 dbus_message_unref(message);
 605                 return -EIO;
 606         }
 607
 608         dbus_message_unref(message);
 609
 610         dbus_error_init(&error);
 611
 612         if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
 613                                                 DBUS_TYPE_INVALID) == FALSE) {
 614                 if (dbus_error_is_set(&error) == TRUE) {
 615                         connman_error("%s", error.message);
 616                         dbus_error_free(&error);
 617                 } else
 618                         connman_error("Wrong arguments for network");
 619                 dbus_message_unref(reply);
 620                 return -EIO;
 621         }
 622
 623         DBG("path %s", path);
 624
 625         task->netpath = g_strdup(path);
 626
 627         dbus_message_unref(reply);
 628
 629         return 0;
 630 }
 631
 632 static int remove_network(struct supplicant_task *task)
 633 {
 634         DBusMessage *message, *reply;
 635         DBusError error;
 636
 637         DBG("task %p", task);
 638
 639         if (task->netpath == NULL)
 640                 return -EINVAL;
 641
 642         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 643                                 SUPPLICANT_INTF ".Interface", "removeNetwork");
 644         if (message == NULL)
 645                 return -ENOMEM;
 646
 647         dbus_message_set_auto_start(message, FALSE);
 648
 649         dbus_message_append_args(message, DBUS_TYPE_OBJECT_PATH, &task->netpath,
 650                                                         DBUS_TYPE_INVALID);
 651
 652         dbus_error_init(&error);
 653
 654         reply = dbus_connection_send_with_reply_and_block(connection,
 655                                                         message, -1, &error);
 656         if (reply == NULL) {
 657                 if (dbus_error_is_set(&error) == TRUE) {
 658                         connman_error("%s", error.message);
 659                         dbus_error_free(&error);
 660                 } else
 661                         connman_error("Failed to remove network");
 662                 dbus_message_unref(message);
 663                 return -EIO;
 664         }
 665
 666         dbus_message_unref(message);
 667
 668         dbus_message_unref(reply);
 669
 670         g_free(task->netpath);
 671         task->netpath = NULL;
 672
 673         return 0;
 674 }
 675
 676 static int select_network(struct supplicant_task *task)
 677 {
 678         DBusMessage *message, *reply;
 679         DBusError error;
 680
 681         DBG("task %p", task);
 682
 683         if (task->netpath == NULL)
 684                 return -EINVAL;
 685
 686         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 687                                 SUPPLICANT_INTF ".Interface", "selectNetwork");
 688         if (message == NULL)
 689                 return -ENOMEM;
 690
 691         dbus_message_set_auto_start(message, FALSE);
 692
 693         dbus_message_append_args(message, DBUS_TYPE_OBJECT_PATH, &task->netpath,
 694                                                         DBUS_TYPE_INVALID);
 695
 696         dbus_error_init(&error);
 697
 698         reply = dbus_connection_send_with_reply_and_block(connection,
 699                                                         message, -1, &error);
 700         if (reply == NULL) {
 701                 if (dbus_error_is_set(&error) == TRUE) {
 702                         connman_error("%s", error.message);
 703                         dbus_error_free(&error);
 704                 } else
 705                         connman_error("Failed to select network");
 706                 dbus_message_unref(message);
 707                 return -EIO;
 708         }
 709
 710         dbus_message_unref(message);
 711
 712         dbus_message_unref(reply);
 713
 714         return 0;
 715 }
 716
 717 static int disconnect_network(struct supplicant_task *task)
 718 {
 719         DBusMessage *message, *reply;
 720         DBusError error;
 721
 722         DBG("task %p", task);
 723
 724         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 725                                 SUPPLICANT_INTF ".Interface", "disconnect");
 726         if (message == NULL)
 727                 return -ENOMEM;
 728
 729         dbus_message_set_auto_start(message, FALSE);
 730
 731         dbus_error_init(&error);
 732
 733         reply = dbus_connection_send_with_reply_and_block(connection,
 734                                                         message, -1, &error);
 735         if (reply == NULL) {
 736                 if (dbus_error_is_set(&error) == TRUE) {
 737                         connman_error("%s", error.message);
 738                         dbus_error_free(&error);
 739                 } else
 740                         connman_error("Failed to disconnect network");
 741                 dbus_message_unref(message);
 742                 return -EIO;
 743         }
 744
 745         dbus_message_unref(message);
 746
 747         dbus_message_unref(reply);
 748
 749         return 0;
 750 }
 751
 752 static int set_network(struct supplicant_task *task,
 753                                 const unsigned char *network, int len,
 754                                 const char *address, const char *security,
 755                                                         const char *passphrase)
 756 {
 757         DBusMessage *message, *reply;
 758         DBusMessageIter array, dict;
 759         DBusError error;
 760         dbus_uint32_t scan_ssid = 1;
 761
 762         DBG("task %p", task);
 763
 764         if (task->netpath == NULL)
 765                 return -EINVAL;
 766
 767         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->netpath,
 768                                         SUPPLICANT_INTF ".Network", "set");
 769         if (message == NULL)
 770                 return -ENOMEM;
 771
 772         dbus_message_set_auto_start(message, FALSE);
 773
 774         dbus_message_iter_init_append(message, &array);
 775
 776         dbus_message_iter_open_container(&array, DBUS_TYPE_ARRAY,
 777                         DBUS_DICT_ENTRY_BEGIN_CHAR_AS_STRING
 778                         DBUS_TYPE_STRING_AS_STRING DBUS_TYPE_VARIANT_AS_STRING
 779                         DBUS_DICT_ENTRY_END_CHAR_AS_STRING, &dict);
 780
 781         connman_dbus_dict_append_variant(&dict, "scan_ssid",
 782                                          DBUS_TYPE_UINT32, &scan_ssid);
 783
 784         if (address)
 785                 connman_dbus_dict_append_variant(&dict, "bssid",
 786                                                 DBUS_TYPE_STRING, &address);
 787
 788         connman_dbus_dict_append_array(&dict, "ssid",
 789                                         DBUS_TYPE_BYTE, &network, len);
 790
 791         if (g_ascii_strcasecmp(security, "wpa") == 0 ||
 792                                 g_ascii_strcasecmp(security, "rsn") == 0) {
 793                 const char *key_mgmt = "WPA-PSK";
 794                 connman_dbus_dict_append_variant(&dict, "key_mgmt",
 795                                                 DBUS_TYPE_STRING, &key_mgmt);
 796
 797                 if (passphrase && strlen(passphrase) > 0)
 798                         connman_dbus_dict_append_variant(&dict, "psk",
 799                                                 DBUS_TYPE_STRING, &passphrase);
 800         } else if (g_ascii_strcasecmp(security, "wep") == 0) {
 801                 const char *key_mgmt = "NONE";
 802                 const char *auth_alg = "OPEN";
 803                 const char *key_index = "0";
 804
 805                 if (task->mac80211 == TRUE)
 806                         auth_alg = "OPEN SHARED";
 807
 808                 connman_dbus_dict_append_variant(&dict, "auth_alg",
 809                                                 DBUS_TYPE_STRING, &auth_alg);
 810
 811                 connman_dbus_dict_append_variant(&dict, "key_mgmt",
 812                                                 DBUS_TYPE_STRING, &key_mgmt);
 813
 814                 if (passphrase) {
 815                         int size = strlen(passphrase);
 816                         if (size == 10 || size == 26) {
 817                                 unsigned char *key = malloc(13);
 818                                 char tmp[3];
 819                                 int i;
 820                                 memset(tmp, 0, sizeof(tmp));
 821                                 if (key == NULL)
 822                                         size = 0;
 823                                 for (i = 0; i < size / 2; i++) {
 824                                         memcpy(tmp, passphrase + (i * 2), 2);
 825                                         key[i] = (unsigned char) strtol(tmp,
 826                                                                 NULL, 16);
 827                                 }
 828                                 connman_dbus_dict_append_array(&dict,
 829                                                 "wep_key0", DBUS_TYPE_BYTE,
 830                                                         &key, size / 2);
 831                                 free(key);
 832                         } else
 833                                 connman_dbus_dict_append_variant(&dict,
 834                                                 "wep_key0", DBUS_TYPE_STRING,
 835                                                                 &passphrase);
 836
 837                         connman_dbus_dict_append_variant(&dict, "wep_tx_keyidx",
 838                                                 DBUS_TYPE_STRING, &key_index);
 839                 }
 840         } else {
 841                 const char *key_mgmt = "NONE";
 842                 connman_dbus_dict_append_variant(&dict, "key_mgmt",
 843                                                 DBUS_TYPE_STRING, &key_mgmt);
 844         }
 845
 846         dbus_message_iter_close_container(&array, &dict);
 847
 848         dbus_error_init(&error);
 849
 850         reply = dbus_connection_send_with_reply_and_block(connection,
 851                                                         message, -1, &error);
 852         if (reply == NULL) {
 853                 if (dbus_error_is_set(&error) == TRUE) {
 854                         connman_error("%s", error.message);
 855                         dbus_error_free(&error);
 856                 } else
 857                         connman_error("Failed to set network options");
 858                 dbus_message_unref(message);
 859                 return -EIO;
 860         }
 861
 862         dbus_message_unref(message);
 863
 864         dbus_message_unref(reply);
 865
 866         return 0;
 867 }
 868
 869 static void scan_reply(DBusPendingCall *call, void *user_data)
 870 {
 871         struct supplicant_task *task = user_data;
 872         DBusMessage *reply;
 873
 874         DBG("task %p", task);
 875
 876         task->scan_call = NULL;
 877
 878         reply = dbus_pending_call_steal_reply(call);
 879         if (reply == NULL)
 880                 return;
 881
 882         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR) {
 883                 connman_device_set_scanning(task->device, FALSE);
 884                 goto done;
 885         }
 886
 887         if (task->scanning == TRUE)
 888                 connman_device_set_scanning(task->device, TRUE);
 889
 890 done:
 891         dbus_message_unref(reply);
 892 }
 893
 894
 895 static int initiate_scan(struct supplicant_task *task)
 896 {
 897         DBusMessage *message;
 898
 899         DBG("task %p", task);
 900
 901         if (task->scan_call != NULL)
 902                 return -EALREADY;
 903
 904         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
 905                                         SUPPLICANT_INTF ".Interface", "scan");
 906         if (message == NULL)
 907                 return -ENOMEM;
 908
 909         dbus_message_set_auto_start(message, FALSE);
 910
 911         if (dbus_connection_send_with_reply(connection, message,
 912                                         &task->scan_call, TIMEOUT) == FALSE) {
 913                 connman_error("Failed to initiate scan");
 914                 dbus_message_unref(message);
 915                 return -EIO;
 916         }
 917
 918         if (task->scan_call == NULL) {
 919                 connman_error("D-Bus connection not available");
 920                 dbus_message_unref(message);
 921                 return -EIO;
 922         }
 923
 924         dbus_pending_call_set_notify(task->scan_call, scan_reply, task, NULL);
 925
 926         dbus_message_unref(message);
 927
 928         return -EINPROGRESS;
 929 }
 930
 931 static struct {
 932         char *name;
 933         char *value;
 934 } special_ssid[] = {
 935         { "<hidden>", "hidden"  },
 936         { "default",  "linksys" },
 937         { "wireless"  },
 938         { "linksys"   },
 939         { "netgear"   },
 940         { "dlink"     },
 941         { "2wire"     },
 942         { "compaq"    },
 943         { "tsunami"   },
 944         { "comcomcom", "3com"     },
 945         { "3Com",      "3com"     },
 946         { "Symbol",    "symbol"   },
 947         { "Motorola",  "motorola" },
 948         { "Wireless" , "wireless" },
 949         { "WLAN",      "wlan"     },
 950         { }
 951 };
 952
 953 static char *build_group(const char *addr, const char *name,
 954                         const unsigned char *ssid, unsigned int ssid_len,
 955                                         const char *mode, const char *security)
 956 {
 957         GString *str;
 958         unsigned int i;
 959
 960         if (addr == NULL)
 961                 return NULL;
 962
 963         str = g_string_sized_new((ssid_len * 2) + 24);
 964         if (str == NULL)
 965                 return NULL;
 966
 967         if (ssid == NULL) {
 968                 g_string_append_printf(str, "hidden_%s", addr);
 969                 goto done;
 970         }
 971
 972         for (i = 0; special_ssid[i].name; i++) {
 973                 if (g_strcmp0(special_ssid[i].name, name) == 0) {
 974                         if (special_ssid[i].value == NULL)
 975                                 g_string_append_printf(str, "%s_%s",
 976                                                                 name, addr);
 977                         else
 978                                 g_string_append_printf(str, "%s_%s",
 979                                                 special_ssid[i].value, addr);
 980                         goto done;
 981                 }
 982         }
 983
 984         if (ssid_len > 0 && ssid[0] != '\0') {
 985                 for (i = 0; i < ssid_len; i++)
 986                         g_string_append_printf(str, "%02x", ssid[i]);
 987         } else
 988                 g_string_append_printf(str, "hidden_%s", addr);
 989
 990 done:
 991         g_string_append_printf(str, "_%s_%s", mode, security);
 992
 993         return g_string_free(str, FALSE);
 994 }
 995
 996 static void extract_addr(DBusMessageIter *value,
 997                                         struct supplicant_result *result)
 998 {
 999         DBusMessageIter array;
1000         struct ether_addr eth;
1001         unsigned char *addr;
1002         int addr_len;
1003
1004         dbus_message_iter_recurse(value, &array);
1005         dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
1006
1007         if (addr_len != 6)
1008                 return;
1009
1010         result->addr = g_try_malloc(addr_len);
1011         if (result->addr == NULL)
1012                 return;
1013
1014         memcpy(result->addr, addr, addr_len);
1015         result->addr_len = addr_len;
1016
1017         result->path = g_try_malloc0(13);
1018         if (result->path == NULL)
1019                 return;
1020
1021         memcpy(&eth, addr, sizeof(eth));
1022         snprintf(result->path, 13, "%02x%02x%02x%02x%02x%02x",
1023                                                 eth.ether_addr_octet[0],
1024                                                 eth.ether_addr_octet[1],
1025                                                 eth.ether_addr_octet[2],
1026                                                 eth.ether_addr_octet[3],
1027                                                 eth.ether_addr_octet[4],
1028                                                 eth.ether_addr_octet[5]);
1029 }
1030
1031 static void extract_ssid(DBusMessageIter *value,
1032                                         struct supplicant_result *result)
1033 {
1034         DBusMessageIter array;
1035         unsigned char *ssid;
1036         int ssid_len, i;
1037
1038         dbus_message_iter_recurse(value, &array);
1039         dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
1040
1041         if (ssid_len < 1)
1042                 return;
1043
1044         if (ssid[0] == '\0')
1045                 return;
1046
1047         result->ssid = g_try_malloc(ssid_len);
1048         if (result->ssid == NULL)
1049                 return;
1050
1051         memcpy(result->ssid, ssid, ssid_len);
1052         result->ssid_len = ssid_len;
1053
1054         result->name = g_try_malloc0(ssid_len + 1);
1055         if (result->name == NULL)
1056                 return;
1057
1058         for (i = 0; i < ssid_len; i++) {
1059                 if (g_ascii_isprint(ssid[i]))
1060                         result->name[i] = ssid[i];
1061                 else
1062                         result->name[i] = ' ';
1063         }
1064 }
1065
1066 static void extract_wpaie(DBusMessageIter *value,
1067                                         struct supplicant_result *result)
1068 {
1069         DBusMessageIter array;
1070         unsigned char *ie;
1071         int ie_len;
1072
1073         dbus_message_iter_recurse(value, &array);
1074         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1075
1076         if (ie_len > 0)
1077                 result->has_wpa = TRUE;
1078 }
1079
1080 static void extract_rsnie(DBusMessageIter *value,
1081                                         struct supplicant_result *result)
1082 {
1083         DBusMessageIter array;
1084         unsigned char *ie;
1085         int ie_len;
1086
1087         dbus_message_iter_recurse(value, &array);
1088         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1089
1090         if (ie_len > 0)
1091                 result->has_rsn = TRUE;
1092 }
1093
1094 static void extract_wpsie(DBusMessageIter *value,
1095                                         struct supplicant_result *result)
1096 {
1097         DBusMessageIter array;
1098         unsigned char *ie;
1099         int ie_len;
1100
1101         dbus_message_iter_recurse(value, &array);
1102         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1103
1104         if (ie_len > 0)
1105                 result->has_wps = TRUE;
1106 }
1107
1108 static void extract_capabilites(DBusMessageIter *value,
1109                                         struct supplicant_result *result)
1110 {
1111         dbus_message_iter_get_basic(value, &result->capabilities);
1112
1113         if (result->capabilities & IEEE80211_CAP_ESS)
1114                 result->adhoc = FALSE;
1115         else if (result->capabilities & IEEE80211_CAP_IBSS)
1116                 result->adhoc = TRUE;
1117
1118         if (result->capabilities & IEEE80211_CAP_PRIVACY)
1119                 result->has_wep = TRUE;
1120 }
1121
1122 static unsigned char calculate_strength(struct supplicant_task *task,
1123                                         struct supplicant_result *result)
1124 {
1125         if (task->range->max_qual.qual == 0) {
1126                 unsigned char strength;
1127
1128                 if (result->level > 0)
1129                         strength = 100 - result->level;
1130                 else
1131                         strength = 120 + result->level;
1132
1133                 if (strength > 100)
1134                         strength = 100;
1135
1136                 return strength;
1137         }
1138
1139         return (result->quality * 100) / task->range->max_qual.qual;
1140 }
1141
1142 static unsigned short calculate_channel(struct supplicant_result *result)
1143 {
1144         if (result->frequency < 0)
1145                 return 0;
1146
1147         return (result->frequency - 2407) / 5;
1148 }
1149
1150 static void get_properties(struct supplicant_task *task);
1151
1152 static void properties_reply(DBusPendingCall *call, void *user_data)
1153 {
1154         struct supplicant_task *task = user_data;
1155         struct supplicant_result result;
1156         struct connman_network *network;
1157         DBusMessage *reply;
1158         DBusMessageIter array, dict;
1159         unsigned char strength;
1160         unsigned short channel, frequency;
1161         const char *mode, *security;
1162         char *group = NULL;
1163
1164         DBG("task %p", task);
1165
1166         reply = dbus_pending_call_steal_reply(call);
1167         if (reply == NULL) {
1168                 get_properties(task);
1169                 return;
1170         }
1171
1172         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR) {
1173                 dbus_message_unref(reply);
1174                 get_properties(task);
1175                 return;
1176         }
1177
1178         memset(&result, 0, sizeof(result));
1179         result.frequency = -1;
1180         result.quality = -1;
1181         result.level = 0;
1182         result.noise = 0;
1183
1184         dbus_message_iter_init(reply, &array);
1185
1186         dbus_message_iter_recurse(&array, &dict);
1187
1188         while (dbus_message_iter_get_arg_type(&dict) == DBUS_TYPE_DICT_ENTRY) {
1189                 DBusMessageIter entry, value;
1190                 const char *key;
1191
1192                 dbus_message_iter_recurse(&dict, &entry);
1193                 dbus_message_iter_get_basic(&entry, &key);
1194
1195                 dbus_message_iter_next(&entry);
1196
1197                 dbus_message_iter_recurse(&entry, &value);
1198
1199                 //type = dbus_message_iter_get_arg_type(&value);
1200                 //dbus_message_iter_get_basic(&value, &val);
1201
1202                 /*
1203                  * bssid        : a (97)
1204                  * ssid         : a (97)
1205                  * wpaie        : a (97)
1206                  * rsnie        : a (97)
1207                  * wpsie        : a (97)
1208                  * frequency    : i (105)
1209                  * capabilities : q (113)
1210                  * quality      : i (105)
1211                  * noise        : i (105)
1212                  * level        : i (105)
1213                  * maxrate      : i (105)
1214                  */
1215
1216                 if (g_str_equal(key, "bssid") == TRUE)
1217                         extract_addr(&value, &result);
1218                 else if (g_str_equal(key, "ssid") == TRUE)
1219                         extract_ssid(&value, &result);
1220                 else if (g_str_equal(key, "wpaie") == TRUE)
1221                         extract_wpaie(&value, &result);
1222                 else if (g_str_equal(key, "rsnie") == TRUE)
1223                         extract_rsnie(&value, &result);
1224                 else if (g_str_equal(key, "wpsie") == TRUE)
1225                         extract_wpsie(&value, &result);
1226                 else if (g_str_equal(key, "capabilities") == TRUE)
1227                         extract_capabilites(&value, &result);
1228                 else if (g_str_equal(key, "frequency") == TRUE)
1229                         dbus_message_iter_get_basic(&value, &result.frequency);
1230                 else if (g_str_equal(key, "quality") == TRUE)
1231                         dbus_message_iter_get_basic(&value, &result.quality);
1232                 else if (g_str_equal(key, "noise") == TRUE)
1233                         dbus_message_iter_get_basic(&value, &result.noise);
1234                 else if (g_str_equal(key, "level") == TRUE)
1235                         dbus_message_iter_get_basic(&value, &result.level);
1236                 else if (g_str_equal(key, "maxrate") == TRUE)
1237                         dbus_message_iter_get_basic(&value, &result.maxrate);
1238
1239                 dbus_message_iter_next(&dict);
1240         }
1241
1242         if (result.path == NULL)
1243                 goto done;
1244
1245         if (result.path[0] == '\0')
1246                 goto done;
1247
1248         if (result.frequency > 0 && result.frequency < 14)
1249                 result.frequency = 2407 + (5 * result.frequency);
1250         else if (result.frequency == 14)
1251                 result.frequency = 2484;
1252
1253         strength = calculate_strength(task, &result);
1254         channel  = calculate_channel(&result);
1255
1256         frequency = (result.frequency < 0) ? 0 : result.frequency;
1257
1258         if (result.has_rsn == TRUE)
1259                 security = "rsn";
1260         else if (result.has_wpa == TRUE)
1261                 security = "wpa";
1262         else if (result.has_wep == TRUE)
1263                 security = "wep";
1264         else
1265                 security = "none";
1266
1267         mode = (result.adhoc == TRUE) ? "adhoc" : "managed";
1268
1269         group = build_group(result.path, result.name,
1270                                         result.ssid, result.ssid_len,
1271                                                         mode, security);
1272
1273         network = connman_device_get_network(task->device, result.path);
1274         if (network == NULL) {
1275                 int index;
1276
1277                 network = connman_network_create(result.path,
1278                                                 CONNMAN_NETWORK_TYPE_WIFI);
1279                 if (network == NULL)
1280                         goto done;
1281
1282                 index = connman_device_get_index(task->device);
1283                 connman_network_set_index(network, index);
1284
1285                 connman_network_set_protocol(network,
1286                                                 CONNMAN_NETWORK_PROTOCOL_IP);
1287
1288                 connman_network_set_address(network, result.addr,
1289                                                         result.addr_len);
1290
1291                 if (connman_device_add_network(task->device, network) < 0) {
1292                         connman_network_unref(network);
1293                         goto done;
1294                 }
1295         }
1296
1297         if (result.name != NULL && result.name[0] != '\0')
1298                 connman_network_set_name(network, result.name);
1299
1300         connman_network_set_blob(network, "WiFi.SSID",
1301                                                 result.ssid, result.ssid_len);
1302
1303         connman_network_set_string(network, "WiFi.Mode", mode);
1304
1305         DBG("%s (%s %s) strength %d (%s)",
1306                                 result.name, mode, security, strength,
1307                                 (result.has_wps == TRUE) ? "WPS" : "no WPS");
1308
1309         connman_network_set_available(network, TRUE);
1310         connman_network_set_strength(network, strength);
1311
1312         connman_network_set_uint16(network, "Frequency", frequency);
1313         connman_network_set_uint16(network, "WiFi.Channel", channel);
1314         connman_network_set_string(network, "WiFi.Security", security);
1315
1316         if (result.ssid != NULL)
1317                 connman_network_set_group(network, group);
1318
1319 done:
1320         g_free(group);
1321
1322         g_free(result.path);
1323         g_free(result.addr);
1324         g_free(result.name);
1325         g_free(result.ssid);
1326
1327         dbus_message_unref(reply);
1328
1329         get_properties(task);
1330 }
1331
1332 static void get_properties(struct supplicant_task *task)
1333 {
1334         DBusMessage *message;
1335         char *path;
1336
1337         path = g_slist_nth_data(task->scan_results, 0);
1338         if (path == NULL)
1339                 goto noscan;
1340
1341         message = dbus_message_new_method_call(SUPPLICANT_NAME, path,
1342                                                 SUPPLICANT_INTF ".BSSID",
1343                                                                 "properties");
1344
1345         task->scan_results = g_slist_remove(task->scan_results, path);
1346         g_free(path);
1347
1348         if (message == NULL)
1349                 goto noscan;
1350
1351         dbus_message_set_auto_start(message, FALSE);
1352
1353         if (dbus_connection_send_with_reply(connection, message,
1354                                 &task->result_call, TIMEOUT) == FALSE) {
1355                 connman_error("Failed to get network properties");
1356                 dbus_message_unref(message);
1357                 goto noscan;
1358         }
1359
1360         if (task->result_call == NULL) {
1361                 connman_error("D-Bus connection not available");
1362                 dbus_message_unref(message);
1363                 goto noscan;
1364         }
1365
1366         dbus_pending_call_set_notify(task->result_call,
1367                                         properties_reply, task, NULL);
1368
1369         dbus_message_unref(message);
1370
1371         return;
1372
1373 noscan:
1374         task->result_call = NULL;
1375
1376         if (task->scanning == TRUE) {
1377                 connman_device_set_scanning(task->device, FALSE);
1378                 task->scanning = FALSE;
1379         }
1380 }
1381
1382 static void scan_results_reply(DBusPendingCall *call, void *user_data)
1383 {
1384         struct supplicant_task *task = user_data;
1385         DBusMessage *reply;
1386         DBusError error;
1387         char **results;
1388         int i, num_results;
1389
1390         DBG("task %p", task);
1391
1392         reply = dbus_pending_call_steal_reply(call);
1393         if (reply == NULL)
1394                 goto noscan;
1395
1396         if (dbus_message_get_type(reply) == DBUS_MESSAGE_TYPE_ERROR)
1397                 goto done;
1398
1399         dbus_error_init(&error);
1400
1401         if (dbus_message_get_args(reply, &error,
1402                                 DBUS_TYPE_ARRAY, DBUS_TYPE_OBJECT_PATH,
1403                                                 &results, &num_results,
1404                                                 DBUS_TYPE_INVALID) == FALSE) {
1405                 if (dbus_error_is_set(&error) == TRUE) {
1406                         connman_error("%s", error.message);
1407                         dbus_error_free(&error);
1408                 } else
1409                         connman_error("Wrong arguments for scan result");
1410                 goto done;
1411         }
1412
1413         if (num_results == 0)
1414                 goto done;
1415
1416         for (i = 0; i < num_results; i++) {
1417                 char *path = g_strdup(results[i]);
1418                 if (path == NULL)
1419                         continue;
1420
1421                 task->scan_results = g_slist_append(task->scan_results, path);
1422         }
1423
1424         g_strfreev(results);
1425
1426         dbus_message_unref(reply);
1427
1428         get_properties(task);
1429
1430         return;
1431
1432 done:
1433         dbus_message_unref(reply);
1434
1435 noscan:
1436         task->result_call = NULL;
1437
1438         if (task->scanning == TRUE) {
1439                 connman_device_set_scanning(task->device, FALSE);
1440                 task->scanning = FALSE;
1441         }
1442 }
1443
1444 static void scan_results_available(struct supplicant_task *task)
1445 {
1446         DBusMessage *message;
1447
1448         DBG("task %p", task);
1449
1450         if (task->result_call != NULL)
1451                 return;
1452
1453         message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
1454                                                 SUPPLICANT_INTF ".Interface",
1455                                                         "scanResults");
1456         if (message == NULL)
1457                 return;
1458
1459         dbus_message_set_auto_start(message, FALSE);
1460
1461         if (dbus_connection_send_with_reply(connection, message,
1462                                 &task->result_call, TIMEOUT) == FALSE) {
1463                 connman_error("Failed to request scan result");
1464                 goto done;
1465         }
1466
1467         if (task->result_call == NULL) {
1468                 connman_error("D-Bus connection not available");
1469                 goto done;
1470         }
1471
1472         if (task->scanning == TRUE)
1473                 connman_device_set_scanning(task->device, TRUE);
1474
1475         dbus_pending_call_set_notify(task->result_call,
1476                                         scan_results_reply, task, NULL);
1477
1478 done:
1479         dbus_message_unref(message);
1480 }
1481
1482 static enum supplicant_state string2state(const char *state)
1483 {
1484         if (g_str_equal(state, "INACTIVE") == TRUE)
1485                 return WPA_INACTIVE;
1486         else if (g_str_equal(state, "SCANNING") == TRUE)
1487                 return WPA_SCANNING;
1488         else if (g_str_equal(state, "ASSOCIATING") == TRUE)
1489                 return WPA_ASSOCIATING;
1490         else if (g_str_equal(state, "ASSOCIATED") == TRUE)
1491                 return WPA_ASSOCIATED;
1492         else if (g_str_equal(state, "GROUP_HANDSHAKE") == TRUE)
1493                 return WPA_GROUP_HANDSHAKE;
1494         else if (g_str_equal(state, "4WAY_HANDSHAKE") == TRUE)
1495                 return WPA_4WAY_HANDSHAKE;
1496         else if (g_str_equal(state, "COMPLETED") == TRUE)
1497                 return WPA_COMPLETED;
1498         else if (g_str_equal(state, "DISCONNECTED") == TRUE)
1499                 return WPA_DISCONNECTED;
1500         else
1501                 return WPA_INVALID;
1502 }
1503
1504 static int task_connect(struct supplicant_task *task)
1505 {
1506         const char *address, *security, *passphrase;
1507         const void *ssid;
1508         unsigned int ssid_len;
1509         int err;
1510
1511         address = connman_network_get_string(task->network, "Address");
1512         security = connman_network_get_string(task->network, "WiFi.Security");
1513         passphrase = connman_network_get_string(task->network, "WiFi.Passphrase");
1514
1515         ssid = connman_network_get_blob(task->network, "WiFi.SSID", &ssid_len);
1516
1517         DBG("address %s security %s passphrase %s",
1518                                         address, security, passphrase);
1519
1520         if (security == NULL && passphrase == NULL)
1521                 return -EINVAL;
1522
1523         if (g_str_equal(security, "none") == FALSE && passphrase == NULL)
1524                 return -EINVAL;
1525
1526         remove_network(task);
1527
1528         set_ap_scan(task);
1529
1530         add_network(task);
1531
1532         set_network(task, ssid, ssid_len, address, security, passphrase);
1533
1534         err = select_network(task);
1535         if (err < 0)
1536                 return err;
1537
1538         return -EINPROGRESS;
1539 }
1540
1541 static void scanning(struct supplicant_task *task, DBusMessage *msg)
1542 {
1543         DBusError error;
1544         dbus_bool_t scanning;
1545
1546         dbus_error_init(&error);
1547
1548         if (dbus_message_get_args(msg, &error, DBUS_TYPE_BOOLEAN, &scanning,
1549                                                 DBUS_TYPE_INVALID) == FALSE) {
1550                 if (dbus_error_is_set(&error) == TRUE) {
1551                         connman_error("%s", error.message);
1552                         dbus_error_free(&error);
1553                 } else
1554                         connman_error("Wrong arguments for scanning");
1555                 return;
1556         }
1557
1558         connman_info("%s scanning %s", task->ifname,
1559                                 scanning == TRUE ? "started" : "finished");
1560 }
1561
1562 static void state_change(struct supplicant_task *task, DBusMessage *msg)
1563 {
1564         DBusError error;
1565         const char *newstate, *oldstate;
1566         unsigned char bssid[ETH_ALEN];
1567         unsigned int bssid_len;
1568         enum supplicant_state state;
1569
1570         dbus_error_init(&error);
1571
1572         if (dbus_message_get_args(msg, &error, DBUS_TYPE_STRING, &newstate,
1573                                                 DBUS_TYPE_STRING, &oldstate,
1574                                                 DBUS_TYPE_INVALID) == FALSE) {
1575                 if (dbus_error_is_set(&error) == TRUE) {
1576                         connman_error("%s", error.message);
1577                         dbus_error_free(&error);
1578                 } else
1579                         connman_error("Wrong arguments for state change");
1580                 return;
1581         }
1582
1583         DBG("state %s ==> %s", oldstate, newstate);
1584
1585         connman_info("%s %s", task->ifname, newstate);
1586
1587         state = string2state(newstate);
1588         if (state == WPA_INVALID)
1589                 return;
1590
1591         if (task->scanning == TRUE && state != WPA_SCANNING) {
1592                 connman_device_set_scanning(task->device, FALSE);
1593                 task->scanning = FALSE;
1594         }
1595
1596         task->state = state;
1597
1598         if (task->network == NULL)
1599                 return;
1600
1601         switch (task->state) {
1602         case WPA_COMPLETED:
1603                 if (get_bssid(task->device, bssid, &bssid_len) == 0)
1604                         connman_network_set_address(task->network,
1605                                                         bssid, bssid_len);
1606
1607                 /* carrier on */
1608                 connman_network_set_connected(task->network, TRUE);
1609                 break;
1610
1611         case WPA_DISCONNECTED:
1612                 remove_network(task);
1613
1614                 /* carrier off */
1615                 connman_network_set_connected(task->network, FALSE);
1616
1617                 if (task->disconnecting == TRUE) {
1618                         connman_network_unref(task->network);
1619                         task->disconnecting = FALSE;
1620
1621                         if (task->pending_network != NULL) {
1622                                 task->network = task->pending_network;
1623                                 task->pending_network = NULL;
1624                                 task_connect(task);
1625                         } else
1626                                 task->network = NULL;
1627                 }
1628                 break;
1629
1630         case WPA_ASSOCIATING:
1631                 connman_network_set_associating(task->network, TRUE);
1632                 break;
1633
1634         case WPA_INACTIVE:
1635                 connman_network_set_connected(task->network, FALSE);
1636
1637                 if (task->disconnecting == TRUE) {
1638                         connman_network_unref(task->network);
1639                         task->disconnecting = FALSE;
1640
1641                         if (task->pending_network != NULL) {
1642                                 task->network = task->pending_network;
1643                                 task->pending_network = NULL;
1644                                 task_connect(task);
1645                         } else
1646                                 task->network = NULL;
1647                 }
1648                 break;
1649
1650         default:
1651                 connman_network_set_associating(task->network, FALSE);
1652                 break;
1653         }
1654 }
1655
1656 static DBusHandlerResult supplicant_filter(DBusConnection *conn,
1657                                                 DBusMessage *msg, void *data)
1658 {
1659         struct supplicant_task *task;
1660         const char *member, *path;
1661
1662         if (dbus_message_has_interface(msg,
1663                                 SUPPLICANT_INTF ".Interface") == FALSE)
1664                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1665
1666         member = dbus_message_get_member(msg);
1667         if (member == NULL)
1668                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1669
1670         path = dbus_message_get_path(msg);
1671         if (path == NULL)
1672                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1673
1674         task = find_task_by_path(path);
1675         if (task == NULL)
1676                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1677
1678         DBG("task %p member %s", task, member);
1679
1680         if (g_str_equal(member, "ScanResultsAvailable") == TRUE)
1681                 scan_results_available(task);
1682         else if (g_str_equal(member, "Scanning") == TRUE)
1683                 scanning(task, msg);
1684         else if (g_str_equal(member, "StateChange") == TRUE)
1685                 state_change(task, msg);
1686
1687         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1688 }
1689
1690 int supplicant_start(struct connman_device *device)
1691 {
1692         struct supplicant_task *task;
1693         int err;
1694
1695         DBG("device %p", device);
1696
1697         task = g_try_new0(struct supplicant_task, 1);
1698         if (task == NULL)
1699                 return -ENOMEM;
1700
1701         task->ifindex = connman_device_get_index(device);
1702         task->ifname = connman_inet_ifname(task->ifindex);
1703
1704         if (task->ifname == NULL) {
1705                 err = -ENOMEM;
1706                 goto failed;
1707         }
1708
1709         task->mac80211 = connman_inet_is_mac80211(task->ifindex);
1710         if (task->mac80211 == FALSE)
1711                 connman_warn("Enabling quirks for unsupported driver");
1712
1713         task->range = g_try_malloc0(sizeof(struct iw_range));
1714         if (task->range == NULL) {
1715                 err = -ENOMEM;
1716                 goto failed;
1717         }
1718
1719         err = get_range(task);
1720         if (err < 0)
1721                 goto failed;
1722
1723         task->device = connman_device_ref(device);
1724
1725         task->created = FALSE;
1726         task->scanning = FALSE;
1727         task->state = WPA_INVALID;
1728         task->disconnecting = FALSE;
1729         task->pending_network = NULL;
1730
1731         task_list = g_slist_append(task_list, task);
1732
1733         return create_interface(task);
1734
1735 failed:
1736         g_free(task->range);
1737         g_free(task->ifname);
1738         g_free(task);
1739
1740         return err;
1741 }
1742
1743 int supplicant_stop(struct connman_device *device)
1744 {
1745         int index = connman_device_get_index(device);
1746         struct supplicant_task *task;
1747
1748         DBG("device %p", device);
1749
1750         task = find_task_by_index(index);
1751         if (task == NULL)
1752                 return -ENODEV;
1753
1754         g_free(task->range);
1755
1756         task_list = g_slist_remove(task_list, task);
1757
1758         if (task->scan_call != NULL) {
1759                 dbus_pending_call_cancel(task->scan_call);
1760                 task->scan_call = NULL;
1761         }
1762
1763         if (task->result_call != NULL) {
1764                 dbus_pending_call_cancel(task->result_call);
1765                 task->result_call = NULL;
1766         }
1767
1768         if (task->scanning == TRUE)
1769                 connman_device_set_scanning(task->device, FALSE);
1770
1771         remove_network(task);
1772
1773         disconnect_network(task);
1774
1775         return remove_interface(task);
1776 }
1777
1778 int supplicant_scan(struct connman_device *device)
1779 {
1780         int index = connman_device_get_index(device);
1781         struct supplicant_task *task;
1782         int err;
1783
1784         DBG("device %p", device);
1785
1786         task = find_task_by_index(index);
1787         if (task == NULL)
1788                 return -ENODEV;
1789
1790         switch (task->state) {
1791         case WPA_SCANNING:
1792                 return -EALREADY;
1793         case WPA_ASSOCIATING:
1794         case WPA_ASSOCIATED:
1795         case WPA_4WAY_HANDSHAKE:
1796         case WPA_GROUP_HANDSHAKE:
1797                 return -EBUSY;
1798         default:
1799                 break;
1800         }
1801
1802         task->scanning = TRUE;
1803
1804         err = initiate_scan(task);
1805         if (err < 0) {
1806                 if (err == -EINPROGRESS)
1807                         return 0;
1808
1809                 task->scanning = FALSE;
1810                 return err;
1811         }
1812
1813         connman_device_set_scanning(task->device, TRUE);
1814
1815         return 0;
1816 }
1817
1818 int supplicant_connect(struct connman_network *network)
1819 {
1820         struct supplicant_task *task;
1821         int index;
1822
1823         DBG("network %p", network);
1824
1825         index = connman_network_get_index(network);
1826
1827         task = find_task_by_index(index);
1828         if (task == NULL)
1829                 return -ENODEV;
1830
1831         if (task->disconnecting == TRUE)
1832                 task->pending_network = connman_network_ref(network);
1833         else {
1834                 task->network = connman_network_ref(network);
1835                 return task_connect(task);
1836         }
1837
1838         return -EINPROGRESS;
1839 }
1840
1841 int supplicant_disconnect(struct connman_network *network)
1842 {
1843         struct supplicant_task *task;
1844         int index;
1845
1846         DBG("network %p", network);
1847
1848         index = connman_network_get_index(network);
1849
1850         task = find_task_by_index(index);
1851         if (task == NULL)
1852                 return -ENODEV;
1853
1854         if (task->disconnecting == TRUE)
1855                 return -EALREADY;
1856
1857         remove_network(task);
1858
1859         disconnect_network(task);
1860
1861         task->disconnecting = TRUE;
1862
1863         return 0;
1864 }
1865
1866 static void supplicant_activate(DBusConnection *conn)
1867 {
1868         DBusMessage *message;
1869
1870         DBG("conn %p", conn);
1871
1872         message = dbus_message_new_method_call(SUPPLICANT_NAME, "/",
1873                                 DBUS_INTERFACE_INTROSPECTABLE, "Introspect");
1874         if (message == NULL)
1875                 return;
1876
1877         dbus_message_set_no_reply(message, TRUE);
1878
1879         dbus_connection_send(conn, message, NULL);
1880
1881         dbus_message_unref(message);
1882 }
1883
1884 static GSList *driver_list = NULL;
1885
1886 static void supplicant_probe(DBusConnection *conn, void *user_data)
1887 {
1888         GSList *list;
1889
1890         DBG("conn %p", conn);
1891
1892         for (list = driver_list; list; list = list->next) {
1893                 struct supplicant_driver *driver = list->data;
1894
1895                 DBG("driver %p name %s", driver, driver->name);
1896
1897                 if (driver->probe)
1898                         driver->probe();
1899         }
1900 }
1901
1902 static void supplicant_remove(DBusConnection *conn, void *user_data)
1903 {
1904         GSList *list;
1905
1906         DBG("conn %p", conn);
1907
1908         for (list = driver_list; list; list = list->next) {
1909                 struct supplicant_driver *driver = list->data;
1910
1911                 DBG("driver %p name %s", driver, driver->name);
1912
1913                 if (driver->remove)
1914                         driver->remove();
1915         }
1916 }
1917
1918 static const char *supplicant_rule = "type=signal,"
1919                                 "interface=" SUPPLICANT_INTF ".Interface";
1920 static guint watch;
1921
1922 static int supplicant_create(void)
1923 {
1924         if (g_slist_length(driver_list) > 0)
1925                 return 0;
1926
1927         connection = connman_dbus_get_connection();
1928         if (connection == NULL)
1929                 return -EIO;
1930
1931         DBG("connection %p", connection);
1932
1933         if (dbus_connection_add_filter(connection,
1934                                 supplicant_filter, NULL, NULL) == FALSE) {
1935                 connection = connman_dbus_get_connection();
1936                 return -EIO;
1937         }
1938
1939         dbus_bus_add_match(connection, supplicant_rule, NULL);
1940         dbus_connection_flush(connection);
1941
1942         watch = g_dbus_add_service_watch(connection, SUPPLICANT_NAME,
1943                         supplicant_probe, supplicant_remove, NULL, NULL);
1944
1945         return 0;
1946 }
1947
1948 static void supplicant_destroy(void)
1949 {
1950         if (g_slist_length(driver_list) > 0)
1951                 return;
1952
1953         DBG("connection %p", connection);
1954
1955         if (watch > 0)
1956                 g_dbus_remove_watch(connection, watch);
1957
1958         dbus_bus_remove_match(connection, supplicant_rule, NULL);
1959         dbus_connection_flush(connection);
1960
1961         dbus_connection_remove_filter(connection, supplicant_filter, NULL);
1962
1963         dbus_connection_unref(connection);
1964         connection = NULL;
1965 }
1966
1967 int supplicant_register(struct supplicant_driver *driver)
1968 {
1969         int err;
1970
1971         DBG("driver %p name %s", driver, driver->name);
1972
1973         err = supplicant_create();
1974         if (err < 0)
1975                 return err;
1976
1977         driver_list = g_slist_append(driver_list, driver);
1978
1979         supplicant_activate(connection);
1980
1981         return 0;
1982 }
1983
1984 void supplicant_unregister(struct supplicant_driver *driver)
1985 {
1986         DBG("driver %p name %s", driver, driver->name);
1987
1988         supplicant_remove(connection, NULL);
1989
1990         driver_list = g_slist_remove(driver_list, driver);
1991
1992         supplicant_destroy();
1993 }