5 * Copyright (C) 2007-2010 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 connman_inet_set_host_route(element->index, data->gateway);
357 if (connman_inet_set_gateway_address(element->index, data->gateway) < 0)
361 service = __connman_element_get_service(element);
362 __connman_service_indicate_default(service);
365 static struct gateway_data *find_default_gateway(void)
367 struct gateway_data *found = NULL;
368 unsigned int order = 0;
371 for (list = gateway_list; list; list = list->next) {
372 struct gateway_data *data = list->data;
374 if (found == NULL || data->order > order) {
383 static void remove_gateway(struct gateway_data *data)
385 DBG("gateway %s", data->gateway);
387 gateway_list = g_slist_remove(gateway_list, data);
389 if (data->active == TRUE)
392 g_free(data->gateway);
393 g_free(data->vpn_ip);
397 static void connection_delgateway(int index, const char *gateway)
399 struct gateway_data *data;
401 DBG("index %d gateway %s", index, gateway);
403 data = find_gateway(index, gateway);
405 data->active = FALSE;
407 data = find_default_gateway();
409 set_default_gateway(data);
412 static struct connman_rtnl connection_rtnl = {
413 .name = "connection",
414 .newgateway = connection_newgateway,
415 .delgateway = connection_delgateway,
418 static struct gateway_data *find_active_gateway(void)
424 for (list = gateway_list; list; list = list->next) {
425 struct gateway_data *data = list->data;
426 if (data->active == TRUE)
433 static int connection_probe(struct connman_element *element)
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;
441 DBG("element %p name %s", element, element->name);
443 if (element->parent == NULL)
446 if (element->parent->type != CONNMAN_ELEMENT_TYPE_IPV4)
449 connman_element_get_value(element,
450 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
452 connman_element_get_value(element,
453 CONNMAN_PROPERTY_ID_IPV4_ADDRESS, &vpn_ip);
455 DBG("gateway %s", gateway);
457 service = __connman_element_get_service(element);
458 __connman_service_indicate_state(service,
459 CONNMAN_SERVICE_STATE_READY);
461 connman_element_set_enabled(element, TRUE);
466 active_gateway = find_active_gateway();
467 new_gateway = add_gateway(element->index, gateway);
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;
475 new_gateway->vpn = FALSE;
477 if (active_gateway == NULL) {
478 set_default_gateway(new_gateway);
482 if (new_gateway->vpn == TRUE) {
483 add_vpn_host(active_gateway->element,
484 active_gateway->gateway,
485 new_gateway->gateway);
489 if (new_gateway->order >= active_gateway->order) {
490 del_route_all(active_gateway);
497 static void connection_remove(struct connman_element *element)
499 struct connman_service *service;
500 const char *gateway = NULL;
501 struct gateway_data *data = NULL;
502 gboolean set_default = FALSE;
504 DBG("element %p name %s", element, element->name);
506 service = __connman_element_get_service(element);
507 __connman_service_indicate_state(service,
508 CONNMAN_SERVICE_STATE_DISCONNECT);
510 connman_element_set_enabled(element, FALSE);
512 connman_element_get_value(element,
513 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
515 DBG("gateway %s", gateway);
520 data = find_gateway(element->index, gateway);
524 set_default = data->vpn;
526 if (data->vpn == TRUE)
527 del_vpn_host(data->gateway);
529 remove_gateway(data);
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.
536 data = find_default_gateway();
538 set_default_gateway(data);
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,
550 int __connman_connection_init(void)
554 if (connman_rtnl_register(&connection_rtnl) < 0)
555 connman_error("Failed to setup RTNL gateway driver");
557 return connman_driver_register(&connection_driver);
560 void __connman_connection_cleanup(void)
566 connman_driver_unregister(&connection_driver);
568 connman_rtnl_unregister(&connection_rtnl);
570 for (list = gateway_list; list; list = list->next) {
571 struct gateway_data *data = list->data;
573 DBG("index %d gateway %s", data->index, data->gateway);
575 g_free(data->gateway);
580 g_slist_free(gateway_list);
584 static void update_order(void)
588 for (list = gateway_list; list; list = list->next) {
589 struct gateway_data *data = list->data;
590 struct connman_service *service;
592 /* vpn gataway is not attached to a service. */
596 service = __connman_element_get_service(data->element);
597 data->order = __connman_service_get_order(service);
601 gboolean __connman_connection_update_gateway(void)
603 struct gateway_data *active_gateway, *default_gateway;
604 gboolean updated = FALSE;
608 active_gateway = find_active_gateway();
609 default_gateway = find_default_gateway();
611 if (active_gateway && active_gateway != default_gateway) {
612 del_route_all(active_gateway);