X-Git-Url: http://review.tizen.org/git/?a=blobdiff_plain;f=plugins%2Fwifi.c;h=fc304e3b96a03b448cd70a12dfb2422fa4b2a52b;hb=refs%2Ftags%2Fupstream%2F1.38;hp=5f41b25bb2d2f40ac5a4f162f1fc880adee9debc;hpb=7999a1fc4c6f695674d9510e9c18790748f5e4e5;p=platform%2Fupstream%2Fconnman.git diff --git a/plugins/wifi.c b/plugins/wifi.c index 5f41b25..fc304e3 100644 --- a/plugins/wifi.c +++ b/plugins/wifi.c @@ -2,7 +2,7 @@ * * Connection Manager * - * Copyright (C) 2007-2010 Intel Corporation. All rights reserved. + * Copyright (C) 2007-2014 Intel Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as @@ -30,9 +30,8 @@ #include #include #include -#include -#include #include +#include #ifndef IFF_LOWER_UP #define IFF_LOWER_UP 0x10000 @@ -47,23 +46,83 @@ #include #include #include +#include +#include #include #include #include +#include +#include +#include +#include +#include #include +#include "src/shared/util.h" + #define CLEANUP_TIMEOUT 8 /* in seconds */ #define INACTIVE_TIMEOUT 12 /* in seconds */ -#define MAXIMUM_RETRIES 4 +#define FAVORITE_MAXIMUM_RETRIES 2 + +#define BGSCAN_DEFAULT "simple:30:-65:300" +#define AUTOSCAN_EXPONENTIAL "exponential:3:300" +#define AUTOSCAN_SINGLE "single:3" + +#define P2P_FIND_TIMEOUT 30 +#define P2P_CONNECTION_TIMEOUT 100 +#define P2P_LISTEN_PERIOD 500 +#define P2P_LISTEN_INTERVAL 2000 + +#define ASSOC_STATUS_NO_CLIENT 17 +#define LOAD_SHAPING_MAX_RETRIES 3 + +static struct connman_technology *wifi_technology = NULL; +static struct connman_technology *p2p_technology = NULL; + +enum wifi_ap_capability{ + WIFI_AP_UNKNOWN = 0, + WIFI_AP_SUPPORTED = 1, + WIFI_AP_NOT_SUPPORTED = 2, +}; -struct connman_technology *wifi_technology = NULL; +enum wifi_scanning_type { + WIFI_SCANNING_UNKNOWN = 0, + WIFI_SCANNING_PASSIVE = 1, + WIFI_SCANNING_ACTIVE = 2, +}; struct hidden_params { char ssid[32]; unsigned int ssid_len; char *identity; + char *anonymous_identity; + char *subject_match; + char *altsubject_match; + char *domain_suffix_match; + char *domain_match; char *passphrase; + char *security; + GSupplicantScanParams *scan_params; + gpointer user_data; +}; + +/** + * Used for autoscan "emulation". + * Should be removed when wpa_s autoscan support will be by default. + */ +struct autoscan_params { + int base; + int limit; + int interval; + unsigned int timeout; +}; + +struct wifi_tethering_info { + struct wifi_data *wifi; + struct connman_technology *technology; + char *ifname; + GSupplicantSSID *ssid; }; struct wifi_data { @@ -74,306 +133,1495 @@ struct wifi_data { GSList *networks; GSupplicantInterface *interface; GSupplicantState state; - connman_bool_t connected; - connman_bool_t disconnecting; - connman_bool_t tethering; - connman_bool_t bridged; + bool connected; + bool disconnecting; + bool tethering; + enum wifi_ap_capability ap_supported; + bool bridged; + bool interface_ready; const char *bridge; int index; unsigned flags; unsigned int watch; int retries; + int load_shaping_retries; struct hidden_params *hidden; + bool postpone_hidden; + struct wifi_tethering_info *tethering_param; + /** + * autoscan "emulation". + */ + struct autoscan_params *autoscan; + enum wifi_scanning_type scanning_type; + GSupplicantScanParams *scan_params; + unsigned int p2p_find_timeout; + unsigned int p2p_connection_timeout; + struct connman_peer *pending_peer; + GSList *peers; + bool p2p_connecting; + bool p2p_device; + int servicing; + int disconnect_code; + int assoc_code; }; static GList *iface_list = NULL; -static void handle_tethering(struct wifi_data *wifi) +static GList *pending_wifi_device = NULL; +static GList *p2p_iface_list = NULL; +static bool wfd_service_registered = false; + +static void start_autoscan(struct connman_device *device); +static int tech_set_tethering(struct connman_technology *technology, + const char *identifier, const char *passphrase, + const char *bridge, bool enabled); + +static int p2p_tech_probe(struct connman_technology *technology) { - if (wifi->tethering == FALSE) - return; + p2p_technology = technology; - if (wifi->bridge == NULL) - return; + return 0; +} - if (wifi->bridged == TRUE) - return; +static void p2p_tech_remove(struct connman_technology *technology) +{ + p2p_technology = NULL; +} - DBG("index %d bridge %s", wifi->index, wifi->bridge); +static struct connman_technology_driver p2p_tech_driver = { + .name = "p2p", + .type = CONNMAN_SERVICE_TYPE_P2P, + .probe = p2p_tech_probe, + .remove = p2p_tech_remove, +}; - if (connman_inet_add_to_bridge(wifi->index, wifi->bridge) < 0) +static bool is_p2p_connecting(void) +{ + GList *list; + + for (list = iface_list; list; list = list->next) { + struct wifi_data *wifi = list->data; + + if (wifi->p2p_connecting) + return true; + } + + return false; +} + +static void add_pending_wifi_device(struct wifi_data *wifi) +{ + if (g_list_find(pending_wifi_device, wifi)) return; - wifi->bridged = TRUE; + pending_wifi_device = g_list_append(pending_wifi_device, wifi); } -static void wifi_newlink(unsigned flags, unsigned change, void *user_data) +static struct wifi_data *get_pending_wifi_data(const char *ifname) { - struct connman_device *device = user_data; - struct wifi_data *wifi = connman_device_get_data(device); + GList *list; - DBG("index %d flags %d change %d", wifi->index, flags, change); + for (list = pending_wifi_device; list; list = list->next) { + struct wifi_data *wifi; + const char *dev_name; - if (!change) - return; + wifi = list->data; + if (!wifi || !wifi->device) + continue; - if ((wifi->flags & IFF_UP) != (flags & IFF_UP)) { - if (flags & IFF_UP) - DBG("interface up"); - else - DBG("interface down"); + dev_name = connman_device_get_string(wifi->device, "Interface"); + if (!g_strcmp0(ifname, dev_name)) { + pending_wifi_device = g_list_delete_link( + pending_wifi_device, list); + return wifi; + } } - if ((wifi->flags & IFF_LOWER_UP) != (flags & IFF_LOWER_UP)) { - if (flags & IFF_LOWER_UP) { - DBG("carrier on"); + return NULL; +} - handle_tethering(wifi); - } else - DBG("carrier off"); - } +static void remove_pending_wifi_device(struct wifi_data *wifi) +{ + GList *link; - wifi->flags = flags; + link = g_list_find(pending_wifi_device, wifi); + + if (!link) + return; + + pending_wifi_device = g_list_delete_link(pending_wifi_device, link); } -static int wifi_probe(struct connman_device *device) +static void peer_cancel_timeout(struct wifi_data *wifi) { - struct wifi_data *wifi; + if (wifi->p2p_connection_timeout > 0) + g_source_remove(wifi->p2p_connection_timeout); - DBG("device %p", device); + wifi->p2p_connection_timeout = 0; + wifi->p2p_connecting = false; - wifi = g_try_new0(struct wifi_data, 1); - if (wifi == NULL) - return -ENOMEM; + if (wifi->pending_peer) { + connman_peer_unref(wifi->pending_peer); + wifi->pending_peer = NULL; + } +} - wifi->connected = FALSE; - wifi->disconnecting = FALSE; - wifi->tethering = FALSE; - wifi->bridged = FALSE; - wifi->bridge = NULL; - wifi->state = G_SUPPLICANT_STATE_INACTIVE; +static gboolean peer_connect_timeout(gpointer data) +{ + struct wifi_data *wifi = data; - connman_device_set_data(device, wifi); - wifi->device = connman_device_ref(device); + DBG(""); - wifi->index = connman_device_get_index(device); - wifi->flags = 0; + if (wifi->p2p_connecting) { + enum connman_peer_state state = CONNMAN_PEER_STATE_FAILURE; + GSupplicantPeer *gs_peer = + g_supplicant_interface_peer_lookup(wifi->interface, + connman_peer_get_identifier(wifi->pending_peer)); - wifi->watch = connman_rtnl_add_newlink_watch(wifi->index, - wifi_newlink, device); + if (g_supplicant_peer_has_requested_connection(gs_peer)) + state = CONNMAN_PEER_STATE_IDLE; + + connman_peer_set_state(wifi->pending_peer, state); + } - iface_list = g_list_append(iface_list, wifi); + peer_cancel_timeout(wifi); - return 0; + return FALSE; } -static void remove_networks(struct connman_device *device, - struct wifi_data *wifi) +static void peer_connect_callback(int result, GSupplicantInterface *interface, + void *user_data) { - GSList *list; + struct wifi_data *wifi = user_data; + struct connman_peer *peer = wifi->pending_peer; - for (list = wifi->networks; list != NULL; list = list->next) { - struct connman_network *network = list->data; + DBG("peer %p - %d", peer, result); - connman_device_remove_network(device, network); - connman_network_unref(network); + if (!peer) + return; + + if (result < 0) { + peer_connect_timeout(wifi); + return; } - g_slist_free(wifi->networks); - wifi->networks = NULL; + connman_peer_set_state(peer, CONNMAN_PEER_STATE_ASSOCIATION); + + wifi->p2p_connection_timeout = g_timeout_add_seconds( + P2P_CONNECTION_TIMEOUT, + peer_connect_timeout, wifi); } -static void wifi_remove(struct connman_device *device) +static int peer_connect(struct connman_peer *peer, + enum connman_peer_wps_method wps_method, + const char *wps_pin) { - struct wifi_data *wifi = connman_device_get_data(device); + struct connman_device *device = connman_peer_get_device(peer); + GSupplicantPeerParams *peer_params; + GSupplicantPeer *gs_peer; + struct wifi_data *wifi; + bool pbc, pin; + int ret; - DBG("device %p wifi %p", device, wifi); + DBG("peer %p", peer); - if (wifi == NULL) - return; + if (!device) + return -ENODEV; - iface_list = g_list_remove(iface_list, wifi); + wifi = connman_device_get_data(device); + if (!wifi || !wifi->interface) + return -ENODEV; - remove_networks(device, wifi); + if (wifi->p2p_connecting) + return -EBUSY; - connman_device_set_powered(device, FALSE); - connman_device_set_data(device, NULL); - connman_device_unref(wifi->device); - connman_rtnl_remove_watch(wifi->watch); + gs_peer = g_supplicant_interface_peer_lookup(wifi->interface, + connman_peer_get_identifier(peer)); + if (!gs_peer) + return -EINVAL; - g_supplicant_interface_set_data(wifi->interface, NULL); + pbc = g_supplicant_peer_is_wps_pbc(gs_peer); + pin = g_supplicant_peer_is_wps_pin(gs_peer); - g_free(wifi->identifier); - g_free(wifi); + switch (wps_method) { + case CONNMAN_PEER_WPS_UNKNOWN: + if ((pbc && pin) || pin) + return -ENOKEY; + break; + case CONNMAN_PEER_WPS_PBC: + if (!pbc) + return -EINVAL; + wps_pin = NULL; + break; + case CONNMAN_PEER_WPS_PIN: + if (!pin || !wps_pin) + return -EINVAL; + break; + } + + peer_params = g_try_malloc0(sizeof(GSupplicantPeerParams)); + if (!peer_params) + return -ENOMEM; + + peer_params->path = g_strdup(g_supplicant_peer_get_path(gs_peer)); + if (wps_pin) + peer_params->wps_pin = g_strdup(wps_pin); + + peer_params->master = connman_peer_service_is_master(); + + ret = g_supplicant_interface_p2p_connect(wifi->interface, peer_params, + peer_connect_callback, wifi); + if (ret == -EINPROGRESS) { + wifi->pending_peer = connman_peer_ref(peer); + wifi->p2p_connecting = true; + } else if (ret < 0) { + g_free(peer_params->path); + g_free(peer_params->wps_pin); + g_free(peer_params); + } + + return ret; } -static void interface_create_callback(int result, - GSupplicantInterface *interface, - void *user_data) +static int peer_disconnect(struct connman_peer *peer) { - struct wifi_data *wifi = user_data; + struct connman_device *device = connman_peer_get_device(peer); + GSupplicantPeerParams peer_params = {}; + GSupplicantPeer *gs_peer; + struct wifi_data *wifi; + int ret; - DBG("result %d ifname %s, wifi %p", result, - g_supplicant_interface_get_ifname(interface), - wifi); + DBG("peer %p", peer); - if (result < 0 || wifi == NULL) - return; + if (!device) + return -ENODEV; - wifi->interface = interface; - g_supplicant_interface_set_data(interface, wifi); + wifi = connman_device_get_data(device); + if (!wifi) + return -ENODEV; - if (g_supplicant_interface_get_ready(interface) == FALSE) - return; + gs_peer = g_supplicant_interface_peer_lookup(wifi->interface, + connman_peer_get_identifier(peer)); + if (!gs_peer) + return -EINVAL; - DBG("interface is ready wifi %p tethering %d", wifi, wifi->tethering); + peer_params.path = g_strdup(g_supplicant_peer_get_path(gs_peer)); - if (wifi->device == NULL) { - connman_error("WiFi device not set"); - return; + ret = g_supplicant_interface_p2p_disconnect(wifi->interface, + &peer_params); + g_free(peer_params.path); + + if (ret == -EINPROGRESS) { + peer_cancel_timeout(wifi); + wifi->p2p_device = false; } - connman_device_set_powered(wifi->device, TRUE); + return ret; } -static void interface_remove_callback(int result, - GSupplicantInterface *interface, - void *user_data) +struct peer_service_registration { + peer_service_registration_cb_t callback; + void *user_data; +}; + +static bool is_service_wfd(const unsigned char *specs, int length) { - struct wifi_data *wifi; + if (length < 9 || specs[0] != 0 || specs[1] != 0 || specs[2] != 6) + return false; - wifi = g_supplicant_interface_get_data(interface); + return true; +} - DBG("result %d wifi %p", result, wifi); +static void apply_p2p_listen_on_iface(gpointer data, gpointer user_data) +{ + struct wifi_data *wifi = data; - if (result < 0 || wifi == NULL) + if (!wifi->interface || + !g_supplicant_interface_has_p2p(wifi->interface)) return; - wifi->interface = NULL; + if (!wifi->servicing) { + g_supplicant_interface_p2p_listen(wifi->interface, + P2P_LISTEN_PERIOD, P2P_LISTEN_INTERVAL); + } + + wifi->servicing++; } +static void register_wfd_service_cb(int result, + GSupplicantInterface *iface, void *user_data) +{ + struct peer_service_registration *reg_data = user_data; -static int wifi_enable(struct connman_device *device) + DBG(""); + + if (result == 0) + g_list_foreach(iface_list, apply_p2p_listen_on_iface, NULL); + + if (reg_data && reg_data->callback) { + reg_data->callback(result, reg_data->user_data); + g_free(reg_data); + } +} + +static GSupplicantP2PServiceParams *fill_in_peer_service_params( + const unsigned char *spec, + int spec_length, const unsigned char *query, + int query_length, int version) { - struct wifi_data *wifi = connman_device_get_data(device); - const char *interface = connman_device_get_string(device, "Interface"); - const char *driver = connman_option_get_string("wifi"); - int ret; + GSupplicantP2PServiceParams *params; - DBG("device %p %p", device, wifi); + params = g_try_malloc0(sizeof(GSupplicantP2PServiceParams)); + if (!params) + return NULL; - ret = g_supplicant_interface_create(interface, driver, NULL, - interface_create_callback, - wifi); - if (ret < 0) - return ret; + if (version > 0) { + params->version = version; + params->service = g_memdup(spec, spec_length); + } else if (query_length > 0 && spec_length > 0) { + params->query = g_memdup(query, query_length); + params->query_length = query_length; - return -EINPROGRESS; + params->response = g_memdup(spec, spec_length); + params->response_length = spec_length; + } else { + params->wfd_ies = g_memdup(spec, spec_length); + params->wfd_ies_length = spec_length; + } + + return params; } -static int wifi_disable(struct connman_device *device) +static void free_peer_service_params(GSupplicantP2PServiceParams *params) { - struct wifi_data *wifi = connman_device_get_data(device); + if (!params) + return; + + g_free(params->service); + g_free(params->query); + g_free(params->response); + g_free(params->wfd_ies); + + g_free(params); +} + +static int peer_register_wfd_service(const unsigned char *specification, + int specification_length, + peer_service_registration_cb_t callback, + void *user_data) +{ + struct peer_service_registration *reg_data = NULL; + static GSupplicantP2PServiceParams *params; int ret; - DBG("device %p", device); + DBG(""); - wifi->connected = FALSE; - wifi->disconnecting = FALSE; + if (wfd_service_registered) + return -EBUSY; - if (wifi->pending_network != NULL) - wifi->pending_network = NULL; + params = fill_in_peer_service_params(specification, + specification_length, NULL, 0, 0); + if (!params) + return -ENOMEM; - remove_networks(device, wifi); + reg_data = g_try_malloc0(sizeof(*reg_data)); + if (!reg_data) { + ret = -ENOMEM; + goto error; + } - ret = g_supplicant_interface_remove(wifi->interface, - interface_remove_callback, - NULL); - if (ret < 0) - return ret; + reg_data->callback = callback; + reg_data->user_data = user_data; - return -EINPROGRESS; + ret = g_supplicant_set_widi_ies(params, + register_wfd_service_cb, reg_data); + if (ret < 0 && ret != -EINPROGRESS) + goto error; + + wfd_service_registered = true; + + return ret; +error: + free_peer_service_params(params); + g_free(reg_data); + + return ret; } -static void hidden_free(struct hidden_params *hidden) +static void register_peer_service_cb(int result, + GSupplicantInterface *iface, void *user_data) { - if (hidden == NULL) - return; + struct wifi_data *wifi = g_supplicant_interface_get_data(iface); + struct peer_service_registration *reg_data = user_data; - g_free(hidden->identity); - g_free(hidden->passphrase); - g_free(hidden); + DBG(""); + + if (result == 0) + apply_p2p_listen_on_iface(wifi, NULL); + + if (reg_data->callback) + reg_data->callback(result, reg_data->user_data); + + g_free(reg_data); } -static void scan_callback(int result, GSupplicantInterface *interface, - void *user_data) +static int peer_register_service(const unsigned char *specification, + int specification_length, + const unsigned char *query, + int query_length, int version, + peer_service_registration_cb_t callback, + void *user_data) { - struct connman_device *device = user_data; - struct wifi_data *wifi = connman_device_get_data(device); + struct peer_service_registration *reg_data; + GSupplicantP2PServiceParams *params; + bool found = false; + int ret, ret_f; + GList *list; - DBG("result %d", result); + DBG(""); - if (wifi != NULL && wifi->hidden != NULL) { - hidden_free(wifi->hidden); - wifi->hidden = NULL; + if (specification && !version && !query && + is_service_wfd(specification, specification_length)) { + return peer_register_wfd_service(specification, + specification_length, callback, user_data); } - if (result < 0) - connman_device_reset_scanning(device); - else - connman_device_set_scanning(device, FALSE); - connman_device_unref(device); + reg_data = g_try_malloc0(sizeof(*reg_data)); + if (!reg_data) + return -ENOMEM; + + reg_data->callback = callback; + reg_data->user_data = user_data; + + ret_f = -EOPNOTSUPP; + + for (list = iface_list; list; list = list->next) { + struct wifi_data *wifi = list->data; + GSupplicantInterface *iface = wifi->interface; + + if (!g_supplicant_interface_has_p2p(iface)) + continue; + + params = fill_in_peer_service_params(specification, + specification_length, query, + query_length, version); + if (!params) + continue; + + if (!found) { + ret_f = g_supplicant_interface_p2p_add_service(iface, + register_peer_service_cb, params, reg_data); + if (ret_f == 0 || ret_f == -EINPROGRESS) + found = true; + ret = ret_f; + } else + ret = g_supplicant_interface_p2p_add_service(iface, + register_peer_service_cb, params, NULL); + if (ret != 0 && ret != -EINPROGRESS) + free_peer_service_params(params); + } + + if (ret_f != 0 && ret_f != -EINPROGRESS) + g_free(reg_data); + + return ret_f; +} + +static int peer_unregister_wfd_service(void) +{ + GSupplicantP2PServiceParams *params; + GList *list; + + if (!wfd_service_registered) + return -EALREADY; + + params = fill_in_peer_service_params(NULL, 0, NULL, 0, 0); + if (!params) + return -ENOMEM; + + wfd_service_registered = false; + + g_supplicant_set_widi_ies(params, NULL, NULL); + + for (list = iface_list; list; list = list->next) { + struct wifi_data *wifi = list->data; + + if (!g_supplicant_interface_has_p2p(wifi->interface)) + continue; + + wifi->servicing--; + if (!wifi->servicing || wifi->servicing < 0) { + g_supplicant_interface_p2p_listen(wifi->interface, + 0, 0); + wifi->servicing = 0; + } + } + + return 0; +} + +static int peer_unregister_service(const unsigned char *specification, + int specification_length, + const unsigned char *query, + int query_length, int version) +{ + GSupplicantP2PServiceParams *params; + bool wfd = false; + GList *list; + int ret; + + if (specification && !version && !query && + is_service_wfd(specification, specification_length)) { + ret = peer_unregister_wfd_service(); + if (ret != 0 && ret != -EINPROGRESS) + return ret; + wfd = true; + } + + for (list = iface_list; list; list = list->next) { + struct wifi_data *wifi = list->data; + GSupplicantInterface *iface = wifi->interface; + + if (wfd) + goto stop_listening; + + if (!g_supplicant_interface_has_p2p(iface)) + continue; + + params = fill_in_peer_service_params(specification, + specification_length, query, + query_length, version); + if (!params) + continue; + + ret = g_supplicant_interface_p2p_del_service(iface, params); + if (ret != 0 && ret != -EINPROGRESS) + free_peer_service_params(params); +stop_listening: + wifi->servicing--; + if (!wifi->servicing || wifi->servicing < 0) { + g_supplicant_interface_p2p_listen(iface, 0, 0); + wifi->servicing = 0; + } + } + + return 0; +} + +static struct connman_peer_driver peer_driver = { + .connect = peer_connect, + .disconnect = peer_disconnect, + .register_service = peer_register_service, + .unregister_service = peer_unregister_service, +}; + +static void handle_tethering(struct wifi_data *wifi) +{ + if (!wifi->tethering) + return; + + if (!wifi->bridge) + return; + + if (wifi->bridged) + return; + + DBG("index %d bridge %s", wifi->index, wifi->bridge); + + if (connman_inet_add_to_bridge(wifi->index, wifi->bridge) < 0) + return; + + wifi->bridged = true; +} + +static void wifi_newlink(unsigned flags, unsigned change, void *user_data) +{ + struct connman_device *device = user_data; + struct wifi_data *wifi = connman_device_get_data(device); + + if (!wifi) + return; + + DBG("index %d flags %d change %d", wifi->index, flags, change); + + if ((wifi->flags & IFF_UP) != (flags & IFF_UP)) { + if (flags & IFF_UP) + DBG("interface up"); + else + DBG("interface down"); + } + + if ((wifi->flags & IFF_LOWER_UP) != (flags & IFF_LOWER_UP)) { + if (flags & IFF_LOWER_UP) { + DBG("carrier on"); + + handle_tethering(wifi); + } else + DBG("carrier off"); + } + + wifi->flags = flags; +} + +static int wifi_probe(struct connman_device *device) +{ + struct wifi_data *wifi; + + DBG("device %p", device); + + wifi = g_try_new0(struct wifi_data, 1); + if (!wifi) + return -ENOMEM; + + wifi->state = G_SUPPLICANT_STATE_INACTIVE; + wifi->ap_supported = WIFI_AP_UNKNOWN; + wifi->tethering_param = NULL; + + connman_device_set_data(device, wifi); + wifi->device = connman_device_ref(device); + + wifi->index = connman_device_get_index(device); + wifi->flags = 0; + + wifi->watch = connman_rtnl_add_newlink_watch(wifi->index, + wifi_newlink, device); + if (is_p2p_connecting()) + add_pending_wifi_device(wifi); + else + iface_list = g_list_append(iface_list, wifi); + + return 0; +} + +static void remove_networks(struct connman_device *device, + struct wifi_data *wifi) +{ + GSList *list; + + for (list = wifi->networks; list; list = list->next) { + struct connman_network *network = list->data; + + connman_device_remove_network(device, network); + connman_network_unref(network); + } + + g_slist_free(wifi->networks); + wifi->networks = NULL; +} + +static void remove_peers(struct wifi_data *wifi) +{ + GSList *list; + + for (list = wifi->peers; list; list = list->next) { + struct connman_peer *peer = list->data; + + connman_peer_unregister(peer); + connman_peer_unref(peer); + } + + g_slist_free(wifi->peers); + wifi->peers = NULL; +} + +static void reset_autoscan(struct connman_device *device) +{ + struct wifi_data *wifi = connman_device_get_data(device); + struct autoscan_params *autoscan; + + DBG(""); + + if (!wifi || !wifi->autoscan) + return; + + autoscan = wifi->autoscan; + + autoscan->interval = 0; + + if (autoscan->timeout == 0) + return; + + g_source_remove(autoscan->timeout); + autoscan->timeout = 0; + + connman_device_unref(device); +} + +static void stop_autoscan(struct connman_device *device) +{ + const struct wifi_data *wifi = connman_device_get_data(device); + + if (!wifi || !wifi->autoscan) + return; + + reset_autoscan(device); + + connman_device_set_scanning(device, CONNMAN_SERVICE_TYPE_WIFI, false); +} + +static void check_p2p_technology(void) +{ + bool p2p_exists = false; + GList *list; + + for (list = iface_list; list; list = list->next) { + struct wifi_data *w = list->data; + + if (w->interface && + g_supplicant_interface_has_p2p(w->interface)) + p2p_exists = true; + } + + if (!p2p_exists) { + connman_technology_driver_unregister(&p2p_tech_driver); + connman_peer_driver_unregister(&peer_driver); + } +} + +static void wifi_remove(struct connman_device *device) +{ + struct wifi_data *wifi = connman_device_get_data(device); + + DBG("device %p wifi %p", device, wifi); + + if (!wifi) + return; + + stop_autoscan(device); + + if (wifi->p2p_device) + p2p_iface_list = g_list_remove(p2p_iface_list, wifi); + else + iface_list = g_list_remove(iface_list, wifi); + + check_p2p_technology(); + + remove_pending_wifi_device(wifi); + + if (connman_device_get_scanning(device, CONNMAN_SERVICE_TYPE_P2P)) { + g_source_remove(wifi->p2p_find_timeout); + connman_device_unref(wifi->device); + } + + if (wifi->p2p_connection_timeout) + g_source_remove(wifi->p2p_connection_timeout); + + remove_networks(device, wifi); + remove_peers(wifi); + + connman_device_set_powered(device, false); + connman_device_set_data(device, NULL); + connman_device_unref(wifi->device); + connman_rtnl_remove_watch(wifi->watch); + + g_supplicant_interface_set_data(wifi->interface, NULL); + + g_supplicant_interface_cancel(wifi->interface); + + if (wifi->scan_params) + g_supplicant_free_scan_params(wifi->scan_params); + + g_free(wifi->autoscan); + g_free(wifi->identifier); + g_free(wifi); +} + +static bool is_duplicate(GSList *list, gchar *ssid, int ssid_len) +{ + GSList *iter; + + for (iter = list; iter; iter = g_slist_next(iter)) { + struct scan_ssid *scan_ssid = iter->data; + + if (ssid_len == scan_ssid->ssid_len && + memcmp(ssid, scan_ssid->ssid, ssid_len) == 0) + return true; + } + + return false; +} + +static int add_scan_param(gchar *hex_ssid, char *raw_ssid, int ssid_len, + int freq, GSupplicantScanParams *scan_data, + int driver_max_scan_ssids, char *ssid_name) +{ + unsigned int i; + struct scan_ssid *scan_ssid; + + if ((driver_max_scan_ssids == 0 || + driver_max_scan_ssids > scan_data->num_ssids) && + (hex_ssid || raw_ssid)) { + gchar *ssid; + unsigned int j = 0, hex; + + if (hex_ssid) { + size_t hex_ssid_len = strlen(hex_ssid); + + ssid = g_try_malloc0(hex_ssid_len / 2); + if (!ssid) + return -ENOMEM; + + for (i = 0; i < hex_ssid_len; i += 2) { + sscanf(hex_ssid + i, "%02x", &hex); + ssid[j++] = hex; + } + } else { + ssid = raw_ssid; + j = ssid_len; + } + + /* + * If we have already added hidden AP to the list, + * then do not do it again. This might happen if you have + * used or are using multiple wifi cards, so in that case + * you might have multiple service files for same AP. + */ + if (is_duplicate(scan_data->ssids, ssid, j)) { + if (hex_ssid) + g_free(ssid); + return 0; + } + + scan_ssid = g_try_new(struct scan_ssid, 1); + if (!scan_ssid) { + if (hex_ssid) + g_free(ssid); + return -ENOMEM; + } + + memcpy(scan_ssid->ssid, ssid, j); + scan_ssid->ssid_len = j; + scan_data->ssids = g_slist_prepend(scan_data->ssids, + scan_ssid); + + scan_data->num_ssids++; + + DBG("SSID %s added to scanned list of %d entries", ssid_name, + scan_data->num_ssids); + + if (hex_ssid) + g_free(ssid); + } else + return -EINVAL; + + scan_data->ssids = g_slist_reverse(scan_data->ssids); + + if (!scan_data->freqs) { + scan_data->freqs = g_try_malloc0(sizeof(uint16_t)); + if (!scan_data->freqs) { + g_slist_free_full(scan_data->ssids, g_free); + return -ENOMEM; + } + + scan_data->num_freqs = 1; + scan_data->freqs[0] = freq; + } else { + bool duplicate = false; + + /* Don't add duplicate entries */ + for (i = 0; i < scan_data->num_freqs; i++) { + if (scan_data->freqs[i] == freq) { + duplicate = true; + break; + } + } + + if (!duplicate) { + scan_data->num_freqs++; + scan_data->freqs = g_try_realloc(scan_data->freqs, + sizeof(uint16_t) * scan_data->num_freqs); + if (!scan_data->freqs) { + g_slist_free_full(scan_data->ssids, g_free); + return -ENOMEM; + } + scan_data->freqs[scan_data->num_freqs - 1] = freq; + } + } + + return 1; +} + +static int get_hidden_connections(GSupplicantScanParams *scan_data) +{ + struct connman_config_entry **entries; + GKeyFile *keyfile; + gchar **services; + char *ssid, *name; + int i, ret; + bool value; + int num_ssids = 0, add_param_failed = 0; + + services = connman_storage_get_services(); + for (i = 0; services && services[i]; i++) { + if (strncmp(services[i], "wifi_", 5) != 0) + continue; + + keyfile = connman_storage_load_service(services[i]); + if (!keyfile) + continue; + + value = g_key_file_get_boolean(keyfile, + services[i], "Hidden", NULL); + if (!value) { + g_key_file_free(keyfile); + continue; + } + + value = g_key_file_get_boolean(keyfile, + services[i], "Favorite", NULL); + if (!value) { + g_key_file_free(keyfile); + continue; + } + + ssid = g_key_file_get_string(keyfile, + services[i], "SSID", NULL); + + name = g_key_file_get_string(keyfile, services[i], "Name", + NULL); + + ret = add_scan_param(ssid, NULL, 0, 0, scan_data, 0, name); + if (ret < 0) + add_param_failed++; + else if (ret > 0) + num_ssids++; + + g_free(ssid); + g_free(name); + g_key_file_free(keyfile); + } + + /* + * Check if there are any hidden AP that needs to be provisioned. + */ + entries = connman_config_get_entries("wifi"); + for (i = 0; entries && entries[i]; i++) { + int len; + + if (!entries[i]->hidden) + continue; + + if (!entries[i]->ssid) { + ssid = entries[i]->name; + len = strlen(ssid); + } else { + ssid = entries[i]->ssid; + len = entries[i]->ssid_len; + } + + if (!ssid) + continue; + + ret = add_scan_param(NULL, ssid, len, 0, scan_data, 0, ssid); + if (ret < 0) + add_param_failed++; + else if (ret > 0) + num_ssids++; + } + + connman_config_free_entries(entries); + + if (add_param_failed > 0) + DBG("Unable to scan %d out of %d SSIDs", + add_param_failed, num_ssids); + + g_strfreev(services); + + return num_ssids; +} + +static int get_hidden_connections_params(struct wifi_data *wifi, + GSupplicantScanParams *scan_params) +{ + int driver_max_ssids, i; + GSupplicantScanParams *orig_params; + + /* + * Scan hidden networks so that we can autoconnect to them. + * We will assume 1 as a default number of ssid to scan. + */ + driver_max_ssids = g_supplicant_interface_get_max_scan_ssids( + wifi->interface); + if (driver_max_ssids == 0) + driver_max_ssids = 1; + + DBG("max ssids %d", driver_max_ssids); + + if (!wifi->scan_params) { + wifi->scan_params = g_try_malloc0(sizeof(GSupplicantScanParams)); + if (!wifi->scan_params) + return 0; + + if (get_hidden_connections(wifi->scan_params) == 0) { + g_supplicant_free_scan_params(wifi->scan_params); + wifi->scan_params = NULL; + + return 0; + } + } + + orig_params = wifi->scan_params; + + /* Let's transfer driver_max_ssids params */ + for (i = 0; i < driver_max_ssids; i++) { + struct scan_ssid *ssid; + + if (!wifi->scan_params->ssids) + break; + + ssid = orig_params->ssids->data; + orig_params->ssids = g_slist_remove(orig_params->ssids, ssid); + scan_params->ssids = g_slist_prepend(scan_params->ssids, ssid); + } + + if (i > 0) { + scan_params->num_ssids = i; + scan_params->ssids = g_slist_reverse(scan_params->ssids); + + scan_params->freqs = g_memdup(orig_params->freqs, + sizeof(uint16_t) * orig_params->num_freqs); + if (!scan_params->freqs) + goto err; + + scan_params->num_freqs = orig_params->num_freqs; + + } else + goto err; + + orig_params->num_ssids -= scan_params->num_ssids; + + return scan_params->num_ssids; + +err: + g_slist_free_full(scan_params->ssids, g_free); + g_supplicant_free_scan_params(wifi->scan_params); + wifi->scan_params = NULL; + + return 0; +} + +static int throw_wifi_scan(struct connman_device *device, + GSupplicantInterfaceCallback callback) +{ + struct wifi_data *wifi = connman_device_get_data(device); + int ret; + + if (!wifi) + return -ENODEV; + + DBG("device %p %p", device, wifi->interface); + + if (wifi->tethering) + return -EBUSY; + + if (connman_device_get_scanning(device, CONNMAN_SERVICE_TYPE_WIFI)) + return -EALREADY; + + connman_device_ref(device); + + ret = g_supplicant_interface_scan(wifi->interface, NULL, + callback, device); + if (ret == 0) { + connman_device_set_scanning(device, + CONNMAN_SERVICE_TYPE_WIFI, true); + } else + connman_device_unref(device); + + return ret; +} + +static void hidden_free(struct hidden_params *hidden) +{ + if (!hidden) + return; + + if (hidden->scan_params) + g_supplicant_free_scan_params(hidden->scan_params); + g_free(hidden->identity); + g_free(hidden->passphrase); + g_free(hidden->security); + g_free(hidden); +} + +static void scan_callback(int result, GSupplicantInterface *interface, + void *user_data) +{ + struct connman_device *device = user_data; + struct wifi_data *wifi = connman_device_get_data(device); + bool scanning; + + DBG("result %d wifi %p", result, wifi); + + if (wifi) { + if (wifi->hidden && !wifi->postpone_hidden) { + connman_network_clear_hidden(wifi->hidden->user_data); + hidden_free(wifi->hidden); + wifi->hidden = NULL; + } + + if (wifi->scan_params) { + g_supplicant_free_scan_params(wifi->scan_params); + wifi->scan_params = NULL; + } + } + + if (result < 0) + connman_device_reset_scanning(device); + + /* User is connecting to a hidden AP, let's wait for finished event */ + if (wifi && wifi->hidden && wifi->postpone_hidden) { + GSupplicantScanParams *scan_params; + int ret; + + wifi->postpone_hidden = false; + scan_params = wifi->hidden->scan_params; + wifi->hidden->scan_params = NULL; + + reset_autoscan(device); + + ret = g_supplicant_interface_scan(wifi->interface, scan_params, + scan_callback, device); + if (ret == 0) + return; + + /* On error, let's recall scan_callback, which will cleanup */ + return scan_callback(ret, interface, user_data); + } + + scanning = connman_device_get_scanning(device, CONNMAN_SERVICE_TYPE_WIFI); + + if (scanning) { + connman_device_set_scanning(device, + CONNMAN_SERVICE_TYPE_WIFI, false); + } + + if (result != -ENOLINK) + start_autoscan(device); + + /* + * If we are here then we were scanning; however, if we are + * also mid-flight disabling the interface, then wifi_disable + * has already cleared the device scanning state and + * unreferenced the device, obviating the need to do it here. + */ + + if (scanning) + connman_device_unref(device); +} + +static void scan_callback_hidden(int result, + GSupplicantInterface *interface, void *user_data) +{ + struct connman_device *device = user_data; + struct wifi_data *wifi = connman_device_get_data(device); + GSupplicantScanParams *scan_params; + int ret; + + DBG("result %d wifi %p", result, wifi); + + if (!wifi) + goto out; + + /* User is trying to connect to a hidden AP */ + if (wifi->hidden && wifi->postpone_hidden) + goto out; + + scan_params = g_try_malloc0(sizeof(GSupplicantScanParams)); + if (!scan_params) + goto out; + + if (get_hidden_connections_params(wifi, scan_params) > 0) { + ret = g_supplicant_interface_scan(wifi->interface, + scan_params, + scan_callback_hidden, + device); + if (ret == 0) + return; + } + + g_supplicant_free_scan_params(scan_params); + +out: + scan_callback(result, interface, user_data); +} + +static gboolean autoscan_timeout(gpointer data) +{ + struct connman_device *device = data; + struct wifi_data *wifi = connman_device_get_data(device); + struct autoscan_params *autoscan; + int interval; + + if (!wifi) + return FALSE; + + autoscan = wifi->autoscan; + + if (autoscan->interval <= 0) { + interval = autoscan->base; + goto set_interval; + } else + interval = autoscan->interval * autoscan->base; + + if (interval > autoscan->limit) + interval = autoscan->limit; + + throw_wifi_scan(wifi->device, scan_callback_hidden); + + /* + * In case BackgroundScanning is disabled, interval will reach the + * limit exactly after the very first passive scanning. It allows + * to ensure at most one passive scan is performed in such cases. + */ + if (!connman_setting_get_bool("BackgroundScanning") && + interval == autoscan->limit) { + g_source_remove(autoscan->timeout); + autoscan->timeout = 0; + + connman_device_unref(device); + + return FALSE; + } + +set_interval: + DBG("interval %d", interval); + + autoscan->interval = interval; + + autoscan->timeout = g_timeout_add_seconds(interval, + autoscan_timeout, device); + + return FALSE; +} + +static void start_autoscan(struct connman_device *device) +{ + struct wifi_data *wifi = connman_device_get_data(device); + struct autoscan_params *autoscan; + + DBG(""); + + if (!wifi) + return; + + if (wifi->p2p_device) + return; + + if (wifi->connected) + return; + + autoscan = wifi->autoscan; + if (!autoscan) + return; + + if (autoscan->timeout > 0 || autoscan->interval > 0) + return; + + connman_device_ref(device); + + autoscan_timeout(device); +} + +static struct autoscan_params *parse_autoscan_params(const char *params) +{ + struct autoscan_params *autoscan; + char **list_params; + int limit; + int base; + + DBG(""); + + list_params = g_strsplit(params, ":", 0); + if (list_params == 0) + return NULL; + + if (!g_strcmp0(list_params[0], "exponential") && + g_strv_length(list_params) == 3) { + base = atoi(list_params[1]); + limit = atoi(list_params[2]); + } else if (!g_strcmp0(list_params[0], "single") && + g_strv_length(list_params) == 2) + base = limit = atoi(list_params[1]); + else { + g_strfreev(list_params); + return NULL; + } + + DBG("Setup %s autoscanning", list_params[0]); + + g_strfreev(list_params); + + autoscan = g_try_malloc0(sizeof(struct autoscan_params)); + if (!autoscan) { + DBG("Could not allocate memory for autoscan"); + return NULL; + } + + DBG("base %d - limit %d", base, limit); + autoscan->base = base; + autoscan->limit = limit; + + return autoscan; +} + +static void setup_autoscan(struct wifi_data *wifi) +{ + /* + * If BackgroundScanning is enabled, setup exponential + * autoscanning if it has not been previously done. + */ + if (connman_setting_get_bool("BackgroundScanning")) { + wifi->autoscan = parse_autoscan_params(AUTOSCAN_EXPONENTIAL); + return; + } + + /* + * On the contrary, if BackgroundScanning is disabled, update autoscan + * parameters based on the type of scanning that is being performed. + */ + if (wifi->autoscan) { + g_free(wifi->autoscan); + wifi->autoscan = NULL; + } + + switch (wifi->scanning_type) { + case WIFI_SCANNING_PASSIVE: + /* Do not setup autoscan. */ + break; + case WIFI_SCANNING_ACTIVE: + /* Setup one single passive scan after active. */ + wifi->autoscan = parse_autoscan_params(AUTOSCAN_SINGLE); + break; + case WIFI_SCANNING_UNKNOWN: + /* Setup autoscan in this case but we should never fall here. */ + wifi->autoscan = parse_autoscan_params(AUTOSCAN_SINGLE); + break; + } +} + +static void finalize_interface_creation(struct wifi_data *wifi) +{ + DBG("interface is ready wifi %p tethering %d", wifi, wifi->tethering); + + if (!wifi->device) { + connman_error("WiFi device not set"); + return; + } + + connman_device_set_powered(wifi->device, true); + + if (wifi->p2p_device) + return; + + if (!wifi->autoscan) + setup_autoscan(wifi); + + start_autoscan(wifi->device); +} + +static void interface_create_callback(int result, + GSupplicantInterface *interface, + void *user_data) +{ + struct wifi_data *wifi = user_data; + + DBG("result %d ifname %s, wifi %p", result, + g_supplicant_interface_get_ifname(interface), + wifi); + + if (result < 0 || !wifi) + return; + + wifi->interface = interface; + g_supplicant_interface_set_data(interface, wifi); + + if (g_supplicant_interface_get_ready(interface)) { + wifi->interface_ready = true; + finalize_interface_creation(wifi); + } +} + +static int wifi_enable(struct connman_device *device) +{ + struct wifi_data *wifi = connman_device_get_data(device); + int index; + char *interface; + const char *driver = connman_option_get_string("wifi"); + int ret; + + DBG("device %p %p", device, wifi); + + index = connman_device_get_index(device); + if (!wifi || index < 0) + return -ENODEV; + + if (is_p2p_connecting()) + return -EINPROGRESS; + + interface = connman_inet_ifname(index); + ret = g_supplicant_interface_create(interface, driver, NULL, + interface_create_callback, + wifi); + g_free(interface); + + if (ret < 0) + return ret; + + return -EINPROGRESS; } -static int add_scan_param(gchar *hex_ssid, int freq, - GSupplicantScanParams *scan_data, - int driver_max_scan_ssids) +static int wifi_disable(struct connman_device *device) { - unsigned int i; + struct wifi_data *wifi = connman_device_get_data(device); + int ret; - if (driver_max_scan_ssids > scan_data->num_ssids && hex_ssid != NULL) { - gchar *ssid; - unsigned int j = 0, hex; - size_t hex_ssid_len = strlen(hex_ssid); + DBG("device %p wifi %p", device, wifi); - ssid = g_try_malloc0(hex_ssid_len / 2); - if (ssid == NULL) - return -ENOMEM; + if (!wifi) + return -ENODEV; - for (i = 0; i < hex_ssid_len; i += 2) { - sscanf(hex_ssid + i, "%02x", &hex); - ssid[j++] = hex; - } + wifi->connected = false; + wifi->disconnecting = false; - memcpy(scan_data->ssids[scan_data->num_ssids].ssid, ssid, j); - scan_data->ssids[scan_data->num_ssids].ssid_len = j; - scan_data->num_ssids++; + if (wifi->pending_network) + wifi->pending_network = NULL; - g_free(ssid); + stop_autoscan(device); + + if (connman_device_get_scanning(device, CONNMAN_SERVICE_TYPE_P2P)) { + g_source_remove(wifi->p2p_find_timeout); + wifi->p2p_find_timeout = 0; + connman_device_set_scanning(device, CONNMAN_SERVICE_TYPE_P2P, false); + connman_device_unref(wifi->device); } - /* Don't add duplicate entries */ - for (i = 0; i < G_SUPPLICANT_MAX_FAST_SCAN; i++) { - if (scan_data->freqs[i] == 0) { - scan_data->freqs[i] = freq; - break; - } else if (scan_data->freqs[i] == freq) - break; + /* In case of a user scan, device is still referenced */ + if (connman_device_get_scanning(device, CONNMAN_SERVICE_TYPE_WIFI)) { + connman_device_set_scanning(device, + CONNMAN_SERVICE_TYPE_WIFI, false); + connman_device_unref(wifi->device); } - return 0; + remove_networks(device, wifi); + remove_peers(wifi); + + ret = g_supplicant_interface_remove(wifi->interface, NULL, NULL); + if (ret < 0) + return ret; + + return -EINPROGRESS; } struct last_connected { - GTimeVal modified; + struct timeval modified; gchar *ssid; int freq; }; static gint sort_entry(gconstpointer a, gconstpointer b, gpointer user_data) { - GTimeVal *aval = (GTimeVal *)a; - GTimeVal *bval = (GTimeVal *)b; + struct timeval *aval = (struct timeval *)a; + struct timeval *bval = (struct timeval *)b; /* Note that the sort order is descending */ if (aval->tv_sec < bval->tv_sec) @@ -400,7 +1648,7 @@ static int get_latest_connections(int max_ssids, GSequence *latest_list; struct last_connected *entry; GKeyFile *keyfile; - GTimeVal modified; + struct timeval modified; gchar **services; gchar *str; char *ssid; @@ -408,7 +1656,7 @@ static int get_latest_connections(int max_ssids, int num_ssids = 0; latest_list = g_sequence_new(free_entry); - if (latest_list == NULL) + if (!latest_list) return -ENOMEM; services = connman_storage_get_services(); @@ -417,12 +1665,13 @@ static int get_latest_connections(int max_ssids, continue; keyfile = connman_storage_load_service(services[i]); + if (!keyfile) + continue; str = g_key_file_get_string(keyfile, services[i], "Favorite", NULL); - if (str == NULL || g_strcmp0(str, "true")) { - if (str) - g_free(str); + if (!str || g_strcmp0(str, "true")) { + g_free(str); g_key_file_free(keyfile); continue; } @@ -430,9 +1679,8 @@ static int get_latest_connections(int max_ssids, str = g_key_file_get_string(keyfile, services[i], "AutoConnect", NULL); - if (str == NULL || g_strcmp0(str, "true")) { - if (str) - g_free(str); + if (!str || g_strcmp0(str, "true")) { + g_free(str); g_key_file_free(keyfile); continue; } @@ -440,10 +1688,12 @@ static int get_latest_connections(int max_ssids, str = g_key_file_get_string(keyfile, services[i], "Modified", NULL); - if (str != NULL) { - g_time_val_from_iso8601(str, &modified); - g_free(str); + if (!str) { + g_key_file_free(keyfile); + continue; } + util_iso8601_to_timeval(str, &modified); + g_free(str); ssid = g_key_file_get_string(keyfile, services[i], "SSID", NULL); @@ -452,7 +1702,7 @@ static int get_latest_connections(int max_ssids, "Frequency", NULL); if (freq) { entry = g_try_new(struct last_connected, 1); - if (entry == NULL) { + if (!entry) { g_sequence_free(latest_list); g_key_file_free(keyfile); g_free(ssid); @@ -474,8 +1724,7 @@ static int get_latest_connections(int max_ssids, g_strfreev(services); - num_ssids = num_ssids > G_SUPPLICANT_MAX_FAST_SCAN ? - G_SUPPLICANT_MAX_FAST_SCAN : num_ssids; + num_ssids = num_ssids > max_ssids ? max_ssids : num_ssids; iter = g_sequence_get_begin_iter(latest_list); @@ -485,7 +1734,8 @@ static int get_latest_connections(int max_ssids, DBG("ssid %s freq %d modified %lu", entry->ssid, entry->freq, entry->modified.tv_sec); - add_scan_param(entry->ssid, entry->freq, scan_data, max_ssids); + add_scan_param(entry->ssid, NULL, 0, entry->freq, scan_data, + max_ssids, entry->ssid); iter = g_sequence_iter_next(iter); } @@ -494,114 +1744,288 @@ static int get_latest_connections(int max_ssids, return num_ssids; } -static int wifi_scan(struct connman_device *device) +static void wifi_update_scanner_type(struct wifi_data *wifi, + enum wifi_scanning_type new_type) +{ + DBG(""); + + if (!wifi || wifi->scanning_type == new_type) + return; + + wifi->scanning_type = new_type; + + setup_autoscan(wifi); +} + +static int wifi_scan_simple(struct connman_device *device) +{ + struct wifi_data *wifi = connman_device_get_data(device); + + reset_autoscan(device); + + /* Distinguish between devices performing passive and active scanning */ + if (wifi) + wifi_update_scanner_type(wifi, WIFI_SCANNING_PASSIVE); + + return throw_wifi_scan(device, scan_callback_hidden); +} + +static gboolean p2p_find_stop(gpointer data) +{ + struct connman_device *device = data; + struct wifi_data *wifi = connman_device_get_data(device); + + DBG(""); + + if (wifi) { + wifi->p2p_find_timeout = 0; + + g_supplicant_interface_p2p_stop_find(wifi->interface); + } + + connman_device_set_scanning(device, CONNMAN_SERVICE_TYPE_P2P, false); + + connman_device_unref(device); + start_autoscan(device); + + return FALSE; +} + +static void p2p_find_callback(int result, GSupplicantInterface *interface, + void *user_data) { + struct connman_device *device = user_data; struct wifi_data *wifi = connman_device_get_data(device); + + DBG("result %d wifi %p", result, wifi); + + if (!wifi) + goto error; + + if (wifi->p2p_find_timeout) { + g_source_remove(wifi->p2p_find_timeout); + wifi->p2p_find_timeout = 0; + } + + if (result) + goto error; + + wifi->p2p_find_timeout = g_timeout_add_seconds(P2P_FIND_TIMEOUT, + p2p_find_stop, device); + if (!wifi->p2p_find_timeout) + goto error; + + return; +error: + p2p_find_stop(device); +} + +static int p2p_find(struct connman_device *device) +{ + struct wifi_data *wifi; int ret; - DBG("device %p %p", device, wifi->interface); + DBG(""); - if (wifi->tethering == TRUE) - return 0; + if (!p2p_technology) + return -ENOTSUP; + + wifi = connman_device_get_data(device); + + if (g_supplicant_interface_is_p2p_finding(wifi->interface)) + return -EALREADY; + reset_autoscan(device); connman_device_ref(device); - ret = g_supplicant_interface_scan(wifi->interface, NULL, - scan_callback, device); - if (ret == 0) - connman_device_set_scanning(device, TRUE); - else + + ret = g_supplicant_interface_p2p_find(wifi->interface, + p2p_find_callback, device); + if (ret) { connman_device_unref(device); + start_autoscan(device); + } else { + connman_device_set_scanning(device, + CONNMAN_SERVICE_TYPE_P2P, true); + } return ret; } -static int wifi_scan_fast(struct connman_device *device) +/* + * Note that the hidden scan is only used when connecting to this specific + * hidden AP first time. It is not used when system autoconnects to hidden AP. + */ +static int wifi_scan(struct connman_device *device, + struct connman_device_scan_params *params) { struct wifi_data *wifi = connman_device_get_data(device); GSupplicantScanParams *scan_params = NULL; + struct scan_ssid *scan_ssid; + struct hidden_params *hidden; int ret; int driver_max_ssids = 0; + bool do_hidden; + bool scanning; - DBG("device %p %p", device, wifi->interface); + if (!wifi) + return -ENODEV; - if (wifi->tethering == TRUE) - return 0; + if (wifi->p2p_device) + return -EBUSY; - driver_max_ssids = g_supplicant_interface_get_max_scan_ssids( + if (wifi->tethering) + return -EBUSY; + + if (params->type == CONNMAN_SERVICE_TYPE_P2P) + return p2p_find(device); + + DBG("device %p wifi %p hidden ssid %s", device, wifi->interface, + params->ssid); + + scanning = connman_device_get_scanning(device, CONNMAN_SERVICE_TYPE_WIFI); + + if (!params->ssid || params->ssid_len == 0 || params->ssid_len > 32) { + if (scanning) + return -EALREADY; + + driver_max_ssids = g_supplicant_interface_get_max_scan_ssids( wifi->interface); - DBG("max ssids %d", driver_max_ssids); - if (driver_max_ssids == 0) - return wifi_scan(device); + DBG("max ssids %d", driver_max_ssids); + if (driver_max_ssids == 0) + return wifi_scan_simple(device); + + do_hidden = false; + } else { + if (scanning && wifi->hidden && wifi->postpone_hidden) + return -EALREADY; + + do_hidden = true; + } scan_params = g_try_malloc0(sizeof(GSupplicantScanParams)); - if (scan_params == NULL) + if (!scan_params) return -ENOMEM; - ret = get_latest_connections(driver_max_ssids, scan_params); - if (ret <= 0) { - g_free(scan_params); - return wifi_scan(device); + if (do_hidden) { + scan_ssid = g_try_new(struct scan_ssid, 1); + if (!scan_ssid) { + g_free(scan_params); + return -ENOMEM; + } + + memcpy(scan_ssid->ssid, params->ssid, params->ssid_len); + scan_ssid->ssid_len = params->ssid_len; + scan_params->ssids = g_slist_prepend(scan_params->ssids, + scan_ssid); + scan_params->num_ssids = 1; + + hidden = g_try_new0(struct hidden_params, 1); + if (!hidden) { + g_supplicant_free_scan_params(scan_params); + return -ENOMEM; + } + + if (wifi->hidden) { + hidden_free(wifi->hidden); + wifi->hidden = NULL; + } + + memcpy(hidden->ssid, params->ssid, params->ssid_len); + hidden->ssid_len = params->ssid_len; + hidden->identity = g_strdup(params->identity); + hidden->passphrase = g_strdup(params->passphrase); + hidden->security = g_strdup(params->security); + hidden->user_data = params->user_data; + wifi->hidden = hidden; + + if (scanning) { + /* Let's keep this active scan for later, + * when current scan will be over. */ + wifi->postpone_hidden = TRUE; + hidden->scan_params = scan_params; + + return 0; + } + } else if (wifi->connected) { + g_supplicant_free_scan_params(scan_params); + return wifi_scan_simple(device); + } else if (!params->force_full_scan) { + ret = get_latest_connections(driver_max_ssids, scan_params); + if (ret <= 0) { + g_supplicant_free_scan_params(scan_params); + return wifi_scan_simple(device); + } } + /* Distinguish between devices performing passive and active scanning */ + wifi_update_scanner_type(wifi, WIFI_SCANNING_ACTIVE); + connman_device_ref(device); + + reset_autoscan(device); + ret = g_supplicant_interface_scan(wifi->interface, scan_params, scan_callback, device); - if (ret == 0) - connman_device_set_scanning(device, TRUE); - else { - g_free(scan_params); + if (ret == 0) { + connman_device_set_scanning(device, + CONNMAN_SERVICE_TYPE_WIFI, true); + } else { + g_supplicant_free_scan_params(scan_params); connman_device_unref(device); + + if (do_hidden) { + hidden_free(wifi->hidden); + wifi->hidden = NULL; + } } return ret; } -static int wifi_scan_hidden(struct connman_device *device, - const char *ssid, unsigned int ssid_len, - const char *identity, const char* passphrase) +static void wifi_stop_scan(enum connman_service_type type, + struct connman_device *device) { struct wifi_data *wifi = connman_device_get_data(device); - GSupplicantScanParams *scan_params = NULL; - struct hidden_params *hidden; - int ret; - DBG("hidden SSID %s", ssid); + DBG("device %p wifi %p", device, wifi); - if (wifi->tethering == TRUE || wifi->hidden != NULL) - return -EBUSY; + if (!wifi) + return; - if (ssid == NULL || ssid_len == 0 || ssid_len > 32) - return -EINVAL; + if (type == CONNMAN_SERVICE_TYPE_P2P) { + if (connman_device_get_scanning(device, CONNMAN_SERVICE_TYPE_P2P)) { + g_source_remove(wifi->p2p_find_timeout); + p2p_find_stop(device); + } + } +} - scan_params = g_try_malloc0(sizeof(GSupplicantScanParams)); - if (scan_params == NULL) - return -ENOMEM; - memcpy(scan_params->ssids[0].ssid, ssid, ssid_len); - scan_params->ssids[0].ssid_len = ssid_len; - scan_params->num_ssids = 1; +static void wifi_regdom_callback(int result, + const char *alpha2, + void *user_data) +{ + struct connman_device *device = user_data; - hidden = g_try_new0(struct hidden_params, 1); - if (hidden == NULL) { - g_free(scan_params); - return -ENOMEM; - } - memcpy(hidden->ssid, ssid, ssid_len); - hidden->ssid_len = ssid_len; - hidden->identity = g_strdup(identity); - hidden->passphrase = g_strdup(passphrase); - wifi->hidden = hidden; + connman_device_regdom_notify(device, result, alpha2); + + connman_device_unref(device); +} + +static int wifi_set_regdom(struct connman_device *device, const char *alpha2) +{ + struct wifi_data *wifi = connman_device_get_data(device); + int ret; + + if (!wifi) + return -EINVAL; connman_device_ref(device); - ret = g_supplicant_interface_scan(wifi->interface, scan_params, - scan_callback, device); - if (ret == 0) - connman_device_set_scanning(device, TRUE); - else { + + ret = g_supplicant_interface_set_country(wifi->interface, + wifi_regdom_callback, + alpha2, device); + if (ret != 0) connman_device_unref(device); - g_free(scan_params); - hidden_free(wifi->hidden); - wifi->hidden = NULL; - } return ret; } @@ -615,8 +2039,8 @@ static struct connman_device_driver wifi_ng_driver = { .enable = wifi_enable, .disable = wifi_disable, .scan = wifi_scan, - .scan_fast = wifi_scan_fast, - .scan_hidden = wifi_scan_hidden, + .stop_scan = wifi_stop_scan, + .set_regdom = wifi_set_regdom, }; static void system_ready(void) @@ -649,7 +2073,7 @@ static void network_remove(struct connman_network *network) DBG("network %p", network); wifi = connman_device_get_data(device); - if (wifi == NULL) + if (!wifi) return; if (wifi->network != network) @@ -672,21 +2096,23 @@ static void connect_callback(int result, GSupplicantInterface *interface, connman_network_set_error(network, CONNMAN_NETWORK_ERROR_CONFIGURE_FAIL); } + + connman_network_unref(network); } static GSupplicantSecurity network_security(const char *security) { - if (g_str_equal(security, "none") == TRUE) + if (g_str_equal(security, "none")) return G_SUPPLICANT_SECURITY_NONE; - else if (g_str_equal(security, "wep") == TRUE) + else if (g_str_equal(security, "wep")) return G_SUPPLICANT_SECURITY_WEP; - else if (g_str_equal(security, "psk") == TRUE) + else if (g_str_equal(security, "psk")) return G_SUPPLICANT_SECURITY_PSK; - else if (g_str_equal(security, "wpa") == TRUE) + else if (g_str_equal(security, "wpa")) return G_SUPPLICANT_SECURITY_PSK; - else if (g_str_equal(security, "rsn") == TRUE) + else if (g_str_equal(security, "rsn")) return G_SUPPLICANT_SECURITY_PSK; - else if (g_str_equal(security, "ieee8021x") == TRUE) + else if (g_str_equal(security, "ieee8021x")) return G_SUPPLICANT_SECURITY_IEEE8021X; return G_SUPPLICANT_SECURITY_UNKNOWN; @@ -694,7 +2120,7 @@ static GSupplicantSecurity network_security(const char *security) static void ssid_init(GSupplicantSSID *ssid, struct connman_network *network) { - const char *security, *passphrase, *agent_passphrase; + const char *security; memset(ssid, 0, sizeof(*ssid)); ssid->mode = G_SUPPLICANT_MODE_INFRA; @@ -703,20 +2129,8 @@ static void ssid_init(GSupplicantSSID *ssid, struct connman_network *network) ssid->scan_ssid = 1; security = connman_network_get_string(network, "WiFi.Security"); ssid->security = network_security(security); - passphrase = connman_network_get_string(network, + ssid->passphrase = connman_network_get_string(network, "WiFi.Passphrase"); - if (passphrase == NULL || strlen(passphrase) == 0) { - - /* Use agent provided passphrase as a fallback */ - agent_passphrase = connman_network_get_string(network, - "WiFi.AgentPassphrase"); - - if (agent_passphrase == NULL || strlen(agent_passphrase) == 0) - ssid->passphrase = NULL; - else - ssid->passphrase = agent_passphrase; - } else - ssid->passphrase = passphrase; ssid->eap = connman_network_get_string(network, "WiFi.EAP"); @@ -726,8 +2140,7 @@ static void ssid_init(GSupplicantSSID *ssid, struct connman_network *network) * for PEAP where 2 passphrases (identity and client * cert may have to be provided. */ - if (connman_network_get_string(network, - "WiFi.PrivateKeyPassphrase") == NULL) + if (!connman_network_get_string(network, "WiFi.PrivateKeyPassphrase")) connman_network_set_string(network, "WiFi.PrivateKeyPassphrase", ssid->passphrase); @@ -735,12 +2148,22 @@ static void ssid_init(GSupplicantSSID *ssid, struct connman_network *network) ssid->identity = connman_network_get_string(network, "WiFi.Identity"); /* Use agent provided identity as a fallback */ - if (ssid->identity == NULL || strlen(ssid->identity) == 0) + if (!ssid->identity || strlen(ssid->identity) == 0) ssid->identity = connman_network_get_string(network, "WiFi.AgentIdentity"); + ssid->anonymous_identity = connman_network_get_string(network, + "WiFi.AnonymousIdentity"); ssid->ca_cert_path = connman_network_get_string(network, "WiFi.CACertFile"); + ssid->subject_match = connman_network_get_string(network, + "WiFi.SubjectMatch"); + ssid->altsubject_match = connman_network_get_string(network, + "WiFi.AltSubjectMatch"); + ssid->domain_suffix_match = connman_network_get_string(network, + "WiFi.DomainSuffixMatch"); + ssid->domain_match = connman_network_get_string(network, + "WiFi.DomainMatch"); ssid->client_cert_path = connman_network_get_string(network, "WiFi.ClientCertFile"); ssid->private_key_path = connman_network_get_string(network, @@ -752,6 +2175,8 @@ static void ssid_init(GSupplicantSSID *ssid, struct connman_network *network) ssid->use_wps = connman_network_get_bool(network, "WiFi.UseWPS"); ssid->pin_wps = connman_network_get_string(network, "WiFi.PinWPS"); + if (connman_setting_get_bool("BackgroundScanning")) + ssid->bgscan = BGSCAN_DEFAULT; } static int network_connect(struct connman_network *network) @@ -763,25 +2188,26 @@ static int network_connect(struct connman_network *network) DBG("network %p", network); - if (device == NULL) + if (!device) return -ENODEV; wifi = connman_device_get_data(device); - if (wifi == NULL) + if (!wifi) return -ENODEV; ssid = g_try_malloc0(sizeof(GSupplicantSSID)); - if (ssid == NULL) + if (!ssid) return -ENOMEM; interface = wifi->interface; ssid_init(ssid, network); - if (wifi->disconnecting == TRUE) + if (wifi->disconnecting) { wifi->pending_network = network; - else { - wifi->network = network; + g_free(ssid); + } else { + wifi->network = connman_network_ref(network); wifi->retries = 0; return g_supplicant_interface_connect(interface, ssid, @@ -796,27 +2222,27 @@ static void disconnect_callback(int result, GSupplicantInterface *interface, { struct wifi_data *wifi = user_data; - if (wifi->network != NULL) { - /* - * if result < 0 supplican return an error because - * the network is not current. - * we wont receive G_SUPPLICANT_STATE_DISCONNECTED since it - * failed, call connman_network_set_connected to report - * disconnect is completed. - */ - if (result < 0) - connman_network_set_connected(wifi->network, FALSE); + DBG("result %d supplicant interface %p wifi %p", + result, interface, wifi); + + if (result == -ECONNABORTED) { + DBG("wifi interface no longer available"); + return; } + if (wifi->network && wifi->network != wifi->pending_network) + connman_network_set_connected(wifi->network, false); wifi->network = NULL; - wifi->disconnecting = FALSE; + wifi->disconnecting = false; + wifi->connected = false; - if (wifi->pending_network != NULL) { + if (wifi->pending_network) { network_connect(wifi->pending_network); wifi->pending_network = NULL; } + start_autoscan(wifi->device); } static int network_disconnect(struct connman_network *network) @@ -828,20 +2254,20 @@ static int network_disconnect(struct connman_network *network) DBG("network %p", network); wifi = connman_device_get_data(device); - if (wifi == NULL || wifi->interface == NULL) + if (!wifi || !wifi->interface) return -ENODEV; - connman_network_set_associating(network, FALSE); + connman_network_set_associating(network, false); - if (wifi->disconnecting == TRUE) + if (wifi->disconnecting) return -EALREADY; - wifi->disconnecting = TRUE; + wifi->disconnecting = true; err = g_supplicant_interface_disconnect(wifi->interface, disconnect_callback, wifi); if (err < 0) - wifi->disconnecting = FALSE; + wifi->disconnecting = false; return err; } @@ -863,39 +2289,39 @@ static void interface_added(GSupplicantInterface *interface) struct wifi_data *wifi; wifi = g_supplicant_interface_get_data(interface); + if (!wifi) { + wifi = get_pending_wifi_data(ifname); + if (!wifi) + return; - /* - * We can get here with a NULL wifi pointer when - * the interface added signal is sent before the - * interface creation callback is called. - */ - if (wifi == NULL) - return; + wifi->interface = interface; + g_supplicant_interface_set_data(interface, wifi); + p2p_iface_list = g_list_append(p2p_iface_list, wifi); + wifi->p2p_device = true; + } DBG("ifname %s driver %s wifi %p tethering %d", ifname, driver, wifi, wifi->tethering); - if (wifi->device == NULL) { + if (!wifi->device) { connman_error("WiFi device not set"); return; } - connman_device_set_powered(wifi->device, TRUE); - - if (wifi->tethering == TRUE) - return; + connman_device_set_powered(wifi->device, true); } -static connman_bool_t is_idle(struct wifi_data *wifi) +static bool is_idle(struct wifi_data *wifi) { DBG("state %d", wifi->state); switch (wifi->state) { case G_SUPPLICANT_STATE_UNKNOWN: + case G_SUPPLICANT_STATE_DISABLED: case G_SUPPLICANT_STATE_DISCONNECTED: case G_SUPPLICANT_STATE_INACTIVE: case G_SUPPLICANT_STATE_SCANNING: - return TRUE; + return true; case G_SUPPLICANT_STATE_AUTHENTICATING: case G_SUPPLICANT_STATE_ASSOCIATING: @@ -903,49 +2329,50 @@ static connman_bool_t is_idle(struct wifi_data *wifi) case G_SUPPLICANT_STATE_4WAY_HANDSHAKE: case G_SUPPLICANT_STATE_GROUP_HANDSHAKE: case G_SUPPLICANT_STATE_COMPLETED: - return FALSE; + return false; } - return FALSE; + return false; } -static connman_bool_t is_idle_wps(GSupplicantInterface *interface, +static bool is_idle_wps(GSupplicantInterface *interface, struct wifi_data *wifi) { /* First, let's check if WPS processing did not went wrong */ if (g_supplicant_interface_get_wps_state(interface) == G_SUPPLICANT_WPS_STATE_FAIL) - return FALSE; + return false; /* Unlike normal connection, being associated while processing wps * actually means that we are idling. */ switch (wifi->state) { case G_SUPPLICANT_STATE_UNKNOWN: + case G_SUPPLICANT_STATE_DISABLED: case G_SUPPLICANT_STATE_DISCONNECTED: case G_SUPPLICANT_STATE_INACTIVE: case G_SUPPLICANT_STATE_SCANNING: case G_SUPPLICANT_STATE_ASSOCIATED: - return TRUE; + return true; case G_SUPPLICANT_STATE_AUTHENTICATING: case G_SUPPLICANT_STATE_ASSOCIATING: case G_SUPPLICANT_STATE_4WAY_HANDSHAKE: case G_SUPPLICANT_STATE_GROUP_HANDSHAKE: case G_SUPPLICANT_STATE_COMPLETED: - return FALSE; + return false; } - return FALSE; + return false; } -static connman_bool_t handle_wps_completion(GSupplicantInterface *interface, +static bool handle_wps_completion(GSupplicantInterface *interface, struct connman_network *network, struct connman_device *device, struct wifi_data *wifi) { - connman_bool_t wps; + bool wps; wps = connman_network_get_bool(network, "WiFi.UseWPS"); - if (wps == TRUE) { + if (wps) { const unsigned char *ssid, *wps_ssid; unsigned int ssid_len, wps_ssid_len; const char *wps_key; @@ -958,12 +2385,12 @@ static connman_bool_t handle_wps_completion(GSupplicantInterface *interface, wps_ssid = g_supplicant_interface_get_wps_ssid( interface, &wps_ssid_len); - if (wps_ssid == NULL || wps_ssid_len != ssid_len || + if (!wps_ssid || wps_ssid_len != ssid_len || memcmp(ssid, wps_ssid, ssid_len) != 0) { - connman_network_set_associating(network, FALSE); + connman_network_set_associating(network, false); g_supplicant_interface_disconnect(wifi->interface, disconnect_callback, wifi); - return FALSE; + return false; } wps_key = g_supplicant_interface_get_wps_key(interface); @@ -973,24 +2400,49 @@ static connman_bool_t handle_wps_completion(GSupplicantInterface *interface, connman_network_set_string(network, "WiFi.PinWPS", NULL); } - return TRUE; + return true; } -static connman_bool_t handle_4way_handshake_failure(GSupplicantInterface *interface, +static bool handle_assoc_status_code(GSupplicantInterface *interface, + struct wifi_data *wifi) +{ + if (wifi->state == G_SUPPLICANT_STATE_ASSOCIATING && + wifi->assoc_code == ASSOC_STATUS_NO_CLIENT && + wifi->load_shaping_retries < LOAD_SHAPING_MAX_RETRIES) { + wifi->load_shaping_retries ++; + return TRUE; + } + wifi->load_shaping_retries = 0; + return FALSE; +} + +static bool handle_4way_handshake_failure(GSupplicantInterface *interface, struct connman_network *network, struct wifi_data *wifi) { + struct connman_service *service; + if (wifi->state != G_SUPPLICANT_STATE_4WAY_HANDSHAKE) - return FALSE; + return false; + + if (wifi->connected) + return false; + + service = connman_service_lookup_from_network(network); + if (!service) + return false; wifi->retries++; - if (wifi->retries < MAXIMUM_RETRIES) - return TRUE; + if (connman_service_get_favorite(service)) { + if (wifi->retries < FAVORITE_MAXIMUM_RETRIES) + return true; + } + wifi->retries = 0; connman_network_set_error(network, CONNMAN_NETWORK_ERROR_INVALID_KEY); - return FALSE; + return false; } static void interface_state(GSupplicantInterface *interface) @@ -999,39 +2451,69 @@ static void interface_state(GSupplicantInterface *interface) struct connman_device *device; struct wifi_data *wifi; GSupplicantState state = g_supplicant_interface_get_state(interface); - connman_bool_t wps; + bool wps; + bool old_connected; wifi = g_supplicant_interface_get_data(interface); DBG("wifi %p interface state %d", wifi, state); - if (wifi == NULL) + if (!wifi) return; - network = wifi->network; device = wifi->device; + if (!device) + return; + + if (state == G_SUPPLICANT_STATE_COMPLETED) { + if (wifi->tethering_param) { + g_free(wifi->tethering_param->ssid); + g_free(wifi->tethering_param); + wifi->tethering_param = NULL; + } + + if (wifi->tethering) + stop_autoscan(device); + } + + if (g_supplicant_interface_get_ready(interface) && + !wifi->interface_ready) { + wifi->interface_ready = true; + finalize_interface_creation(wifi); + } - if (device == NULL || network == NULL) + network = wifi->network; + if (!network) return; switch (state) { case G_SUPPLICANT_STATE_SCANNING: + if (wifi->connected) + connman_network_set_connected(network, false); + break; case G_SUPPLICANT_STATE_AUTHENTICATING: case G_SUPPLICANT_STATE_ASSOCIATING: - connman_network_set_associating(network, TRUE); + stop_autoscan(device); + + if (!wifi->connected) + connman_network_set_associating(network, true); + break; case G_SUPPLICANT_STATE_COMPLETED: - if (handle_wps_completion(interface, network, device, wifi) == - FALSE) + /* though it should be already stopped: */ + stop_autoscan(device); + + if (!handle_wps_completion(interface, network, device, wifi)) break; - /* reset scan trigger and schedule background scan */ - connman_device_schedule_scan(device); + connman_network_set_connected(network, true); - connman_network_set_connected(network, TRUE); + wifi->disconnect_code = 0; + wifi->assoc_code = 0; + wifi->load_shaping_retries = 0; break; case G_SUPPLICANT_STATE_DISCONNECTED: @@ -1042,65 +2524,176 @@ static void interface_state(GSupplicantInterface *interface) * in progress. */ wps = connman_network_get_bool(network, "WiFi.UseWPS"); - if (wps == TRUE) - if (is_idle_wps(interface, wifi) == TRUE) + if (wps) + if (is_idle_wps(interface, wifi)) break; if (is_idle(wifi)) break; + if (handle_assoc_status_code(interface, wifi)) + break; + /* If previous state was 4way-handshake, then * it's either: psk was incorrect and thus we retry * or if we reach the maximum retries we declare the * psk as wrong */ if (handle_4way_handshake_failure(interface, - network, wifi) == TRUE) + network, wifi)) + break; + + /* See table 8-36 Reason codes in IEEE Std 802.11 */ + switch (wifi->disconnect_code) { + case 1: /* Unspecified reason */ + /* Let's assume it's because we got blocked */ + + case 6: /* Class 2 frame received from nonauthenticated STA */ + connman_network_set_error(network, + CONNMAN_NETWORK_ERROR_BLOCKED); + break; + + default: break; + } + + if (network != wifi->pending_network) { + connman_network_set_connected(network, false); + connman_network_set_associating(network, false); + } + wifi->disconnecting = false; - /* We disable the selected network, if not then - * wpa_supplicant will loop retrying */ - if (g_supplicant_interface_enable_selected_network(interface, - FALSE) != 0) - DBG("Could not disables selected network"); + start_autoscan(device); - connman_network_set_associating(network, FALSE); - connman_network_set_connected(network, FALSE); break; case G_SUPPLICANT_STATE_INACTIVE: - connman_network_set_associating(network, FALSE); + connman_network_set_associating(network, false); + start_autoscan(device); + break; case G_SUPPLICANT_STATE_UNKNOWN: + case G_SUPPLICANT_STATE_DISABLED: case G_SUPPLICANT_STATE_ASSOCIATED: case G_SUPPLICANT_STATE_4WAY_HANDSHAKE: case G_SUPPLICANT_STATE_GROUP_HANDSHAKE: break; } + old_connected = wifi->connected; wifi->state = state; + /* Saving wpa_s state policy: + * If connected and if the state changes are roaming related: + * --> We stay connected + * If completed + * --> We are connected + * All other case: + * --> We are not connected + * */ + switch (state) { + case G_SUPPLICANT_STATE_AUTHENTICATING: + case G_SUPPLICANT_STATE_ASSOCIATING: + case G_SUPPLICANT_STATE_ASSOCIATED: + case G_SUPPLICANT_STATE_4WAY_HANDSHAKE: + case G_SUPPLICANT_STATE_GROUP_HANDSHAKE: + if (wifi->connected) + connman_warn("Probably roaming right now!" + " Staying connected..."); + break; + case G_SUPPLICANT_STATE_SCANNING: + wifi->connected = false; + + if (old_connected) + start_autoscan(device); + break; + case G_SUPPLICANT_STATE_COMPLETED: + wifi->connected = true; + break; + default: + wifi->connected = false; + break; + } + DBG("DONE"); } -static void interface_removed(GSupplicantInterface *interface) +static void interface_removed(GSupplicantInterface *interface) +{ + const char *ifname = g_supplicant_interface_get_ifname(interface); + struct wifi_data *wifi; + + DBG("ifname %s", ifname); + + wifi = g_supplicant_interface_get_data(interface); + + if (wifi) + wifi->interface = NULL; + + if (wifi && wifi->tethering) + return; + + if (!wifi || !wifi->device) { + DBG("wifi interface already removed"); + return; + } + + connman_device_set_powered(wifi->device, false); + + check_p2p_technology(); +} + +static void set_device_type(const char *type, char dev_type[17]) +{ + const char *oui = "0050F204"; + const char *category = "0001"; + const char *sub_category = "0000"; + + if (!g_strcmp0(type, "handset")) { + category = "000A"; + sub_category = "0005"; + } else if (!g_strcmp0(type, "vm") || !g_strcmp0(type, "container")) + sub_category = "0001"; + else if (!g_strcmp0(type, "server")) + sub_category = "0002"; + else if (!g_strcmp0(type, "laptop")) + sub_category = "0005"; + else if (!g_strcmp0(type, "desktop")) + sub_category = "0006"; + else if (!g_strcmp0(type, "tablet")) + sub_category = "0009"; + else if (!g_strcmp0(type, "watch")) + category = "00FF"; + + snprintf(dev_type, 17, "%s%s%s", category, oui, sub_category); +} + +static void p2p_support(GSupplicantInterface *interface) { - const char *ifname = g_supplicant_interface_get_ifname(interface); - struct wifi_data *wifi; + char dev_type[17] = {}; + const char *hostname; - DBG("ifname %s", ifname); + DBG(""); - wifi = g_supplicant_interface_get_data(interface); + if (!interface) + return; - if (wifi != NULL && wifi->tethering == TRUE) + if (!g_supplicant_interface_has_p2p(interface)) return; - if (wifi == NULL || wifi->device == NULL) { - connman_error("Wrong wifi pointer"); + if (connman_technology_driver_register(&p2p_tech_driver) < 0) { + DBG("Could not register P2P technology driver"); return; } - connman_device_set_powered(wifi->device, FALSE); + hostname = connman_utsname_get_hostname(); + if (!hostname) + hostname = "ConnMan"; + + set_device_type(connman_machine_get_type(), dev_type); + g_supplicant_interface_set_p2p_device_config(interface, + hostname, dev_type); + connman_peer_driver_register(&peer_driver); } static void scan_started(GSupplicantInterface *interface) @@ -1113,6 +2706,34 @@ static void scan_finished(GSupplicantInterface *interface) DBG(""); } +static void ap_create_fail(GSupplicantInterface *interface) +{ + struct wifi_data *wifi = g_supplicant_interface_get_data(interface); + int ret; + + if ((wifi->tethering) && (wifi->tethering_param)) { + DBG("%s create AP fail \n", + g_supplicant_interface_get_ifname(wifi->interface)); + + connman_inet_remove_from_bridge(wifi->index, wifi->bridge); + wifi->ap_supported = WIFI_AP_NOT_SUPPORTED; + wifi->tethering = false; + + ret = tech_set_tethering(wifi->tethering_param->technology, + wifi->tethering_param->ssid->ssid, + wifi->tethering_param->ssid->passphrase, + wifi->bridge, true); + + if ((ret == -EOPNOTSUPP) && (wifi_technology)) { + connman_technology_tethering_notify(wifi_technology,false); + } + + g_free(wifi->tethering_param->ssid); + g_free(wifi->tethering_param); + wifi->tethering_param = NULL; + } +} + static unsigned char calculate_strength(GSupplicantNetwork *supplicant_network) { unsigned char strength; @@ -1129,32 +2750,44 @@ static void network_added(GSupplicantNetwork *supplicant_network) struct connman_network *network; GSupplicantInterface *interface; struct wifi_data *wifi; - const char *name, *identifier, *security, *group; + const char *name, *identifier, *security, *group, *mode; const unsigned char *ssid; unsigned int ssid_len; - connman_bool_t wps; + bool wps; + bool wps_pbc; + bool wps_ready; + bool wps_advertizing; - DBG(""); + mode = g_supplicant_network_get_mode(supplicant_network); + identifier = g_supplicant_network_get_identifier(supplicant_network); + + DBG("%s", identifier); + + if (!g_strcmp0(mode, "adhoc")) + return; interface = g_supplicant_network_get_interface(supplicant_network); wifi = g_supplicant_interface_get_data(interface); name = g_supplicant_network_get_name(supplicant_network); - identifier = g_supplicant_network_get_identifier(supplicant_network); security = g_supplicant_network_get_security(supplicant_network); group = g_supplicant_network_get_identifier(supplicant_network); wps = g_supplicant_network_get_wps(supplicant_network); + wps_pbc = g_supplicant_network_is_wps_pbc(supplicant_network); + wps_ready = g_supplicant_network_is_wps_active(supplicant_network); + wps_advertizing = g_supplicant_network_is_wps_advertizing( + supplicant_network); - if (wifi == NULL) + if (!wifi) return; ssid = g_supplicant_network_get_ssid(supplicant_network, &ssid_len); network = connman_device_get_network(wifi->device, identifier); - if (network == NULL) { + if (!network) { network = connman_network_create(identifier, CONNMAN_NETWORK_TYPE_WIFI); - if (network == NULL) + if (!network) return; connman_network_set_index(network, wifi->index); @@ -1164,10 +2797,10 @@ static void network_added(GSupplicantNetwork *supplicant_network) return; } - wifi->networks = g_slist_append(wifi->networks, network); + wifi->networks = g_slist_prepend(wifi->networks, network); } - if (name != NULL && name[0] != '\0') + if (name && name[0] != '\0') connman_network_set_name(network, name); connman_network_set_blob(network, "WiFi.SSID", @@ -1176,22 +2809,35 @@ static void network_added(GSupplicantNetwork *supplicant_network) connman_network_set_strength(network, calculate_strength(supplicant_network)); connman_network_set_bool(network, "WiFi.WPS", wps); + connman_network_set_bool(network, "WiFi.WPSAdvertising", + wps_advertizing); + + if (wps) { + /* Is AP advertizing for WPS association? + * If so, we decide to use WPS by default */ + if (wps_ready && wps_pbc && + wps_advertizing) + connman_network_set_bool(network, "WiFi.UseWPS", true); + } connman_network_set_frequency(network, g_supplicant_network_get_frequency(supplicant_network)); - connman_network_set_available(network, TRUE); + connman_network_set_available(network, true); + connman_network_set_string(network, "WiFi.Mode", mode); - if (ssid != NULL) + if (ssid) connman_network_set_group(network, group); - if (wifi->hidden != NULL) { - if (wifi->hidden->ssid_len == ssid_len && - memcmp(wifi->hidden->ssid, ssid, - ssid_len) == 0) { + if (wifi->hidden && ssid) { + if (!g_strcmp0(wifi->hidden->security, security) && + wifi->hidden->ssid_len == ssid_len && + !memcmp(wifi->hidden->ssid, ssid, ssid_len)) { connman_network_connect_hidden(network, wifi->hidden->identity, - wifi->hidden->passphrase); + wifi->hidden->passphrase, + wifi->hidden->user_data); + wifi->hidden->user_data = NULL; hidden_free(wifi->hidden); wifi->hidden = NULL; } @@ -1212,11 +2858,11 @@ static void network_removed(GSupplicantNetwork *network) DBG("name %s", name); - if (wifi == NULL) + if (!wifi) return; connman_network = connman_device_get_network(wifi->device, identifier); - if (connman_network == NULL) + if (!connman_network) return; wifi->networks = g_slist_remove(wifi->networks, connman_network); @@ -1231,6 +2877,7 @@ static void network_changed(GSupplicantNetwork *network, const char *property) struct wifi_data *wifi; const char *name, *identifier; struct connman_network *connman_network; + bool update_needed; interface = g_supplicant_network_get_interface(network); wifi = g_supplicant_interface_get_data(interface); @@ -1239,18 +2886,311 @@ static void network_changed(GSupplicantNetwork *network, const char *property) DBG("name %s", name); - if (wifi == NULL) + if (!wifi) return; connman_network = connman_device_get_network(wifi->device, identifier); - if (connman_network == NULL) + if (!connman_network) return; - if (g_str_equal(property, "Signal") == TRUE) { - connman_network_set_strength(connman_network, + if (g_str_equal(property, "WPSCapabilities")) { + bool wps; + bool wps_pbc; + bool wps_ready; + bool wps_advertizing; + + wps = g_supplicant_network_get_wps(network); + wps_pbc = g_supplicant_network_is_wps_pbc(network); + wps_ready = g_supplicant_network_is_wps_active(network); + wps_advertizing = + g_supplicant_network_is_wps_advertizing(network); + + connman_network_set_bool(connman_network, "WiFi.WPS", wps); + connman_network_set_bool(connman_network, + "WiFi.WPSAdvertising", wps_advertizing); + + if (wps) { + /* + * Is AP advertizing for WPS association? + * If so, we decide to use WPS by default + */ + if (wps_ready && wps_pbc && wps_advertizing) + connman_network_set_bool(connman_network, + "WiFi.UseWPS", true); + } + + update_needed = true; + } else if (g_str_equal(property, "Signal")) { + connman_network_set_strength(connman_network, calculate_strength(network)); - connman_network_update(connman_network); + update_needed = true; + } else + update_needed = false; + + if (update_needed) + connman_network_update(connman_network); +} + +static void network_associated(GSupplicantNetwork *network) +{ + GSupplicantInterface *interface; + struct wifi_data *wifi; + struct connman_network *connman_network; + const char *identifier; + + DBG(""); + + interface = g_supplicant_network_get_interface(network); + if (!interface) + return; + + wifi = g_supplicant_interface_get_data(interface); + if (!wifi) + return; + + /* P2P networks must not be treated as WiFi networks */ + if (wifi->p2p_connecting || wifi->p2p_device) + return; + + identifier = g_supplicant_network_get_identifier(network); + + connman_network = connman_device_get_network(wifi->device, identifier); + if (!connman_network) + return; + + if (wifi->network) { + if (wifi->network == connman_network) + return; + + /* + * This should never happen, we got associated with + * a network different than the one we were expecting. + */ + DBG("Associated to %p while expecting %p", + connman_network, wifi->network); + + connman_network_set_associating(wifi->network, false); + } + + DBG("Reconnecting to previous network %p from wpa_s", connman_network); + + wifi->network = connman_network_ref(connman_network); + wifi->retries = 0; + + /* + * Interface state changes callback (interface_state) is always + * called before network_associated callback thus we need to call + * interface_state again in order to process the new state now that + * we have the network properly set. + */ + interface_state(interface); +} + +static void sta_authorized(GSupplicantInterface *interface, + const char *addr) +{ + struct wifi_data *wifi = g_supplicant_interface_get_data(interface); + + DBG("wifi %p station %s authorized", wifi, addr); + + if (!wifi || !wifi->tethering) + return; + + __connman_tethering_client_register(addr); +} + +static void sta_deauthorized(GSupplicantInterface *interface, + const char *addr) +{ + struct wifi_data *wifi = g_supplicant_interface_get_data(interface); + + DBG("wifi %p station %s deauthorized", wifi, addr); + + if (!wifi || !wifi->tethering) + return; + + __connman_tethering_client_unregister(addr); +} + +static void apply_peer_services(GSupplicantPeer *peer, + struct connman_peer *connman_peer) +{ + const unsigned char *data; + int length; + + DBG(""); + + connman_peer_reset_services(connman_peer); + + data = g_supplicant_peer_get_widi_ies(peer, &length); + if (data) { + connman_peer_add_service(connman_peer, + CONNMAN_PEER_SERVICE_WIFI_DISPLAY, data, length); + } +} + +static void peer_found(GSupplicantPeer *peer) +{ + GSupplicantInterface *iface = g_supplicant_peer_get_interface(peer); + struct wifi_data *wifi = g_supplicant_interface_get_data(iface); + struct connman_peer *connman_peer; + const char *identifier, *name; + int ret; + + identifier = g_supplicant_peer_get_identifier(peer); + name = g_supplicant_peer_get_name(peer); + + DBG("ident: %s", identifier); + + connman_peer = connman_peer_get(wifi->device, identifier); + if (connman_peer) + return; + + connman_peer = connman_peer_create(identifier); + connman_peer_set_name(connman_peer, name); + connman_peer_set_device(connman_peer, wifi->device); + apply_peer_services(peer, connman_peer); + + ret = connman_peer_register(connman_peer); + if (ret < 0 && ret != -EALREADY) + connman_peer_unref(connman_peer); + else + wifi->peers = g_slist_prepend(wifi->peers, connman_peer); +} + +static void peer_lost(GSupplicantPeer *peer) +{ + GSupplicantInterface *iface = g_supplicant_peer_get_interface(peer); + struct wifi_data *wifi = g_supplicant_interface_get_data(iface); + struct connman_peer *connman_peer; + const char *identifier; + + if (!wifi) + return; + + identifier = g_supplicant_peer_get_identifier(peer); + + DBG("ident: %s", identifier); + + connman_peer = connman_peer_get(wifi->device, identifier); + if (connman_peer) { + if (wifi->p2p_connecting && + wifi->pending_peer == connman_peer) { + peer_connect_timeout(wifi); + } + connman_peer_unregister(connman_peer); + connman_peer_unref(connman_peer); + } + + wifi->peers = g_slist_remove(wifi->peers, connman_peer); +} + +static void peer_changed(GSupplicantPeer *peer, GSupplicantPeerState state) +{ + GSupplicantInterface *iface = g_supplicant_peer_get_interface(peer); + struct wifi_data *wifi = g_supplicant_interface_get_data(iface); + enum connman_peer_state p_state = CONNMAN_PEER_STATE_UNKNOWN; + struct connman_peer *connman_peer; + const char *identifier; + + identifier = g_supplicant_peer_get_identifier(peer); + + DBG("ident: %s", identifier); + + if (!wifi) + return; + + connman_peer = connman_peer_get(wifi->device, identifier); + if (!connman_peer) + return; + + switch (state) { + case G_SUPPLICANT_PEER_SERVICES_CHANGED: + apply_peer_services(peer, connman_peer); + connman_peer_services_changed(connman_peer); + return; + case G_SUPPLICANT_PEER_GROUP_CHANGED: + if (!g_supplicant_peer_is_in_a_group(peer)) + p_state = CONNMAN_PEER_STATE_IDLE; + else + p_state = CONNMAN_PEER_STATE_CONFIGURATION; + break; + case G_SUPPLICANT_PEER_GROUP_STARTED: + break; + case G_SUPPLICANT_PEER_GROUP_FINISHED: + p_state = CONNMAN_PEER_STATE_IDLE; + break; + case G_SUPPLICANT_PEER_GROUP_JOINED: + connman_peer_set_iface_address(connman_peer, + g_supplicant_peer_get_iface_address(peer)); + break; + case G_SUPPLICANT_PEER_GROUP_DISCONNECTED: + p_state = CONNMAN_PEER_STATE_IDLE; + break; + case G_SUPPLICANT_PEER_GROUP_FAILED: + if (g_supplicant_peer_has_requested_connection(peer)) + p_state = CONNMAN_PEER_STATE_IDLE; + else + p_state = CONNMAN_PEER_STATE_FAILURE; + break; } + + if (p_state == CONNMAN_PEER_STATE_CONFIGURATION || + p_state == CONNMAN_PEER_STATE_FAILURE) { + if (wifi->p2p_connecting + && connman_peer == wifi->pending_peer) + peer_cancel_timeout(wifi); + else + p_state = CONNMAN_PEER_STATE_UNKNOWN; + } + + if (p_state == CONNMAN_PEER_STATE_UNKNOWN) + return; + + if (p_state == CONNMAN_PEER_STATE_CONFIGURATION) { + GSupplicantInterface *g_iface; + struct wifi_data *g_wifi; + + g_iface = g_supplicant_peer_get_group_interface(peer); + if (!g_iface) + return; + + g_wifi = g_supplicant_interface_get_data(g_iface); + if (!g_wifi) + return; + + connman_peer_set_as_master(connman_peer, + !g_supplicant_peer_is_client(peer)); + connman_peer_set_sub_device(connman_peer, g_wifi->device); + + /* + * If wpa_supplicant didn't create a dedicated p2p-group + * interface then mark this interface as p2p_device to avoid + * scan and auto-scan are launched on it while P2P is connected. + */ + if (!g_list_find(p2p_iface_list, g_wifi)) + wifi->p2p_device = true; + } + + connman_peer_set_state(connman_peer, p_state); +} + +static void peer_request(GSupplicantPeer *peer) +{ + GSupplicantInterface *iface = g_supplicant_peer_get_interface(peer); + struct wifi_data *wifi = g_supplicant_interface_get_data(iface); + struct connman_peer *connman_peer; + const char *identifier; + + identifier = g_supplicant_peer_get_identifier(peer); + + DBG("ident: %s", identifier); + + connman_peer = connman_peer_get(wifi->device, identifier); + if (!connman_peer) + return; + + connman_peer_request_connection(connman_peer); } static void debug(const char *str) @@ -1259,18 +3199,48 @@ static void debug(const char *str) connman_debug("%s", str); } +static void disconnect_reasoncode(GSupplicantInterface *interface, + int reasoncode) +{ + struct wifi_data *wifi = g_supplicant_interface_get_data(interface); + + if (wifi != NULL) { + wifi->disconnect_code = reasoncode; + } +} + +static void assoc_status_code(GSupplicantInterface *interface, int status_code) +{ + struct wifi_data *wifi = g_supplicant_interface_get_data(interface); + + if (wifi != NULL) { + wifi->assoc_code = status_code; + } +} + static const GSupplicantCallbacks callbacks = { .system_ready = system_ready, .system_killed = system_killed, .interface_added = interface_added, .interface_state = interface_state, .interface_removed = interface_removed, + .p2p_support = p2p_support, .scan_started = scan_started, .scan_finished = scan_finished, + .ap_create_fail = ap_create_fail, .network_added = network_added, .network_removed = network_removed, .network_changed = network_changed, + .network_associated = network_associated, + .sta_authorized = sta_authorized, + .sta_deauthorized = sta_deauthorized, + .peer_found = peer_found, + .peer_lost = peer_lost, + .peer_changed = peer_changed, + .peer_request = peer_request, .debug = debug, + .disconnect_reasoncode = disconnect_reasoncode, + .assoc_status_code = assoc_status_code, }; @@ -1286,19 +3256,12 @@ static void tech_remove(struct connman_technology *technology) wifi_technology = NULL; } -struct wifi_tethering_info { - struct wifi_data *wifi; - struct connman_technology *technology; - char *ifname; - GSupplicantSSID *ssid; -}; - static GSupplicantSSID *ssid_ap_init(const char *ssid, const char *passphrase) { GSupplicantSSID *ap; ap = g_try_malloc0(sizeof(GSupplicantSSID)); - if (ap == NULL) + if (!ap) return NULL; ap->mode = G_SUPPLICANT_MODE_MASTER; @@ -1307,7 +3270,7 @@ static GSupplicantSSID *ssid_ap_init(const char *ssid, const char *passphrase) ap->scan_ssid = 0; ap->freq = 2412; - if (passphrase == NULL || strlen(passphrase) == 0) { + if (!passphrase || strlen(passphrase) == 0) { ap->security = G_SUPPLICANT_SECURITY_NONE; ap->passphrase = NULL; } else { @@ -1329,10 +3292,16 @@ static void ap_start_callback(int result, GSupplicantInterface *interface, DBG("result %d index %d bridge %s", result, info->wifi->index, info->wifi->bridge); - if (result < 0) { + if ((result < 0) || (info->wifi->ap_supported != WIFI_AP_SUPPORTED)) { connman_inet_remove_from_bridge(info->wifi->index, info->wifi->bridge); - connman_technology_tethering_notify(info->technology, FALSE); + + if (info->wifi->ap_supported == WIFI_AP_SUPPORTED) { + connman_technology_tethering_notify(info->technology, false); + g_free(info->wifi->tethering_param->ssid); + g_free(info->wifi->tethering_param); + info->wifi->tethering_param = NULL; + } } g_free(info->ifname); @@ -1348,12 +3317,20 @@ static void ap_create_callback(int result, DBG("result %d ifname %s", result, g_supplicant_interface_get_ifname(interface)); - if (result < 0) { + if ((result < 0) || (info->wifi->ap_supported != WIFI_AP_SUPPORTED)) { connman_inet_remove_from_bridge(info->wifi->index, info->wifi->bridge); - connman_technology_tethering_notify(info->technology, FALSE); + + if (info->wifi->ap_supported == WIFI_AP_SUPPORTED) { + connman_technology_tethering_notify(info->technology, false); + g_free(info->wifi->tethering_param->ssid); + g_free(info->wifi->tethering_param); + info->wifi->tethering_param = NULL; + + } g_free(info->ifname); + g_free(info->ssid); g_free(info); return; } @@ -1377,26 +3354,32 @@ static void sta_remove_callback(int result, DBG("ifname %s result %d ", info->ifname, result); - if (result < 0) { - info->wifi->tethering = TRUE; + if ((result < 0) || (info->wifi->ap_supported != WIFI_AP_SUPPORTED)) { + info->wifi->tethering = false; + connman_technology_tethering_notify(info->technology, false); + + if (info->wifi->ap_supported == WIFI_AP_SUPPORTED) { + g_free(info->wifi->tethering_param->ssid); + g_free(info->wifi->tethering_param); + info->wifi->tethering_param = NULL; + } g_free(info->ifname); + g_free(info->ssid); g_free(info); return; } info->wifi->interface = NULL; - connman_technology_tethering_notify(info->technology, TRUE); - g_supplicant_interface_create(info->ifname, driver, info->wifi->bridge, ap_create_callback, info); } -static int tech_set_tethering(struct connman_technology *technology, - const char *identifier, const char *passphrase, - const char *bridge, connman_bool_t enabled) +static int enable_wifi_tethering(struct connman_technology *technology, + const char *bridge, const char *identifier, + const char *passphrase, bool available) { GList *list; GSupplicantInterface *interface; @@ -1404,89 +3387,156 @@ static int tech_set_tethering(struct connman_technology *technology, struct wifi_tethering_info *info; const char *ifname; unsigned int mode; - int err; - - DBG(""); - - if (enabled == FALSE) { - for (list = iface_list; list; list = list->next) { - wifi = list->data; - - if (wifi->tethering == TRUE) { - wifi->tethering = FALSE; - - connman_inet_remove_from_bridge(wifi->index, - bridge); - wifi->bridged = FALSE; - } - } - - connman_technology_tethering_notify(technology, FALSE); - - return 0; - } + int err, berr = 0; for (list = iface_list; list; list = list->next) { wifi = list->data; + DBG("wifi %p network %p pending_network %p", wifi, + wifi->network, wifi->pending_network); + interface = wifi->interface; - if (interface == NULL) + if (!interface) continue; ifname = g_supplicant_interface_get_ifname(wifi->interface); + if (!ifname) + continue; + + if (wifi->ap_supported == WIFI_AP_NOT_SUPPORTED) { + DBG("%s does not support AP mode (detected)", ifname); + continue; + } mode = g_supplicant_interface_get_mode(interface); if ((mode & G_SUPPLICANT_CAPABILITY_MODE_AP) == 0) { - DBG("%s does not support AP mode", ifname); + wifi->ap_supported = WIFI_AP_NOT_SUPPORTED; + DBG("%s does not support AP mode (capability)", ifname); continue; } + if (wifi->network && available) + continue; + info = g_try_malloc0(sizeof(struct wifi_tethering_info)); - if (info == NULL) + if (!info) + return -ENOMEM; + + wifi->tethering_param = g_try_malloc0(sizeof(struct wifi_tethering_info)); + if (!wifi->tethering_param) { + g_free(info); return -ENOMEM; + } info->wifi = wifi; info->technology = technology; info->wifi->bridge = bridge; info->ssid = ssid_ap_init(identifier, passphrase); - if (info->ssid == NULL) { - g_free(info); - continue; - } + if (!info->ssid) + goto failed; + info->ifname = g_strdup(ifname); - if (info->ifname == NULL) { - g_free(info); - continue; - } - info->wifi->tethering = TRUE; + wifi->tethering_param->technology = technology; + wifi->tethering_param->ssid = ssid_ap_init(identifier, passphrase); + if (!wifi->tethering_param->ssid) + goto failed; + + info->wifi->tethering = true; + info->wifi->ap_supported = WIFI_AP_SUPPORTED; + + berr = connman_technology_tethering_notify(technology, true); + if (berr < 0) + goto failed; err = g_supplicant_interface_remove(interface, sta_remove_callback, info); - if (err == 0) - return err; + if (err >= 0) { + DBG("tethering wifi %p ifname %s", wifi, ifname); + return 0; + } + + failed: + g_free(info->ifname); + g_free(info->ssid); + g_free(info); + g_free(wifi->tethering_param); + wifi->tethering_param = NULL; + + /* + * Remove bridge if it was correctly created but remove + * operation failed. Instead, if bridge creation failed then + * break out and do not try again on another interface, + * bridge set-up does not depend on it. + */ + if (berr == 0) + connman_technology_tethering_notify(technology, false); + else + break; } return -EOPNOTSUPP; } -static void regdom_callback(void *user_data) +static int tech_set_tethering(struct connman_technology *technology, + const char *identifier, const char *passphrase, + const char *bridge, bool enabled) { - char *alpha2 = user_data; + GList *list; + struct wifi_data *wifi; + int err; + + DBG(""); + + if (!enabled) { + for (list = iface_list; list; list = list->next) { + wifi = list->data; + + if (wifi->tethering) { + wifi->tethering = false; + + connman_inet_remove_from_bridge(wifi->index, + bridge); + wifi->bridged = false; + } + } + + connman_technology_tethering_notify(technology, false); + + return 0; + } + + DBG("trying tethering for available devices"); + err = enable_wifi_tethering(technology, bridge, identifier, passphrase, + true); + if (err < 0) { + DBG("trying tethering for any device"); + err = enable_wifi_tethering(technology, bridge, identifier, + passphrase, false); + } + + return err; +} + +static void regdom_callback(int result, const char *alpha2, void *user_data) +{ DBG(""); - if (wifi_technology == NULL) + if (!wifi_technology) return; + if (result != 0) + alpha2 = NULL; + connman_technology_regdom_notify(wifi_technology, alpha2); } static int tech_set_regdom(struct connman_technology *technology, const char *alpha2) { - return g_supplicant_set_country(alpha2, regdom_callback, alpha2); + return g_supplicant_set_country(alpha2, regdom_callback, NULL); } static struct connman_technology_driver tech_driver = {