ethernet: Add USB CDC tethering support
[platform/upstream/connman.git] / plugins / ethernet.c
index b05c78b..71dff3f 100644 (file)
@@ -2,7 +2,7 @@
  *
  *  Connection Manager
  *
- *  Copyright (C) 2007-2008  Intel Corporation. All rights reserved.
+ *  Copyright (C) 2007-2010  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
 #include <config.h>
 #endif
 
-#include <unistd.h>
-#include <string.h>
-#include <sys/ioctl.h>
-#include <sys/socket.h>
-#include <linux/if.h>
-#include <linux/netlink.h>
-#include <linux/rtnetlink.h>
+#include <errno.h>
+#include <net/if.h>
 
+#ifndef IFF_LOWER_UP
+#define IFF_LOWER_UP   0x10000
+#endif
+
+#include <glib.h>
+
+#define CONNMAN_API_SUBJECT_TO_CHANGE
+#include <connman/technology.h>
 #include <connman/plugin.h>
-#include <connman/driver.h>
+#include <connman/device.h>
+#include <connman/inet.h>
+#include <connman/rtnl.h>
 #include <connman/log.h>
 
 struct ethernet_data {
        int index;
-       short flags;
+       unsigned flags;
+       unsigned int watch;
+       struct connman_network *network;
 };
 
-static GStaticMutex ethernet_mutex = G_STATIC_MUTEX_INIT;
-static GSList *ethernet_list = NULL;
-
-static void rtnl_link(struct nlmsghdr *hdr, const char *type)
+static int cable_probe(struct connman_network *network)
 {
-       GSList *list;
-       struct ifinfomsg *msg;
-       int bytes;
+       DBG("network %p", network);
 
-       msg = (struct ifinfomsg *) NLMSG_DATA(hdr);
-       bytes = IFLA_PAYLOAD(hdr);
+       return 0;
+}
 
-       DBG("%s ifi_index %d ifi_flags 0x%04x",
-                               type, msg->ifi_index, msg->ifi_flags);
+static void cable_remove(struct connman_network *network)
+{
+       DBG("network %p", network);
+}
 
