plugins/ethernet.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2008  Intel Corporation. All rights reserved.
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License version 2 as
   9  *  published by the Free Software Foundation.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  19  *
  20  */
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <unistd.h>
  27 #include <string.h>
  28 #include <sys/ioctl.h>
  29 #include <sys/socket.h>
  30 #include <linux/if.h>
  31 #include <linux/netlink.h>
  32 #include <linux/rtnetlink.h>
  33
  34 #include <connman/plugin.h>
  35 #include <connman/driver.h>
  36 #include <connman/rtnl.h>
  37 #include <connman/log.h>
  38
  39 struct ethernet_data {
  40         int index;
  41         unsigned flags;
  42 };
  43
  44 static GSList *ethernet_list = NULL;
  45
  46 static void ethernet_newlink(unsigned short type, int index,
  47                                         unsigned flags, unsigned change)
  48 {
  49         GSList *list;
  50
  51         DBG("index %d flags %ld change %ld", index, flags, change);
  52
  53         for (list = ethernet_list; list; list = list->next) {
  54                 struct connman_element *element = list->data;
  55                 struct connman_element *netdev;
  56                 struct ethernet_data *ethernet;
  57
  58                 ethernet = connman_element_get_data(element);
  59                 if (ethernet == NULL)
  60                         continue;
  61
  62                 if (ethernet->index != index)
  63                         continue;
  64
  65                 if ((ethernet->flags & IFF_LOWER_UP) == (flags & IFF_LOWER_UP))
  66                         continue;
  67
  68                 ethernet->flags = flags;
  69
  70                 if (ethernet->flags & IFF_LOWER_UP) {
  71                         DBG("carrier on");
  72
  73                         netdev = connman_element_create(NULL);
  74                         if (netdev != NULL) {
  75                                 netdev->type    = CONNMAN_ELEMENT_TYPE_DEVICE;
  76                                 netdev->subtype = CONNMAN_ELEMENT_SUBTYPE_NETWORK;
  77                                 netdev->index   = element->index;
  78
  79                                 connman_element_register(netdev, element);
  80                         }
  81                 } else {
  82                         DBG("carrier off");
  83
  84                         connman_element_unregister_children(element);
  85                 }
  86         }
  87 }
  88
  89 static struct connman_rtnl ethernet_rtnl = {
  90         .name           = "ethernet",
  91         .newlink        = ethernet_newlink,
  92 };
  93
  94 static int iface_up(struct ethernet_data *ethernet)
  95 {
  96         struct ifreq ifr;
  97         int sk, err;
  98
  99         DBG("index %d flags %d", ethernet->index, ethernet->flags);
 100
 101         sk = socket(PF_INET, SOCK_DGRAM, 0);
 102         if (sk < 0)
 103                 return -errno;
 104
 105         memset(&ifr, 0, sizeof(ifr));
 106         ifr.ifr_ifindex = ethernet->index;
 107
 108         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 109                 err = -errno;
 110                 goto done;
 111         }
 112
 113         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
 114                 err = -errno;
 115                 goto done;
 116         }
 117
 118         if (ifr.ifr_flags & IFF_UP) {
 119                 err = -EALREADY;
 120                 goto done;
 121         }
 122
 123         ifr.ifr_flags |= IFF_UP;
 124
 125         if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0) {
 126                 err = -errno;
 127                 goto done;
 128         }
 129
 130         err = 0;
 131
 132 done:
 133         close(sk);
 134
 135         return err;
 136 }
 137
 138 static int iface_down(struct ethernet_data *ethernet)
 139 {
 140         struct ifreq ifr;
 141         int sk, err;
 142
 143         DBG("index %d flags %d", ethernet->index, ethernet->flags);
 144
 145         sk = socket(PF_INET, SOCK_DGRAM, 0);
 146         if (sk < 0)
 147                 return -errno;
 148
 149         memset(&ifr, 0, sizeof(ifr));
 150         ifr.ifr_ifindex = ethernet->index;
 151
 152         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 153                 err = -errno;
 154                 goto done;
 155         }
 156
 157         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
 158                 err = -errno;
 159                 goto done;
 160         }
 161
 162         if (!(ifr.ifr_flags & IFF_UP)) {
 163                 err = -EALREADY;
 164                 goto done;
 165         }
 166
 167         ifr.ifr_flags &= ~IFF_UP;
 168
 169         if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0)
 170                 err = -errno;
 171         else
 172                 err = 0;
 173
 174 done:
 175         close(sk);
 176
 177         return err;
 178 }
 179
 180 static int ethernet_probe(struct connman_element *element)
 181 {
 182         struct ethernet_data *ethernet;
 183
 184         DBG("element %p name %s", element, element->name);
 185
 186         ethernet = g_try_new0(struct ethernet_data, 1);
 187         if (ethernet == NULL)
 188                 return -ENOMEM;
 189
 190         ethernet_list = g_slist_append(ethernet_list, element);
 191
 192         connman_element_set_data(element, ethernet);
 193
 194         ethernet->index = element->index;
 195
 196         connman_rtnl_send_getlink();
 197
 198         return 0;
 199 }
 200
 201 static void ethernet_remove(struct connman_element *element)
 202 {
 203         struct ethernet_data *ethernet = connman_element_get_data(element);
 204
 205         DBG("element %p name %s", element, element->name);
 206
 207         connman_element_set_data(element, NULL);
 208
 209         ethernet_list = g_slist_remove(ethernet_list, element);
 210
 211         g_free(ethernet);
 212 }
 213
 214 static int ethernet_enable(struct connman_element *element)
 215 {
 216         struct ethernet_data *ethernet = connman_element_get_data(element);
 217
 218         DBG("element %p name %s", element, element->name);
 219
 220         iface_up(ethernet);
 221
 222         return 0;
 223 }
 224
 225 static int ethernet_disable(struct connman_element *element)
 226 {
 227         struct ethernet_data *ethernet = connman_element_get_data(element);
 228
 229         DBG("element %p name %s", element, element->name);
 230
 231         iface_down(ethernet);
 232
 233         return 0;
 234 }
 235
 236 static struct connman_driver ethernet_driver = {
 237         .name           = "ethernet",
 238         .type           = CONNMAN_ELEMENT_TYPE_DEVICE,
 239         .subtype        = CONNMAN_ELEMENT_SUBTYPE_ETHERNET,
 240         .probe          = ethernet_probe,
 241         .remove         = ethernet_remove,
 242         .enable         = ethernet_enable,
 243         .disable        = ethernet_disable,
 244 };
 245
 246 static int ethernet_init(void)
 247 {
 248         int err;
 249
 250         err = connman_rtnl_register(&ethernet_rtnl);
 251         if (err < 0)
 252                 return err;
 253
 254         err = connman_driver_register(&ethernet_driver);
 255         if (err < 0) {
 256                 connman_rtnl_unregister(&ethernet_rtnl);
 257                 return err;
 258         }
 259
 260         return 0;
 261 }
 262
 263 static void ethernet_exit(void)
 264 {
 265         connman_driver_unregister(&ethernet_driver);
 266
 267         connman_rtnl_unregister(&ethernet_rtnl);
 268 }
 269
 270 CONNMAN_PLUGIN_DEFINE(ethernet, "Ethernet interface plugin", VERSION,
 271                                                 ethernet_init, ethernet_exit)