5 * Copyright (C) 2007-2009 Intel Corporation. All rights reserved.
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.
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.
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
29 #include <sys/ioctl.h>
30 #include <arpa/inet.h>
32 #include <net/route.h>
41 struct connman_element *element;
49 static GSList *gateway_list = NULL;
51 static struct gateway_data *find_gateway(int index, const char *gateway)
58 for (list = gateway_list; list; list = list->next) {
59 struct gateway_data *data = list->data;
61 if (data->gateway == NULL)
64 if (data->index == index &&
65 g_str_equal(data->gateway, gateway) == TRUE)
72 static int add_vpn_host(struct connman_element *element,
78 struct sockaddr_in addr;
81 DBG("element %p", element);
83 sk = socket(PF_INET, SOCK_DGRAM, 0);
87 memset(&ifr, 0, sizeof(ifr));
88 ifr.ifr_ifindex = element->index;
90 if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
94 DBG("ifname %s", ifr.ifr_name);
96 memset(&rt, 0, sizeof(rt));
97 rt.rt_flags = RTF_UP | RTF_HOST | RTF_GATEWAY;
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));
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));
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));
114 rt.rt_dev = ifr.ifr_name;
116 err = ioctl(sk, SIOCADDRT, &rt);
118 connman_error("Setting VPN host failed (%s)",
126 static int del_vpn_host(const char *host)
129 struct sockaddr_in addr;
132 sk = socket(PF_INET, SOCK_DGRAM, 0);
136 memset(&rt, 0, sizeof(rt));
137 rt.rt_flags = RTF_UP | RTF_HOST;
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));
144 err = ioctl(sk, SIOCDELRT, &rt);
146 connman_error("Del vpn route failed (%s)",
154 static int set_vpn_route(struct connman_element *element, const char *gateway)
158 struct sockaddr_in addr;
161 DBG("set_rout1: element %p", element);
163 sk = socket(PF_INET, SOCK_DGRAM, 0);
167 memset(&ifr, 0, sizeof(ifr));
168 ifr.ifr_ifindex = element->index;
170 if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
175 DBG("ifname %s", ifr.ifr_name);
177 memset(&ifr, 0, sizeof(ifr));
178 ifr.ifr_ifindex = element->index;
180 memset(&rt, 0, sizeof(rt));
181 rt.rt_flags = RTF_UP | RTF_GATEWAY;
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));
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));
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));
198 err = ioctl(sk, SIOCADDRT, &rt);
200 connman_error("Setting VPN route failed (%s)",
208 static int del_route(struct connman_element *element, const char *gateway)
212 struct sockaddr_in addr;
215 DBG("element %p", element);
217 sk = socket(PF_INET, SOCK_DGRAM, 0);
221 memset(&ifr, 0, sizeof(ifr));
222 ifr.ifr_ifindex = element->index;
224 if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
229 DBG("ifname %s", ifr.ifr_name);
231 memset(&rt, 0, sizeof(rt));
232 rt.rt_flags = RTF_UP | RTF_GATEWAY;
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));
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));
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));
249 err = ioctl(sk, SIOCDELRT, &rt);
251 connman_error("Removing default route failed (%s)",
259 static int del_route_all(struct gateway_data *data)
264 del_vpn_host(data->gateway);
266 err = del_route(data->element, data->vpn_ip);
268 err = del_route(data->element, data->gateway);
273 static void find_element(struct connman_element *element, gpointer user_data)
275 struct gateway_data *data = user_data;
277 DBG("element %p name %s", element, element->name);
279 if (data->element != NULL)
282 if (element->index != data->index)
285 data->element = element;
288 static struct gateway_data *add_gateway(int index, const char *gateway)
290 struct gateway_data *data;
291 struct connman_service *service;
293 data = g_try_new0(struct gateway_data, 1);
298 data->gateway = g_strdup(gateway);
299 data->active = FALSE;
300 data->element = NULL;
304 __connman_element_foreach(NULL, CONNMAN_ELEMENT_TYPE_CONNECTION,
307 service = __connman_element_get_service(data->element);
308 data->order = __connman_service_get_order(service);
310 gateway_list = g_slist_append(gateway_list, data);
315 static void connection_newgateway(int index, const char *gateway)
317 struct gateway_data *data;
319 DBG("index %d gateway %s", index, gateway);
321 data = find_gateway(index, gateway);
328 static void set_default_gateway(struct gateway_data *data)
330 struct connman_element *element = data->element;
331 struct connman_service *service = NULL;
334 DBG("gateway %s", data->gateway);
336 if (data->vpn == TRUE) {
338 set_vpn_route(element, data->vpn_ip);
339 /* vpn gateway going away no changes in services */
343 ifflags = connman_inet_ifflags(element->index);
345 connman_error("Fail to get network interface flags");
349 if (ifflags & IFF_POINTOPOINT) {
350 if (connman_inet_set_gateway_interface(element->index) < 0)
355 if (connman_inet_set_gateway_address(element->index, data->gateway) < 0)
359 service = __connman_element_get_service(element);
360 __connman_service_indicate_default(service);
363 static struct gateway_data *find_default_gateway(void)
365 struct gateway_data *found = NULL;
366 unsigned int order = 0;
369 for (list = gateway_list; list; list = list->next) {
370 struct gateway_data *data = list->data;
372 if (found == NULL || data->order > order) {
381 static void remove_gateway(struct gateway_data *data)
383 DBG("gateway %s", data->gateway);
385 gateway_list = g_slist_remove(gateway_list, data);
387 if (data->active == TRUE)
390 g_free(data->gateway);
391 g_free(data->vpn_ip);
395 static void connection_delgateway(int index, const char *gateway)
397 struct gateway_data *data;
399 DBG("index %d gateway %s", index, gateway);
401 data = find_gateway(index, gateway);
403 data->active = FALSE;
405 data = find_default_gateway();
407 set_default_gateway(data);
410 static struct connman_rtnl connection_rtnl = {
411 .name = "connection",
412 .newgateway = connection_newgateway,
413 .delgateway = connection_delgateway,
416 static struct gateway_data *find_active_gateway(void)
422 for (list = gateway_list; list; list = list->next) {
423 struct gateway_data *data = list->data;
424 if (data->active == TRUE)
431 static int connection_probe(struct connman_element *element)
433 struct connman_service *service = NULL;
434 const char *gateway = NULL;
435 const char *vpn_ip = NULL;
436 struct gateway_data *active_gateway = NULL;
437 struct gateway_data *new_gateway = NULL;
439 DBG("element %p name %s", element, element->name);
441 if (element->parent == NULL)
444 if (element->parent->type != CONNMAN_ELEMENT_TYPE_IPV4)
447 connman_element_get_value(element,
448 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
450 connman_element_get_value(element,
451 CONNMAN_PROPERTY_ID_IPV4_ADDRESS, &vpn_ip);
453 DBG("gateway %s", gateway);
455 service = __connman_element_get_service(element);
456 __connman_service_indicate_state(service,
457 CONNMAN_SERVICE_STATE_READY);
459 connman_element_set_enabled(element, TRUE);
464 active_gateway = find_active_gateway();
465 new_gateway = add_gateway(element->index, gateway);
467 if (service == NULL) {
468 new_gateway->vpn = TRUE;
469 new_gateway->vpn_ip = g_strdup(vpn_ip);
470 /* make sure vpn gateway are at higher priority */
471 new_gateway->order = 10;
473 new_gateway->vpn = FALSE;
475 if (active_gateway == NULL) {
476 set_default_gateway(new_gateway);
480 if (new_gateway->vpn == TRUE) {
481 add_vpn_host(active_gateway->element,
482 active_gateway->gateway,
483 new_gateway->gateway);
487 if (new_gateway->order >= active_gateway->order) {
488 del_route_all(active_gateway);
495 static void connection_remove(struct connman_element *element)
497 struct connman_service *service;
498 const char *gateway = NULL;
499 struct gateway_data *data = NULL;
500 gboolean set_default = FALSE;
502 DBG("element %p name %s", element, element->name);
504 service = __connman_element_get_service(element);
505 __connman_service_indicate_state(service,
506 CONNMAN_SERVICE_STATE_DISCONNECT);
508 connman_element_set_enabled(element, FALSE);
510 connman_element_get_value(element,
511 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
513 DBG("gateway %s", gateway);
518 data = find_gateway(element->index, gateway);
522 set_default = data->vpn;
524 if (data->vpn == TRUE)
525 del_vpn_host(data->gateway);
527 remove_gateway(data);
529 /* with vpn this will be called after the network was deleted,
530 * we need to call set_default here because we will not recieve any
531 * gateway delete notification.
534 data = find_default_gateway();
536 set_default_gateway(data);
540 static struct connman_driver connection_driver = {
541 .name = "connection",
542 .type = CONNMAN_ELEMENT_TYPE_CONNECTION,
543 .priority = CONNMAN_DRIVER_PRIORITY_LOW,
544 .probe = connection_probe,
545 .remove = connection_remove,
548 int __connman_connection_init(void)
552 if (connman_rtnl_register(&connection_rtnl) < 0)
553 connman_error("Failed to setup RTNL gateway driver");
555 return connman_driver_register(&connection_driver);
558 void __connman_connection_cleanup(void)
564 connman_driver_unregister(&connection_driver);
566 connman_rtnl_unregister(&connection_rtnl);
568 for (list = gateway_list; list; list = list->next) {
569 struct gateway_data *data = list->data;
571 DBG("index %d gateway %s", data->index, data->gateway);
573 g_free(data->gateway);
578 g_slist_free(gateway_list);
582 static void update_order(void)
586 for (list = gateway_list; list; list = list->next) {
587 struct gateway_data *data = list->data;
588 struct connman_service *service;
590 /* vpn gataway is not attached to a service. */
594 service = __connman_element_get_service(data->element);
595 data->order = __connman_service_get_order(service);
599 gboolean __connman_connection_update_gateway(void)
601 struct gateway_data *active_gateway, *default_gateway;
602 gboolean updated = FALSE;
606 active_gateway = find_active_gateway();
607 default_gateway = find_default_gateway();
609 if (active_gateway && active_gateway != default_gateway) {
610 del_route_all(active_gateway);