5 * Copyright (C) 2007-2010 Intel Corporation. All rights reserved.
6 * Copyright (C) 2011 BMW Car IT GmbH. All rights reserved.
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
35 struct gateway_config {
48 struct connman_service *service;
50 struct gateway_config *ipv4_gateway;
51 struct gateway_config *ipv6_gateway;
54 static GHashTable *gateway_hash = NULL;
56 static struct gateway_config *find_gateway(int index, const char *gateway)
64 g_hash_table_iter_init(&iter, gateway_hash);
66 while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) {
67 struct gateway_data *data = value;
69 if (data->ipv4_gateway != NULL && data->index == index &&
70 g_str_equal(data->ipv4_gateway->gateway,
72 return data->ipv4_gateway;
74 if (data->ipv6_gateway != NULL && data->index == index &&
75 g_str_equal(data->ipv6_gateway->gateway,
77 return data->ipv6_gateway;
83 static int del_routes(struct gateway_data *data,
84 enum connman_ipconfig_type type)
86 int status4 = 0, status6 = 0;
87 int do_ipv4 = FALSE, do_ipv6 = FALSE;
89 if (type == CONNMAN_IPCONFIG_TYPE_IPV4)
91 else if (type == CONNMAN_IPCONFIG_TYPE_IPV6)
94 do_ipv4 = do_ipv6 = TRUE;
96 if (do_ipv4 == TRUE && data->ipv4_gateway != NULL) {
97 if (data->ipv4_gateway->vpn == TRUE) {
98 if (data->ipv4_gateway->vpn_phy_index >= 0)
99 connman_inet_del_host_route(
100 data->ipv4_gateway->vpn_phy_index,
101 data->ipv4_gateway->gateway);
103 status4 = connman_inet_clear_gateway_address(
105 data->ipv4_gateway->vpn_ip);
107 } else if (g_strcmp0(data->ipv4_gateway->gateway,
109 status4 = connman_inet_clear_gateway_interface(
112 connman_inet_del_host_route(data->index,
113 data->ipv4_gateway->gateway);
114 status4 = connman_inet_clear_gateway_address(
116 data->ipv4_gateway->gateway);
120 if (do_ipv6 == TRUE && data->ipv6_gateway != NULL) {
121 if (data->ipv6_gateway->vpn == TRUE) {
122 if (data->ipv6_gateway->vpn_phy_index >= 0)
123 connman_inet_del_host_route(
124 data->ipv6_gateway->vpn_phy_index,
125 data->ipv6_gateway->gateway);
127 status6 = connman_inet_clear_ipv6_gateway_address(
129 data->ipv6_gateway->vpn_ip);
131 } else if (g_strcmp0(data->ipv6_gateway->gateway, "::") == 0) {
132 status6 = connman_inet_clear_ipv6_gateway_interface(
135 connman_inet_del_ipv6_host_route(data->index,
136 data->ipv6_gateway->gateway);
137 status6 = connman_inet_clear_ipv6_gateway_address(
139 data->ipv6_gateway->gateway);
143 return (status4 < 0 ? status4 : status6);
146 static int disable_gateway(struct gateway_data *data,
147 enum connman_ipconfig_type type)
149 gboolean active = FALSE;
151 if (type == CONNMAN_IPCONFIG_TYPE_IPV4) {
152 if (data->ipv4_gateway != NULL)
153 active = data->ipv4_gateway->active;
154 } else if (type == CONNMAN_IPCONFIG_TYPE_IPV6) {
155 if (data->ipv6_gateway != NULL)
156 active = data->ipv6_gateway->active;
160 DBG("type %d active %d", type, active);
163 return del_routes(data, type);
168 static struct gateway_data *add_gateway(struct connman_service *service,
169 int index, const char *gateway,
170 enum connman_ipconfig_type type)
172 struct gateway_data *data, *old;
173 struct gateway_config *config;
175 if (gateway == NULL || strlen(gateway) == 0)
178 data = g_try_new0(struct gateway_data, 1);
184 config = g_try_new0(struct gateway_config, 1);
185 if (config == NULL) {
190 config->gateway = g_strdup(gateway);
191 config->vpn_ip = NULL;
192 config->vpn_phy_ip = NULL;
194 config->vpn_phy_index = -1;
195 config->active = FALSE;
197 if (type == CONNMAN_IPCONFIG_TYPE_IPV4)
198 data->ipv4_gateway = config;
199 else if (type == CONNMAN_IPCONFIG_TYPE_IPV6)
200 data->ipv6_gateway = config;
202 g_free(config->gateway);
208 data->service = service;
210 data->order = __connman_service_get_order(service);
213 * If the service is already in the hash, then we
214 * must not replace it blindly but disable the gateway
215 * of the type we are replacing and take the other type
216 * from old gateway settings.
218 old = g_hash_table_lookup(gateway_hash, service);
220 DBG("Replacing gw %p ipv4 %p ipv6 %p", old,
221 old->ipv4_gateway, old->ipv6_gateway);
222 disable_gateway(old, type);
223 if (type == CONNMAN_IPCONFIG_TYPE_IPV4) {
224 data->ipv6_gateway = old->ipv6_gateway;
225 old->ipv6_gateway = NULL;
226 } else if (type == CONNMAN_IPCONFIG_TYPE_IPV6) {
227 data->ipv4_gateway = old->ipv4_gateway;
228 old->ipv4_gateway = NULL;
232 g_hash_table_replace(gateway_hash, service, data);
237 static void connection_newgateway(int index, const char *gateway)
239 struct gateway_config *config;
241 DBG("index %d gateway %s", index, gateway);
243 config = find_gateway(index, gateway);
247 config->active = TRUE;
250 static void set_default_gateway(struct gateway_data *data,
251 enum connman_ipconfig_type type)
254 int status4 = 0, status6 = 0;
255 int do_ipv4 = FALSE, do_ipv6 = FALSE;
257 if (type == CONNMAN_IPCONFIG_TYPE_IPV4)
259 else if (type == CONNMAN_IPCONFIG_TYPE_IPV6)
262 do_ipv4 = do_ipv6 = TRUE;
264 DBG("type %d gateway ipv4 %p ipv6 %p", type, data->ipv4_gateway,
267 if (do_ipv4 == TRUE && data->ipv4_gateway != NULL &&
268 data->ipv4_gateway->vpn == TRUE) {
269 connman_inet_set_gateway_address(data->index,
270 data->ipv4_gateway->vpn_ip);
271 connman_inet_add_host_route(data->ipv4_gateway->vpn_phy_index,
272 data->ipv4_gateway->vpn_ip,
273 data->ipv4_gateway->vpn_phy_ip);
274 data->ipv4_gateway->active = TRUE;
276 __connman_service_indicate_default(data->service);
281 if (do_ipv6 == TRUE && data->ipv6_gateway != NULL &&
282 data->ipv6_gateway->vpn == TRUE) {
283 connman_inet_set_ipv6_gateway_address(data->index,
284 data->ipv6_gateway->vpn_ip);
285 connman_inet_add_ipv6_host_route(
286 data->ipv6_gateway->vpn_phy_index,
287 data->ipv6_gateway->vpn_ip,
288 data->ipv6_gateway->vpn_phy_ip);
289 data->ipv6_gateway->active = TRUE;
291 __connman_service_indicate_default(data->service);
296 index = __connman_service_get_index(data->service);
298 if (do_ipv4 == TRUE && data->ipv4_gateway != NULL &&
299 g_strcmp0(data->ipv4_gateway->gateway,
301 if (connman_inet_set_gateway_interface(index) < 0)
306 if (do_ipv6 == TRUE && data->ipv6_gateway != NULL &&
307 g_strcmp0(data->ipv6_gateway->gateway,
309 if (connman_inet_set_ipv6_gateway_interface(index) < 0)
314 if (do_ipv6 == TRUE && data->ipv6_gateway != NULL)
315 status6 = connman_inet_set_ipv6_gateway_address(index,
316 data->ipv6_gateway->gateway);
318 if (do_ipv4 == TRUE && data->ipv4_gateway != NULL)
319 status4 = connman_inet_set_gateway_address(index,
320 data->ipv4_gateway->gateway);
322 if (status4 < 0 || status6 < 0)
326 __connman_service_indicate_default(data->service);
329 static struct gateway_data *find_default_gateway(void)
331 struct gateway_data *found = NULL;
332 unsigned int order = 0;
336 g_hash_table_iter_init(&iter, gateway_hash);
338 while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) {
339 struct gateway_data *data = value;
341 if (found == NULL || data->order > order) {
350 static void remove_gateway(gpointer user_data)
352 struct gateway_data *data = user_data;
354 DBG("gateway ipv4 %p ipv6 %p", data->ipv4_gateway, data->ipv6_gateway);
356 if (data->ipv4_gateway != NULL) {
357 g_free(data->ipv4_gateway->gateway);
358 g_free(data->ipv4_gateway->vpn_ip);
359 g_free(data->ipv4_gateway->vpn_phy_ip);
360 g_free(data->ipv4_gateway);
363 if (data->ipv6_gateway != NULL) {
364 g_free(data->ipv6_gateway->gateway);
365 g_free(data->ipv6_gateway->vpn_ip);
366 g_free(data->ipv6_gateway->vpn_phy_ip);
367 g_free(data->ipv6_gateway);
373 static void connection_delgateway(int index, const char *gateway)
375 struct gateway_config *config;
376 struct gateway_data *data;
378 DBG("index %d gateway %s", index, gateway);
380 config = find_gateway(index, gateway);
382 config->active = FALSE;
384 data = find_default_gateway();
386 set_default_gateway(data, CONNMAN_IPCONFIG_TYPE_ALL);
389 static struct connman_rtnl connection_rtnl = {
390 .name = "connection",
391 .newgateway = connection_newgateway,
392 .delgateway = connection_delgateway,
395 static struct gateway_data *find_active_gateway(void)
402 g_hash_table_iter_init(&iter, gateway_hash);
404 while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) {
405 struct gateway_data *data = value;
407 if (data->ipv4_gateway != NULL &&
408 data->ipv4_gateway->active == TRUE)
411 if (data->ipv6_gateway != NULL &&
412 data->ipv6_gateway->active == TRUE)
419 static void update_order(void)
426 g_hash_table_iter_init(&iter, gateway_hash);
428 while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) {
429 struct gateway_data *data = value;
431 data->order = __connman_service_get_order(data->service);
435 void __connman_connection_gateway_activate(struct connman_service *service,
436 enum connman_ipconfig_type type)
438 struct gateway_data *data = NULL;
440 data = g_hash_table_lookup(gateway_hash, service);
444 DBG("gateway %p/%p type %d", data->ipv4_gateway,
445 data->ipv6_gateway, type);
447 if (type == CONNMAN_IPCONFIG_TYPE_IPV4)
448 data->ipv4_gateway->active = TRUE;
449 else if (type == CONNMAN_IPCONFIG_TYPE_IPV6)
450 data->ipv6_gateway->active = TRUE;
453 int __connman_connection_gateway_add(struct connman_service *service,
455 enum connman_ipconfig_type type,
458 struct gateway_data *active_gateway = NULL;
459 struct gateway_data *new_gateway = NULL;
462 index = __connman_service_get_index(service);
464 DBG("service %p index %d gateway %s vpn ip %s type %d",
465 service, index, gateway, peer, type);
468 * If gateway is NULL, it's a point to point link and the default
469 * gateway for ipv4 is 0.0.0.0 and for ipv6 is ::, meaning the
472 if (gateway == NULL && type == CONNMAN_IPCONFIG_TYPE_IPV4)
475 if (gateway == NULL && type == CONNMAN_IPCONFIG_TYPE_IPV6)
478 active_gateway = find_active_gateway();
479 new_gateway = add_gateway(service, index, gateway, type);
480 if (new_gateway == NULL)
483 if (type == CONNMAN_IPCONFIG_TYPE_IPV6 &&
484 new_gateway->ipv6_gateway != NULL &&
485 g_strcmp0(new_gateway->ipv6_gateway->gateway,
487 connman_inet_add_ipv6_host_route(index,
488 new_gateway->ipv6_gateway->gateway,
491 if (type == CONNMAN_IPCONFIG_TYPE_IPV4 &&
492 new_gateway->ipv4_gateway != NULL &&
493 g_strcmp0(new_gateway->ipv4_gateway->gateway,
495 connman_inet_add_host_route(index,
496 new_gateway->ipv4_gateway->gateway,
499 if (type == CONNMAN_IPCONFIG_TYPE_IPV4 &&
500 new_gateway->ipv4_gateway != NULL) {
501 __connman_service_nameserver_add_routes(service,
502 new_gateway->ipv4_gateway->gateway);
503 __connman_service_ipconfig_indicate_state(service,
504 CONNMAN_SERVICE_STATE_READY,
505 CONNMAN_IPCONFIG_TYPE_IPV4);
508 if (type == CONNMAN_IPCONFIG_TYPE_IPV6 &&
509 new_gateway->ipv6_gateway != NULL) {
510 __connman_service_nameserver_add_routes(service,
511 new_gateway->ipv6_gateway->gateway);
512 __connman_service_ipconfig_indicate_state(service,
513 CONNMAN_SERVICE_STATE_READY,
514 CONNMAN_IPCONFIG_TYPE_IPV6);
517 if (connman_service_get_type(service) == CONNMAN_SERVICE_TYPE_VPN) {
518 if (type == CONNMAN_IPCONFIG_TYPE_IPV4 &&
519 new_gateway->ipv4_gateway != NULL) {
520 new_gateway->ipv4_gateway->vpn = TRUE;
522 new_gateway->ipv4_gateway->vpn_ip =
524 else if (gateway != NULL)
525 new_gateway->ipv4_gateway->vpn_ip =
527 if (active_gateway) {
528 const char *new_ipv4_gateway;
531 active_gateway->ipv4_gateway->gateway;
532 if (new_ipv4_gateway != NULL &&
533 g_strcmp0(new_ipv4_gateway,
535 new_gateway->ipv4_gateway->vpn_phy_ip =
536 g_strdup(new_ipv4_gateway);
538 new_gateway->ipv4_gateway->vpn_phy_index =
539 active_gateway->index;
542 } else if (type == CONNMAN_IPCONFIG_TYPE_IPV6 &&
543 new_gateway->ipv6_gateway != NULL) {
544 new_gateway->ipv6_gateway->vpn = TRUE;
546 new_gateway->ipv6_gateway->vpn_ip =
548 else if (gateway != NULL)
549 new_gateway->ipv6_gateway->vpn_ip =
551 if (active_gateway) {
552 const char *new_ipv6_gateway;
555 active_gateway->ipv6_gateway->gateway;
556 if (new_ipv6_gateway != NULL &&
557 g_strcmp0(new_ipv6_gateway, "::") != 0)
558 new_gateway->ipv6_gateway->vpn_phy_ip =
559 g_strdup(new_ipv6_gateway);
561 new_gateway->ipv6_gateway->vpn_phy_index =
562 active_gateway->index;
566 if (type == CONNMAN_IPCONFIG_TYPE_IPV4 &&
567 new_gateway->ipv4_gateway != NULL)
568 new_gateway->ipv4_gateway->vpn = FALSE;
570 if (type == CONNMAN_IPCONFIG_TYPE_IPV6 &&
571 new_gateway->ipv6_gateway != NULL)
572 new_gateway->ipv6_gateway->vpn = FALSE;
575 if (active_gateway == NULL) {
576 set_default_gateway(new_gateway, type);
580 if (type == CONNMAN_IPCONFIG_TYPE_IPV4 &&
581 new_gateway->ipv4_gateway != NULL &&
582 new_gateway->ipv4_gateway->vpn == TRUE) {
583 connman_inet_add_host_route(active_gateway->index,
584 new_gateway->ipv4_gateway->gateway,
585 active_gateway->ipv4_gateway->gateway);
586 connman_inet_clear_gateway_address(active_gateway->index,
587 active_gateway->ipv4_gateway->gateway);
590 if (type == CONNMAN_IPCONFIG_TYPE_IPV6 &&
591 new_gateway->ipv6_gateway != NULL &&
592 new_gateway->ipv6_gateway->vpn == TRUE) {
593 connman_inet_add_ipv6_host_route(active_gateway->index,
594 new_gateway->ipv6_gateway->gateway,
595 active_gateway->ipv6_gateway->gateway);
596 connman_inet_clear_ipv6_gateway_address(active_gateway->index,
597 active_gateway->ipv6_gateway->gateway);
603 void __connman_connection_gateway_remove(struct connman_service *service,
604 enum connman_ipconfig_type type)
606 struct gateway_data *data = NULL;
607 gboolean set_default4 = FALSE, set_default6 = FALSE;
608 int do_ipv4 = FALSE, do_ipv6 = FALSE;
611 DBG("service %p type %d", service, type);
613 if (type == CONNMAN_IPCONFIG_TYPE_IPV4)
615 else if (type == CONNMAN_IPCONFIG_TYPE_IPV6)
618 do_ipv4 = do_ipv6 = TRUE;
620 __connman_service_nameserver_del_routes(service);
622 data = g_hash_table_lookup(gateway_hash, service);
626 if (do_ipv4 == TRUE && data->ipv4_gateway != NULL)
627 set_default4 = data->ipv4_gateway->vpn;
629 if (do_ipv6 == TRUE && data->ipv6_gateway != NULL)
630 set_default6 = data->ipv6_gateway->vpn;
632 DBG("ipv4 gateway %s ipv6 gateway %s vpn %d/%d",
633 data->ipv4_gateway ? data->ipv4_gateway->gateway : "<null>",
634 data->ipv6_gateway ? data->ipv6_gateway->gateway : "<null>",
635 set_default4, set_default6);
637 if (do_ipv4 == TRUE && data->ipv4_gateway != NULL &&
638 data->ipv4_gateway->vpn == TRUE && data->index >= 0)
639 connman_inet_del_host_route(data->index,
640 data->ipv4_gateway->gateway);
642 if (do_ipv6 == TRUE && data->ipv6_gateway != NULL &&
643 data->ipv6_gateway->vpn == TRUE && data->index >= 0)
644 connman_inet_del_ipv6_host_route(data->index,
645 data->ipv6_gateway->gateway);
647 __connman_service_nameserver_del_routes(service);
649 err = disable_gateway(data, type);
652 * We remove the service from the hash only if all the gateway
653 * settings are to be removed.
655 if (do_ipv4 == do_ipv6 ||
656 (data->ipv4_gateway != NULL && data->ipv6_gateway == NULL
657 && do_ipv4 == TRUE) ||
658 (data->ipv6_gateway != NULL && data->ipv4_gateway == NULL
661 g_hash_table_remove(gateway_hash, service);
663 DBG("Not yet removing gw ipv4 %p/%d ipv6 %p/%d",
664 data->ipv4_gateway, do_ipv4,
665 data->ipv6_gateway, do_ipv6);
667 /* with vpn this will be called after the network was deleted,
668 * we need to call set_default here because we will not recieve any
669 * gateway delete notification.
670 * We hit the same issue if remove_gateway() fails.
672 if (set_default4 || set_default6 || err < 0) {
673 data = find_default_gateway();
675 set_default_gateway(data, type);
679 gboolean __connman_connection_update_gateway(void)
681 struct gateway_data *active_gateway, *default_gateway;
682 gboolean updated = FALSE;
684 if (gateway_hash == NULL)
689 active_gateway = find_active_gateway();
690 default_gateway = find_default_gateway();
692 if (active_gateway && active_gateway != default_gateway)
698 int __connman_connection_init(void)
704 gateway_hash = g_hash_table_new_full(g_direct_hash, g_direct_equal,
705 NULL, remove_gateway);
707 err = connman_rtnl_register(&connection_rtnl);
709 connman_error("Failed to setup RTNL gateway driver");
714 void __connman_connection_cleanup(void)
721 connman_rtnl_unregister(&connection_rtnl);
723 g_hash_table_iter_init(&iter, gateway_hash);
725 while (g_hash_table_iter_next(&iter, &key, &value) == TRUE) {
726 struct gateway_data *data = value;
728 disable_gateway(data, CONNMAN_IPCONFIG_TYPE_ALL);
731 g_hash_table_destroy(gateway_hash);