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                 g_free(devname);
 463                 return NULL;
 464         }
 465
 466         type = __connman_rtnl_get_device_type(index);
 467
 468         switch (type) {
 469         case CONNMAN_DEVICE_TYPE_UNKNOWN:
 470                 connman_info("Ignoring interface %s (type unknown)", devname);
 471                 g_free(devname);
 472                 return NULL;
 473         case CONNMAN_DEVICE_TYPE_ETHERNET:
 474         case CONNMAN_DEVICE_TYPE_GADGET:
 475         case CONNMAN_DEVICE_TYPE_WIFI:
 476         case CONNMAN_DEVICE_TYPE_WIMAX:
 477                 name = index2ident(index, "");
 478                 addr = index2addr(index);
 479                 break;
 480         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
 481         case CONNMAN_DEVICE_TYPE_CELLULAR:
 482         case CONNMAN_DEVICE_TYPE_GPS:
 483         case CONNMAN_DEVICE_TYPE_VENDOR:
 484                 name = strdup(devname);
 485                 break;
 486         }
 487
 488         device = connman_device_create(name, type);
 489         if (device == NULL)
 490                 goto done;
 491
 492         switch (type) {
 493         case CONNMAN_DEVICE_TYPE_UNKNOWN:
 494         case CONNMAN_DEVICE_TYPE_VENDOR:
 495         case CONNMAN_DEVICE_TYPE_GPS:
 496                 break;
 497         case CONNMAN_DEVICE_TYPE_ETHERNET:
 498         case CONNMAN_DEVICE_TYPE_GADGET:
 499                 ident = index2ident(index, NULL);
 500                 break;
 501         case CONNMAN_DEVICE_TYPE_WIFI:
 502         case CONNMAN_DEVICE_TYPE_WIMAX:
 503                 ident = index2ident(index, NULL);
 504                 break;
 505         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
 506                 break;
 507         case CONNMAN_DEVICE_TYPE_CELLULAR:
 508                 ident = index2ident(index, NULL);
 509                 break;
 510         }
 511
 512         connman_device_set_index(device, index);
 513         connman_device_set_interface(device, devname);
 514
 515         if (ident != NULL) {
 516                 connman_device_set_ident(device, ident);
 517                 free(ident);
 518         }
 519
 520         connman_device_set_string(device, "Address", addr);
 521
 522 done:
 523         g_free(devname);
 524         free(name);
 525         free(addr);
 526
 527         return device;
 528 }
 529
 530 struct in6_ifreq {
 531         struct in6_addr ifr6_addr;
 532         __u32 ifr6_prefixlen;
 533         unsigned int ifr6_ifindex;
 534 };
 535
 536 int connman_inet_set_ipv6_address(int index,
 537                 struct connman_ipaddress *ipaddress)
 538 {
 539         unsigned char prefix_len;
 540         const char *address;
 541
 542         if (ipaddress->local == NULL)
 543                 return 0;
 544
 545         prefix_len = ipaddress->prefixlen;
 546         address = ipaddress->local;
 547
 548         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 549
 550         if ((__connman_inet_modify_address(RTM_NEWADDR,
 551                         NLM_F_REPLACE | NLM_F_ACK, index, AF_INET6,
 552                                 address, NULL, prefix_len, NULL)) < 0) {
 553                 connman_error("Set IPv6 address error");
 554                 return -1;
 555         }
 556
 557         return 0;
 558 }
 559
 560 int connman_inet_set_address(int index, struct connman_ipaddress *ipaddress)
 561 {
 562         unsigned char prefix_len;
 563         const char *address, *broadcast, *peer;
 564
 565         if (ipaddress->local == NULL)
 566                 return -1;
 567
 568         prefix_len = ipaddress->prefixlen;
 569         address = ipaddress->local;
 570         broadcast = ipaddress->broadcast;
 571         peer = ipaddress->peer;
 572
 573         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 574
 575         if ((__connman_inet_modify_address(RTM_NEWADDR,
 576                         NLM_F_REPLACE | NLM_F_ACK, index, AF_INET,
 577                                 address, peer, prefix_len, broadcast)) < 0) {
 578                 DBG("address setting failed");
 579                 return -1;
 580         }
 581
 582         return 0;
 583 }
 584
 585 int connman_inet_clear_ipv6_address(int index, const char *address,
 586                                                         int prefix_len)
 587 {
 588         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 589
 590         if ((__connman_inet_modify_address(RTM_DELADDR, 0, index, AF_INET6,
 591                                         address, NULL, prefix_len, NULL)) < 0) {
 592                 connman_error("Clear IPv6 address error");
 593                 return -1;
 594         }
 595
 596         return 0;
 597 }
 598
 599 int connman_inet_clear_address(int index, struct connman_ipaddress *ipaddress)
 600 {
 601         unsigned char prefix_len;
 602         const char *address, *broadcast, *peer;
 603
 604         prefix_len = ipaddress->prefixlen;
 605         address = ipaddress->local;
 606         broadcast = ipaddress->broadcast;
 607         peer = ipaddress->peer;
 608
 609         DBG("index %d address %s prefix_len %d", index, address, prefix_len);
 610
 611         if ((__connman_inet_modify_address(RTM_DELADDR, 0, index, AF_INET,
 612                                 address, peer, prefix_len, broadcast)) < 0) {
 613                 DBG("address removal failed");
 614                 return -1;
 615         }
 616
 617         return 0;
 618 }
 619
 620 int connman_inet_add_host_route(int index, const char *host,
 621                                 const char *gateway)
 622 {
 623         return connman_inet_add_network_route(index, host, gateway, NULL);
 624 }
 625
 626 int connman_inet_del_host_route(int index, const char *host)
 627 {
 628         return connman_inet_del_network_route(index, host);
 629 }
 630
 631 int connman_inet_add_network_route(int index, const char *host,
 632                                         const char *gateway,
 633                                         const char *netmask)
 634 {
 635         struct ifreq ifr;
 636         struct rtentry rt;
 637         struct sockaddr_in addr;
 638         int sk, err;
 639
 640         sk = socket(PF_INET, SOCK_DGRAM, 0);
 641         if (sk < 0)
 642                 return -1;
 643
 644         memset(&ifr, 0, sizeof(ifr));
 645         ifr.ifr_ifindex = index;
 646
 647         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 648                 close(sk);
 649                 return -1;
 650         }
 651
 652         DBG("ifname %s", ifr.ifr_name);
 653
 654         memset(&rt, 0, sizeof(rt));
 655         rt.rt_flags = RTF_UP;
 656         if (gateway != NULL)
 657                 rt.rt_flags |= RTF_GATEWAY;
 658         if (netmask == NULL)
 659                 rt.rt_flags |= RTF_HOST;
 660
 661         memset(&addr, 0, sizeof(addr));
 662         addr.sin_family = AF_INET;
 663         addr.sin_addr.s_addr = inet_addr(host);
 664         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 665
 666         memset(&addr, 0, sizeof(addr));
 667         addr.sin_family = AF_INET;
 668         if (gateway != NULL)
 669                 addr.sin_addr.s_addr = inet_addr(gateway);
 670         else
 671                 addr.sin_addr.s_addr = INADDR_ANY;
 672         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 673
 674         memset(&addr, 0, sizeof(addr));
 675         addr.sin_family = AF_INET;
 676         addr.sin_addr.s_addr = INADDR_ANY;
 677         if (netmask != NULL)
 678                 addr.sin_addr.s_addr = inet_addr(netmask);
 679         else
 680                 addr.sin_addr.s_addr = INADDR_ANY;
 681         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 682
 683         rt.rt_dev = ifr.ifr_name;
 684
 685         err = ioctl(sk, SIOCADDRT, &rt);
 686         if (err < 0)
 687                 connman_error("Adding host route failed (%s)",
 688                                                         strerror(errno));
 689
 690         close(sk);
 691
 692         return err;
 693 }
 694
 695 int connman_inet_del_network_route(int index, const char *host)
 696 {
 697         struct ifreq ifr;
 698         struct rtentry rt;
 699         struct sockaddr_in addr;
 700         int sk, err;
 701
 702         sk = socket(PF_INET, SOCK_DGRAM, 0);
 703         if (sk < 0)
 704                 return -1;
 705
 706         memset(&ifr, 0, sizeof(ifr));
 707         ifr.ifr_ifindex = index;
 708
 709         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 710                 close(sk);
 711                 return -1;
 712         }
 713
 714         DBG("ifname %s", ifr.ifr_name);
 715
 716         memset(&rt, 0, sizeof(rt));
 717         rt.rt_flags = RTF_UP | RTF_HOST;
 718
 719         memset(&addr, 0, sizeof(addr));
 720         addr.sin_family = AF_INET;
 721         addr.sin_addr.s_addr = inet_addr(host);
 722         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 723
 724         rt.rt_dev = ifr.ifr_name;
 725
 726         err = ioctl(sk, SIOCDELRT, &rt);
 727         if (err < 0)
 728                 connman_error("Deleting host route failed (%s)",
 729                                                         strerror(errno));
 730
 731         close(sk);
 732
 733         return err;
 734 }
 735
 736 int connman_inet_del_ipv6_host_route(int index, const char *host)
 737 {
 738         struct in6_rtmsg rt;
 739         int sk, err;
 740
 741         DBG("index %d host %s", index, host);
 742
 743         if (host == NULL)
 744                 return -EINVAL;
 745
 746         memset(&rt, 0, sizeof(rt));
 747
 748         rt.rtmsg_dst_len = 128;
 749
 750         err = inet_pton(AF_INET6, host, &rt.rtmsg_dst);
 751         if (err < 0)
 752                 goto out;
 753
 754         rt.rtmsg_flags = RTF_UP | RTF_HOST;
 755
 756         rt.rtmsg_metric = 1;
 757         rt.rtmsg_ifindex = index;
 758
 759         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 760         if (sk < 0) {
 761                 err = -1;
 762                 goto out;
 763         }
 764
 765         err = ioctl(sk, SIOCDELRT, &rt);
 766         close(sk);
 767 out:
 768         if (err < 0)
 769                 connman_error("Del IPv6 host route error");
 770
 771         return err;
 772 }
 773
 774 int connman_inet_add_ipv6_host_route(int index, const char *host,
 775                                                 const char *gateway)
 776 {
 777         struct in6_rtmsg rt;
 778         int sk, err;
 779
 780         DBG("index %d host %s gateway %s", index, host, gateway);
 781
 782         if (host == NULL)
 783                 return -EINVAL;
 784
 785         memset(&rt, 0, sizeof(rt));
 786
 787         rt.rtmsg_dst_len = 128;
 788
 789         err = inet_pton(AF_INET6, host, &rt.rtmsg_dst);
 790         if (err < 0)
 791                 goto out;
 792
 793         rt.rtmsg_flags = RTF_UP | RTF_HOST;
 794
 795         if (gateway != NULL) {
 796                 rt.rtmsg_flags |= RTF_GATEWAY;
 797                 inet_pton(AF_INET6, gateway, &rt.rtmsg_gateway);
 798         }
 799
 800         rt.rtmsg_metric = 1;
 801         rt.rtmsg_ifindex = index;
 802
 803         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 804         if (sk < 0) {
 805                 err = -1;
 806                 goto out;
 807         }
 808
 809         err = ioctl(sk, SIOCADDRT, &rt);
 810         close(sk);
 811 out:
 812         if (err < 0)
 813                 connman_error("Set IPv6 host route error");
 814
 815         return err;
 816 }
 817
 818 int connman_inet_set_ipv6_gateway_address(int index, const char *gateway)
 819 {
 820         struct in6_rtmsg rt;
 821         int sk, err;
 822
 823         DBG("index %d, gateway %s", index, gateway);
 824
 825         if (gateway == NULL)
 826                 return -EINVAL;
 827
 828         memset(&rt, 0, sizeof(rt));
 829
 830         err = inet_pton(AF_INET6, gateway, &rt.rtmsg_gateway);
 831         if (err < 0)
 832                 goto out;
 833
 834         rt.rtmsg_flags = RTF_UP | RTF_GATEWAY;
 835         rt.rtmsg_metric = 1;
 836         rt.rtmsg_dst_len = 0;
 837         rt.rtmsg_ifindex = index;
 838
 839         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 840         if (sk < 0) {
 841                 err = -1;
 842                 goto out;
 843         }
 844
 845         err = ioctl(sk, SIOCADDRT, &rt);
 846         close(sk);
 847 out:
 848         if (err < 0)
 849                 connman_error("Set default IPv6 gateway error");
 850
 851         return err;
 852 }
 853
 854 int connman_inet_clear_ipv6_gateway_address(int index, const char *gateway)
 855 {
 856         struct in6_rtmsg rt;
 857         int sk, err;
 858
 859         DBG("index %d, gateway %s", index, gateway);
 860
 861         if (gateway == NULL)
 862                 return -EINVAL;
 863
 864         memset(&rt, 0, sizeof(rt));
 865
 866         err = inet_pton(AF_INET6, gateway, &rt.rtmsg_gateway);
 867         if (err < 0)
 868                 goto out;
 869
 870         rt.rtmsg_flags = RTF_UP | RTF_GATEWAY;
 871         rt.rtmsg_metric = 1;
 872         rt.rtmsg_dst_len = 0;
 873         rt.rtmsg_ifindex = index;
 874
 875         sk = socket(AF_INET6, SOCK_DGRAM, 0);
 876         if (sk < 0) {
 877                 err = -1;
 878                 goto out;
 879         }
 880
 881         err = ioctl(sk, SIOCDELRT, &rt);
 882         close(sk);
 883 out:
 884         if (err < 0)
 885                 connman_error("Clear default IPv6 gateway error");
 886
 887         return err;
 888 }
 889
 890 int connman_inet_set_gateway_address(int index, const char *gateway)
 891 {
 892         struct ifreq ifr;
 893         struct rtentry rt;
 894         struct sockaddr_in addr;
 895         int sk, err;
 896
 897         sk = socket(PF_INET, SOCK_DGRAM, 0);
 898         if (sk < 0)
 899                 return -1;
 900
 901         memset(&ifr, 0, sizeof(ifr));
 902         ifr.ifr_ifindex = index;
 903
 904         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 905                 close(sk);
 906                 return -1;
 907         }
 908
 909         DBG("ifname %s", ifr.ifr_name);
 910
 911         memset(&rt, 0, sizeof(rt));
 912         rt.rt_flags = RTF_UP | RTF_GATEWAY;
 913
 914         memset(&addr, 0, sizeof(addr));
 915         addr.sin_family = AF_INET;
 916         addr.sin_addr.s_addr = INADDR_ANY;
 917         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 918
 919         memset(&addr, 0, sizeof(addr));
 920         addr.sin_family = AF_INET;
 921         addr.sin_addr.s_addr = inet_addr(gateway);
 922         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 923
 924         memset(&addr, 0, sizeof(addr));
 925         addr.sin_family = AF_INET;
 926         addr.sin_addr.s_addr = INADDR_ANY;
 927         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 928
 929         err = ioctl(sk, SIOCADDRT, &rt);
 930         if (err < 0)
 931                 connman_error("Setting default gateway route failed (%s)",
 932                                                         strerror(errno));
 933
 934         close(sk);
 935
 936         return err;
 937 }
 938
 939 int connman_inet_set_gateway_interface(int index)
 940 {
 941         struct ifreq ifr;
 942         struct rtentry rt;
 943         struct sockaddr_in addr;
 944         int sk, err;
 945
 946         DBG("");
 947
 948         sk = socket(PF_INET, SOCK_DGRAM, 0);
 949         if (sk < 0)
 950                 return -1;
 951
 952         memset(&ifr, 0, sizeof(ifr));
 953         ifr.ifr_ifindex = index;
 954
 955         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 956                 close(sk);
 957                 return -1;
 958         }
 959
 960         DBG("ifname %s", ifr.ifr_name);
 961
 962         memset(&rt, 0, sizeof(rt));
 963         rt.rt_flags = RTF_UP;
 964
 965         memset(&addr, 0, sizeof(addr));
 966         addr.sin_family = AF_INET;
 967         addr.sin_addr.s_addr = INADDR_ANY;
 968
 969         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 970         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 971         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 972
 973         rt.rt_dev = ifr.ifr_name;
 974
 975         err = ioctl(sk, SIOCADDRT, &rt);
 976         if (err < 0)
 977                 connman_error("Setting default interface route failed (%s)",
 978                                                         strerror(errno));
 979         close(sk);
 980
 981         return err;
 982 }
 983
 984 int connman_inet_clear_gateway_address(int index, const char *gateway)
 985 {
 986         struct ifreq ifr;
 987         struct rtentry rt;
 988         struct sockaddr_in addr;
 989         int sk, err;
 990
 991         DBG("");
 992
 993         sk = socket(PF_INET, SOCK_DGRAM, 0);
 994         if (sk < 0)
 995                 return -1;
 996
 997         memset(&ifr, 0, sizeof(ifr));
 998         ifr.ifr_ifindex = index;
 999
1000         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
1001                 close(sk);
1002                 return -1;
1003         }
1004
1005         DBG("ifname %s", ifr.ifr_name);
1006
1007         memset(&rt, 0, sizeof(rt));
1008         rt.rt_flags = RTF_UP | RTF_GATEWAY;
1009
1010         memset(&addr, 0, sizeof(addr));
1011         addr.sin_family = AF_INET;
1012         addr.sin_addr.s_addr = INADDR_ANY;
1013         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
1014
1015         memset(&addr, 0, sizeof(addr));
1016         addr.sin_family = AF_INET;
1017         addr.sin_addr.s_addr = inet_addr(gateway);
1018         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
1019
1020         memset(&addr, 0, sizeof(addr));
1021         addr.sin_family = AF_INET;
1022         addr.sin_addr.s_addr = INADDR_ANY;
1023         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
1024
1025         err = ioctl(sk, SIOCDELRT, &rt);
1026         if (err < 0)
1027                 connman_error("Removing default gateway route failed (%s)",
1028                                                         strerror(errno));
1029
1030         close(sk);
1031
1032         return err;
1033 }
1034
1035 int connman_inet_clear_gateway_interface(int index)
1036 {
1037         struct ifreq ifr;
1038         struct rtentry rt;
1039         struct sockaddr_in addr;
1040         int sk, err;
1041
1042         DBG("");
1043
1044         sk = socket(PF_INET, SOCK_DGRAM, 0);
1045         if (sk < 0)
1046                 return -1;
1047
1048         memset(&ifr, 0, sizeof(ifr));
1049         ifr.ifr_ifindex = index;
1050
1051         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
1052                 close(sk);
1053                 return -1;
1054         }
1055
1056         DBG("ifname %s", ifr.ifr_name);
1057
1058         memset(&rt, 0, sizeof(rt));
1059         rt.rt_flags = RTF_UP;
1060
1061         memset(&addr, 0, sizeof(addr));
1062         addr.sin_family = AF_INET;
1063         addr.sin_addr.s_addr = INADDR_ANY;
1064
1065         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
1066         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
1067         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
1068
1069         rt.rt_dev = ifr.ifr_name;
1070
1071         err = ioctl(sk, SIOCDELRT, &rt);
1072         if (err < 0)
1073                 connman_error("Removing default interface route failed (%s)",
1074                                                         strerror(errno));
1075         close(sk);
1076
1077         return err;
1078 }
1079
1080 connman_bool_t connman_inet_compare_subnet(int index, const char *host)
1081 {
1082         struct ifreq ifr;
1083         struct in_addr _host_addr;
1084         in_addr_t host_addr, netmask_addr, if_addr;
1085         struct sockaddr_in *netmask, *addr;
1086         int sk;
1087
1088         DBG("host %s", host);
1089
1090         if (host == NULL)
1091                 return FALSE;
1092
1093         if (inet_aton(host, &_host_addr) == 0)
1094                 return -1;
1095         host_addr = _host_addr.s_addr;
1096
1097         sk = socket(PF_INET, SOCK_DGRAM, 0);
1098         if (sk < 0)
1099                 return FALSE;
1100
1101         memset(&ifr, 0, sizeof(ifr));
1102         ifr.ifr_ifindex = index;
1103
1104         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
1105                 close(sk);
1106                 return FALSE;
1107         }
1108
1109         if (ioctl(sk, SIOCGIFNETMASK, &ifr) < 0) {
1110                 close(sk);
1111                 return FALSE;
1112         }
1113
1114         netmask = (struct sockaddr_in *)&ifr.ifr_netmask;
1115         netmask_addr = netmask->sin_addr.s_addr;
1116
1117         if (ioctl(sk, SIOCGIFADDR, &ifr) < 0) {
1118                 close(sk);
1119                 return FALSE;
1120         }
1121         addr = (struct sockaddr_in *)&ifr.ifr_addr;
1122         if_addr = addr->sin_addr.s_addr;
1123
1124         return ((if_addr & netmask_addr) == (host_addr & netmask_addr));
1125 }
1126
1127 int connman_inet_remove_from_bridge(int index, const char *bridge)
1128 {
1129         struct ifreq ifr;
1130         int sk, err;
1131
1132         if (bridge == NULL)
1133                 return -EINVAL;
1134
1135         sk = socket(AF_INET, SOCK_STREAM, 0);
1136         if (sk < 0)
1137                 return sk;
1138
1139         memset(&ifr, 0, sizeof(ifr));
1140         strncpy(ifr.ifr_name, bridge, IFNAMSIZ - 1);
1141         ifr.ifr_ifindex = index;
1142
1143         err = ioctl(sk, SIOCBRDELIF, &ifr);
1144
1145         close(sk);
1146
1147         if (err < 0) {
1148                 connman_error("Remove interface from bridge error %s",
1149                                                         strerror(errno));
1150                 return err;
1151         }
1152
1153         return 0;
1154 }
1155
1156 int connman_inet_add_to_bridge(int index, const char *bridge)
1157 {
1158         struct ifreq ifr;
1159         int sk, err;
1160
1161         if (bridge == NULL)
1162                 return -EINVAL;
1163
1164         sk = socket(AF_INET, SOCK_STREAM, 0);
1165         if (sk < 0)
1166                 return sk;
1167
1168         memset(&ifr, 0, sizeof(ifr));
1169         strncpy(ifr.ifr_name, bridge, IFNAMSIZ - 1);
1170         ifr.ifr_ifindex = index;
1171
1172         err = ioctl(sk, SIOCBRADDIF, &ifr);
1173
1174         close(sk);
1175
1176         if (err < 0) {
1177                 connman_error("Add interface to bridge error %s",
1178                                                         strerror(errno));
1179                 return err;
1180         }
1181
1182         return 0;
1183 }