Send signals for Powered and Connected changes
[connman] / plugins / wifi.c
index 6ab5940..660ea9f 100644 (file)
 #include <config.h>
 #endif
 
-#include <dbus/dbus.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <string.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <linux/if_arp.h>
+#include <linux/wireless.h>
+
+#include <gdbus.h>
 
 #include <connman/plugin.h>
 #include <connman/driver.h>
+#include <connman/rtnl.h>
 #include <connman/log.h>
 
-static DBusConnection *connection;
+#include "inet.h"
+#include "supplicant.h"
 
-#define SUPPLICANT_NAME  "fi.epitest.hostap.WPASupplicant"
-#define SUPPLICANT_INTF  "fi.epitest.hostap.WPASupplicant"
-#define SUPPLICANT_PATH  "/fi/epitest/hostap/WPASupplicant"
-
-enum supplicant_state {
-       STATE_INACTIVE,
-       STATE_SCANNING,
-       STATE_ASSOCIATING,
-       STATE_ASSOCIATED,
-       STATE_4WAY_HANDSHAKE,
-       STATE_GROUP_HANDSHAKE,
-       STATE_COMPLETED,
-       STATE_DISCONNECTED,
+struct wifi_data {
+       GSList *list;
+       gchar *identifier;
+       gboolean connected;
 };
 
-struct supplicant_task {
-       int ifindex;
-       gchar *ifname;
-       enum supplicant_state state;
-       gchar *path;
-       gboolean created;
-};
+static int network_probe(struct connman_element *element)
+{
+       DBG("element %p name %s", element, element->name);
 
-static GStaticMutex task_mutex = G_STATIC_MUTEX_INIT;
-static GSList *task_list = NULL;
+       return 0;
+}
 
-static struct supplicant_task *find_task_by_index(int index)
+static void network_remove(struct connman_element *element)
 {
-       GSList *list;
+       DBG("element %p name %s", element, element->name);
+}
 
-       for (list = task_list; list; list = list->next) {
-               struct supplicant_task *task = list->data;
+static int network_enable(struct connman_element *element)
+{
+       char *name, *security = NULL, *passphrase = NULL;
+       unsigned char *ssid;
+       int ssid_len;
+
+       DBG("element %p name %s", element, element->name);
+
+       if (connman_element_get_static_property(element,
+                                               "Name", &name) == FALSE)
+               return -EIO;
 
-               if (task->ifindex == index)
-                       return task;
+       if (connman_element_get_static_array_property(element,
+                               "WiFi.SSID", &ssid, &ssid_len) == FALSE)
+               return -EIO;
+
+       if (element->parent != NULL) {
+               struct wifi_data *data = connman_element_get_data(element->parent);
+
+               if (data->connected == TRUE)
+                       return -EBUSY;
+
+               if (data != NULL) {
+                       g_free(data->identifier);
+                       data->identifier = g_strdup(name);
+               }
        }
 
-       return NULL;
+       connman_element_get_value(element,
+                       CONNMAN_PROPERTY_ID_WIFI_SECURITY, &security);
+
+       connman_element_get_value(element,
+                       CONNMAN_PROPERTY_ID_WIFI_PASSPHRASE, &passphrase);
+
+       DBG("name %s security %s passhprase %s",
+                                       name, security, passphrase);
+
+       if (__supplicant_connect(element, ssid, ssid_len,
+                                               security, passphrase) < 0)
+               connman_error("Failed to initiate connect");
+
+       return 0;
 }
 
-static int get_interface(struct supplicant_task *task)
+static int network_disable(struct connman_element *element)
 {
-       DBusMessage *message, *reply;
-       DBusError error;
-       const char *path;
+       DBG("element %p name %s", element, element->name);
 
-       DBG("task %p", task);
+       connman_element_unregister_children(element);
 
-       message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
-                                       SUPPLICANT_INTF, "getInterface");
-       if (message == NULL)
-               return -ENOMEM;
+       __supplicant_disconnect(element);
+
+       return 0;
+}
 
-       dbus_message_append_args(message, DBUS_TYPE_STRING, &task->ifname,
-                                                       DBUS_TYPE_INVALID);
+static struct connman_driver network_driver = {
+       .name           = "wifi-network",
+       .type           = CONNMAN_ELEMENT_TYPE_NETWORK,
+       .subtype        = CONNMAN_ELEMENT_SUBTYPE_WIFI,
+       .probe          = network_probe,
+       .remove         = network_remove,
+       .enable         = network_enable,
+       .disable        = network_disable,
+};
+
+static struct connman_element *find_element(struct wifi_data *data,
+                                               const char *identifier)
+{
+       GSList *list;
 
-       dbus_error_init(&error);
+       for (list = data->list; list; list = list->next) {
+               struct connman_element *element = list->data;
 
-       reply = dbus_connection_send_with_reply_and_block(connection,
-                                                       message, -1, &error);
-       if (reply == NULL) {
-               if (dbus_error_is_set(&error) == TRUE) {
-                       connman_error("%s", error.message);
-                       dbus_error_free(&error);
-               } else
-                       connman_error("Failed to get interface");
-               dbus_message_unref(message);
-               return -EIO;
+               if (connman_element_match_static_property(element,
+                                       "Name", &identifier) == TRUE)
+                       return element;
        }
 
-       dbus_message_unref(message);
+       return NULL;
+}
+
+static void state_change(struct connman_element *parent,
+                                               enum supplicant_state state)
+{
+       struct wifi_data *data = connman_element_get_data(parent);
+       struct connman_element *element;
 
-       dbus_error_init(&error);
+       DBG("state %d", state);
 
-       if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
-                                               DBUS_TYPE_INVALID) == FALSE) {
-               if (dbus_error_is_set(&error) == TRUE) {
-                       connman_error("%s", error.message);
-                       dbus_error_free(&error);
-               } else
-                       connman_error("Wrong arguments for interface");
-               dbus_message_unref(reply);
-               return -EIO;
-       }
+       if (data == NULL)
+               return;
 
-       DBG("path %s", path);
+       if (data->identifier == NULL)
+               return;
 
-       task->path = g_strdup(path);
-       task->created = FALSE;
+       element = find_element(data, data->identifier);
+       if (element == NULL)
+               return;
 
-       dbus_message_unref(reply);
+       if (state == STATE_COMPLETED) {
+               struct connman_element *dhcp;
 
-       return 0;
+               data->connected = TRUE;
+
+               dhcp = connman_element_create(NULL);
+
+               dhcp->type = CONNMAN_ELEMENT_TYPE_DHCP;
+               dhcp->index = element->index;
+
+               connman_element_register(dhcp, element);
+       } else if (state == STATE_DISCONNECTED || state == STATE_INACTIVE)
+               data->connected = FALSE;
 }
 
