Set default gateway when route deletion fails
[platform/upstream/connman.git] / 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 <net/if.h>
27
28 #include <gdbus.h>
29
30 #include "connman.h"
31
32 struct gateway_data {
33         int index;
34         char *gateway;
35         struct connman_element *element;
36         unsigned int order;
37         gboolean active;
38         /* VPN extra data */
39         gboolean vpn;
40         char *vpn_ip;
41         int vpn_phy_index;
42 };
43
44 static GSList *gateway_list = NULL;
45
46 static struct gateway_data *find_gateway(int index, const char *gateway)
47 {
48         GSList *list;
49
50         if (gateway == NULL)
51                 return NULL;
52
53         for (list = gateway_list; list; list = list->next) {
54                 struct gateway_data *data = list->data;
55
56                 if (data->gateway == NULL)
57                         continue;
58
59                 if (data->index == index &&
60                                 g_str_equal(data->gateway, gateway) == TRUE)
61                         return data;
62         }
63
64         return NULL;
65 }
66
67 static int del_routes(struct gateway_data *data)
68 {
69         const char *address;
70
71         if (data->vpn) {
72                 if (data->vpn_phy_index >= 0)
73                         connman_inet_del_host_route(data->vpn_phy_index,
74                                                         data->gateway);
75                 address = data->vpn_ip;
76         } else {
77                 connman_inet_del_host_route(data->index, data->gateway);
78                 address = data->gateway;
79         }
80         return connman_inet_clear_gateway_address(data->index, address);
81 }
82
83 static void find_element(struct connman_element *element, gpointer user_data)
84 {
85         struct gateway_data *data = user_data;
86
87         DBG("element %p name %s", element, element->name);
88
89         if (data->element != NULL)
90                 return;
91
92         if (element->index != data->index)
93                 return;
94
95         data->element = element;
96 }
97
98 static struct gateway_data *add_gateway(int index, const char *gateway)
99 {
100         struct gateway_data *data;
101         struct connman_service *service;
102
103         data = g_try_new0(struct gateway_data, 1);
104         if (data == NULL)
105                 return NULL;
106
107         data->index = index;
108         data->gateway = g_strdup(gateway);
109         data->active = FALSE;
110         data->element = NULL;
111         data->vpn_ip = NULL;
112         data->vpn = FALSE;
113         data->vpn_phy_index = -1;
114
115         __connman_element_foreach(NULL, CONNMAN_ELEMENT_TYPE_CONNECTION,
116                                                         find_element, data);
117
118         service = __connman_element_get_service(data->element);
119         data->order = __connman_service_get_order(service);
120
121         gateway_list = g_slist_append(gateway_list, data);
122
123         return data;
124 }
125
126 static void connection_newgateway(int index, const char *gateway)
127 {
128         struct gateway_data *data;
129
130         DBG("index %d gateway %s", index, gateway);
131
132         data = find_gateway(index, gateway);
133         if (data == NULL)
134                 return;
135
136         data->active = TRUE;
137 }
138
139 static void set_default_gateway(struct gateway_data *data)
140 {
141         struct connman_element *element = data->element;
142         struct connman_service *service = NULL;
143         short int ifflags;
144
145         DBG("gateway %s", data->gateway);
146
147         if (data->vpn == TRUE) {
148                 connman_inet_set_gateway_address(data->index, data->vpn_ip);
149                 data->active = TRUE;
150                 /* vpn gateway going away no changes in services */
151                 return;
152         }
153
154         ifflags = connman_inet_ifflags(element->index);
155         if (ifflags < 0) {
156                 connman_error("Fail to get network interface flags");
157                 return;
158         }
159
160         if (ifflags & IFF_POINTOPOINT) {
161                 if (connman_inet_set_gateway_interface(element->index) < 0)
162                         return;
163                 goto done;
164         }
165
166         connman_inet_add_host_route(element->index, data->gateway);
167
168         if (connman_inet_set_gateway_address(element->index, data->gateway) < 0)
169                 return;
170
171 done:
172         service = __connman_element_get_service(element);
173         __connman_service_indicate_default(service);
174 }
175
176 static struct gateway_data *find_default_gateway(void)
177 {
178         struct gateway_data *found = NULL;
179         unsigned int order = 0;
180         GSList *list;
181
182         for (list = gateway_list; list; list = list->next) {
183                 struct gateway_data *data = list->data;
184
185                 if (found == NULL || data->order > order) {
186                         found = data;
187                         order = data->order;
188                 }
189         }
190
191         return found;
192 }
193
194 static int remove_gateway(struct gateway_data *data)
195 {
196         int ret;
197
198         DBG("gateway %s", data->gateway);
199
200         gateway_list = g_slist_remove(gateway_list, data);
201
202         if (data->active == TRUE)
203                 ret = del_routes(data);
204
205         g_free(data->gateway);
206         g_free(data->vpn_ip);
207         g_free(data);
208
209         return ret;
210 }
211
212 static void connection_delgateway(int index, const char *gateway)
213 {
214         struct gateway_data *data;
215
216         DBG("index %d gateway %s", index, gateway);
217
218         data = find_gateway(index, gateway);
219         if (data != NULL)
220                 data->active = FALSE;
221
222         data = find_default_gateway();
223         if (data != NULL)
224                 set_default_gateway(data);
225 }
226
227 static struct connman_rtnl connection_rtnl = {
228         .name           = "connection",
229         .newgateway     = connection_newgateway,
230         .delgateway     = connection_delgateway,
231 };
232
233 static struct gateway_data *find_active_gateway(void)
234 {
235         GSList *list;
236
237         DBG("");
238
239         for (list = gateway_list; list; list = list->next) {
240                 struct gateway_data *data = list->data;
241                 if (data->active == TRUE)
242                         return data;
243         }
244
245         return NULL;
246 }
247
248 static int connection_probe(struct connman_element *element)
249 {
250         struct connman_service *service = NULL;
251         const char *gateway = NULL;
252         const char *vpn_ip = NULL;
253         struct gateway_data *active_gateway = NULL;
254         struct gateway_data *new_gateway = NULL;
255
256         DBG("element %p name %s", element, element->name);
257
258         if (element->parent == NULL)
259                 return -ENODEV;
260
261         /* FIXME: Remove temporarily for the static gateway support */
262         /* if (element->parent->type != CONNMAN_ELEMENT_TYPE_IPV4)
263                 return -ENODEV; */
264
265         connman_element_get_value(element,
266                                 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
267
268         connman_element_get_value(element,
269                                   CONNMAN_PROPERTY_ID_IPV4_ADDRESS, &vpn_ip);
270
271         DBG("gateway %s", gateway);
272
273         service = __connman_element_get_service(element);
274         __connman_service_indicate_state(service,
275                                         CONNMAN_SERVICE_STATE_READY);
276
277         connman_element_set_enabled(element, TRUE);
278
279         if (gateway == NULL)
280                 return 0;
281
282         active_gateway = find_active_gateway();
283         new_gateway = add_gateway(element->index, gateway);
284
285         if (service == NULL) {
286                 new_gateway->vpn = TRUE;
287                 new_gateway->vpn_ip = g_strdup(vpn_ip);
288                 /* make sure vpn gateway are at higher priority */
289                 new_gateway->order = 10;
290                 if (active_gateway)
291                         new_gateway->vpn_phy_index = active_gateway->index;
292         } else
293                 new_gateway->vpn = FALSE;
294
295         if (active_gateway == NULL) {
296                 set_default_gateway(new_gateway);
297                 return 0;
298         }
299
300         if (new_gateway->vpn == TRUE) {
301                 connman_inet_add_host_route_vpn(active_gateway->index,
302                                                 active_gateway->gateway,
303                                                 new_gateway->gateway);
304         }
305
306         if (new_gateway->order >= active_gateway->order) {
307                 del_routes(active_gateway);
308                 return 0;
309         }
310
311         return 0;
312 }
313
314 static void connection_remove(struct connman_element *element)
315 {
316         struct connman_service *service;
317         const char *gateway = NULL;
318         struct gateway_data *data = NULL;
319         gboolean set_default = FALSE;
320         int ret;
321
322         DBG("element %p name %s", element, element->name);
323
324         service = __connman_element_get_service(element);
325         __connman_service_indicate_state(service,
326                                         CONNMAN_SERVICE_STATE_DISCONNECT);
327
328         connman_element_set_enabled(element, FALSE);
329
330         connman_element_get_value(element,
331                                 CONNMAN_PROPERTY_ID_IPV4_GATEWAY, &gateway);
332
333         DBG("gateway %s", gateway);
334
335         if (gateway == NULL)
336                 return;
337
338         data = find_gateway(element->index, gateway);
339         if (data == NULL)
340                 return;
341
342         set_default = data->vpn;
343
344         if (data->vpn == TRUE && data->vpn_phy_index >= 0)
345                 connman_inet_del_host_route(data->vpn_phy_index, data->gateway);
346
347         ret = remove_gateway(data);
348
349         /* with vpn this will be called after the network was deleted,
350          * we need to call set_default here because we will not recieve any
351          * gateway delete notification.
352          * We hit the same issue if remove_gateway() fails.
353          */
354         if (set_default || ret) {
355                 data = find_default_gateway();
356                 if (data != NULL)
357                         set_default_gateway(data);
358         }
359 }
360
361 static struct connman_driver connection_driver = {
362         .name           = "connection",
363         .type           = CONNMAN_ELEMENT_TYPE_CONNECTION,
364         .priority       = CONNMAN_DRIVER_PRIORITY_LOW,
365         .probe          = connection_probe,
366         .remove         = connection_remove,
367 };
368
369 int __connman_connection_init(void)
370 {
371         DBG("");
372
373         if (connman_rtnl_register(&connection_rtnl) < 0)
374                 connman_error("Failed to setup RTNL gateway driver");
375
376         return connman_driver_register(&connection_driver);
377 }
378
379 void __connman_connection_cleanup(void)
380 {
381         GSList *list;
382
383         DBG("");
384
385         connman_driver_unregister(&connection_driver);
386
387         connman_rtnl_unregister(&connection_rtnl);
388
389         for (list = gateway_list; list; list = list->next) {
390                 struct gateway_data *data = list->data;
391
392                 DBG("index %d gateway %s", data->index, data->gateway);
393
394                 g_free(data->gateway);
395                 g_free(data);
396                 list->data = NULL;
397         }
398
399         g_slist_free(gateway_list);
400         gateway_list = NULL;
401 }
402
403 static void update_order(void)
404 {
405         GSList *list = NULL;
406
407         for (list = gateway_list; list; list = list->next) {
408                 struct gateway_data *data = list->data;
409                 struct connman_service *service;
410
411                 /* vpn gataway is not attached to a service. */
412                 if (data->vpn)
413                         continue;
414
415                 service = __connman_element_get_service(data->element);
416                 data->order = __connman_service_get_order(service);
417         }
418 }
419
420 gboolean __connman_connection_update_gateway(void)
421 {
422         struct gateway_data *active_gateway, *default_gateway;
423         gboolean updated = FALSE;
424
425         update_order();
426
427         active_gateway = find_active_gateway();
428         default_gateway = find_default_gateway();
429
430         if (active_gateway && active_gateway != default_gateway) {
431                 del_routes(active_gateway);
432                 updated = TRUE;
433         }
434
435         return updated;
436 }