src/connection.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 <errno.h>
  27 #include <unistd.h>
  28 #include <string.h>
  29 #include <sys/ioctl.h>
  30 #include <arpa/inet.h>
  31 #include <net/if.h>
  32 #include <net/route.h>
  33
  34 #include <gdbus.h>
  35
  36 #include "connman.h"
  37
  38 struct gateway_data {
  39         int index;
  40         char *gateway;
  41         struct connman_element *element;
  42         unsigned int order;
  43         gboolean active;
  44         /* VPN extra data */
  45         gboolean vpn;
  46         char *vpn_ip;
  47 };
  48
  49 static GSList *gateway_list = NULL;
  50
  51 static struct gateway_data *find_gateway(int index, const char *gateway)
  52 {
  53         GSList *list;
  54
  55         if (gateway == NULL)
  56                 return NULL;
  57
  58         for (list = gateway_list; list; list = list->next) {
  59                 struct gateway_data *data = list->data;
  60
  61                 if (data->gateway == NULL)
  62                         continue;
  63
  64                 if (data->index == index &&
  65                                 g_str_equal(data->gateway, gateway) == TRUE)
  66                         return data;
  67         }
  68
  69         return NULL;
  70 }
  71
  72 static int add_vpn_host(struct connman_element *element,
  73                         const char *gateway,
  74                         const char *host)
  75 {
  76         struct ifreq ifr;
  77         struct rtentry rt;
  78         struct sockaddr_in addr;
  79         int sk, err;
  80
  81         DBG("element %p", element);
  82
  83         sk = socket(PF_INET, SOCK_DGRAM, 0);
  84         if (sk < 0)
  85                 return -1;
  86
  87         memset(&ifr, 0, sizeof(ifr));
  88         ifr.ifr_ifindex = element->index;
  89
  90         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
  91                 close(sk);
  92                 return -1;
  93         }
  94         DBG("ifname %s", ifr.ifr_name);
  95
  96         memset(&rt, 0, sizeof(rt));
  97         rt.rt_flags = RTF_UP | RTF_HOST | RTF_GATEWAY;
  98
  99         memset(&addr, 0, sizeof(addr));
 100         addr.sin_family = AF_INET;
 101         addr.sin_addr.s_addr = inet_addr(host);
 102         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 103
 104         memset(&addr, 0, sizeof(addr));
 105         addr.sin_family = AF_INET;
 106         addr.sin_addr.s_addr = inet_addr(gateway);
 107         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 108
 109         memset(&addr, 0, sizeof(addr));
 110         addr.sin_family = AF_INET;
 111         addr.sin_addr.s_addr = INADDR_NONE;
 112         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 113
 114         rt.rt_dev = ifr.ifr_name;
 115
 116         err = ioctl(sk, SIOCADDRT, &rt);
 117         if (err < 0)
 118                 connman_error("Setting VPN host failed (%s)",
 119                               strerror(errno));
 120
 121         close(sk);
 122
 123         return err;
 124 }
 125
 126 static int del_vpn_host(const char *host)
 127 {
 128         struct rtentry rt;
 129         struct sockaddr_in addr;
 130         int sk, err;
 131
 132         sk = socket(PF_INET, SOCK_DGRAM, 0);
 133         if (sk < 0)
 134                 return -1;
 135
 136         memset(&rt, 0, sizeof(rt));
 137         rt.rt_flags = RTF_UP | RTF_HOST;
 138
 139         memset(&addr, 0, sizeof(addr));
 140         addr.sin_family = AF_INET;
 141         addr.sin_addr.s_addr = inet_addr(host);
 142         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 143
 144         err = ioctl(sk, SIOCDELRT, &rt);
 145         if (err < 0)
 146                 connman_error("Del vpn route failed (%s)",
 147                               strerror(errno));
 148
 149         close(sk);
 150
 151         return err;
 152 }
 153
 154 static int set_vpn_route(struct connman_element *element, const char *gateway)
 155 {
 156         struct ifreq ifr;
 157         struct rtentry rt;
 158         struct sockaddr_in addr;
 159         int sk, err;
 160
 161         DBG("set_rout1: element %p", element);
 162
 163         sk = socket(PF_INET, SOCK_DGRAM, 0);
 164         if (sk < 0)
 165                 return -1;
 166
 167         memset(&ifr, 0, sizeof(ifr));
 168         ifr.ifr_ifindex = element->index;
 169
 170         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 171                 close(sk);
 172                 return -1;
 173         }
 174
 175         DBG("ifname %s", ifr.ifr_name);
 176
 177         memset(&ifr, 0, sizeof(ifr));
 178         ifr.ifr_ifindex = element->index;
 179
 180         memset(&rt, 0, sizeof(rt));
 181         rt.rt_flags = RTF_UP | RTF_GATEWAY;
 182
 183         memset(&addr, 0, sizeof(addr));
 184         addr.sin_family = AF_INET;
 185         addr.sin_addr.s_addr = INADDR_ANY;
 186         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 187
 188         memset(&addr, 0, sizeof(addr));
 189         addr.sin_family = AF_INET;
 190         addr.sin_addr.s_addr = inet_addr(gateway);
 191         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 192
 193         memset(&addr, 0, sizeof(addr));
 194         addr.sin_family = AF_INET;
 195         addr.sin_addr.s_addr = INADDR_ANY;
 196         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 197
 198         err = ioctl(sk, SIOCADDRT, &rt);
 199         if (err < 0)
 200                 connman_error("Setting VPN route failed (%s)",
 201                                strerror(errno));
 202
 203         close(sk);
 204
 205         return err;
 206 }
 207
 208 static int del_route(struct connman_element *element, const char *gateway)
 209 {
 210         struct ifreq ifr;
 211         struct rtentry rt;
 212         struct sockaddr_in addr;
 213         int sk, err;
 214
 215         DBG("element %p", element);
 216
 217         sk = socket(PF_INET, SOCK_DGRAM, 0);
 218         if (sk < 0)
 219                 return -1;
 220
 221         memset(&ifr, 0, sizeof(ifr));
 222         ifr.ifr_ifindex = element->index;
 223
 224         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
 225                 close(sk);
 226                 return -1;
 227         }
 228
 229         DBG("ifname %s", ifr.ifr_name);
 230
 231         memset(&rt, 0, sizeof(rt));
 232         rt.rt_flags = RTF_UP | RTF_GATEWAY;
 233
 234         memset(&addr, 0, sizeof(addr));
 235         addr.sin_family = AF_INET;
 236         addr.sin_addr.s_addr = INADDR_ANY;
 237         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
 238
 239         memset(&addr, 0, sizeof(addr));
 240         addr.sin_family = AF_INET;
 241         addr.sin_addr.s_addr = inet_addr(gateway);
 242         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
 243
 244         memset(&addr, 0, sizeof(addr));
 245         addr.sin_family = AF_INET;
 246         addr.sin_addr.s_addr = INADDR_ANY;
 247         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
 248
 249         err = ioctl(sk, SIOCDELRT, &rt);
 250         if (err < 0)
 251                 connman_error("Removing default route failed (%s)",
 252                                                         strerror(errno));
 253
 254         close(sk);
 255
 256         return err;
 257 }
 258
 259 static int del_route_all(struct gateway_data *data)
 260 {
 261         int err = 0;
 262
 263         if (data->vpn) {
 264                 del_vpn_host(data->gateway);
 265
 266                 err = del_route(data->element, data->vpn_ip);
 267         } else
 268                 err = del_route(data->element, data->gateway);
 269
 270         return err;
 271 }
 272
 273 static void find_element(struct connman_element *element, gpointer user_data)
 274 {
 275         struct gateway_data *data = user_data;
 276
 277         DBG("element %p name %s", element, element->name);
 278
 279         if (data->element != NULL)
 280                 return;
 281
 282         if (element->index != data->index)
 283                 return;
 284
 285         data->element = element;
 286 }
 287
 288 static struct gateway_data *add_gateway(int index, const char *gateway)
 289 {
 290         struct gateway_data *data;
 291         struct connman_service *service;
 292
 293         data = g_try_new0(struct gateway_data, 1);
 294         if (data == NULL)
 295                 return NULL;
 296
 297         data->index = index;
 298         data->gateway = g_strdup(gateway);
 299         data->active = FALSE;
 300         data->element = NULL;
 301         data->vpn_ip = NULL;
 302         data->vpn = FALSE;
 303
 304         __connman_element_foreach(NULL, CONNMAN_ELEMENT_TYPE_CONNECTION,
 305                                                         find_element, data);
 306
 307         service = __connman_element_get_service(data->element);
 308         data->order = __connman_service_get_order(service);
 309
 310         gateway_list = g_slist_append(gateway_list, data);
 311
 312         return data;
 313 }
 314
 315 static void connection_newgateway(int index, const char *gateway)
 316 {
 317         struct gateway_data *data;
 318
 319         DBG("index %d gateway %s", index, gateway);
 320
 321         data = find_gateway(index, gateway);
 322         if (data == NULL)
 323                 return;
 324
 325         data->active = TRUE;
 326 }
 327
 328 static void set_default_gateway(struct gateway_data *data)
 329 {
 330         struct connman_element *element = data->element;
 331         struct connman_service *service = NULL;
 332         short int ifflags;
 333
 334         DBG("gateway %s", data->gateway);
 335
 336         if (data->vpn == TRUE) {
 337
 338                 set_vpn_route(element, data->vpn_ip);
 339                 /* vpn gateway going away no changes in services */
 340                 return;
 341         }
 342
 343         ifflags = connman_inet_ifflags(element->index);
 344         if (ifflags < 0) {
 345                 connman_error("Fail to get network interface flags");
 346                 return;
 347         }
 348
 349         if (ifflags & IFF_POINTOPOINT) {
 350                 if (connman_inet_set_gateway_interface(element->index) < 0)
 351                         return;
 352                 goto done;
 353         }
 354
 355         connman_inet_add_host_route(element->index, data->gateway);
 356
 357         if (connman_inet_set_gateway_address(element->index, data->gateway) < 0)
 358                 return;
 359
 360 done:
 361         service = __connman_element_get_service(element);
 362         __connman_service_indicate_default(service);
 363 }
 364
 365 static struct gateway_data *find_default_gateway(void)
 366 {
 367         struct gateway_data *found = NULL;
 368         unsigned int order = 0;
 369         GSList *list;
 370
 371         for (list = gateway_list; list; list = list->next) {
 372                 struct gateway_data *data = list->data;
 373
 374                 if (found == NULL || data->order > order) {
 375                         found = data;
 376                         order = data->order;
 377                 }
 378         }
 379
 380         return found;
 381 }
 382
 383 static void remove_gateway(struct gateway_data *data)
 384 {
 385         DBG("gateway %s", data->gateway);
 386
 387         gateway_list = g_slist_remove(gateway_list, data);
 388
 389         if (data->active == TRUE)
 390                 del_route_all(data);
 391
 392         g_free(data->gateway);
 393         g_free(data->vpn_ip);
 394         g_free(data);
 395 }
 396
 397 static void connection_delgateway(int index, const char *gateway)
 398 {
 399         struct gateway_data *data;
 400
 401         DBG("index %d gateway %s", index, gateway);
 402
 403         data = find_gateway(index, gateway);
 404         if (data != NULL)
 405                 data->active = FALSE;
 406
 407         data = find_default_gateway();
 408         if (data != NULL)
 409                 set_default_gateway(data);
 410 }
 411
 412 static struct connman_rtnl connection_rtnl = {
 413         .name           = "connection",
 414         .newgateway     = connection_newgateway,
 415         .delgateway     = connection_delgateway,
 416 };
 417
 418 static struct gateway_data *find_active_gateway(void)
 419 {
 420         GSList *list;
 421
 422         DBG("");
 423
 424         for (list = gateway_list; list; list = list->next) {
 425                 struct gateway_data *data = list->data;
 426                 if (data->active == TRUE)
 427                         return data;
 428         }
 429
 430         return NULL;
 431 }
 432
 433 static int connection_probe(struct connman_element *element)
 434 {
 435         struct connman_service *service = NULL;
 436         const char *gateway = NULL;
 437         const char *vpn_ip = NULL;
 438         struct gateway_data *active_gateway = NULL;
 439         struct gateway_data *new_gateway = NULL;
 440
 441         DBG("element %p name %s", element, element->name);
 442
 443         if (element->parent == NULL)
 444                 return -ENODEV;
 445
 446         if (element->parent->type != CONNMAN_ELEMENT_TYPE_IPV4)
 447                 return -ENODEV;
 448
 449         connman_element_get_value(element,
 450                                 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
 451
 452         connman_element_get_value(element,
 453                                   CONNMAN_PROPERTY_ID_IPV4_ADDRESS, &vpn_ip);
 454
 455         DBG("gateway %s", gateway);
 456
 457         service = __connman_element_get_service(element);
 458         __connman_service_indicate_state(service,
 459                                         CONNMAN_SERVICE_STATE_READY);
 460
 461         connman_element_set_enabled(element, TRUE);
 462
 463         if (gateway == NULL)
 464                 return 0;
 465
 466         active_gateway = find_active_gateway();
 467         new_gateway = add_gateway(element->index, gateway);
 468
 469         if (service == NULL) {
 470                 new_gateway->vpn = TRUE;
 471                 new_gateway->vpn_ip = g_strdup(vpn_ip);
 472                 /* make sure vpn gateway are at higher priority */
 473                 new_gateway->order = 10;
 474         } else
 475                 new_gateway->vpn = FALSE;
 476
 477         if (active_gateway == NULL) {
 478                 set_default_gateway(new_gateway);
 479                 return 0;
 480         }
 481
 482         if (new_gateway->vpn == TRUE) {
 483                 add_vpn_host(active_gateway->element,
 484                              active_gateway->gateway,
 485                              new_gateway->gateway);
 486
 487         }
 488
 489         if (new_gateway->order >= active_gateway->order) {
 490                 del_route_all(active_gateway);
 491                 return 0;
 492         }
 493
 494         return 0;
 495 }
 496
 497 static void connection_remove(struct connman_element *element)
 498 {
 499         struct connman_service *service;
 500         const char *gateway = NULL;
 501         struct gateway_data *data = NULL;
 502         gboolean set_default = FALSE;
 503
 504         DBG("element %p name %s", element, element->name);
 505
 506         service = __connman_element_get_service(element);
 507         __connman_service_indicate_state(service,
 508                                         CONNMAN_SERVICE_STATE_DISCONNECT);
 509
 510         connman_element_set_enabled(element, FALSE);
 511
 512         connman_element_get_value(element,
 513                                 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
 514
 515         DBG("gateway %s", gateway);
 516
 517         if (gateway == NULL)
 518                 return;
 519
 520         data = find_gateway(element->index, gateway);
 521         if (data == NULL)
 522                 return;
 523
 524         set_default = data->vpn;
 525
 526         if (data->vpn == TRUE)
 527                 del_vpn_host(data->gateway);
 528
 529         remove_gateway(data);
 530
 531         /* with vpn this will be called after the network was deleted,
 532          * we need to call set_default here because we will not recieve any
 533          * gateway delete notification.
 534          */
 535         if (set_default) {
 536                 data = find_default_gateway();
 537                 if (data != NULL)
 538                         set_default_gateway(data);
 539         }
 540 }
 541
 542 static struct connman_driver connection_driver = {
 543         .name           = "connection",
 544         .type           = CONNMAN_ELEMENT_TYPE_CONNECTION,
 545         .priority       = CONNMAN_DRIVER_PRIORITY_LOW,
 546         .probe          = connection_probe,
 547         .remove         = connection_remove,
 548 };
 549
 550 int __connman_connection_init(void)
 551 {
 552         DBG("");
 553
 554         if (connman_rtnl_register(&connection_rtnl) < 0)
 555                 connman_error("Failed to setup RTNL gateway driver");
 556
 557         return connman_driver_register(&connection_driver);
 558 }
 559
 560 void __connman_connection_cleanup(void)
 561 {
 562         GSList *list;
 563
 564         DBG("");
 565
 566         connman_driver_unregister(&connection_driver);
 567
 568         connman_rtnl_unregister(&connection_rtnl);
 569
 570         for (list = gateway_list; list; list = list->next) {
 571                 struct gateway_data *data = list->data;
 572
 573                 DBG("index %d gateway %s", data->index, data->gateway);
 574
 575                 g_free(data->gateway);
 576                 g_free(data);
 577                 list->data = NULL;
 578         }
 579
 580         g_slist_free(gateway_list);
 581         gateway_list = NULL;
 582 }
 583
 584 static void update_order(void)
 585 {
 586         GSList *list = NULL;
 587
 588         for (list = gateway_list; list; list = list->next) {
 589                 struct gateway_data *data = list->data;
 590                 struct connman_service *service;
 591
 592                 /* vpn gataway is not attached to a service. */
 593                 if (data->vpn)
 594                         continue;
 595
 596                 service = __connman_element_get_service(data->element);
 597                 data->order = __connman_service_get_order(service);
 598         }
 599 }
 600
 601 gboolean __connman_connection_update_gateway(void)
 602 {
 603         struct gateway_data *active_gateway, *default_gateway;
 604         gboolean updated = FALSE;
 605
 606         update_order();
 607
 608         active_gateway = find_active_gateway();
 609         default_gateway = find_default_gateway();
 610
 611         if (active_gateway && active_gateway != default_gateway) {
 612                 del_route_all(active_gateway);
 613                 updated = TRUE;
 614         }
 615
 616         return updated;
 617 }