src/inet.c

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2007-2010  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 <linux/sockios.h>
  35 #include <arpa/inet.h>
  36 #include <net/route.h>
  37 #include <net/ethernet.h>
  38 #include <linux/if_arp.h>
  39 #include <linux/wireless.h>
  40
  41 #include "connman.h"
  42
  43 #define NLMSG_TAIL(nmsg)                                \
  44         ((struct rtattr *) (((uint8_t*) (nmsg)) +       \
  45         NLMSG_ALIGN((nmsg)->nlmsg_len)))
  46
  47 static int add_rtattr(struct nlmsghdr *n, size_t max_length, int type,
  48                                 const void *data, size_t data_length)
  49 {
  50         size_t length;
  51         struct rtattr *rta;
  52
  53         length = RTA_LENGTH(data_length);
  54
  55         if (NLMSG_ALIGN(n->nlmsg_len) + RTA_ALIGN(length) > max_length)
  56                 return -E2BIG;
  57
  58         rta = NLMSG_TAIL(n);
  59         rta->rta_type = type;
  60         rta->rta_len = length;
  61         memcpy(RTA_DATA(rta), data, data_length);
  62         n->nlmsg_len = NLMSG_ALIGN(n->nlmsg_len) + RTA_ALIGN(length);
  63
  64         return 0;
  65 }
  66
  67 int __connman_inet_modify_address(int cmd, int flags,
  68                                 int index, int family,
  69                                 const char *address,
  70                                 const char *peer,
  71                                 unsigned char prefixlen,
  72                                 const char *broadcast)
  73 {
  74         uint8_t request[NLMSG_ALIGN(sizeof(struct nlmsghdr)) +
  75                         NLMSG_ALIGN(sizeof(struct ifaddrmsg)) +
  76                         RTA_LENGTH(sizeof(struct in6_addr)) +
  77                         RTA_LENGTH(sizeof(struct in6_addr))];
  78
  79         struct nlmsghdr *header;
  80         struct sockaddr_nl nl_addr;
  81         struct ifaddrmsg *ifaddrmsg;
  82         struct in6_addr ipv6_addr;
  83         struct in_addr ipv4_addr, ipv4_dest, ipv4_bcast;
  84         int sk, err;
  85
  86         DBG("");
  87
  88         if (address == NULL)
  89                 return -1;
  90
  91         if (family != AF_INET && family != AF_INET6)
  92                 return -1;
  93
  94         memset(&request, 0, sizeof(request));
  95
  96         header = (struct nlmsghdr *)request;
  97         header->nlmsg_len = NLMSG_LENGTH(sizeof(struct ifaddrmsg));
  98         header->nlmsg_type = cmd;
  99         header->nlmsg_flags = NLM_F_REQUEST | flags;
 100         header->nlmsg_seq = 1;
 101
 102         ifaddrmsg = NLMSG_DATA(header);
 103         ifaddrmsg->ifa_family = family;
 104         ifaddrmsg->ifa_prefixlen = prefixlen;
 105         ifaddrmsg->ifa_flags = IFA_F_PERMANENT;
 106         ifaddrmsg->ifa_scope = RT_SCOPE_UNIVERSE;
 107         ifaddrmsg->ifa_index = index;
 108
 109         if (family == AF_INET) {
 110                 if (inet_pton(AF_INET, address, &ipv4_addr) < 1)
 111                         return -1;
 112
 113                 if (broadcast != NULL)
 114                         inet_pton(AF_INET, broadcast, &ipv4_bcast);
 115                 else
 116                         ipv4_bcast.s_addr = ipv4_addr.s_addr |
 117                                 htonl(0xfffffffflu >> prefixlen);
 118
 119                 if (peer != NULL) {
 120                         if (inet_pton(AF_INET, peer, &ipv4_dest) < 1)
 121                                 return -1;
 122
 123                         if ((err = add_rtattr(header, sizeof(request),
 124                                         IFA_ADDRESS,
 125                                         &ipv4_dest, sizeof(ipv4_dest))) < 0)
 126                         return err;
 127                 }
 128
 129                 if ((err = add_rtattr(header, sizeof(request), IFA_LOCAL,
 130                                 &ipv4_addr, sizeof(ipv4_addr))) < 0)
 131                         return err;
 132
 133                 if ((err = add_rtattr(header, sizeof(request), IFA_BROADCAST,
 134                                 &ipv4_bcast, sizeof(ipv4_bcast))) < 0)
 135                         return err;
 136
 137         } else if (family == AF_INET6) {
 138                 if (inet_pton(AF_INET6, address, &ipv6_addr) < 1)
 139                         return -1;
 140
 141                 if ((err = add_rtattr(header, sizeof(request), IFA_LOCAL,
 142                                 &ipv6_addr, sizeof(ipv6_addr))) < 0)
 143                         return err;
 144         }
 145
 146         sk = socket(AF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE);
 147         if (sk < 0)
 148                 return -1;
 149
 150         memset(&nl_addr, 0, sizeof(nl_addr));
 151         nl_addr.nl_family = AF_NETLINK;
 152
 153         if ((err = sendto(sk, request, header->nlmsg_len, 0,
 154                         (struct sockaddr *) &nl_addr, sizeof(nl_addr))) < 0)
 155                 goto done;
 156
 157         err = 0;
 158
 159 done:
 160         close(sk);
 161
 162         return err;
 163 }
 164
 165 int connman_inet_ifindex(const char *name)
 166 {
 167         struct ifreq ifr;
 168         int sk, err;
 169
 170         if (name == NULL)
 171                 return -1;
 172
 173         sk = socket(PF_INET, SOCK_DGRAM, 0);
 174         if (sk < 0)
 175                 return -1;
 176
 177         memset(&ifr, 0, sizeof(ifr));
 178         strncpy(ifr.ifr_name, name, sizeof(ifr.ifr_name));
 179
 180         err = ioctl(sk, SIOCGIFINDEX, &ifr);
 181
 182         close(sk);
 183
 184         if (err < 0)
 185                 return -1;
 186
 187         return ifr.ifr_ifindex;
 188 }
 189
 190 char *connman_inet_ifname(int index)
 191 {
 192         struct ifreq ifr;
 193         int sk, err;
 194
 195         if (index < 0)
 196                 return NULL;
 197
 198         sk = socket(PF_INET, SOCK_DGRAM, 0);
 199         if (sk < 0)
 200                 return NULL;
 201
 202         memset(&ifr, 0, sizeof(ifr));
 203         ifr.ifr_ifindex = index;
 204
 205         err = ioctl(sk, SIOCGIFNAME, &ifr);
 206
 207         close(sk);
 208
 209         if (err < 0)
 210                 return NULL;
 211
 212         return strdup(ifr.ifr_name);
 213 }
 214
 215 short int connman_inet_ifflags(int index)
 216 {
 217         struct ifreq ifr;
 218         int sk, err;
 219
 220         sk = socket(PF_INET, SOCK_DGRAM, 0);
 221         if (sk < 0)
 222                 return -errno;
 223
 224         memset(&ifr, 0, sizeof(ifr));
 225         ifr.ifr_ifindex = index;
 226
 227         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 228                 err = -errno;
 229                 goto done;
 230         }
 231
 232         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
 233                 err = -errno;
 234                 goto done;
 235         }
 236
 237         err = ifr.ifr_flags;
 238
 239 done:
 240         close(sk);
 241
 242         return err;
 243 }
 244
 245 int connman_inet_ifup(int index)
 246 {
 247         struct ifreq ifr;
 248         int sk, err;
 249
 250         sk = socket(PF_INET, SOCK_DGRAM, 0);
 251         if (sk < 0)
 252                 return -errno;
 253
 254         memset(&ifr, 0, sizeof(ifr));
 255         ifr.ifr_ifindex = index;
 256
 257         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 258                 err = -errno;
 259                 goto done;
 260         }
 261
 262         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
 263                 err = -errno;
 264                 goto done;
 265         }
 266
 267         if (ifr.ifr_flags & IFF_UP) {
 268                 err = -EALREADY;
 269                 goto done;
 270         }
 271
 272         ifr.ifr_flags |= IFF_UP;
 273
 274         if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0) {
 275                 err = -errno;
 276                 goto done;
 277         }
 278
 279         err = 0;
 280
 281 done:
 282         close(sk);
 283
 284         return err;
 285 }
 286
 287 int connman_inet_ifdown(int index)
 288 {
 289         struct ifreq ifr;
 290         int sk, err;
 291
 292         sk = socket(PF_INET, SOCK_DGRAM, 0);
 293         if (sk < 0)
 294                 return -errno;
 295
 296         memset(&ifr, 0, sizeof(ifr));
 297         ifr.ifr_ifindex = index;
 298
 299         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 300                 err = -errno;
 301                 goto done;
 302         }
 303
 304         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
 305                 err = -errno;
 306                 goto done;
 307         }
 308
 309         if (!(ifr.ifr_flags & IFF_UP)) {
 310                 err = -EALREADY;
 311                 goto done;
 312         }
 313
 314         ifr.ifr_flags &= ~IFF_UP;
 315
 316         if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0)
 317                 err = -errno;
 318         else
 319                 err = 0;
 320
 321 done:
 322         close(sk);
 323
 324         return err;
 325 }
 326
 327 static char *index2addr(int index)
 328 {
 329         struct ifreq ifr;
 330         struct ether_addr eth;
 331         char *str;
 332         int sk, err;
 333
 334         if (index < 0)
 335                 return NULL;
 336
 337         sk = socket(PF_INET, SOCK_DGRAM, 0);
 338         if (sk < 0)
 339                 return NULL;
 340
 341         memset(&ifr, 0, sizeof(ifr));
 342         ifr.ifr_ifindex = index;
 343
 344         err = ioctl(sk, SIOCGIFNAME, &ifr);
 345
 346         if (err == 0)
 347                 err = ioctl(sk, SIOCGIFHWADDR, &ifr);
 348
 349         close(sk);
 350
 351         if (err < 0)
 352                 return NULL;
 353
 354         str = malloc(18);
 355         if (!str)
 356                 return NULL;
 357
 358         memcpy(&eth, &ifr.ifr_hwaddr.sa_data, sizeof(eth));
 359         snprintf(str, 18, "%02X:%02X:%02X:%02X:%02X:%02X",
 360                                                 eth.ether_addr_octet[0],
 361                                                 eth.ether_addr_octet[1],
 362                                                 eth.ether_addr_octet[2],
 363                                                 eth.ether_addr_octet[3],
 364                                                 eth.ether_addr_octet[4],
 365                                                 eth.ether_addr_octet[5]);
 366
 367         return str;
 368 }
 369
 370 static char *index2ident(int index, const char *prefix)
 371 {
 372         struct ifreq ifr;
 373         struct ether_addr eth;
 374         char *str;
 375         int sk, err, len;
 376
 377         if (index < 0)
 378                 return NULL;
 379
 380         sk = socket(PF_INET, SOCK_DGRAM, 0);
 381         if (sk < 0)
 382                 return NULL;
 383
 384         memset(&ifr, 0, sizeof(ifr));
 385         ifr.ifr_ifindex = index;
 386
 387         err = ioctl(sk, SIOCGIFNAME, &ifr);
 388
 389         if (err == 0)
 390                 err = ioctl(sk, SIOCGIFHWADDR, &ifr);
 391
 392         close(sk);
 393
 394         if (err < 0)
 395                 return NULL;
 396
 397         len = prefix ? strlen(prefix) + 18 : 18;
 398
 399         str = malloc(len);
 400         if (!str)
 401                 return NULL;
 402
 403         memcpy(&eth, &ifr.ifr_hwaddr.sa_data, sizeof(eth));
 404         snprintf(str, len, "%s%02x%02x%02x%02x%02x%02x",
 405                                                 prefix ? prefix : "",
 406                                                 eth.ether_addr_octet[0],
 407                                                 eth.ether_addr_octet[1],
 408                                                 eth.ether_addr_octet[2],
 409                                                 eth.ether_addr_octet[3],
 410                                                 eth.ether_addr_octet[4],
 411                                                 eth.ether_addr_octet[5]);
 412
 413         return str;
 414 }
 415
 416 connman_bool_t connman_inet_is_cfg80211(int index)
 417 {
 418         connman_bool_t result = FALSE;
 419         char phy80211_path[PATH_MAX];
 420         struct stat st;
 421         struct ifreq ifr;
 422         int sk;
 423
 424         sk = socket(PF_INET, SOCK_DGRAM, 0);
 425         if (sk < 0)
 426                 return FALSE;
 427
 428         memset(&ifr, 0, sizeof(ifr));
 429         ifr.ifr_ifindex = index;
 430
 431         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0)
 432                 goto done;
 433
 434         snprintf(phy80211_path, PATH_MAX,
 435                                 "/sys/class/net/%s/phy80211", ifr.ifr_name);
 436
 437         if (stat(phy80211_path, &st) == 0 && (st.st_mode & S_IFDIR))
 438                 result = TRUE;
 439
 440 done:
 441         close(sk);
 442
 443         return result;
 444 }
 445
 446 struct connman_device *connman_inet_create_device(int index)
 447 {
 448         enum connman_device_type type;
 449         struct connman_device *device;
 450         char *devname, *ident = NULL;
 451         char *addr = NULL, *name = NULL;
 452
 453         if (index < 0)
 454                 return NULL;
 455
 456         devname = connman_inet_ifname(index);
 457         if (devname == NULL)
 458                 return NULL;
 459
 460         if (__connman_element_device_isfiltered(devname) == TRUE) {
 461                 connman_info("Ignoring interface %s (filtered)", devname);
 462                 return NULL;
 463         }
 464
 465         type = __connman_rtnl_get_device_type(index);
 466
 467         switch (type) {
 468         case CONNMAN_DEVICE_TYPE_UNKNOWN:
 469                 connman_info("Ignoring interface %s (type unknown)", devname);
 470                 g_free(devname);
 471                 return NULL;
 472         case CONNMAN_DEVICE_TYPE_ETHERNET:
 473         case CONNMAN_DEVICE_TYPE_GADGET:
 474         case CONNMAN_DEVICE_TYPE_WIFI:
 475         case CONNMAN_DEVICE_TYPE_WIMAX:
 476                 name = index2ident(index, "");
 477                 addr = index2addr(index);
 478                 break;
 479         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
 480         case CONNMAN_DEVICE_TYPE_CELLULAR:
 481         case CONNMAN_DEVICE_TYPE_GPS:
 482         case CONNMAN_DEVICE_TYPE_VENDOR:
 483                 name = strdup(devname);
 484                 break;
 485         }
 486
 487         device = connman_device_create(name, type);
 488         if (device == NULL)
 489                 goto done;
 490
 491         switch (type) {
 492         case CONNMAN_DEVICE_TYPE_UNKNOWN:
 493         case CONNMAN_DEVICE_TYPE_VENDOR:
 494         case CONNMAN_DEVICE_TYPE_GPS:
 495                 break;
 496         case CONNMAN_DEVICE_TYPE_ETHERNET:
 497         case CONNMAN_DEVICE_TYPE_GADGET:
 498                 ident = index2ident(index, NULL);
 499                 break;
 500         case CONNMAN_DEVICE_TYPE_WIFI:
 501         case CONNMAN_DEVICE_TYPE_WIMAX:
 502                 ident = index2ident(index, NULL);
 503                 break;
 504         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
 505                 break;
 506         case CONNMAN_DEVICE_TYPE_CELLULAR:
 507                 ident = index2ident(index, NULL);
 508                 break;
 509         }
 510
 511         connman_device_set_index(device, index);
 512         connman_device_set_interface(device, devname);
 513
 514         if (ident != NULL) {
 515                 connman_device_set_ident(device, ident);
 516                 free(ident);
 517         }
 518
 519         connman_device_set_string(device, "Address", addr);
 520
 521 done:
 522         g_free(devname);
 523         free(name);
 524         free(addr);
 525
 526         return device;
 527 }
 528
 529 struct in6_ifreq {
 530         struct in6_addr ifr6_addr;
 531         __u32 ifr6_prefixlen;
 532         unsigned int ifr6_ifindex;
 533 };
 534
 535 int connman_inet_set_ipv6_address(int index,
 536                 struct connman_ipaddress *ipaddress)
 537 {
 538         unsigned char prefix_len;
 539         const char *address;
 540
 541         if (ipaddress->local == NULL)
 542                 return 0;
 543
 544         prefix_len = ipaddress->prefixlen;
 545         address = ipaddress->local;
 546
 547         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 548
 549         if ((__connman_inet_modify_address(RTM_NEWADDR,
 550                         NLM_F_REPLACE | NLM_F_ACK, index, AF_INET6,
 551                                 address, NULL, prefix_len, NULL)) < 0) {
 552                 connman_error("Set IPv6 address error");
 553                 return -1;
 554         }
 555
 556         return 0;
 557 }
 558
 559 int connman_inet_set_address(int index, struct connman_ipaddress *ipaddress)
 560 {
 561         unsigned char prefix_len;
 562         const char *address, *broadcast, *peer;
 563
 564         if (ipaddress->local == NULL)
 565                 return -1;
 566
 567         prefix_len = ipaddress->prefixlen;
 568         address = ipaddress->local;
 569         broadcast = ipaddress->broadcast;
 570         peer = ipaddress->peer;
 571
 572         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 573
 574         if ((__connman_inet_modify_address(RTM_NEWADDR,
 575                         NLM_F_REPLACE | NLM_F_ACK, index, AF_INET,
 576                                 address, peer, prefix_len, broadcast)) < 0) {
 577                 DBG("address setting failed");
 578                 return -1;
 579         }
 580
 581         return 0;
 582 }
 583
 584 int connman_inet_clear_ipv6_address(int index, const char *address,
 585                                                         int prefix_len)
 586 {
 587         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 588
 589         if ((__connman_inet_modify_address(RTM_DELADDR, 0, index, AF_INET6,
 590                                         address, NULL, prefix_len, NULL)) < 0) {
 591                 connman_error("Clear IPv6 address error");
 592                 return -1;
 593         }
 594
 595         return 0;
 596 }
 597
 598 int connman_inet_clear_address(int index, struct connman_ipaddress *ipaddress)
 599 {
 600         unsigned char prefix_len;
 601         const char *address, *broadcast, *peer;
 602
 603         prefix_len = ipaddress->prefixlen;
 604         address = ipaddress->local;
 605         broadcast = ipaddress->broadcast;
 606         peer = ipaddress->peer;
 607
 608         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 609
 610         if ((__connman_inet_modify_address(RTM_DELADDR, 0, index, AF_INET,
 611                                 address, peer, prefix_len, broadcast)) < 0) {
 612                 DBG("address removal failed");
 613                 return -1;
 614         }
 615
 616         return 0;
 617 }
 618
 619 int connman_inet_add_host_route(int index, const char *host,
 620                                 const char *gateway)
 621 {
 622         return connman_inet_add_network_route(index, host, gateway, NULL);
 623 }
 624
 625 int connman_inet_del_host_route(int index, const char *host)
 626 {
 627         return connman_inet_del_network_route(index, host);
 628 }
 629
 630 int connman_inet_add_network_route(int index, const char *host,
 631                                         const char *gateway,
 632                                         const char *netmask)
 633 {
 634         struct ifreq ifr;
 635         struct rtentry rt;
 636         struct sockaddr_in addr;
 637         int sk, err;
 638
 639         sk = socket(PF_INET, SOCK_DGRAM, 0);
 640         if (sk < 0)
 641                 return -1;
 642
 643         memset(&ifr, 0, sizeof(ifr));
 644         ifr.ifr_ifindex = index;
 645
 646         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 647                 close(sk);
 648                 return -1;
 649         }
 650
 651         DBG("ifname %s", ifr.ifr_name);
 652
 653         memset(&rt, 0, sizeof(rt));
 654         rt.rt_flags = RTF_UP;
 655         if (gateway != NULL)
 656                 rt.rt_flags |= RTF_GATEWAY;
 657         if (netmask == NULL)
 658                 rt.rt_flags |= RTF_HOST;
 659
 660         memset(&addr, 0, sizeof(addr));
 661         addr.sin_family = AF_INET;
 662         addr.sin_addr.s_addr = inet_addr(host);
 663         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 664
 665         memset(&addr, 0, sizeof(addr));
 666         addr.sin_family = AF_INET;
 667         if (gateway != NULL)
 668                 addr.sin_addr.s_addr = inet_addr(gateway);
 669         else
 670                 addr.sin_addr.s_addr = INADDR_ANY;
 671         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 672
 673         memset(&addr, 0, sizeof(addr));
 674         addr.sin_family = AF_INET;
 675         addr.sin_addr.s_addr = INADDR_ANY;
 676         if (netmask != NULL)
 677                 addr.sin_addr.s_addr = inet_addr(netmask);
 678         else
 679                 addr.sin_addr.s_addr = INADDR_ANY;
 680         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 681
 682         rt.rt_dev = ifr.ifr_name;
 683
 684         err = ioctl(sk, SIOCADDRT, &rt);
 685         if (err < 0)
 686                 connman_error("Adding host route failed (%s)",
 687                                                         strerror(errno));
 688
 689         close(sk);
 690
 691         return err;
 692 }
 693
 694 int connman_inet_del_network_route(int index, const char *host)
 695 {
 696         struct ifreq ifr;
 697         struct rtentry rt;
 698         struct sockaddr_in addr;
 699         int sk, err;
 700
 701         sk = socket(PF_INET, SOCK_DGRAM, 0);
 702         if (sk < 0)
 703                 return -1;
 704
 705         memset(&ifr, 0, sizeof(ifr));
 706         ifr.ifr_ifindex = index;
 707
 708         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 709                 close(sk);
 710                 return -1;
 711         }
 712
 713         DBG("ifname %s", ifr.ifr_name);
 714
 715         memset(&rt, 0, sizeof(rt));
 716         rt.rt_flags = RTF_UP | RTF_HOST;
 717
 718         memset(&addr, 0, sizeof(addr));
 719         addr.sin_family = AF_INET;
 720         addr.sin_addr.s_addr = inet_addr(host);
 721         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 722
 723         rt.rt_dev = ifr.ifr_name;
 724
 725         err = ioctl(sk, SIOCDELRT, &rt);
 726         if (err < 0)
 727                 connman_error("Deleting host route failed (%s)",
 728                                                         strerror(errno));
 729
 730         close(sk);
 731
 732         return err;
 733 }
 734
 735 int connman_inet_del_ipv6_host_route(int index, const char *host)
 736 {
 737         struct in6_rtmsg rt;
 738         int sk, err;
 739
 740         DBG("index %d host %s", index, host);
 741
 742         if (host == NULL)
 743                 return -EINVAL;
 744
 745         memset(&rt, 0, sizeof(rt));
 746
 747         rt.rtmsg_dst_len = 128;
 748
 749         err = inet_pton(AF_INET6, host, &rt.rtmsg_dst);
 750         if (err < 0)
 751                 goto out;
 752
 753         rt.rtmsg_flags = RTF_UP | RTF_HOST;
 754
 755         rt.rtmsg_metric = 1;
 756         rt.rtmsg_ifindex = index;
 757
 758         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 759         if (sk < 0) {
 760                 err = -1;
 761                 goto out;
 762         }
 763
 764         err = ioctl(sk, SIOCDELRT, &rt);
 765         close(sk);
 766 out:
 767         if (err < 0)
 768                 connman_error("Del IPv6 host route error");
 769
 770         return err;
 771 }
 772
 773 int connman_inet_add_ipv6_host_route(int index, const char *host,
 774                                                 const char *gateway)
 775 {
 776         struct in6_rtmsg rt;
 777         int sk, err;
 778
 779         DBG("index %d host %s gateway %s", index, host, gateway);
 780
 781         if (host == NULL)
 782                 return -EINVAL;
 783
 784         memset(&rt, 0, sizeof(rt));
 785
 786         rt.rtmsg_dst_len = 128;
 787
 788         err = inet_pton(AF_INET6, host, &rt.rtmsg_dst);
 789         if (err < 0)
 790                 goto out;
 791
 792         rt.rtmsg_flags = RTF_UP | RTF_HOST;
 793
 794         if (gateway != NULL) {
 795                 rt.rtmsg_flags |= RTF_GATEWAY;
 796                 inet_pton(AF_INET6, gateway, &rt.rtmsg_gateway);
 797         }
 798
 799         rt.rtmsg_metric = 1;
 800         rt.rtmsg_ifindex = index;
 801
 802         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 803         if (sk < 0) {
 804                 err = -1;
 805                 goto out;
 806         }
 807
 808         err = ioctl(sk, SIOCADDRT, &rt);
 809         close(sk);
 810 out:
 811         if (err < 0)
 812                 connman_error("Set IPv6 host route error");
 813
 814         return err;
 815 }
 816
 817 int connman_inet_set_ipv6_gateway_address(int index, const char *gateway)
 818 {
 819         struct in6_rtmsg rt;
 820         int sk, err;
 821
 822         DBG("index %d, gateway %s", index, gateway);
 823
 824         if (gateway == NULL)
 825                 return -EINVAL;
 826
 827         memset(&rt, 0, sizeof(rt));
 828
 829         err = inet_pton(AF_INET6, gateway, &rt.rtmsg_gateway);
 830         if (err < 0)
 831                 goto out;
 832
 833         rt.rtmsg_flags = RTF_UP | RTF_GATEWAY;
 834         rt.rtmsg_metric = 1;
 835         rt.rtmsg_dst_len = 0;
 836         rt.rtmsg_ifindex = index;
 837
 838         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 839         if (sk < 0) {
 840                 err = -1;
 841                 goto out;
 842         }
 843
 844         err = ioctl(sk, SIOCADDRT, &rt);
 845         close(sk);
 846 out:
 847         if (err < 0)
 848                 connman_error("Set default IPv6 gateway error");
 849
 850         return err;
 851 }
 852
 853 int connman_inet_clear_ipv6_gateway_address(int index, const char *gateway)
 854 {
 855         struct in6_rtmsg rt;
 856         int sk, err;
 857
 858         DBG("index %d, gateway %s", index, gateway);
 859
 860         if (gateway == NULL)
 861                 return -EINVAL;
 862
 863         memset(&rt, 0, sizeof(rt));
 864
 865         err = inet_pton(AF_INET6, gateway, &rt.rtmsg_gateway);
 866         if (err < 0)
 867                 goto out;
 868
 869         rt.rtmsg_flags = RTF_UP | RTF_GATEWAY;
 870         rt.rtmsg_metric = 1;
 871         rt.rtmsg_dst_len = 0;
 872         rt.rtmsg_ifindex = index;
 873
 874         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 875         if (sk < 0) {
 876                 err = -1;
 877                 goto out;
 878         }
 879
 880         err = ioctl(sk, SIOCDELRT, &rt);
 881         close(sk);
 882 out:
 883         if (err < 0)
 884                 connman_error("Clear default IPv6 gateway error");
 885
 886         return err;
 887 }
 888
 889 int connman_inet_set_gateway_address(int index, const char *gateway)
 890 {
 891         struct ifreq ifr;
 892         struct rtentry rt;
 893         struct sockaddr_in addr;
 894         int sk, err;
 895
 896         sk = socket(PF_INET, SOCK_DGRAM, 0);
 897         if (sk < 0)
 898                 return -1;
 899
 900         memset(&ifr, 0, sizeof(ifr));
 901         ifr.ifr_ifindex = index;
 902
 903         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 904                 close(sk);
 905                 return -1;
 906         }
 907
 908         DBG("ifname %s", ifr.ifr_name);
 909
 910         memset(&rt, 0, sizeof(rt));
 911         rt.rt_flags = RTF_UP | RTF_GATEWAY;
 912
 913         memset(&addr, 0, sizeof(addr));
 914         addr.sin_family = AF_INET;
 915         addr.sin_addr.s_addr = INADDR_ANY;
 916         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 917
 918         memset(&addr, 0, sizeof(addr));
 919         addr.sin_family = AF_INET;
 920         addr.sin_addr.s_addr = inet_addr(gateway);
 921         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 922
 923         memset(&addr, 0, sizeof(addr));
 924         addr.sin_family = AF_INET;
 925         addr.sin_addr.s_addr = INADDR_ANY;
 926         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 927
 928         err = ioctl(sk, SIOCADDRT, &rt);
 929         if (err < 0)
 930                 connman_error("Setting default gateway route failed (%s)",
 931                                                         strerror(errno));
 932
 933         close(sk);
 934
 935         return err;
 936 }
 937
 938 int connman_inet_set_gateway_interface(int index)
 939 {
 940         struct ifreq ifr;
 941         struct rtentry rt;
 942         struct sockaddr_in addr;
 943         int sk, err;
 944
 945         DBG("");
 946
 947         sk = socket(PF_INET, SOCK_DGRAM, 0);
 948         if (sk < 0)
 949                 return -1;
 950
 951         memset(&ifr, 0, sizeof(ifr));
 952         ifr.ifr_ifindex = index;
 953
 954         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 955                 close(sk);
 956                 return -1;
 957         }
 958
 959         DBG("ifname %s", ifr.ifr_name);
 960
 961         memset(&rt, 0, sizeof(rt));
 962         rt.rt_flags = RTF_UP;
 963
 964         memset(&addr, 0, sizeof(addr));
 965         addr.sin_family = AF_INET;
 966         addr.sin_addr.s_addr = INADDR_ANY;
 967
 968         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 969         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 970         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 971
 972         rt.rt_dev = ifr.ifr_name;
 973
 974         err = ioctl(sk, SIOCADDRT, &rt);
 975         if (err < 0)
 976                 connman_error("Setting default interface route failed (%s)",
 977                                                         strerror(errno));
 978         close(sk);
 979
 980         return err;
 981 }
 982
 983 int connman_inet_clear_gateway_address(int index, const char *gateway)
 984 {
 985         struct ifreq ifr;
 986         struct rtentry rt;
 987         struct sockaddr_in addr;
 988         int sk, err;
 989
 990         DBG("");
 991
 992         sk = socket(PF_INET, SOCK_DGRAM, 0);
 993         if (sk < 0)
 994                 return -1;
 995
 996         memset(&ifr, 0, sizeof(ifr));
 997         ifr.ifr_ifindex = index;
 998
 999         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
1000                 close(sk);
1001                 return -1;
1002         }
1003
1004         DBG("ifname %s", ifr.ifr_name);
1005
1006         memset(&rt, 0, sizeof(rt));
1007         rt.rt_flags = RTF_UP | RTF_GATEWAY;
1008
1009         memset(&addr, 0, sizeof(addr));
1010         addr.sin_family = AF_INET;
1011         addr.sin_addr.s_addr = INADDR_ANY;
1012         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
1013
1014         memset(&addr, 0, sizeof(addr));
1015         addr.sin_family = AF_INET;
1016         addr.sin_addr.s_addr = inet_addr(gateway);
1017         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
1018
1019         memset(&addr, 0, sizeof(addr));
1020         addr.sin_family = AF_INET;
1021         addr.sin_addr.s_addr = INADDR_ANY;
1022         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
1023
1024         err = ioctl(sk, SIOCDELRT, &rt);
1025         if (err < 0)
1026                 connman_error("Removing default gateway route failed (%s)",
1027                                                         strerror(errno));
1028
1029         close(sk);
1030
1031         return err;
1032 }
1033
1034 int connman_inet_clear_gateway_interface(int index)
1035 {
1036         struct ifreq ifr;
1037         struct rtentry rt;
1038         struct sockaddr_in addr;
1039         int sk, err;
1040
1041         DBG("");
1042
1043         sk = socket(PF_INET, SOCK_DGRAM, 0);
1044         if (sk < 0)
1045                 return -1;
1046
1047         memset(&ifr, 0, sizeof(ifr));
1048         ifr.ifr_ifindex = index;
1049
1050         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
1051                 close(sk);
1052                 return -1;
1053         }
1054
1055         DBG("ifname %s", ifr.ifr_name);
1056
1057         memset(&rt, 0, sizeof(rt));
1058         rt.rt_flags = RTF_UP;
1059
1060         memset(&addr, 0, sizeof(addr));
1061         addr.sin_family = AF_INET;
1062         addr.sin_addr.s_addr = INADDR_ANY;
1063
1064         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
1065         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
1066         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
1067
1068         rt.rt_dev = ifr.ifr_name;
1069
1070         err = ioctl(sk, SIOCDELRT, &rt);
1071         if (err < 0)
1072                 connman_error("Removing default interface route failed (%s)",
1073                                                         strerror(errno));
1074         close(sk);
1075
1076         return err;
1077 }
1078
1079 connman_bool_t connman_inet_compare_subnet(int index, const char *host)
1080 {
1081         struct ifreq ifr;
1082         struct in_addr _host_addr;
1083         in_addr_t host_addr, netmask_addr, if_addr;
1084         struct sockaddr_in *netmask, *addr;
1085         int sk;
1086
1087         DBG("host %s", host);
1088
1089         if (host == NULL)
1090                 return FALSE;
1091
1092         if (inet_aton(host, &_host_addr) == 0)
1093                 return -1;
1094         host_addr = _host_addr.s_addr;
1095
1096         sk = socket(PF_INET, SOCK_DGRAM, 0);
1097         if (sk < 0)
1098                 return FALSE;
1099
1100         memset(&ifr, 0, sizeof(ifr));
1101         ifr.ifr_ifindex = index;
1102
1103         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
1104                 close(sk);
1105                 return FALSE;
1106         }
1107
1108         if (ioctl(sk, SIOCGIFNETMASK, &ifr) < 0) {
1109                 close(sk);
1110                 return FALSE;
1111         }
1112
1113         netmask = (struct sockaddr_in *)&ifr.ifr_netmask;
1114         netmask_addr = netmask->sin_addr.s_addr;
1115
1116         if (ioctl(sk, SIOCGIFADDR, &ifr) < 0) {
1117                 close(sk);
1118                 return FALSE;
1119         }
1120         addr = (struct sockaddr_in *)&ifr.ifr_addr;
1121         if_addr = addr->sin_addr.s_addr;
1122
1123         return ((if_addr & netmask_addr) == (host_addr & netmask_addr));
1124 }
1125
1126 int connman_inet_remove_from_bridge(int index, const char *bridge)
1127 {
1128         struct ifreq ifr;
1129         int sk, err;
1130
1131         if (bridge == NULL)
1132                 return -EINVAL;
1133
1134         sk = socket(AF_INET, SOCK_STREAM, 0);
1135         if (sk < 0)
1136                 return sk;
1137
1138         memset(&ifr, 0, sizeof(ifr));
1139         strncpy(ifr.ifr_name, bridge, IFNAMSIZ - 1);
1140         ifr.ifr_ifindex = index;
1141
1142         err = ioctl(sk, SIOCBRDELIF, &ifr);
1143
1144         close(sk);
1145
1146         if (err < 0) {
1147                 connman_error("Remove interface from bridge error %s",
1148                                                         strerror(errno));
1149                 return err;
1150         }
1151
1152         return 0;
1153 }
1154
1155 int connman_inet_add_to_bridge(int index, const char *bridge)
1156 {
1157         struct ifreq ifr;
1158         int sk, err;
1159
1160         if (bridge == NULL)
1161                 return -EINVAL;
1162
1163         sk = socket(AF_INET, SOCK_STREAM, 0);
1164         if (sk < 0)
1165                 return sk;
1166
1167         memset(&ifr, 0, sizeof(ifr));
1168         strncpy(ifr.ifr_name, bridge, IFNAMSIZ - 1);
1169         ifr.ifr_ifindex = index;
1170
1171         err = ioctl(sk, SIOCBRADDIF, &ifr);
1172
1173         close(sk);
1174
1175         if (err < 0) {
1176                 connman_error("Add interface to bridge error %s",
1177                                                         strerror(errno));
1178                 return err;
1179         }
1180
1181         return 0;
1182 }