src/rtnl.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2013  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 <errno.h>
  27 #include <stdio.h>
  28 #include <unistd.h>
  29 #include <string.h>
  30 #include <sys/socket.h>
  31 #include <sys/ioctl.h>
  32 #include <arpa/inet.h>
  33 #include <netinet/ether.h>
  34 #include <netinet/icmp6.h>
  35 #include <net/if_arp.h>
  36 #include <linux/if.h>
  37 #include <linux/netlink.h>
  38 #include <linux/rtnetlink.h>
  39 #include <linux/wireless.h>
  40
  41 #include <glib.h>
  42
  43 #include "connman.h"
  44
  45 #ifndef ARPHDR_PHONET_PIPE
  46 #define ARPHDR_PHONET_PIPE (821)
  47 #endif
  48
  49 #define print(arg...) do { if (0) connman_info(arg); } while (0)
  50 //#define print(arg...) connman_info(arg)
  51
  52 struct watch_data {
  53         unsigned int id;
  54         int index;
  55         connman_rtnl_link_cb_t newlink;
  56         void *user_data;
  57 };
  58
  59 static GSList *watch_list = NULL;
  60 static unsigned int watch_id = 0;
  61
  62 static GSList *update_list = NULL;
  63 static guint update_interval = G_MAXUINT;
  64 static guint update_timeout = 0;
  65
  66 struct interface_data {
  67         int index;
  68         char *ident;
  69         enum connman_service_type service_type;
  70         enum connman_device_type device_type;
  71 };
  72
  73 static GHashTable *interface_list = NULL;
  74
  75 static void free_interface(gpointer data)
  76 {
  77         struct interface_data *interface = data;
  78
  79         __connman_technology_remove_interface(interface->service_type,
  80                         interface->index, interface->ident);
  81
  82         g_free(interface->ident);
  83         g_free(interface);
  84 }
  85
  86 static bool ether_blacklisted(const char *name)
  87 {
  88         if (!name)
  89                 return true;
  90
  91         if (__connman_device_isfiltered(name))
  92                 return true;
  93
  94         return false;
  95 }
  96
  97 static bool wext_interface(char *ifname)
  98 {
  99         struct iwreq wrq;
 100         int fd, err;
 101
 102         fd = socket(PF_INET, SOCK_DGRAM | SOCK_CLOEXEC, 0);
 103         if (fd < 0)
 104                 return false;
 105
 106         memset(&wrq, 0, sizeof(wrq));
 107         strncpy(wrq.ifr_name, ifname, sizeof(wrq.ifr_name) - 1);
 108
 109         err = ioctl(fd, SIOCGIWNAME, &wrq);
 110
 111         close(fd);
 112
 113         if (err < 0)
 114                 return false;
 115
 116         return true;
 117 }
 118
 119 static void read_uevent(struct interface_data *interface)
 120 {
 121         char *filename, *name, line[128];
 122         bool found_devtype;
 123         FILE *f;
 124
 125         name = connman_inet_ifname(interface->index);
 126
 127         if (ether_blacklisted(name)) {
 128                 interface->service_type = CONNMAN_SERVICE_TYPE_UNKNOWN;
 129                 interface->device_type = CONNMAN_DEVICE_TYPE_UNKNOWN;
 130                 goto out;
 131         } else {
 132                 interface->service_type = CONNMAN_SERVICE_TYPE_ETHERNET;
 133                 interface->device_type = CONNMAN_DEVICE_TYPE_ETHERNET;
 134         }
 135
 136         filename = g_strdup_printf("/sys/class/net/%s/uevent", name);
 137
 138         f = fopen(filename, "re");
 139
 140         g_free(filename);
 141
 142         if (!f) {
 143                 interface->service_type = CONNMAN_SERVICE_TYPE_UNKNOWN;
 144                 interface->device_type = CONNMAN_DEVICE_TYPE_UNKNOWN;
 145                 goto out;
 146         }
 147
 148         found_devtype = false;
 149         while (fgets(line, sizeof(line), f)) {
 150                 char *pos;
 151
 152                 pos = strchr(line, '\n');
 153                 if (!pos)
 154                         continue;
 155                 pos[0] = '\0';
 156
 157                 if (strncmp(line, "DEVTYPE=", 8) != 0)
 158                         continue;
 159
 160                 found_devtype = true;
 161
 162                 if (strcmp(line + 8, "wlan") == 0) {
 163                         interface->service_type = CONNMAN_SERVICE_TYPE_WIFI;
 164                         interface->device_type = CONNMAN_DEVICE_TYPE_WIFI;
 165                 } else if (strcmp(line + 8, "wwan") == 0) {
 166                         interface->service_type = CONNMAN_SERVICE_TYPE_CELLULAR;
 167                         interface->device_type = CONNMAN_DEVICE_TYPE_CELLULAR;
 168                 } else if (strcmp(line + 8, "bluetooth") == 0) {
 169                         interface->service_type = CONNMAN_SERVICE_TYPE_BLUETOOTH;
 170                         interface->device_type = CONNMAN_DEVICE_TYPE_BLUETOOTH;
 171                 } else if (strcmp(line + 8, "gadget") == 0) {
 172                         interface->service_type = CONNMAN_SERVICE_TYPE_GADGET;
 173                         interface->device_type = CONNMAN_DEVICE_TYPE_GADGET;
 174                 } else if (strcmp(line + 8, "vlan") == 0) {
 175                         interface->service_type = CONNMAN_SERVICE_TYPE_ETHERNET;
 176                         interface->device_type = CONNMAN_DEVICE_TYPE_ETHERNET;
 177                 } else if (strcmp(line + 8, "bond") == 0) {
 178                         interface->service_type = CONNMAN_SERVICE_TYPE_ETHERNET;
 179                         interface->device_type = CONNMAN_DEVICE_TYPE_ETHERNET;
 180                 } else if (strcmp(line + 8, "dsa") == 0) {
 181                         interface->service_type = CONNMAN_SERVICE_TYPE_ETHERNET;
 182                         interface->device_type = CONNMAN_DEVICE_TYPE_ETHERNET;
 183                 } else {
 184                         interface->service_type = CONNMAN_SERVICE_TYPE_UNKNOWN;
 185                         interface->device_type = CONNMAN_DEVICE_TYPE_UNKNOWN;
 186                 }
 187         }
 188
 189         fclose(f);
 190
 191         if (found_devtype)
 192                 goto out;
 193
 194         /* We haven't got a DEVTYPE, let's check if it's a wireless device */
 195         if (wext_interface(name)) {
 196                 interface->service_type = CONNMAN_SERVICE_TYPE_WIFI;
 197                 interface->device_type = CONNMAN_DEVICE_TYPE_WIFI;
 198
 199                 connman_error("%s runs an unsupported 802.11 driver", name);
 200         }
 201
 202 out:
 203         g_free(name);
 204 }
 205
 206 enum connman_device_type __connman_rtnl_get_device_type(int index)
 207 {
 208         struct interface_data *interface;
 209
 210         interface = g_hash_table_lookup(interface_list,
 211                                         GINT_TO_POINTER(index));
 212         if (!interface)
 213                 return CONNMAN_DEVICE_TYPE_UNKNOWN;
 214
 215         return interface->device_type;
 216 }
 217
 218 /**
 219  * connman_rtnl_add_newlink_watch:
 220  * @index: network device index
 221  * @callback: callback function
 222  * @user_data: callback data;
 223  *
 224  * Add a new RTNL watch for newlink events
 225  *
 226  * Returns: %0 on failure and a unique id on success
 227  */
 228 unsigned int connman_rtnl_add_newlink_watch(int index,
 229                         connman_rtnl_link_cb_t callback, void *user_data)
 230 {
 231         struct watch_data *watch;
 232
 233         watch = g_try_new0(struct watch_data, 1);
 234         if (!watch)
 235                 return 0;
 236
 237         watch->id = ++watch_id;
 238         watch->index = index;
 239
 240         watch->newlink = callback;
 241         watch->user_data = user_data;
 242
 243         watch_list = g_slist_prepend(watch_list, watch);
 244
 245         DBG("id %d", watch->id);
 246
 247         if (callback) {
 248                 unsigned int flags = __connman_ipconfig_get_flags_from_index(index);
 249
 250                 if (flags > 0)
 251                         callback(flags, 0, user_data);
 252         }
 253
 254         return watch->id;
 255 }
 256
 257 /**
 258  * connman_rtnl_remove_watch:
 259  * @id: watch identifier
 260  *
 261  * Remove the RTNL watch for the identifier
 262  */
 263 void connman_rtnl_remove_watch(unsigned int id)
 264 {
 265         GSList *list;
 266
 267         DBG("id %d", id);
 268
 269         if (id == 0)
 270                 return;
 271
 272         for (list = watch_list; list; list = list->next) {
 273                 struct watch_data *watch = list->data;
 274
 275                 if (watch->id  == id) {
 276                         watch_list = g_slist_remove(watch_list, watch);
 277                         g_free(watch);
 278                         break;
 279                 }
 280         }
 281 }
 282
 283 static void trigger_rtnl(int index, void *user_data)
 284 {
 285         struct connman_rtnl *rtnl = user_data;
 286
 287         if (rtnl->newlink) {
 288                 unsigned short type = __connman_ipconfig_get_type_from_index(index);
 289                 unsigned int flags = __connman_ipconfig_get_flags_from_index(index);
 290
 291                 rtnl->newlink(type, index, flags, 0);
 292         }
 293
 294         if (rtnl->newgateway) {
 295                 const char *gateway =
 296                         __connman_ipconfig_get_gateway_from_index(index,
 297                                         CONNMAN_IPCONFIG_TYPE_ALL);
 298
 299                 if (gateway)
 300                         rtnl->newgateway(index, gateway);
 301         }
 302 }
 303
 304 static GSList *rtnl_list = NULL;
 305
 306 static gint compare_priority(gconstpointer a, gconstpointer b)
 307 {
 308         const struct connman_rtnl *rtnl1 = a;
 309         const struct connman_rtnl *rtnl2 = b;
 310
 311         return rtnl2->priority - rtnl1->priority;
 312 }
 313
 314 /**
 315  * connman_rtnl_register:
 316  * @rtnl: RTNL module
 317  *
 318  * Register a new RTNL module
 319  *
 320  * Returns: %0 on success
 321  */
 322 int connman_rtnl_register(struct connman_rtnl *rtnl)
 323 {
 324         DBG("rtnl %p name %s", rtnl, rtnl->name);
 325
 326         rtnl_list = g_slist_insert_sorted(rtnl_list, rtnl,
 327                                                         compare_priority);
 328
 329         __connman_ipconfig_foreach(trigger_rtnl, rtnl);
 330
 331         return 0;
 332 }
 333
 334 /**
 335  * connman_rtnl_unregister:
 336  * @rtnl: RTNL module
 337  *
 338  * Remove a previously registered RTNL module
 339  */
 340 void connman_rtnl_unregister(struct connman_rtnl *rtnl)
 341 {
 342         DBG("rtnl %p name %s", rtnl, rtnl->name);
 343
 344         rtnl_list = g_slist_remove(rtnl_list, rtnl);
 345 }
 346
 347 static const char *operstate2str(unsigned char operstate)
 348 {
 349         switch (operstate) {
 350         case IF_OPER_UNKNOWN:
 351                 return "UNKNOWN";
 352         case IF_OPER_NOTPRESENT:
 353                 return "NOT-PRESENT";
 354         case IF_OPER_DOWN:
 355                 return "DOWN";
 356         case IF_OPER_LOWERLAYERDOWN:
 357                 return "LOWER-LAYER-DOWN";
 358         case IF_OPER_TESTING:
 359                 return "TESTING";
 360         case IF_OPER_DORMANT:
 361                 return "DORMANT";
 362         case IF_OPER_UP:
 363                 return "UP";
 364         }
 365
 366         return "";
 367 }
 368
 369 static bool extract_link(struct ifinfomsg *msg, int bytes,
 370                                 struct ether_addr *address, const char **ifname,
 371                                 unsigned int *mtu, unsigned char *operstate,
 372                                 struct rtnl_link_stats *stats)
 373 {
 374         struct rtattr *attr;
 375
 376         for (attr = IFLA_RTA(msg); RTA_OK(attr, bytes);
 377                                         attr = RTA_NEXT(attr, bytes)) {
 378                 switch (attr->rta_type) {
 379                 case IFLA_ADDRESS:
 380                         if (address)
 381                                 memcpy(address, RTA_DATA(attr), ETH_ALEN);
 382                         break;
 383                 case IFLA_IFNAME:
 384                         if (ifname)
 385                                 *ifname = RTA_DATA(attr);
 386                         break;
 387                 case IFLA_MTU:
 388                         if (mtu)
 389                                 *mtu = *((unsigned int *) RTA_DATA(attr));
 390                         break;
 391                 case IFLA_STATS:
 392                         if (stats)
 393                                 memcpy(stats, RTA_DATA(attr),
 394                                         sizeof(struct rtnl_link_stats));
 395                         break;
 396                 case IFLA_OPERSTATE:
 397                         if (operstate)
 398                                 *operstate = *((unsigned char *) RTA_DATA(attr));
 399                         break;
 400                 case IFLA_LINKMODE:
 401                         break;
 402                 case IFLA_WIRELESS:
 403                         return false;
 404                 }
 405         }
 406
 407         return true;
 408 }
 409
 410 static void process_newlink(unsigned short type, int index, unsigned flags,
 411                         unsigned change, struct ifinfomsg *msg, int bytes)
 412 {
 413         struct ether_addr address = {{ 0, 0, 0, 0, 0, 0 }};
 414         struct rtnl_link_stats stats;
 415         unsigned char operstate = 0xff;
 416         struct interface_data *interface;
 417         const char *ifname = NULL;
 418         unsigned int mtu = 0;
 419         char ident[13], str[18];
 420         GSList *list;
 421
 422         memset(&stats, 0, sizeof(stats));
 423         if (!extract_link(msg, bytes, &address, &ifname, &mtu, &operstate, &stats))
 424                 return;
 425
 426         snprintf(ident, 13, "%02x%02x%02x%02x%02x%02x",
 427                                                 address.ether_addr_octet[0],
 428                                                 address.ether_addr_octet[1],
 429                                                 address.ether_addr_octet[2],
 430                                                 address.ether_addr_octet[3],
 431                                                 address.ether_addr_octet[4],
 432                                                 address.ether_addr_octet[5]);
 433
 434         snprintf(str, 18, "%02X:%02X:%02X:%02X:%02X:%02X",
 435                                                 address.ether_addr_octet[0],
 436                                                 address.ether_addr_octet[1],
 437                                                 address.ether_addr_octet[2],
 438                                                 address.ether_addr_octet[3],
 439                                                 address.ether_addr_octet[4],
 440                                                 address.ether_addr_octet[5]);
 441
 442         if (flags & IFF_SLAVE) {
 443                 connman_info("%s {newlink} ignoring slave, index %d address %s",
 444                                                 ifname, index, str);
 445                 return;
 446         }
 447
 448         switch (type) {
 449         case ARPHRD_ETHER:
 450         case ARPHRD_LOOPBACK:
 451         case ARPHDR_PHONET_PIPE:
 452         case ARPHRD_PPP:
 453         case ARPHRD_NONE:
 454                 __connman_ipconfig_newlink(index, type, flags,
 455                                                         str, mtu, &stats);
 456                 break;
 457         }
 458
 459         connman_info("%s {newlink} index %d address %s mtu %u",
 460                                         ifname, index, str, mtu);
 461
 462         if (operstate != 0xff)
 463                 connman_info("%s {newlink} index %d operstate %u <%s>",
 464                                                 ifname, index, operstate,
 465                                                 operstate2str(operstate));
 466
 467         interface = g_hash_table_lookup(interface_list, GINT_TO_POINTER(index));
 468         if (!interface) {
 469                 interface = g_new0(struct interface_data, 1);
 470                 interface->index = index;
 471                 interface->ident = g_strdup(ident);
 472
 473                 g_hash_table_insert(interface_list,
 474                                         GINT_TO_POINTER(index), interface);
 475
 476                 if (type == ARPHRD_ETHER)
 477                         read_uevent(interface);
 478         } else if (type == ARPHRD_ETHER && interface->device_type == CONNMAN_DEVICE_TYPE_UNKNOWN)
 479                 read_uevent(interface);
 480         else
 481                 interface = NULL;
 482
 483         for (list = rtnl_list; list; list = list->next) {
 484                 struct connman_rtnl *rtnl = list->data;
 485
 486                 if (rtnl->newlink)
 487                         rtnl->newlink(type, index, flags, change);
 488         }
 489
 490         /*
 491          * The interface needs to be added after the newlink call.
 492          * The newlink will create the technology when needed and
 493          * __connman_technology_add_interface() expects the
 494          * technology to be there already.
 495          */
 496         if (interface)
 497                 __connman_technology_add_interface(interface->service_type,
 498                         interface->index, interface->ident);
 499
 500         list = watch_list;
 501         while (list) {
 502                 GSList *next = list->next;
 503                 struct watch_data *watch = list->data;
 504
 505                 if (watch->index == index && watch->newlink)
 506                         watch->newlink(flags, change, watch->user_data);
 507
 508                 list = next;
 509         }
 510 }
 511
 512 static void process_dellink(unsigned short type, int index, unsigned flags,
 513                         unsigned change, struct ifinfomsg *msg, int bytes)
 514 {
 515         struct rtnl_link_stats stats;
 516         unsigned char operstate = 0xff;
 517         const char *ifname = NULL;
 518         GSList *list;
 519
 520         memset(&stats, 0, sizeof(stats));
 521         if (!extract_link(msg, bytes, NULL, &ifname, NULL, &operstate, &stats))
 522                 return;
 523
 524         if (operstate != 0xff)
 525                 connman_info("%s {dellink} index %d operstate %u <%s>",
 526                                                 ifname, index, operstate,
 527                                                 operstate2str(operstate));
 528
 529         for (list = rtnl_list; list; list = list->next) {
 530                 struct connman_rtnl *rtnl = list->data;
 531
 532                 if (rtnl->dellink)
 533                         rtnl->dellink(type, index, flags, change);
 534         }
 535
 536         switch (type) {
 537         case ARPHRD_ETHER:
 538         case ARPHRD_LOOPBACK:
 539         case ARPHDR_PHONET_PIPE:
 540         case ARPHRD_PPP:
 541         case ARPHRD_NONE:
 542                 __connman_ipconfig_dellink(index, &stats);
 543                 break;
 544         }
 545
 546         g_hash_table_remove(interface_list, GINT_TO_POINTER(index));
 547 }
 548
 549 static void extract_ipv4_addr(struct ifaddrmsg *msg, int bytes,
 550                                                 const char **label,
 551                                                 struct in_addr *local,
 552                                                 struct in_addr *address,
 553                                                 struct in_addr *broadcast)
 554 {
 555         struct rtattr *attr;
 556
 557         for (attr = IFA_RTA(msg); RTA_OK(attr, bytes);
 558                                         attr = RTA_NEXT(attr, bytes)) {
 559                 switch (attr->rta_type) {
 560                 case IFA_ADDRESS:
 561                         if (address)
 562                                 *address = *((struct in_addr *) RTA_DATA(attr));
 563                         break;
 564                 case IFA_LOCAL:
 565                         if (local)
 566                                 *local = *((struct in_addr *) RTA_DATA(attr));
 567                         break;
 568                 case IFA_BROADCAST:
 569                         if (broadcast)
 570                                 *broadcast = *((struct in_addr *) RTA_DATA(attr));
 571                         break;
 572                 case IFA_LABEL:
 573                         if (label)
 574                                 *label = RTA_DATA(attr);
 575                         break;
 576                 }
 577         }
 578 }
 579
 580 static void extract_ipv6_addr(struct ifaddrmsg *msg, int bytes,
 581                                                 struct in6_addr *addr,
 582                                                 struct in6_addr *local)
 583 {
 584         struct rtattr *attr;
 585
 586         for (attr = IFA_RTA(msg); RTA_OK(attr, bytes);
 587                                         attr = RTA_NEXT(attr, bytes)) {
 588                 switch (attr->rta_type) {
 589                 case IFA_ADDRESS:
 590                         if (addr)
 591                                 *addr = *((struct in6_addr *) RTA_DATA(attr));
 592                         break;
 593                 case IFA_LOCAL:
 594                         if (local)
 595                                 *local = *((struct in6_addr *) RTA_DATA(attr));
 596                         break;
 597                 }
 598         }
 599 }
 600
 601 static void process_newaddr(unsigned char family, unsigned char prefixlen,
 602                                 int index, struct ifaddrmsg *msg, int bytes)
 603 {
 604         struct in_addr ipv4_addr = { INADDR_ANY };
 605         struct in6_addr ipv6_address, ipv6_local;
 606         const char *label = NULL;
 607         void *src;
 608         char ip_string[INET6_ADDRSTRLEN];
 609
 610         if (family == AF_INET) {
 611
 612                 extract_ipv4_addr(msg, bytes, &label, &ipv4_addr, NULL, NULL);
 613                 src = &ipv4_addr;
 614         } else if (family == AF_INET6) {
 615                 extract_ipv6_addr(msg, bytes, &ipv6_address, &ipv6_local);
 616                 if (IN6_IS_ADDR_LINKLOCAL(&ipv6_address))
 617                         return;
 618
 619                 src = &ipv6_address;
 620         } else {
 621                 return;
 622         }
 623
 624         if (!inet_ntop(family, src, ip_string, INET6_ADDRSTRLEN))
 625                 return;
 626
 627         if (__connman_ipconfig_newaddr(index, family, label,
 628                                         prefixlen, ip_string) >= 0) {
 629                 if (family == AF_INET6) {
 630                         /*
 631                          * Re-create RDNSS configured servers if there
 632                          * are any for this interface. This is done
 633                          * because we might have now properly
 634                          * configured interface with proper
 635                          * autoconfigured address.
 636                          */
 637                         __connman_resolver_redo_servers(index);
 638                 }
 639         }
 640 }
 641
 642 static void process_deladdr(unsigned char family, unsigned char prefixlen,
 643                                 int index, struct ifaddrmsg *msg, int bytes)
 644 {
 645         struct in_addr ipv4_addr = { INADDR_ANY };
 646         struct in6_addr ipv6_address, ipv6_local;
 647         const char *label = NULL;
 648         void *src;
 649         char ip_string[INET6_ADDRSTRLEN];
 650
 651         if (family == AF_INET) {
 652                 extract_ipv4_addr(msg, bytes, &label, &ipv4_addr, NULL, NULL);
 653                 src = &ipv4_addr;
 654         } else if (family == AF_INET6) {
 655                 extract_ipv6_addr(msg, bytes, &ipv6_address, &ipv6_local);
 656                 if (IN6_IS_ADDR_LINKLOCAL(&ipv6_address))
 657                         return;
 658
 659                 src = &ipv6_address;
 660         } else {
 661                 return;
 662         }
 663
 664         if (!inet_ntop(family, src, ip_string, INET6_ADDRSTRLEN))
 665                 return;
 666
 667         __connman_ipconfig_deladdr(index, family, label,
 668                                         prefixlen, ip_string);
 669 }
 670
 671 static void extract_ipv4_route(struct rtmsg *msg, int bytes, int *index,
 672                                                 struct in_addr *dst,
 673                                                 struct in_addr *gateway)
 674 {
 675         struct rtattr *attr;
 676
 677         for (attr = RTM_RTA(msg); RTA_OK(attr, bytes);
 678                                         attr = RTA_NEXT(attr, bytes)) {
 679                 switch (attr->rta_type) {
 680                 case RTA_DST:
 681                         if (dst)
 682                                 *dst = *((struct in_addr *) RTA_DATA(attr));
 683                         break;
 684                 case RTA_GATEWAY:
 685                         if (gateway)
 686                                 *gateway = *((struct in_addr *) RTA_DATA(attr));
 687                         break;
 688                 case RTA_OIF:
 689                         if (index)
 690                                 *index = *((int *) RTA_DATA(attr));
 691                         break;
 692                 }
 693         }
 694 }
 695
 696 static void extract_ipv6_route(struct rtmsg *msg, int bytes, int *index,
 697                                                 struct in6_addr *dst,
 698                                                 struct in6_addr *gateway)
 699 {
 700         struct rtattr *attr;
 701
 702         for (attr = RTM_RTA(msg); RTA_OK(attr, bytes);
 703                                         attr = RTA_NEXT(attr, bytes)) {
 704                 switch (attr->rta_type) {
 705                 case RTA_DST:
 706                         if (dst)
 707                                 *dst = *((struct in6_addr *) RTA_DATA(attr));
 708                         break;
 709                 case RTA_GATEWAY:
 710                         if (gateway)
 711                                 *gateway =
 712                                         *((struct in6_addr *) RTA_DATA(attr));
 713                         break;
 714                 case RTA_OIF:
 715                         if (index)
 716                                 *index = *((int *) RTA_DATA(attr));
 717                         break;
 718                 }
 719         }
 720 }
 721
 722 static void process_newroute(unsigned char family, unsigned char scope,
 723                                                 struct rtmsg *msg, int bytes)
 724 {
 725         GSList *list;
 726         char dststr[INET6_ADDRSTRLEN], gatewaystr[INET6_ADDRSTRLEN];
 727         int index = -1;
 728
 729         if (family == AF_INET) {
 730                 struct in_addr dst = { INADDR_ANY }, gateway = { INADDR_ANY };
 731
 732                 extract_ipv4_route(msg, bytes, &index, &dst, &gateway);
 733
 734                 inet_ntop(family, &dst, dststr, sizeof(dststr));
 735                 inet_ntop(family, &gateway, gatewaystr, sizeof(gatewaystr));
 736
 737                 __connman_ipconfig_newroute(index, family, scope, dststr,
 738                                                                 gatewaystr);
 739
 740                 /* skip host specific routes */
 741                 if (scope != RT_SCOPE_UNIVERSE &&
 742                         !(scope == RT_SCOPE_LINK && dst.s_addr == INADDR_ANY))
 743                         return;
 744
 745                 if (dst.s_addr != INADDR_ANY)
 746                         return;
 747
 748         } else if (family == AF_INET6) {
 749                 struct in6_addr dst = IN6ADDR_ANY_INIT,
 750                                 gateway = IN6ADDR_ANY_INIT;
 751
 752                 extract_ipv6_route(msg, bytes, &index, &dst, &gateway);
 753
 754                 inet_ntop(family, &dst, dststr, sizeof(dststr));
 755                 inet_ntop(family, &gateway, gatewaystr, sizeof(gatewaystr));
 756
 757                 __connman_ipconfig_newroute(index, family, scope, dststr,
 758                                                                 gatewaystr);
 759
 760                 /* skip host specific routes */
 761                 if (scope != RT_SCOPE_UNIVERSE &&
 762                         !(scope == RT_SCOPE_LINK &&
 763                                 IN6_IS_ADDR_UNSPECIFIED(&dst)))
 764                         return;
 765
 766                 if (!IN6_IS_ADDR_UNSPECIFIED(&dst))
 767                         return;
 768         } else
 769                 return;
 770
 771         for (list = rtnl_list; list; list = list->next) {
 772                 struct connman_rtnl *rtnl = list->data;
 773
 774                 if (rtnl->newgateway)
 775                         rtnl->newgateway(index, gatewaystr);
 776         }
 777 }
 778
 779 static void process_delroute(unsigned char family, unsigned char scope,
 780                                                 struct rtmsg *msg, int bytes)
 781 {
 782         GSList *list;
 783         char dststr[INET6_ADDRSTRLEN], gatewaystr[INET6_ADDRSTRLEN];
 784         int index = -1;
 785
 786         if (family == AF_INET) {
 787                 struct in_addr dst = { INADDR_ANY }, gateway = { INADDR_ANY };
 788
 789                 extract_ipv4_route(msg, bytes, &index, &dst, &gateway);
 790
 791                 inet_ntop(family, &dst, dststr, sizeof(dststr));
 792                 inet_ntop(family, &gateway, gatewaystr, sizeof(gatewaystr));
 793
 794                 __connman_ipconfig_delroute(index, family, scope, dststr,
 795                                                                 gatewaystr);
 796
 797                 /* skip host specific routes */
 798                 if (scope != RT_SCOPE_UNIVERSE &&
 799                         !(scope == RT_SCOPE_LINK && dst.s_addr == INADDR_ANY))
 800                         return;
 801
 802                 if (dst.s_addr != INADDR_ANY)
 803                         return;
 804
 805         }  else if (family == AF_INET6) {
 806                 struct in6_addr dst = IN6ADDR_ANY_INIT,
 807                                 gateway = IN6ADDR_ANY_INIT;
 808
 809                 extract_ipv6_route(msg, bytes, &index, &dst, &gateway);
 810
 811                 inet_ntop(family, &dst, dststr, sizeof(dststr));
 812                 inet_ntop(family, &gateway, gatewaystr, sizeof(gatewaystr));
 813
 814                 __connman_ipconfig_delroute(index, family, scope, dststr,
 815                                                 gatewaystr);
 816
 817                 /* skip host specific routes */
 818                 if (scope != RT_SCOPE_UNIVERSE &&
 819                         !(scope == RT_SCOPE_LINK &&
 820                                 IN6_IS_ADDR_UNSPECIFIED(&dst)))
 821                         return;
 822
 823                 if (!IN6_IS_ADDR_UNSPECIFIED(&dst))
 824                         return;
 825         } else
 826                 return;
 827
 828         for (list = rtnl_list; list; list = list->next) {
 829                 struct connman_rtnl *rtnl = list->data;
 830
 831                 if (rtnl->delgateway)
 832                         rtnl->delgateway(index, gatewaystr);
 833         }
 834 }
 835
 836 static inline void print_ether(struct rtattr *attr, const char *name)
 837 {
 838         int len = (int) RTA_PAYLOAD(attr);
 839
 840         if (len == ETH_ALEN) {
 841                 struct ether_addr eth;
 842                 memcpy(&eth, RTA_DATA(attr), ETH_ALEN);
 843                 print("  attr %s (len %d) %s\n", name, len, ether_ntoa(&eth));
 844         } else
 845                 print("  attr %s (len %d)\n", name, len);
 846 }
 847
 848 static inline void print_inet(struct rtattr *attr, const char *name,
 849                                                         unsigned char family)
 850 {
 851         int len = (int) RTA_PAYLOAD(attr);
 852
 853         if (family == AF_INET && len == sizeof(struct in_addr)) {
 854                 struct in_addr addr;
 855                 addr = *((struct in_addr *) RTA_DATA(attr));
 856                 print("  attr %s (len %d) %s\n", name, len, inet_ntoa(addr));
 857         } else
 858                 print("  attr %s (len %d)\n", name, len);
 859 }
 860
 861 static inline void print_string(struct rtattr *attr, const char *name)
 862 {
 863         print("  attr %s (len %d) %s\n", name, (int) RTA_PAYLOAD(attr),
 864                                                 (char *) RTA_DATA(attr));
 865 }
 866
 867 static inline void print_byte(struct rtattr *attr, const char *name)
 868 {
 869         print("  attr %s (len %d) 0x%02x\n", name, (int) RTA_PAYLOAD(attr),
 870                                         *((unsigned char *) RTA_DATA(attr)));
 871 }
 872
 873 static inline void print_integer(struct rtattr *attr, const char *name)
 874 {
 875         print("  attr %s (len %d) %d\n", name, (int) RTA_PAYLOAD(attr),
 876                                                 *((int *) RTA_DATA(attr)));
 877 }
 878
 879 static inline void print_attr(struct rtattr *attr, const char *name)
 880 {
 881         int len = (int) RTA_PAYLOAD(attr);
 882
 883         if (name && len > 0)
 884                 print("  attr %s (len %d)\n", name, len);
 885         else
 886                 print("  attr %d (len %d)\n", attr->rta_type, len);
 887 }
 888
 889 static void rtnl_link(struct nlmsghdr *hdr)
 890 {
 891         struct ifinfomsg *msg;
 892         struct rtattr *attr;
 893         int bytes;
 894
 895         msg = (struct ifinfomsg *) NLMSG_DATA(hdr);
 896         bytes = IFLA_PAYLOAD(hdr);
 897
 898         print("ifi_index %d ifi_flags 0x%04x", msg->ifi_index, msg->ifi_flags);
 899
 900         for (attr = IFLA_RTA(msg); RTA_OK(attr, bytes);
 901                                         attr = RTA_NEXT(attr, bytes)) {
 902                 switch (attr->rta_type) {
 903                 case IFLA_ADDRESS:
 904                         print_ether(attr, "address");
 905                         break;
 906                 case IFLA_BROADCAST:
 907                         print_ether(attr, "broadcast");
 908                         break;
 909                 case IFLA_IFNAME:
 910                         print_string(attr, "ifname");
 911                         break;
 912                 case IFLA_MTU:
 913                         print_integer(attr, "mtu");
 914                         break;
 915                 case IFLA_LINK:
 916                         print_attr(attr, "link");
 917                         break;
 918                 case IFLA_QDISC:
 919                         print_attr(attr, "qdisc");
 920                         break;
 921                 case IFLA_STATS:
 922                         print_attr(attr, "stats");
 923                         break;
 924                 case IFLA_COST:
 925                         print_attr(attr, "cost");
 926                         break;
 927                 case IFLA_PRIORITY:
 928                         print_attr(attr, "priority");
 929                         break;
 930                 case IFLA_MASTER:
 931                         print_attr(attr, "master");
 932                         break;
 933                 case IFLA_WIRELESS:
 934                         print_attr(attr, "wireless");
 935                         break;
 936                 case IFLA_PROTINFO:
 937                         print_attr(attr, "protinfo");
 938                         break;
 939                 case IFLA_TXQLEN:
 940                         print_integer(attr, "txqlen");
 941                         break;
 942                 case IFLA_MAP:
 943                         print_attr(attr, "map");
 944                         break;
 945                 case IFLA_WEIGHT:
 946                         print_attr(attr, "weight");
 947                         break;
 948                 case IFLA_OPERSTATE:
 949                         print_byte(attr, "operstate");
 950                         break;
 951                 case IFLA_LINKMODE:
 952                         print_byte(attr, "linkmode");
 953                         break;
 954                 default:
 955                         print_attr(attr, NULL);
 956                         break;
 957                 }
 958         }
 959 }
 960
 961 static void rtnl_newlink(struct nlmsghdr *hdr)
 962 {
 963         struct ifinfomsg *msg = (struct ifinfomsg *) NLMSG_DATA(hdr);
 964
 965         rtnl_link(hdr);
 966
 967         if (hdr->nlmsg_type == IFLA_WIRELESS)
 968                 connman_warn_once("Obsolete WEXT WiFi driver detected");
 969
 970         process_newlink(msg->ifi_type, msg->ifi_index, msg->ifi_flags,
 971                                 msg->ifi_change, msg, IFA_PAYLOAD(hdr));
 972 }
 973
 974 static void rtnl_dellink(struct nlmsghdr *hdr)
 975 {
 976         struct ifinfomsg *msg = (struct ifinfomsg *) NLMSG_DATA(hdr);
 977
 978         rtnl_link(hdr);
 979
 980         process_dellink(msg->ifi_type, msg->ifi_index, msg->ifi_flags,
 981                                 msg->ifi_change, msg, IFA_PAYLOAD(hdr));
 982 }
 983
 984 static void rtnl_addr(struct nlmsghdr *hdr)
 985 {
 986         struct ifaddrmsg *msg;
 987         struct rtattr *attr;
 988         int bytes;
 989
 990         msg = (struct ifaddrmsg *) NLMSG_DATA(hdr);
 991         bytes = IFA_PAYLOAD(hdr);
 992
 993         print("ifa_family %d ifa_index %d", msg->ifa_family, msg->ifa_index);
 994
 995         for (attr = IFA_RTA(msg); RTA_OK(attr, bytes);
 996                                         attr = RTA_NEXT(attr, bytes)) {
 997                 switch (attr->rta_type) {
 998                 case IFA_ADDRESS:
 999                         print_inet(attr, "address", msg->ifa_family);
1000                         break;
1001                 case IFA_LOCAL:
1002                         print_inet(attr, "local", msg->ifa_family);
1003                         break;
1004                 case IFA_LABEL:
1005                         print_string(attr, "label");
1006                         break;
1007                 case IFA_BROADCAST:
1008                         print_inet(attr, "broadcast", msg->ifa_family);
1009                         break;
1010                 case IFA_ANYCAST:
1011                         print_attr(attr, "anycast");
1012                         break;
1013                 case IFA_CACHEINFO:
1014                         print_attr(attr, "cacheinfo");
1015                         break;
1016                 case IFA_MULTICAST:
1017                         print_attr(attr, "multicast");
1018                         break;
1019                 default:
1020                         print_attr(attr, NULL);
1021                         break;
1022                 }
1023         }
1024 }
1025
1026 static void rtnl_newaddr(struct nlmsghdr *hdr)
1027 {
1028         struct ifaddrmsg *msg = (struct ifaddrmsg *) NLMSG_DATA(hdr);
1029
1030         rtnl_addr(hdr);
1031
1032         process_newaddr(msg->ifa_family, msg->ifa_prefixlen, msg->ifa_index,
1033                                                 msg, IFA_PAYLOAD(hdr));
1034 }
1035
1036 static void rtnl_deladdr(struct nlmsghdr *hdr)
1037 {
1038         struct ifaddrmsg *msg = (struct ifaddrmsg *) NLMSG_DATA(hdr);
1039
1040         rtnl_addr(hdr);
1041
1042         process_deladdr(msg->ifa_family, msg->ifa_prefixlen, msg->ifa_index,
1043                                                 msg, IFA_PAYLOAD(hdr));
1044 }
1045
1046 static void rtnl_route(struct nlmsghdr *hdr)
1047 {
1048         struct rtmsg *msg;
1049         struct rtattr *attr;
1050         int bytes;
1051
1052         msg = (struct rtmsg *) NLMSG_DATA(hdr);
1053         bytes = RTM_PAYLOAD(hdr);
1054
1055         print("rtm_family %d rtm_table %d rtm_protocol %d",
1056                         msg->rtm_family, msg->rtm_table, msg->rtm_protocol);
1057         print("rtm_scope %d rtm_type %d rtm_flags 0x%04x",
1058                                 msg->rtm_scope, msg->rtm_type, msg->rtm_flags);
1059
1060         for (attr = RTM_RTA(msg); RTA_OK(attr, bytes);
1061                                         attr = RTA_NEXT(attr, bytes)) {
1062                 switch (attr->rta_type) {
1063                 case RTA_DST:
1064                         print_inet(attr, "dst", msg->rtm_family);
1065                         break;
1066                 case RTA_SRC:
1067                         print_inet(attr, "src", msg->rtm_family);
1068                         break;
1069                 case RTA_IIF:
1070                         print_string(attr, "iif");
1071                         break;
1072                 case RTA_OIF:
1073                         print_integer(attr, "oif");
1074                         break;
1075                 case RTA_GATEWAY:
1076                         print_inet(attr, "gateway", msg->rtm_family);
1077                         break;
1078                 case RTA_PRIORITY:
1079                         print_attr(attr, "priority");
1080                         break;
1081                 case RTA_PREFSRC:
1082                         print_inet(attr, "prefsrc", msg->rtm_family);
1083                         break;
1084                 case RTA_METRICS:
1085                         print_attr(attr, "metrics");
1086                         break;
1087                 case RTA_TABLE:
1088                         print_integer(attr, "table");
1089                         break;
1090                 default:
1091                         print_attr(attr, NULL);
1092                         break;
1093                 }
1094         }
1095 }
1096
1097 static bool is_route_rtmsg(struct rtmsg *msg)
1098 {
1099         if (msg->rtm_flags & RTM_F_CLONED)
1100                 return false;
1101
1102         if (msg->rtm_table != RT_TABLE_MAIN)
1103                 return false;
1104
1105         if (msg->rtm_protocol != RTPROT_BOOT &&
1106                         msg->rtm_protocol != RTPROT_KERNEL)
1107                 return false;
1108
1109         if (msg->rtm_type != RTN_UNICAST)
1110                 return false;
1111
1112         return true;
1113 }
1114
1115 static void rtnl_newroute(struct nlmsghdr *hdr)
1116 {
1117         struct rtmsg *msg = (struct rtmsg *) NLMSG_DATA(hdr);
1118
1119         rtnl_route(hdr);
1120
1121         if (is_route_rtmsg(msg))
1122                 process_newroute(msg->rtm_family, msg->rtm_scope,
1123                                                 msg, RTM_PAYLOAD(hdr));
1124 }
1125
1126 static void rtnl_delroute(struct nlmsghdr *hdr)
1127 {
1128         struct rtmsg *msg = (struct rtmsg *) NLMSG_DATA(hdr);
1129
1130         rtnl_route(hdr);
1131
1132         if (is_route_rtmsg(msg))
1133                 process_delroute(msg->rtm_family, msg->rtm_scope,
1134                                                 msg, RTM_PAYLOAD(hdr));
1135 }
1136
1137 static void *rtnl_nd_opt_rdnss(struct nd_opt_hdr *opt, guint32 *lifetime,
1138                                int *nr_servers)
1139 {
1140         guint32 *optint = (void *)opt;
1141
1142         if (opt->nd_opt_len < 3)
1143                 return NULL;
1144
1145         if (*lifetime > ntohl(optint[1]))
1146                 *lifetime = ntohl(optint[1]);
1147
1148         /* nd_opt_len is in units of 8 bytes. The header is 1 unit (8 bytes)
1149            and each address is another 2 units (16 bytes).
1150            So the number of addresses (given rounding) is nd_opt_len/2 */
1151         *nr_servers = opt->nd_opt_len / 2;
1152
1153         /* And they start 8 bytes into the packet, or two guint32s in. */
1154         return optint + 2;
1155 }
1156
1157 static const char **rtnl_nd_opt_dnssl(struct nd_opt_hdr *opt, guint32 *lifetime)
1158 {
1159         const char **domains = NULL;
1160         guint32 *optint = (void *)opt;
1161         unsigned char *optc = (void *)&optint[2];
1162         int data_len = (opt->nd_opt_len * 8) - 8;
1163         int nr_domains = 0;
1164         int i, tmp;
1165
1166         if (*lifetime > ntohl(optint[1]))
1167                 *lifetime = ntohl(optint[1]);
1168
1169         /* Turn it into normal strings by converting the length bytes into '.',
1170            and count how many search domains there are while we're at it. */
1171         i = 0;
1172         while (i < data_len) {
1173                 if (optc[i] > 0x3f) {
1174                         DBG("DNSSL contains compressed elements in violation of RFC6106");
1175                         return NULL;
1176                 }
1177
1178                 if (optc[i] == 0) {
1179                         nr_domains++;
1180                         i++;
1181                         /* Check for double zero */
1182                         if (i < data_len && optc[i] == 0)
1183                                 break;
1184                         continue;
1185                 }
1186
1187                 tmp = i;
1188                 i += optc[i] + 1;
1189
1190                 if (i >= data_len) {
1191                         DBG("DNSSL data overflows option length");
1192                         return NULL;
1193                 }
1194
1195                 optc[tmp] = '.';
1196         }
1197
1198         domains = g_try_new0(const char *, nr_domains + 1);
1199         if (!domains)
1200                 return NULL;
1201
1202         /* Now point to the normal strings, missing out the leading '.' that
1203            each of them will have now. */
1204         for (i = 0; i < nr_domains; i++) {
1205                 domains[i] = (char *)optc + 1;
1206                 optc += strlen((char *)optc) + 1;
1207         }
1208
1209         return domains;
1210 }
1211
1212 static void rtnl_newnduseropt(struct nlmsghdr *hdr)
1213 {
1214         struct nduseroptmsg *msg = (struct nduseroptmsg *) NLMSG_DATA(hdr);
1215         struct nd_opt_hdr *opt;
1216         guint32 lifetime = -1;
1217         const char **domains = NULL;
1218         struct in6_addr *servers = NULL;
1219         int i, nr_servers = 0;
1220         int msglen = msg->nduseropt_opts_len;
1221         int index;
1222
1223         DBG("family %d index %d len %d type %d code %d",
1224                 msg->nduseropt_family, msg->nduseropt_ifindex,
1225                 msg->nduseropt_opts_len, msg->nduseropt_icmp_type,
1226                 msg->nduseropt_icmp_code);
1227
1228         if (msg->nduseropt_family != AF_INET6 ||
1229                         msg->nduseropt_icmp_type != ND_ROUTER_ADVERT ||
1230                         msg->nduseropt_icmp_code != 0)
1231                 return;
1232
1233         index = msg->nduseropt_ifindex;
1234         if (index < 0)
1235                 return;
1236
1237         for (opt = (void *)&msg[1];
1238                         msglen > 0;
1239                         msglen -= opt->nd_opt_len * 8,
1240                         opt = ((void *)opt) + opt->nd_opt_len*8) {
1241
1242                 DBG("remaining %d nd opt type %d len %d\n",
1243                         msglen, opt->nd_opt_type, opt->nd_opt_len);
1244
1245                 if (opt->nd_opt_type == 25) { /* ND_OPT_RDNSS */
1246                         char buf[40];
1247
1248                         servers = rtnl_nd_opt_rdnss(opt, &lifetime,
1249                                                                 &nr_servers);
1250                         for (i = 0; i < nr_servers; i++) {
1251                                 if (!inet_ntop(AF_INET6, servers + i, buf,
1252                                                                 sizeof(buf)))
1253                                         continue;
1254
1255                                 connman_resolver_append_lifetime(index,
1256                                                         NULL, buf, lifetime);
1257                         }
1258
1259                 } else if (opt->nd_opt_type == 31) { /* ND_OPT_DNSSL */
1260                         g_free(domains);
1261
1262                         domains = rtnl_nd_opt_dnssl(opt, &lifetime);
1263                         for (i = 0; domains && domains[i]; i++)
1264                                 connman_resolver_append_lifetime(index,
1265                                                 domains[i], NULL, lifetime);
1266                 }
1267         }
1268
1269         g_free(domains);
1270 }
1271
1272 static const char *type2string(uint16_t type)
1273 {
1274         switch (type) {
1275         case NLMSG_NOOP:
1276                 return "NOOP";
1277         case NLMSG_ERROR:
1278                 return "ERROR";
1279         case NLMSG_DONE:
1280                 return "DONE";
1281         case NLMSG_OVERRUN:
1282                 return "OVERRUN";
1283         case RTM_GETLINK:
1284                 return "GETLINK";
1285         case RTM_NEWLINK:
1286                 return "NEWLINK";
1287         case RTM_DELLINK:
1288                 return "DELLINK";
1289         case RTM_GETADDR:
1290                 return "GETADDR";
1291         case RTM_NEWADDR:
1292                 return "NEWADDR";
1293         case RTM_DELADDR:
1294                 return "DELADDR";
1295         case RTM_GETROUTE:
1296                 return "GETROUTE";
1297         case RTM_NEWROUTE:
1298                 return "NEWROUTE";
1299         case RTM_DELROUTE:
1300                 return "DELROUTE";
1301         case RTM_NEWNDUSEROPT:
1302                 return "NEWNDUSEROPT";
1303         default:
1304                 return "UNKNOWN";
1305         }
1306 }
1307
1308 static GIOChannel *channel = NULL;
1309 static guint channel_watch = 0;
1310
1311 struct rtnl_request {
1312         struct nlmsghdr hdr;
1313         struct rtgenmsg msg;
1314 };
1315 #define RTNL_REQUEST_SIZE  (sizeof(struct nlmsghdr) + sizeof(struct rtgenmsg))
1316
1317 static GSList *request_list = NULL;
1318 static guint32 request_seq = 0;
1319
1320 static struct rtnl_request *find_request(guint32 seq)
1321 {
1322         GSList *list;
1323
1324         for (list = request_list; list; list = list->next) {
1325                 struct rtnl_request *req = list->data;
1326
1327                 if (req->hdr.nlmsg_seq == seq)
1328                         return req;
1329         }
1330
1331         return NULL;
1332 }
1333
1334 static int send_request(struct rtnl_request *req)
1335 {
1336         struct sockaddr_nl addr;
1337         int sk;
1338
1339         DBG("%s len %d type %d flags 0x%04x seq %d",
1340                                 type2string(req->hdr.nlmsg_type),
1341                                 req->hdr.nlmsg_len, req->hdr.nlmsg_type,
1342                                 req->hdr.nlmsg_flags, req->hdr.nlmsg_seq);
1343
1344         sk = g_io_channel_unix_get_fd(channel);
1345
1346         memset(&addr, 0, sizeof(addr));
1347         addr.nl_family = AF_NETLINK;
1348
1349         return sendto(sk, req, req->hdr.nlmsg_len, 0,
1350                                 (struct sockaddr *) &addr, sizeof(addr));
1351 }
1352
1353 static int queue_request(struct rtnl_request *req)
1354 {
1355         request_list = g_slist_append(request_list, req);
1356
1357         if (g_slist_length(request_list) > 1)
1358                 return 0;
1359
1360         return send_request(req);
1361 }
1362
1363 static int process_response(guint32 seq)
1364 {
1365         struct rtnl_request *req;
1366
1367         DBG("seq %d", seq);
1368
1369         req = find_request(seq);
1370         if (req) {
1371                 request_list = g_slist_remove(request_list, req);
1372                 g_free(req);
1373         }
1374
1375         req = g_slist_nth_data(request_list, 0);
1376         if (!req)
1377                 return 0;
1378
1379         return send_request(req);
1380 }
1381
1382 static void rtnl_message(void *buf, size_t len)
1383 {
1384         while (len > 0) {
1385                 struct nlmsghdr *hdr = buf;
1386                 struct nlmsgerr *err;
1387
1388                 if (!NLMSG_OK(hdr, len))
1389                         break;
1390
1391                 DBG("%s len %u type %u flags 0x%04x seq %u pid %u",
1392                                         type2string(hdr->nlmsg_type),
1393                                         hdr->nlmsg_len, hdr->nlmsg_type,
1394                                         hdr->nlmsg_flags, hdr->nlmsg_seq,
1395                                         hdr->nlmsg_pid);
1396
1397                 switch (hdr->nlmsg_type) {
1398                 case NLMSG_NOOP:
1399                 case NLMSG_OVERRUN:
1400                         return;
1401                 case NLMSG_DONE:
1402                         process_response(hdr->nlmsg_seq);
1403                         return;
1404                 case NLMSG_ERROR:
1405                         err = NLMSG_DATA(hdr);
1406                         DBG("error %d (%s)", -err->error,
1407                                                 strerror(-err->error));
1408                         return;
1409                 case RTM_NEWLINK:
1410                         rtnl_newlink(hdr);
1411                         break;
1412                 case RTM_DELLINK:
1413                         rtnl_dellink(hdr);
1414                         break;
1415                 case RTM_NEWADDR:
1416                         rtnl_newaddr(hdr);
1417                         break;
1418                 case RTM_DELADDR:
1419                         rtnl_deladdr(hdr);
1420                         break;
1421                 case RTM_NEWROUTE:
1422                         rtnl_newroute(hdr);
1423                         break;
1424                 case RTM_DELROUTE:
1425                         rtnl_delroute(hdr);
1426                         break;
1427                 case RTM_NEWNDUSEROPT:
1428                         rtnl_newnduseropt(hdr);
1429                         break;
1430                 }
1431
1432                 len -= hdr->nlmsg_len;
1433                 buf += hdr->nlmsg_len;
1434         }
1435 }
1436
1437 static gboolean netlink_event(GIOChannel *chan, GIOCondition cond, gpointer data)
1438 {
1439         unsigned char buf[4096];
1440         struct sockaddr_nl nladdr;
1441         socklen_t addr_len = sizeof(nladdr);
1442         ssize_t status;
1443         int fd;
1444
1445         if (cond & (G_IO_NVAL | G_IO_HUP | G_IO_ERR))
1446                 return FALSE;
1447
1448         memset(buf, 0, sizeof(buf));
1449         memset(&nladdr, 0, sizeof(nladdr));
1450
1451         fd = g_io_channel_unix_get_fd(chan);
1452
1453         status = recvfrom(fd, buf, sizeof(buf), 0,
1454                        (struct sockaddr *) &nladdr, &addr_len);
1455         if (status < 0) {
1456                 if (errno == EINTR || errno == EAGAIN)
1457                         return TRUE;
1458
1459                 return FALSE;
1460         }
1461
1462         if (status == 0)
1463                 return FALSE;
1464
1465         if (nladdr.nl_pid != 0) { /* not sent by kernel, ignore */
1466                 DBG("Received msg from %u, ignoring it", nladdr.nl_pid);
1467                 return TRUE;
1468         }
1469
1470         rtnl_message(buf, status);
1471
1472         return TRUE;
1473 }
1474
1475 static int send_getlink(void)
1476 {
1477         struct rtnl_request *req;
1478
1479         DBG("");
1480
1481         req = g_try_malloc0(RTNL_REQUEST_SIZE);
1482         if (!req)
1483                 return -ENOMEM;
1484
1485         req->hdr.nlmsg_len = RTNL_REQUEST_SIZE;
1486         req->hdr.nlmsg_type = RTM_GETLINK;
1487         req->hdr.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
1488         req->hdr.nlmsg_pid = 0;
1489         req->hdr.nlmsg_seq = request_seq++;
1490         req->msg.rtgen_family = AF_INET;
1491
1492         return queue_request(req);
1493 }
1494
1495 static int send_getaddr(void)
1496 {
1497         struct rtnl_request *req;
1498
1499         DBG("");
1500
1501         req = g_try_malloc0(RTNL_REQUEST_SIZE);
1502         if (!req)
1503                 return -ENOMEM;
1504
1505         req->hdr.nlmsg_len = RTNL_REQUEST_SIZE;
1506         req->hdr.nlmsg_type = RTM_GETADDR;
1507         req->hdr.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
1508         req->hdr.nlmsg_pid = 0;
1509         req->hdr.nlmsg_seq = request_seq++;
1510         req->msg.rtgen_family = AF_INET;
1511
1512         return queue_request(req);
1513 }
1514
1515 static int send_getroute(void)
1516 {
1517         struct rtnl_request *req;
1518
1519         DBG("");
1520
1521         req = g_try_malloc0(RTNL_REQUEST_SIZE);
1522         if (!req)
1523                 return -ENOMEM;
1524
1525         req->hdr.nlmsg_len = RTNL_REQUEST_SIZE;
1526         req->hdr.nlmsg_type = RTM_GETROUTE;
1527         req->hdr.nlmsg_flags = NLM_F_REQUEST | NLM_F_DUMP;
1528         req->hdr.nlmsg_pid = 0;
1529         req->hdr.nlmsg_seq = request_seq++;
1530         req->msg.rtgen_family = AF_INET;
1531
1532         return queue_request(req);
1533 }
1534
1535 static gboolean update_timeout_cb(gpointer user_data)
1536 {
1537         __connman_rtnl_request_update();
1538
1539         return TRUE;
1540 }
1541
1542 static void update_interval_callback(guint min)
1543 {
1544         if (update_timeout > 0)
1545                 g_source_remove(update_timeout);
1546
1547         if (min < G_MAXUINT) {
1548                 update_interval = min;
1549                 update_timeout = g_timeout_add_seconds(update_interval,
1550                                                 update_timeout_cb, NULL);
1551         } else {
1552                 update_timeout = 0;
1553                 update_interval = G_MAXUINT;
1554         }
1555 }
1556
1557 static gint compare_interval(gconstpointer a, gconstpointer b)
1558 {
1559         guint val_a = GPOINTER_TO_UINT(a);
1560         guint val_b = GPOINTER_TO_UINT(b);
1561
1562         return val_a - val_b;
1563 }
1564
1565 unsigned int __connman_rtnl_update_interval_add(unsigned int interval)
1566 {
1567         guint min;
1568
1569         if (interval == 0)
1570                 return 0;
1571
1572         update_list = g_slist_insert_sorted(update_list,
1573                         GUINT_TO_POINTER(interval), compare_interval);
1574
1575         min = GPOINTER_TO_UINT(g_slist_nth_data(update_list, 0));
1576         if (min < update_interval) {
1577                 update_interval_callback(min);
1578                 __connman_rtnl_request_update();
1579         }
1580
1581         return update_interval;
1582 }
1583
1584 unsigned int __connman_rtnl_update_interval_remove(unsigned int interval)
1585 {
1586         guint min = G_MAXUINT;
1587
1588         if (interval == 0)
1589                 return 0;
1590
1591         update_list = g_slist_remove(update_list, GINT_TO_POINTER(interval));
1592
1593         if (update_list)
1594                 min = GPOINTER_TO_UINT(g_slist_nth_data(update_list, 0));
1595
1596         if (min > update_interval)
1597                 update_interval_callback(min);
1598
1599         return min;
1600 }
1601
1602 int __connman_rtnl_request_update(void)
1603 {
1604         return send_getlink();
1605 }
1606
1607 int __connman_rtnl_init(void)
1608 {
1609         struct sockaddr_nl addr;
1610         int sk;
1611
1612         DBG("");
1613
1614         interface_list = g_hash_table_new_full(g_direct_hash, g_direct_equal,
1615                                                         NULL, free_interface);
1616
1617         sk = socket(PF_NETLINK, SOCK_DGRAM | SOCK_CLOEXEC, NETLINK_ROUTE);
1618         if (sk < 0)
1619                 return -1;
1620
1621         memset(&addr, 0, sizeof(addr));
1622         addr.nl_family = AF_NETLINK;
1623         addr.nl_groups = RTMGRP_LINK | RTMGRP_IPV4_IFADDR | RTMGRP_IPV4_ROUTE |
1624                                 RTMGRP_IPV6_IFADDR | RTMGRP_IPV6_ROUTE |
1625                                 (1<<(RTNLGRP_ND_USEROPT-1));
1626
1627         if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
1628                 close(sk);
1629                 return -1;
1630         }
1631
1632         channel = g_io_channel_unix_new(sk);
1633         g_io_channel_set_close_on_unref(channel, TRUE);
1634
1635         g_io_channel_set_encoding(channel, NULL, NULL);
1636         g_io_channel_set_buffered(channel, FALSE);
1637
1638         channel_watch = g_io_add_watch(channel,
1639                                 G_IO_IN | G_IO_NVAL | G_IO_HUP | G_IO_ERR,
1640                                 netlink_event, NULL);
1641
1642         return 0;
1643 }
1644
1645 void __connman_rtnl_start(void)
1646 {
1647         DBG("");
1648
1649         send_getlink();
1650         send_getaddr();
1651         send_getroute();
1652 }
1653
1654 void __connman_rtnl_cleanup(void)
1655 {
1656         GSList *list;
1657
1658         DBG("");
1659
1660         for (list = watch_list; list; list = list->next) {
1661                 struct watch_data *watch = list->data;
1662
1663                 DBG("removing watch %d", watch->id);
1664
1665                 g_free(watch);
1666                 list->data = NULL;
1667         }
1668
1669         g_slist_free(watch_list);
1670         watch_list = NULL;
1671
1672         g_slist_free(update_list);
1673         update_list = NULL;
1674
1675         for (list = request_list; list; list = list->next) {
1676                 struct rtnl_request *req = list->data;
1677
1678                 DBG("%s len %d type %d flags 0x%04x seq %d",
1679                                 type2string(req->hdr.nlmsg_type),
1680                                 req->hdr.nlmsg_len, req->hdr.nlmsg_type,
1681                                 req->hdr.nlmsg_flags, req->hdr.nlmsg_seq);
1682
1683                 g_free(req);
1684                 list->data = NULL;
1685         }
1686
1687         g_slist_free(request_list);
1688         request_list = NULL;
1689
1690         if (channel_watch) {
1691                 g_source_remove(channel_watch);
1692                 channel_watch = 0;
1693         }
1694
1695         g_io_channel_shutdown(channel, TRUE, NULL);
1696         g_io_channel_unref(channel);
1697
1698         channel = NULL;
1699
1700         g_hash_table_destroy(interface_list);
1701 }