git.maemo.org Git - connman/blob - src/detect.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2009  Intel Corporation. All rights reserved.
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License version 2 as
   9  *  published by the Free Software Foundation.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  19  *
  20  */
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <stdio.h>
  27 #include <errno.h>
  28 #include <unistd.h>
  29 #include <stdlib.h>
  30 #include <string.h>
  31 #include <sys/stat.h>
  32 #include <sys/ioctl.h>
  33 #include <sys/socket.h>
  34 #include <net/ethernet.h>
  35 #include <linux/if_arp.h>
  36 #include <linux/wireless.h>
  37
  38 #include <glib.h>
  39
  40 #include "connman.h"
  41
  42 static GSList *device_list = NULL;
  43
  44 static struct connman_device *find_device(int index)
  45 {
  46         GSList *list;
  47
  48         for (list = device_list; list; list = list->next) {
  49                 struct connman_device *device = list->data;
  50
  51                 if (connman_device_get_index(device) == index)
  52                         return device;
  53         }
  54
  55         return NULL;
  56 }
  57
  58 static char *index2name(int index)
  59 {
  60         struct ifreq ifr;
  61         int sk, err;
  62
  63         if (index < 0)
  64                 return NULL;
  65
  66         sk = socket(PF_INET, SOCK_DGRAM, 0);
  67         if (sk < 0)
  68                 return NULL;
  69
  70         memset(&ifr, 0, sizeof(ifr));
  71         ifr.ifr_ifindex = index;
  72
  73         err = ioctl(sk, SIOCGIFNAME, &ifr);
  74
  75         close(sk);
  76
  77         if (err < 0)
  78                 return NULL;
  79
  80         return strdup(ifr.ifr_name);
  81 }
  82
  83 static char *index2addr(int index)
  84 {
  85         struct ifreq ifr;
  86         struct ether_addr *eth;
  87         char *str;
  88         int sk, err;
  89
  90         if (index < 0)
  91                 return NULL;
  92
  93         sk = socket(PF_INET, SOCK_DGRAM, 0);
  94         if (sk < 0)
  95                 return NULL;
  96
  97         memset(&ifr, 0, sizeof(ifr));
  98         ifr.ifr_ifindex = index;
  99
 100         err = ioctl(sk, SIOCGIFNAME, &ifr);
 101
 102         if (err == 0)
 103                 err = ioctl(sk, SIOCGIFHWADDR, &ifr);
 104
 105         close(sk);
 106
 107         if (err < 0)
 108                 return NULL;
 109
 110         str = malloc(18);
 111         if (!str)
 112                 return NULL;
 113
 114         eth = (void *) &ifr.ifr_hwaddr.sa_data;
 115         snprintf(str, 18, "%02X:%02X:%02X:%02X:%02X:%02X",
 116                                                 eth->ether_addr_octet[0],
 117                                                 eth->ether_addr_octet[1],
 118                                                 eth->ether_addr_octet[2],
 119                                                 eth->ether_addr_octet[3],
 120                                                 eth->ether_addr_octet[4],
 121                                                 eth->ether_addr_octet[5]);
 122
 123         return str;
 124 }
 125
 126 static char *index2ident(int index, const char *prefix)
 127 {
 128         struct ifreq ifr;
 129         struct ether_addr *eth;
 130         char *str;
 131         int sk, err, len;
 132
 133         if (index < 0)
 134                 return NULL;
 135
 136         sk = socket(PF_INET, SOCK_DGRAM, 0);
 137         if (sk < 0)
 138                 return NULL;
 139
 140         memset(&ifr, 0, sizeof(ifr));
 141         ifr.ifr_ifindex = index;
 142
 143         err = ioctl(sk, SIOCGIFNAME, &ifr);
 144
 145         if (err == 0)
 146                 err = ioctl(sk, SIOCGIFHWADDR, &ifr);
 147
 148         close(sk);
 149
 150         if (err < 0)
 151                 return NULL;
 152
 153         len = prefix ? strlen(prefix) + 18 : 18;
 154
 155         str = malloc(len);
 156         if (!str)
 157                 return NULL;
 158
 159         eth = (void *) &ifr.ifr_hwaddr.sa_data;
 160         snprintf(str, len, "%s%02x%02x%02x%02x%02x%02x",
 161                                                 prefix ? prefix : "",
 162                                                 eth->ether_addr_octet[0],
 163                                                 eth->ether_addr_octet[1],
 164                                                 eth->ether_addr_octet[2],
 165                                                 eth->ether_addr_octet[3],
 166                                                 eth->ether_addr_octet[4],
 167                                                 eth->ether_addr_octet[5]);
 168
 169         return str;
 170 }
 171
 172 static void detect_newlink(unsigned short type, int index,
 173                                         unsigned flags, unsigned change)
 174 {
 175         enum connman_device_type devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
 176         enum connman_device_mode mode = CONNMAN_DEVICE_MODE_UNKNOWN;
 177         struct connman_device *device;
 178         char *addr, *name, *devname, *ident = NULL;
 179
 180         DBG("type %d index %d", type, index);
 181
 182         device = find_device(index);
 183         if (device != NULL)
 184                 return;
 185
 186         devname = index2name(index);
 187         if (devname == NULL)
 188                 return;
 189
 190         if (type == ARPHRD_ETHER) {
 191                 char bridge_path[PATH_MAX], wimax_path[PATH_MAX];
 192                 struct stat st;
 193                 struct iwreq iwr;
 194                 int sk;
 195
 196                 snprintf(bridge_path, PATH_MAX,
 197                                         "/sys/class/net/%s/bridge", devname);
 198                 snprintf(wimax_path, PATH_MAX,
 199                                         "/sys/class/net/%s/wimax", devname);
 200
 201                 memset(&iwr, 0, sizeof(iwr));
 202                 strncpy(iwr.ifr_ifrn.ifrn_name, devname, IFNAMSIZ);
 203
 204                 sk = socket(PF_INET, SOCK_DGRAM, 0);
 205
 206                 if (g_str_has_prefix(devname, "vmnet") == TRUE ||
 207                                 g_str_has_prefix(devname, "vboxnet") == TRUE) {
 208                         connman_info("Ignoring network interface %s", devname);
 209                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
 210                 } else if (g_str_has_prefix(devname, "bnep") == TRUE)
 211                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
 212                 else if (g_str_has_prefix(devname, "wmx") == TRUE)
 213                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
 214                 else if (stat(wimax_path, &st) == 0 && (st.st_mode & S_IFDIR))
 215                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
 216                 else if (stat(bridge_path, &st) == 0 && (st.st_mode & S_IFDIR))
 217                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
 218                 else if (ioctl(sk, SIOCGIWNAME, &iwr) == 0)
 219                         devtype = CONNMAN_DEVICE_TYPE_WIFI;
 220                 else
 221                         devtype = CONNMAN_DEVICE_TYPE_ETHERNET;
 222
 223                 close(sk);
 224         } else if (type == ARPHRD_NONE) {
 225                 if (g_str_has_prefix(devname, "hso") == TRUE)
 226                         devtype = CONNMAN_DEVICE_TYPE_HSO;
 227         }
 228
 229         switch (devtype) {
 230         case CONNMAN_DEVICE_TYPE_UNKNOWN:
 231                 g_free(devname);
 232                 return;
 233         case CONNMAN_DEVICE_TYPE_ETHERNET:
 234         case CONNMAN_DEVICE_TYPE_WIFI:
 235         case CONNMAN_DEVICE_TYPE_WIMAX:
 236                 name = index2ident(index, "dev_");
 237                 addr = index2addr(index);
 238                 break;
 239         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
 240         case CONNMAN_DEVICE_TYPE_GPS:
 241         case CONNMAN_DEVICE_TYPE_HSO:
 242         case CONNMAN_DEVICE_TYPE_NOZOMI:
 243         case CONNMAN_DEVICE_TYPE_HUAWEI:
 244         case CONNMAN_DEVICE_TYPE_NOVATEL:
 245         case CONNMAN_DEVICE_TYPE_VENDOR:
 246                 name = strdup(devname);
 247                 addr = NULL;
 248                 break;
 249         }
 250
 251         device = connman_device_create(name, devtype);
 252         if (device == NULL) {
 253                 g_free(devname);
 254                 g_free(name);
 255                 g_free(addr);
 256                 return;
 257         }
 258
 259         switch (devtype) {
 260         case CONNMAN_DEVICE_TYPE_UNKNOWN:
 261         case CONNMAN_DEVICE_TYPE_VENDOR:
 262         case CONNMAN_DEVICE_TYPE_NOZOMI:
 263         case CONNMAN_DEVICE_TYPE_HUAWEI:
 264         case CONNMAN_DEVICE_TYPE_NOVATEL:
 265         case CONNMAN_DEVICE_TYPE_GPS:
 266                 mode = CONNMAN_DEVICE_MODE_UNKNOWN;
 267                 break;
 268         case CONNMAN_DEVICE_TYPE_ETHERNET:
 269                 mode = CONNMAN_DEVICE_MODE_TRANSPORT_IP;
 270                 ident = index2ident(index, NULL);
 271                 break;
 272         case CONNMAN_DEVICE_TYPE_WIFI:
 273         case CONNMAN_DEVICE_TYPE_WIMAX:
 274                 mode = CONNMAN_DEVICE_MODE_NETWORK_SINGLE;
 275                 ident = index2ident(index, NULL);
 276                 break;
 277         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
 278                 mode = CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE;
 279                 break;
 280         case CONNMAN_DEVICE_TYPE_HSO:
 281                 mode = CONNMAN_DEVICE_MODE_NETWORK_SINGLE;
 282                 connman_device_set_policy(device, CONNMAN_DEVICE_POLICY_MANUAL);
 283                 break;
 284         }
 285
 286         connman_device_set_mode(device, mode);
 287
 288         connman_device_set_index(device, index);
 289         connman_device_set_interface(device, devname);
 290
 291         if (ident != NULL) {
 292                 connman_device_set_ident(device, ident);
 293                 g_free(ident);
 294         }
 295
 296         connman_device_set_string(device, "Address", addr);
 297
 298         g_free(devname);
 299         g_free(name);
 300         g_free(addr);
 301
 302         if (connman_device_register(device) < 0) {
 303                 connman_device_unref(device);
 304                 return;
 305         }
 306
 307         device_list = g_slist_append(device_list, device);
 308 }
 309
 310 static void detect_dellink(unsigned short type, int index,
 311                                         unsigned flags, unsigned change)
 312 {
 313         struct connman_device *device;
 314
 315         DBG("type %d index %d", type, index);
 316
 317         device = find_device(index);
 318         if (device == NULL)
 319                 return;
 320
 321         device_list = g_slist_remove(device_list, device);
 322
 323         connman_device_unregister(device);
 324         connman_device_unref(device);
 325 }
 326
 327 static struct connman_rtnl detect_rtnl = {
 328         .name           = "detect",
 329         .priority       = CONNMAN_RTNL_PRIORITY_LOW,
 330         .newlink        = detect_newlink,
 331         .dellink        = detect_dellink,
 332 };
 333
 334 int __connman_detect_init(void)
 335 {
 336         int err;
 337
 338         err = connman_rtnl_register(&detect_rtnl);
 339         if (err < 0)
 340                 return err;
 341
 342         connman_rtnl_send_getlink();
 343
 344         return 0;
 345 }
 346
 347 void __connman_detect_cleanup(void)
 348 {
 349         GSList *list;
 350
 351         connman_rtnl_unregister(&detect_rtnl);
 352
 353         for (list = device_list; list; list = list->next) {
 354                 struct connman_device *device = list->data;
 355
 356                 connman_device_unregister(device);
 357                 connman_device_unref(device);
 358         }
 359
 360         g_slist_free(device_list);
 361         device_list = NULL;
 362 }