-static int add_interface(struct supplicant_task *task)
+static void scan_result(struct connman_element *parent,
+                                       struct supplicant_network *network)
 {
-       DBusMessage *message, *reply;
-       DBusError error;
-       const char *path;
+       struct wifi_data *data = connman_element_get_data(parent);
+       struct connman_element *element;
+       gchar *temp;
+       int i;
 
-       DBG("task %p", task);
+       DBG("network %p identifier %s", network, network->identifier);
 
-       message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
-                                       SUPPLICANT_INTF, "addInterface");
-       if (message == NULL)
-               return -ENOMEM;
+       if (data == NULL)
+               return;
 
-       dbus_error_init(&error);
+       if (network->identifier == NULL)
+               return;
 
-       dbus_message_append_args(message, DBUS_TYPE_STRING, &task->ifname,
-                                                       DBUS_TYPE_INVALID);
+       if (network->identifier[0] == '\0')
+               return;
 
-       reply = dbus_connection_send_with_reply_and_block(connection,
-                                                       message, -1, &error);
-       if (reply == NULL) {
-               if (dbus_error_is_set(&error) == TRUE) {
-                       connman_error("%s", error.message);
-                       dbus_error_free(&error);
-               } else
-                       connman_error("Failed to add interface");
-               dbus_message_unref(message);
-               return -EIO;
+       temp = g_strdup(network->identifier);
+
+       for (i = 0; i < strlen(temp); i++) {
+               if (temp[i] == ' ' || temp[i] == '.')
+                       temp[i] = '_';
+               else if (temp[i] == '-' || temp[i] == '+')
+                       temp[i] = '_';
+               else if (temp[i] == '!' || temp[i] == '?')
+                       temp[i] = '_';
+               else if (temp[i] == '(' || temp[i] == ')')
+                       temp[i] = '_';
+               else if (g_ascii_isprint(temp[i]) == FALSE)
+                       temp[i] = '_';
+               temp[i] = g_ascii_tolower(temp[i]);
        }
 
-       dbus_message_unref(message);
+       element = find_element(data, network->identifier);
+       if (element == NULL) {
+               guint8 strength;
 
-       dbus_error_init(&error);
+               element = connman_element_create(temp);
 
-       if (dbus_message_get_args(reply, &error, DBUS_TYPE_OBJECT_PATH, &path,
-                                               DBUS_TYPE_INVALID) == FALSE) {
-               if (dbus_error_is_set(&error) == TRUE) {
-                       connman_error("%s", error.message);
-                       dbus_error_free(&error);
-               } else
-                       connman_error("Wrong arguments for interface");
-               dbus_message_unref(reply);
-               return -EIO;
+               element->type = CONNMAN_ELEMENT_TYPE_NETWORK;
+               element->index = parent->index;
+
+               data->list = g_slist_append(data->list, element);
+
+               connman_element_add_static_property(element, "Name",
+                               DBUS_TYPE_STRING, &network->identifier);
+
+               connman_element_add_static_array_property(element, "WiFi.SSID",
+                       DBUS_TYPE_BYTE, &network->ssid, network->ssid_len);
+
+               if (element->wifi.security == NULL) {
+                       const char *security;
+
+                       if (network->has_rsn == TRUE)
+                               security = "wpa2";
+                       else if (network->has_wpa == TRUE)
+                               security = "wpa";
+                       else if (network->has_wep == TRUE)
+                               security = "wep";
+                       else
+                               security = "none";
+
+                       element->wifi.security = g_strdup(security);
+               }
+
+               strength = network->quality;
+
+               connman_element_add_static_property(element, "WiFi.Strength",
+                                               DBUS_TYPE_BYTE, &strength);
+
+               //connman_element_add_static_property(element, "WiFi.Noise",
+               //                      DBUS_TYPE_INT32, &network->noise);
+
+               DBG("%s (%s) strength %d", network->identifier,
+                                       element->wifi.security, strength);
+
+               connman_element_register(element, parent);
        }
 
-       DBG("path %s", path);
+       element->available = TRUE;
+
+       g_free(temp);
+}
+
+static struct supplicant_callback wifi_callback = {
+       .state_change   = state_change,
+       .scan_result    = scan_result,
+};
+
+static int wifi_probe(struct connman_element *element)
+{
+       struct wifi_data *data;
+
+       DBG("element %p name %s", element, element->name);
+
+       data = g_try_new0(struct wifi_data, 1);
+       if (data == NULL)
+               return -ENOMEM;
 
-       task->path = g_strdup(path);
-       task->created = TRUE;
+       data->connected = FALSE;
 
-       dbus_message_unref(reply);
+       connman_element_set_data(element, data);
 
        return 0;
 }
 
-static int remove_interface(struct supplicant_task *task)
+static void wifi_remove(struct connman_element *element)
 {
-       DBusMessage *message, *reply;
-       DBusError error;
+       struct wifi_data *data = connman_element_get_data(element);
+
+       DBG("element %p name %s", element, element->name);
 
-       DBG("task %p", task);
+       connman_element_set_data(element, NULL);
 
-       if (task->created == FALSE)
-               return -EINVAL;
+       g_free(data->identifier);
+       g_free(data);
+}
 
-       message = dbus_message_new_method_call(SUPPLICANT_NAME, SUPPLICANT_PATH,
-                                       SUPPLICANT_INTF, "removeInterface");
-       if (message == NULL)
-               return -ENOMEM;
+static int wifi_update(struct connman_element *element)
+{
+       DBG("element %p name %s", element, element->name);
 
-       dbus_message_append_args(message, DBUS_TYPE_OBJECT_PATH, &task->path,
-                                                       DBUS_TYPE_INVALID);
+       __supplicant_scan(element);
 
-       dbus_error_init(&error);
+       return 0;
+}
 
-       reply = dbus_connection_send_with_reply_and_block(connection,
-                                                       message, -1, &error);
-       if (reply == NULL) {
-               if (dbus_error_is_set(&error) == TRUE) {
-                       connman_error("%s", error.message);
-                       dbus_error_free(&error);
-               } else
-                       connman_error("Failed to remove interface");
-               dbus_message_unref(message);
-               return -EIO;
-       }
+static int wifi_enable(struct connman_element *element)
+{
+       int err;
 
-       dbus_message_unref(message);
+       DBG("element %p name %s", element, element->name);
 
-       g_free(task->path);
-       task->path = NULL;
+       err = __supplicant_start(element, &wifi_callback);
+       if (err < 0)
+               return err;
 
-       dbus_message_unref(reply);
+       __supplicant_scan(element);
 
        return 0;
 }
 
-static int initiate_scan(struct supplicant_task *task)
+static int wifi_disable(struct connman_element *element)
 {
-       DBusMessage *message, *reply;
-       DBusError error;
+       struct wifi_data *data = connman_element_get_data(element);
+       GSList *list;
 
-       DBG("task %p", task);
+       DBG("element %p name %s", element, element->name);
 
-       message = dbus_message_new_method_call(SUPPLICANT_NAME, task->path,
-                                       SUPPLICANT_INTF ".Interface", "scan");
-       if (message == NULL)
-               return -ENOMEM;
+       __supplicant_disconnect(element);
 
-       dbus_error_init(&error);
-
-       reply = dbus_connection_send_with_reply_and_block(connection,
-                                                       message, -1, &error);
-       if (reply == NULL) {
-               if (dbus_error_is_set(&error) == TRUE) {
-                       connman_error("%s", error.message);
-                       dbus_error_free(&error);
-               } else
-                       connman_error("Failed to initiate scan");
-               dbus_message_unref(message);
-               return -EIO;
+       for (list = data->list; list; list = list->next) {
+               struct connman_element *network = list->data;
+
+               connman_element_unref(network);
        }
 
-       dbus_message_unref(message);
+       g_slist_free(data->list);
+       data->list = NULL;
+
+       connman_element_unregister_children(element);
 
-       dbus_message_unref(reply);
+       __supplicant_stop(element);
 
        return 0;
 }
 
-static int wifi_probe(struct connman_element *element)
+static struct connman_driver wifi_driver = {
+       .name           = "wifi-device",
+       .type           = CONNMAN_ELEMENT_TYPE_DEVICE,
+       .subtype        = CONNMAN_ELEMENT_SUBTYPE_WIFI,
+       .probe          = wifi_probe,
+       .remove         = wifi_remove,
+       .update         = wifi_update,
+       .enable         = wifi_enable,
+       .disable        = wifi_disable,
+};
+
+static GSList *device_list = NULL;
+
+static void wifi_newlink(unsigned short type, int index,
+                                       unsigned flags, unsigned change)
 {
-       struct supplicant_task *task;
-       int err;
+       struct connman_element *device;
+       GSList *list;
+       gboolean exists = FALSE;
+       gchar *name, *devname;
+       struct iwreq iwr;
+       int sk;
 
-       DBG("element %p name %s", element, element->name);
+       DBG("index %d", index);
 
-       task = g_try_new0(struct supplicant_task, 1);
-       if (task == NULL)
-               return -ENOMEM;
+       if (type != ARPHRD_ETHER)
+               return;
 
-       task->ifindex = element->netdev.index;
-       task->ifname = g_strdup(element->netdev.name);
+       name = inet_index2ident(index, "dev_");
+       devname = inet_index2name(index);
 
-       if (task->ifname == NULL) {
-               g_free(task);
-               return -ENOMEM;
+       memset(&iwr, 0, sizeof(iwr));
+       strncpy(iwr.ifr_ifrn.ifrn_name, devname, IFNAMSIZ);
+
+       sk = socket(PF_INET, SOCK_DGRAM, 0);
+
+       if (ioctl(sk, SIOCGIWNAME, &iwr) < 0) {
+               g_free(name);
+               close(sk);
+               return;
        }
 
-       task->created = FALSE;
-       task->state = STATE_INACTIVE;
+       close(sk);
 
-       g_static_mutex_lock(&task_mutex);
-       task_list = g_slist_append(task_list, task);
-       g_static_mutex_unlock(&task_mutex);
+       for (list = device_list; list; list = list->next) {
+               struct connman_element *device = list->data;
 
-       err = get_interface(task);
-       if (err < 0) {
-               err = add_interface(task);
-               if (err < 0) {
-                       g_free(task);
-                       return err;
+               if (device->index == index) {
+                       exists = TRUE;
+                       break;
                }
        }
 
-       initiate_scan(task);
+       if (exists == TRUE) {
+               g_free(name);
+               return;
+       }
 
-       return 0;
+       device = connman_element_create(NULL);
+       device->type = CONNMAN_ELEMENT_TYPE_DEVICE;
+       device->subtype = CONNMAN_ELEMENT_SUBTYPE_WIFI;
+
+       device->index = index;
+       device->name = name;
+       device->devname = devname;
+
+       connman_element_register(device, NULL);
+       device_list = g_slist_append(device_list, device);
 }
 
-static void wifi_remove(struct connman_element *element)
+static void wifi_dellink(unsigned short type, int index,
+                                       unsigned flags, unsigned change)
 {
-       struct supplicant_task *task;
+       GSList *list;
 
-       DBG("element %p name %s", element, element->name);
+       DBG("index %d", index);
 
-       g_static_mutex_lock(&task_mutex);
-       task = find_task_by_index(element->netdev.index);
-       g_static_mutex_unlock(&task_mutex);
+       for (list = device_list; list; list = list->next) {
+               struct connman_element *device = list->data;
 
-       if (task == NULL)
+               if (device->index == index) {
+                       device_list = g_slist_remove(device_list, device);
+                       connman_element_unregister(device);
+                       connman_element_unref(device);
+                       break;
+               }
+       }
+}
+
+static struct connman_rtnl wifi_rtnl = {
+       .name           = "wifi",
+       .newlink        = wifi_newlink,
+       .dellink        = wifi_dellink,
+};
+
+static void supplicant_connect(DBusConnection *connection, void *user_data)
+{
+       DBG("connection %p", connection);
+
+       __supplicant_init(connection);
+
+       if (connman_rtnl_register(&wifi_rtnl) < 0)
                return;
 
-       g_static_mutex_lock(&task_mutex);
-       task_list = g_slist_remove(task_list, task);
-       g_static_mutex_unlock(&task_mutex);
+       connman_rtnl_send_getlink();
+}
+
+static void supplicant_disconnect(DBusConnection *connection, void *user_data)
+{
+       GSList *list;
+
+       DBG("connection %p", connection);
+
+       connman_rtnl_unregister(&wifi_rtnl);
 
-       remove_interface(task);
+       for (list = device_list; list; list = list->next) {
+               struct connman_element *device = list->data;
 
-       g_free(task->ifname);
-       g_free(task);
+               connman_element_unregister(device);
+               connman_element_unref(device);
+       }
+
+       g_slist_free(device_list);
+       device_list = NULL;
+
+       __supplicant_exit();
 }
 
-static struct connman_driver wifi_driver = {
-       .name           = "wifi",
-       .type           = CONNMAN_ELEMENT_TYPE_DEVICE,
-       .subtype        = CONNMAN_ELEMENT_SUBTYPE_WIFI,
-       .probe          = wifi_probe,
-       .remove         = wifi_remove,
-};
+static DBusConnection *connection;
+static guint watch;
 
 static int wifi_init(void)
 {
@@ -335,21 +481,40 @@ static int wifi_init(void)
        if (connection == NULL)
                return -EIO;
 
+       err = connman_driver_register(&network_driver);
+       if (err < 0) {
+               dbus_connection_unref(connection);
+               return err;
+       }
+
        err = connman_driver_register(&wifi_driver);
        if (err < 0) {
+               connman_driver_unregister(&network_driver);
                dbus_connection_unref(connection);
                return err;
        }
 
+       watch = g_dbus_add_service_watch(connection, SUPPLICANT_NAME,
+                       supplicant_connect, supplicant_disconnect, NULL, NULL);
+
+       if (g_dbus_check_service(connection, SUPPLICANT_NAME) == TRUE)
+               supplicant_connect(connection, NULL);
+
        return 0;
 }
 
 static void wifi_exit(void)
 {
+       connman_driver_unregister(&network_driver);
        connman_driver_unregister(&wifi_driver);
 
+       if (watch > 0)
+               g_dbus_remove_watch(connection, watch);
+
+       supplicant_disconnect(connection, NULL);
+
        dbus_connection_unref(connection);
 }
 
-CONNMAN_PLUGIN_DEFINE("WiFi", "WiFi interface plugin", VERSION,
+CONNMAN_PLUGIN_DEFINE(wifi, "WiFi interface plugin", VERSION,
                                                        wifi_init, wifi_exit)