-       g_static_mutex_lock(&ethernet_mutex);
+static int cable_connect(struct connman_network *network)
+{
+       DBG("network %p", network);
 
-       for (list = ethernet_list; list; list = list->next) {
-               struct connman_element *element = list->data;
-               struct connman_element *netdev;
-               struct ethernet_data *ethernet;
+       return 0;
+}
 
-               ethernet = connman_element_get_data(element);
-               if (ethernet == NULL)
-                       continue;
+static int cable_disconnect(struct connman_network *network)
+{
+       DBG("network %p", network);
 
-               if (ethernet->index != msg->ifi_index)
-                       continue;
+       return 0;
+}
 
-               if ((ethernet->flags & IFF_RUNNING) ==
-                                       (msg->ifi_flags & IFF_RUNNING))
-                       continue;
+static struct connman_network_driver cable_driver = {
+       .name           = "cable",
+       .type           = CONNMAN_NETWORK_TYPE_ETHERNET,
+       .probe          = cable_probe,
+       .remove         = cable_remove,
+       .connect        = cable_connect,
+       .disconnect     = cable_disconnect,
+};
 
-               ethernet->flags = msg->ifi_flags;
+static void add_network(struct connman_device *device)
+{
+       struct connman_network *network;
+       int index;
 
-               if (ethernet->flags & IFF_RUNNING) {
-                       DBG("carrier on");
+       network = connman_network_create("carrier",
+                                       CONNMAN_NETWORK_TYPE_ETHERNET);
+       if (network == NULL)
+               return;
 
-                       netdev = connman_element_create(NULL);
-                       if (netdev != NULL) {
-                               netdev->type    = CONNMAN_ELEMENT_TYPE_DEVICE;
-                               netdev->subtype = CONNMAN_ELEMENT_SUBTYPE_NETWORK;
-                               netdev->index   = element->index;
+       index = connman_device_get_index(device);
+       connman_network_set_index(network, index);
 
-                               connman_element_register(netdev, element);
-                       }
-               } else {
-                       DBG("carrier off");
+       connman_network_set_name(network, "Wired");
 
-                       connman_element_unregister_children(element);
-               }
+       if (connman_device_add_network(device, network) < 0) {
+               connman_network_unref(network);
+               return;
        }
 
-       g_static_mutex_unlock(&ethernet_mutex);
+       connman_network_set_available(network, TRUE);
+
+       connman_network_set_group(network, "cable");
+
+       connman_network_set_connected(network, TRUE);
 }
 
-static gboolean rtnl_event(GIOChannel *chan, GIOCondition cond, gpointer data)
+static void ethernet_newlink(unsigned flags, unsigned change, void *user_data)
 {
-       unsigned char buf[1024];
-       void *ptr = buf;
-       gsize len;
-       GIOError err;
-
-       if (cond & (G_IO_NVAL | G_IO_HUP | G_IO_ERR))
-               return FALSE;
+       struct connman_device *device = user_data;
+       struct ethernet_data *ethernet = connman_device_get_data(device);
 
-       memset(buf, 0, sizeof(buf));
+       DBG("index %d flags %d change %d", ethernet->index, flags, change);
 
-       err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len);
-       if (err) {
-               if (err == G_IO_ERROR_AGAIN)
-                       return TRUE;
-               return FALSE;
+       if ((ethernet->flags & IFF_UP) != (flags & IFF_UP)) {
+               if (flags & IFF_UP) {
+                       DBG("power on");
+                       connman_device_set_powered(device, TRUE);
+               } else {
+                       DBG("power off");
+                       connman_device_set_powered(device, FALSE);
+               }
        }
 
-       DBG("buf %p len %zd", buf, len);
-
-       while (len > 0) {
-               struct nlmsghdr *hdr = ptr;
-               struct nlmsgerr *err;
-
-               if (!NLMSG_OK(hdr, len))
-                       break;
-
-               DBG("len %d type %d flags 0x%04x seq %d",
-                                       hdr->nlmsg_len, hdr->nlmsg_type,
-                                       hdr->nlmsg_flags, hdr->nlmsg_seq);
-
-               switch (hdr->nlmsg_type) {
-               case NLMSG_ERROR:
-                       err = NLMSG_DATA(hdr);
-                       DBG("ERROR %d (%s)", -err->error,
-                                               strerror(-err->error));
-                       break;
-
-               case RTM_NEWLINK:
-                       rtnl_link(hdr, "NEWLINK");
-                       break;
-
-               case RTM_DELLINK:
-                       rtnl_link(hdr, "DELLINK");
-                       break;
+       if ((ethernet->flags & IFF_LOWER_UP) != (flags & IFF_LOWER_UP)) {
+               if (flags & IFF_LOWER_UP) {
+                       DBG("carrier on");
+                       add_network(device);
+               } else {
+                       DBG("carrier off");
+                       connman_device_remove_all_networks(device);
                }
-
-               len -= hdr->nlmsg_len;
-               ptr += hdr->nlmsg_len;
        }
 
-       return TRUE;
+       ethernet->flags = flags;
 }
 
-static GIOChannel *channel;
-
-static int rtnl_request(void)
+static int ethernet_probe(struct connman_device *device)
 {
-       struct {
-               struct nlmsghdr hdr;
-               struct rtgenmsg msg;
-       } req;
+       struct ethernet_data *ethernet;
 
-       struct sockaddr_nl addr;
-       int sk;
+       DBG("device %p", device);
 
-       DBG("");
+       ethernet = g_try_new0(struct ethernet_data, 1);
+       if (ethernet == NULL)
+               return -ENOMEM;
 
-       memset(&req, 0, sizeof(req));
-       req.hdr.nlmsg_len = sizeof(req.hdr) + sizeof(req.msg);
-       req.hdr.nlmsg_type = RTM_GETLINK;
-       req.hdr.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
-       req.hdr.nlmsg_pid = 0;
-       req.hdr.nlmsg_seq = 42;
-       req.msg.rtgen_family = AF_INET;
+       connman_device_set_data(device, ethernet);
 
-       sk = g_io_channel_unix_get_fd(channel);
+       ethernet->index = connman_device_get_index(device);
+       ethernet->flags = 0;
 
-       memset(&addr, 0, sizeof(addr));
-       addr.nl_family = AF_NETLINK;
+       ethernet->watch = connman_rtnl_add_newlink_watch(ethernet->index,
+                                               ethernet_newlink, device);
 
-       return sendto(sk, &req, sizeof(req), 0,
-                       (struct sockaddr *) &addr, sizeof(addr));
+       return 0;
 }
 
-static int iface_up(struct ethernet_data *ethernet)
+static void ethernet_remove(struct connman_device *device)
 {
-       struct ifreq ifr;
-       int sk, err;
-
-       DBG("index %d flags %d", ethernet->index, ethernet->flags);
-
-       sk = socket(PF_INET, SOCK_DGRAM, 0);
-       if (sk < 0)
-               return -errno;
-
-       memset(&ifr, 0, sizeof(ifr));
-       ifr.ifr_ifindex = ethernet->index;
-
-       if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
-               err = -errno;
-               goto done;
-       }
-
-       if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
-               err = -errno;
-               goto done;
-       }
-
-       if (ifr.ifr_flags & IFF_UP) {
-               err = -EALREADY;
-               goto done;
-       }
+       struct ethernet_data *ethernet = connman_device_get_data(device);
 
-       ifr.ifr_flags |= IFF_UP;
+       DBG("device %p", device);
 
-       if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0) {
-               err = -errno;
-               goto done;
-       }
+       connman_device_set_data(device, NULL);
 
-       err = 0;
+       connman_rtnl_remove_watch(ethernet->watch);
 
-done:
-       close(sk);
+       connman_device_remove_all_networks(device);
 
-       return err;
+       g_free(ethernet);
 }
 
-static int iface_down(struct ethernet_data *ethernet)
+static int ethernet_enable(struct connman_device *device)
 {
-       struct ifreq ifr;
-       int sk, err;
+       struct ethernet_data *ethernet = connman_device_get_data(device);
 
-       DBG("index %d flags %d", ethernet->index, ethernet->flags);
+       DBG("device %p", device);
 
-       sk = socket(PF_INET, SOCK_DGRAM, 0);
-       if (sk < 0)
-               return -errno;
+       return connman_inet_ifup(ethernet->index);
+}
 
-       memset(&ifr, 0, sizeof(ifr));
-       ifr.ifr_ifindex = ethernet->index;
+static int ethernet_disable(struct connman_device *device)
+{
+       struct ethernet_data *ethernet = connman_device_get_data(device);
 
-       if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
-               err = -errno;
-               goto done;
-       }
+       DBG("device %p", device);
 
-       if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
-               err = -errno;
-               goto done;
-       }
+       return connman_inet_ifdown(ethernet->index);
+}
 
-       if (!(ifr.ifr_flags & IFF_UP)) {
-               err = -EALREADY;
-               goto done;
-       }
+static struct connman_device_driver ethernet_driver = {
+       .name           = "ethernet",
+       .type           = CONNMAN_DEVICE_TYPE_ETHERNET,
+       .probe          = ethernet_probe,
+       .remove         = ethernet_remove,
+       .enable         = ethernet_enable,
+       .disable        = ethernet_disable,
+};
 
-       ifr.ifr_flags &= ~IFF_UP;
+static GList *cdc_interface_list = NULL;
 
-       if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0)
-               err = -errno;
-       else
-               err = 0;
+static void tech_add_interface(struct connman_technology *technology,
+                       int index, const char *name, const char *ident)
+{
+       DBG("index %d name %s ident %s", index, name, ident);
 
-done:
-       close(sk);
+       if (g_list_find(cdc_interface_list,
+                       GINT_TO_POINTER((int) index)) != NULL)
+               return;
 
-       return err;
+       cdc_interface_list = g_list_prepend(cdc_interface_list,
+                                       (GINT_TO_POINTER((int) index)));
 }
 
-static int ethernet_probe(struct connman_element *element)
+static void tech_remove_interface(struct connman_technology *technology,
+                                                               int index)
 {
-       struct ethernet_data *ethernet;
-
-       DBG("element %p name %s", element, element->name);
-
-       ethernet = g_try_new0(struct ethernet_data, 1);
-       if (ethernet == NULL)
-               return -ENOMEM;
-
-       g_static_mutex_lock(&ethernet_mutex);
-       ethernet_list = g_slist_append(ethernet_list, element);
-       g_static_mutex_unlock(&ethernet_mutex);
-
-       connman_element_set_data(element, ethernet);
-
-       ethernet->index = element->index;
-
-       iface_up(ethernet);
+       DBG("index %d", index);
 
-       rtnl_request();
-
-       return 0;
+       cdc_interface_list = g_list_remove(cdc_interface_list,
+                                       GINT_TO_POINTER((int) index));
 }
 
-static void ethernet_remove(struct connman_element *element)
+static void enable_tethering(struct connman_technology *technology,
+                                               const char *bridge)
 {
-       struct ethernet_data *ethernet = connman_element_get_data(element);
+       GList *list;
 
-       DBG("element %p name %s", element, element->name);
+       for (list = cdc_interface_list; list; list = list->next) {
+               int index = GPOINTER_TO_INT(list->data);
 
-       connman_element_set_data(element, NULL);
+               connman_inet_ifup(index);
 
-       iface_down(ethernet);
+               connman_inet_add_to_bridge(index, bridge);
 
-       g_static_mutex_lock(&ethernet_mutex);
-       ethernet_list = g_slist_remove(ethernet_list, element);
-       g_static_mutex_unlock(&ethernet_mutex);
-
-       g_free(ethernet);
+               connman_technology_tethering_notify(technology, TRUE);
+       }
 }
 
-static struct connman_driver ethernet_driver = {
-       .name           = "ethernet",
-       .type           = CONNMAN_ELEMENT_TYPE_DEVICE,
-       .subtype        = CONNMAN_ELEMENT_SUBTYPE_ETHERNET,
-       .probe          = ethernet_probe,
-       .remove         = ethernet_remove,
-};
-
-static int rtnl_init(void)
+static void disable_tethering(struct connman_technology *technology,
+                                               const char *bridge)
 {
-       struct sockaddr_nl addr;
-       int sk, err;
+       GList *list;
 
-       DBG("");
+       for (list = cdc_interface_list; list; list = list->next) {
+               int index = GPOINTER_TO_INT(list->data);
 
-       sk = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE);
-       if (sk < 0)
-               return -errno;
+               connman_inet_remove_from_bridge(index, bridge);
 
-       memset(&addr, 0, sizeof(addr));
-       addr.nl_family = AF_NETLINK;
-       addr.nl_groups = RTMGRP_LINK;
+               connman_inet_ifdown(index);
 
-       if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
-               err = -errno;
-               close(sk);
-               return err;
+               connman_technology_tethering_notify(technology, FALSE);
        }
+}
 
-       channel = g_io_channel_unix_new(sk);
-       g_io_channel_set_close_on_unref(channel, TRUE);
+static int tech_set_tethering(struct connman_technology *technology,
+                               const char *bridge, connman_bool_t enabled)
+{
+       DBG("bridge %s enabled %d", bridge, enabled);
 
-       g_io_add_watch(channel, G_IO_IN | G_IO_NVAL | G_IO_HUP | G_IO_ERR,
-                                                       rtnl_event, NULL);
+       if (enabled)
+               enable_tethering(technology, bridge);
+       else
+               disable_tethering(technology, bridge);
+
+       return 0;
+}
 
+static int tech_probe(struct connman_technology *technology)
+{
        return 0;
 }
 
-static void rtnl_cleanup(void)
+static void tech_remove(struct connman_technology *technology)
 {
-       DBG("");
+       g_list_free(cdc_interface_list);
 
-       g_io_channel_shutdown(channel, TRUE, NULL);
-       g_io_channel_unref(channel);
+       cdc_interface_list = NULL;
 }
 
+static struct connman_technology_driver tech_driver = {
+       .name                   = "cdc_ethernet",
+       .type                   = CONNMAN_SERVICE_TYPE_GADGET,
+       .probe                  = tech_probe,
+       .remove                 = tech_remove,
+       .add_interface          = tech_add_interface,
+       .remove_interface       = tech_remove_interface,
+       .set_tethering          = tech_set_tethering,
+};
+
 static int ethernet_init(void)
 {
        int err;
 
-       err = rtnl_init();
+       err = connman_network_driver_register(&cable_driver);
        if (err < 0)
                return err;
 
-       err = connman_driver_register(&ethernet_driver);
+       err = connman_device_driver_register(&ethernet_driver);
+       if (err < 0) {
+               connman_network_driver_unregister(&cable_driver);
+               return err;
+       }
+
+       err = connman_technology_driver_register(&tech_driver);
        if (err < 0) {
-               rtnl_cleanup();
+               connman_device_driver_unregister(&ethernet_driver);
+               connman_network_driver_unregister(&cable_driver);
                return err;
        }
 
@@ -375,10 +319,12 @@ static int ethernet_init(void)
 
 static void ethernet_exit(void)
 {
-       connman_driver_unregister(&ethernet_driver);
+       connman_technology_driver_unregister(&tech_driver);
+
+       connman_network_driver_unregister(&cable_driver);
 
-       rtnl_cleanup();
+       connman_device_driver_unregister(&ethernet_driver);
 }
 
-CONNMAN_PLUGIN_DEFINE("ethernet", "Ethernet interface plugin", VERSION,
-                                               ethernet_init, ethernet_exit)
+CONNMAN_PLUGIN_DEFINE(ethernet, "Ethernet interface plugin", VERSION,
+               CONNMAN_PLUGIN_PRIORITY_DEFAULT, ethernet_init, ethernet_exit)