Add inet helper to retrieve current flags
[platform/upstream/connman.git] / src / inet.c
1 /*
2  *
3  *  Connection Manager
4  *
5  *  Copyright (C) 2007-2009  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 <stdio.h>
27 #include <errno.h>
28 #include <unistd.h>
29 #include <stdlib.h>
30 #include <string.h>
31 #include <sys/stat.h>
32 #include <sys/ioctl.h>
33 #include <sys/socket.h>
34 #include <arpa/inet.h>
35 #include <net/route.h>
36 #include <net/ethernet.h>
37 #include <linux/if_arp.h>
38 #include <linux/wireless.h>
39
40 #include "connman.h"
41
42 int connman_inet_ifindex(const char *name)
43 {
44         struct ifreq ifr;
45         int sk, err;
46
47         if (name == NULL)
48                 return -1;
49
50         sk = socket(PF_INET, SOCK_DGRAM, 0);
51         if (sk < 0)
52                 return -1;
53
54         memset(&ifr, 0, sizeof(ifr));
55         strncpy(ifr.ifr_name, name, sizeof(ifr.ifr_name));
56
57         err = ioctl(sk, SIOCGIFINDEX, &ifr);
58
59         close(sk);
60
61         if (err < 0)
62                 return -1;
63
64         return ifr.ifr_ifindex;
65 }
66
67 char *connman_inet_ifname(int index)
68 {
69         struct ifreq ifr;
70         int sk, err;
71
72         if (index < 0)
73                 return NULL;
74
75         sk = socket(PF_INET, SOCK_DGRAM, 0);
76         if (sk < 0)
77                 return NULL;
78
79         memset(&ifr, 0, sizeof(ifr));
80         ifr.ifr_ifindex = index;
81
82         err = ioctl(sk, SIOCGIFNAME, &ifr);
83
84         close(sk);
85
86         if (err < 0)
87                 return NULL;
88
89         return strdup(ifr.ifr_name);
90 }
91
92 short int connman_inet_ifflags(int index)
93 {
94         struct ifreq ifr;
95         int sk, err;
96
97         sk = socket(PF_INET, SOCK_DGRAM, 0);
98         if (sk < 0)
99                 return -errno;
100
101         memset(&ifr, 0, sizeof(ifr));
102         ifr.ifr_ifindex = index;
103
104         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
105                 err = -errno;
106                 goto done;
107         }
108
109         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
110                 err = -errno;
111                 goto done;
112         }
113
114         err = ifr.ifr_flags;
115
116 done:
117         close(sk);
118
119         return err;
120 }
121
122 int connman_inet_ifup(int index)
123 {
124         struct ifreq ifr;
125         int sk, err;
126
127         sk = socket(PF_INET, SOCK_DGRAM, 0);
128         if (sk < 0)
129                 return -errno;
130
131         memset(&ifr, 0, sizeof(ifr));
132         ifr.ifr_ifindex = index;
133
134         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
135                 err = -errno;
136                 goto done;
137         }
138
139         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
140                 err = -errno;
141                 goto done;
142         }
143
144         if (ifr.ifr_flags & IFF_UP) {
145                 err = -EALREADY;
146                 goto done;
147         }
148
149         ifr.ifr_flags |= IFF_UP;
150
151         if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0) {
152                 err = -errno;
153                 goto done;
154         }
155
156         err = 0;
157
158 done:
159         close(sk);
160
161         return err;
162 }
163
164 int connman_inet_ifdown(int index)
165 {
166         struct ifreq ifr;
167         int sk, err;
168
169         sk = socket(PF_INET, SOCK_DGRAM, 0);
170         if (sk < 0)
171                 return -errno;
172
173         memset(&ifr, 0, sizeof(ifr));
174         ifr.ifr_ifindex = index;
175
176         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
177                 err = -errno;
178                 goto done;
179         }
180
181         if (ioctl(sk, SIOCGIFFLAGS, &ifr) < 0) {
182                 err = -errno;
183                 goto done;
184         }
185
186         if (!(ifr.ifr_flags & IFF_UP)) {
187                 err = -EALREADY;
188                 goto done;
189         }
190
191         ifr.ifr_flags &= ~IFF_UP;
192
193         if (ioctl(sk, SIOCSIFFLAGS, &ifr) < 0)
194                 err = -errno;
195         else
196                 err = 0;
197
198 done:
199         close(sk);
200
201         return err;
202 }
203
204 static unsigned short index2type(int index)
205 {
206         struct ifreq ifr;
207         int sk, err;
208
209         if (index < 0)
210                 return ARPHRD_VOID;
211
212         sk = socket(PF_INET, SOCK_DGRAM, 0);
213         if (sk < 0)
214                 return ARPHRD_VOID;
215
216         memset(&ifr, 0, sizeof(ifr));
217         ifr.ifr_ifindex = index;
218
219         err = ioctl(sk, SIOCGIFNAME, &ifr);
220
221         if (err == 0)
222                 err = ioctl(sk, SIOCGIFHWADDR, &ifr);
223
224         close(sk);
225
226         if (err < 0)
227                 return ARPHRD_VOID;
228
229         return ifr.ifr_hwaddr.sa_family;
230 }
231
232 static char *index2addr(int index)
233 {
234         struct ifreq ifr;
235         struct ether_addr eth;
236         char *str;
237         int sk, err;
238
239         if (index < 0)
240                 return NULL;
241
242         sk = socket(PF_INET, SOCK_DGRAM, 0);
243         if (sk < 0)
244                 return NULL;
245
246         memset(&ifr, 0, sizeof(ifr));
247         ifr.ifr_ifindex = index;
248
249         err = ioctl(sk, SIOCGIFNAME, &ifr);
250
251         if (err == 0)
252                 err = ioctl(sk, SIOCGIFHWADDR, &ifr);
253
254         close(sk);
255
256         if (err < 0)
257                 return NULL;
258
259         str = malloc(18);
260         if (!str)
261                 return NULL;
262
263         memcpy(&eth, &ifr.ifr_hwaddr.sa_data, sizeof(eth));
264         snprintf(str, 18, "%02X:%02X:%02X:%02X:%02X:%02X",
265                                                 eth.ether_addr_octet[0],
266                                                 eth.ether_addr_octet[1],
267                                                 eth.ether_addr_octet[2],
268                                                 eth.ether_addr_octet[3],
269                                                 eth.ether_addr_octet[4],
270                                                 eth.ether_addr_octet[5]);
271
272         return str;
273 }
274
275 static char *index2ident(int index, const char *prefix)
276 {
277         struct ifreq ifr;
278         struct ether_addr eth;
279         char *str;
280         int sk, err, len;
281
282         if (index < 0)
283                 return NULL;
284
285         sk = socket(PF_INET, SOCK_DGRAM, 0);
286         if (sk < 0)
287                 return NULL;
288
289         memset(&ifr, 0, sizeof(ifr));
290         ifr.ifr_ifindex = index;
291
292         err = ioctl(sk, SIOCGIFNAME, &ifr);
293
294         if (err == 0)
295                 err = ioctl(sk, SIOCGIFHWADDR, &ifr);
296
297         close(sk);
298
299         if (err < 0)
300                 return NULL;
301
302         len = prefix ? strlen(prefix) + 18 : 18;
303
304         str = malloc(len);
305         if (!str)
306                 return NULL;
307
308         memcpy(&eth, &ifr.ifr_hwaddr.sa_data, sizeof(eth));
309         snprintf(str, len, "%s%02x%02x%02x%02x%02x%02x",
310                                                 prefix ? prefix : "",
311                                                 eth.ether_addr_octet[0],
312                                                 eth.ether_addr_octet[1],
313                                                 eth.ether_addr_octet[2],
314                                                 eth.ether_addr_octet[3],
315                                                 eth.ether_addr_octet[4],
316                                                 eth.ether_addr_octet[5]);
317
318         return str;
319 }
320
321 connman_bool_t connman_inet_is_mac80211(int index)
322 {
323         connman_bool_t result = FALSE;
324         char phy80211_path[PATH_MAX];
325         struct stat st;
326         struct ifreq ifr;
327         int sk;
328
329         sk = socket(PF_INET, SOCK_DGRAM, 0);
330         if (sk < 0)
331                 return FALSE;
332
333         memset(&ifr, 0, sizeof(ifr));
334         ifr.ifr_ifindex = index;
335
336         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0)
337                 goto done;
338
339         snprintf(phy80211_path, PATH_MAX,
340                                 "/sys/class/net/%s/phy80211", ifr.ifr_name);
341
342         if (stat(phy80211_path, &st) == 0 && (st.st_mode & S_IFDIR))
343                 result = TRUE;
344
345 done:
346         close(sk);
347
348         return result;
349 }
350
351 enum connman_device_type __connman_inet_get_device_type(int index)
352 {
353         enum connman_device_type devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
354         unsigned short type = index2type(index);
355         const char *devname;
356         struct ifreq ifr;
357         int sk;
358
359         sk = socket(PF_INET, SOCK_DGRAM, 0);
360         if (sk < 0)
361                 return devtype;
362
363         memset(&ifr, 0, sizeof(ifr));
364         ifr.ifr_ifindex = index;
365
366         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0)
367                 goto done;
368
369         devname = ifr.ifr_name;
370
371         if (type == ARPHRD_ETHER) {
372                 char phy80211_path[PATH_MAX];
373                 char bonding_path[PATH_MAX];
374                 char bridge_path[PATH_MAX];
375                 char wimax_path[PATH_MAX];
376                 struct stat st;
377                 struct iwreq iwr;
378                 char *devnode;
379
380                 snprintf(phy80211_path, PATH_MAX,
381                                         "/sys/class/net/%s/phy80211", devname);
382                 snprintf(bonding_path, PATH_MAX,
383                                         "/sys/class/net/%s/bonding", devname);
384                 snprintf(bridge_path, PATH_MAX,
385                                         "/sys/class/net/%s/bridge", devname);
386                 snprintf(wimax_path, PATH_MAX,
387                                         "/sys/class/net/%s/wimax", devname);
388
389                 memset(&iwr, 0, sizeof(iwr));
390                 strncpy(iwr.ifr_ifrn.ifrn_name, devname, IFNAMSIZ);
391
392                 devnode = __connman_udev_get_mbm_devnode(devname);
393                 if (devnode != NULL) {
394                         devtype = CONNMAN_DEVICE_TYPE_MBM;
395                         g_free(devnode);
396                         goto done;
397                 }
398
399                 if (g_str_has_prefix(devname, "vmnet") == TRUE)
400                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
401                 else if (g_str_has_prefix(ifr.ifr_name, "vboxnet") == TRUE)
402                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
403                 else if (g_str_has_prefix(devname, "bnep") == TRUE)
404                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
405                 else if (g_str_has_prefix(devname, "wmx") == TRUE)
406                         devtype = CONNMAN_DEVICE_TYPE_WIMAX;
407                 else if (stat(wimax_path, &st) == 0 && (st.st_mode & S_IFDIR))
408                         devtype = CONNMAN_DEVICE_TYPE_WIMAX;
409                 else if (stat(bridge_path, &st) == 0 && (st.st_mode & S_IFDIR))
410                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
411                 else if (stat(bonding_path, &st) == 0 && (st.st_mode & S_IFDIR))
412                         devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
413                 else if (stat(phy80211_path, &st) == 0 && (st.st_mode & S_IFDIR))
414                         devtype = CONNMAN_DEVICE_TYPE_WIFI;
415                 else if (ioctl(sk, SIOCGIWNAME, &iwr) == 0)
416                         devtype = CONNMAN_DEVICE_TYPE_WIFI;
417                 else
418                         devtype = CONNMAN_DEVICE_TYPE_ETHERNET;
419         } else if (type == ARPHRD_NONE) {
420                 if (g_str_has_prefix(devname, "hso") == TRUE)
421                         devtype = CONNMAN_DEVICE_TYPE_HSO;
422         }
423
424 done:
425         close(sk);
426
427         return devtype;
428 }
429
430 struct connman_device *connman_inet_create_device(int index)
431 {
432         enum connman_device_mode mode = CONNMAN_DEVICE_MODE_UNKNOWN;
433         enum connman_device_type type;
434         struct connman_device *device;
435         char *devname, *ident = NULL;
436         char *addr = NULL, *name = NULL, *node = NULL;
437
438         if (index < 0)
439                 return NULL;
440
441         devname = connman_inet_ifname(index);
442         if (devname == NULL)
443                 return NULL;
444
445         __connman_udev_get_devtype(devname);
446
447         type = __connman_inet_get_device_type(index);
448
449         switch (type) {
450         case CONNMAN_DEVICE_TYPE_UNKNOWN:
451                 connman_info("Ignoring network interface %s", devname);
452                 g_free(devname);
453                 return NULL;
454         case CONNMAN_DEVICE_TYPE_ETHERNET:
455         case CONNMAN_DEVICE_TYPE_WIFI:
456         case CONNMAN_DEVICE_TYPE_WIMAX:
457                 name = index2ident(index, "");
458                 addr = index2addr(index);
459                 break;
460         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
461         case CONNMAN_DEVICE_TYPE_GPS:
462         case CONNMAN_DEVICE_TYPE_HSO:
463         case CONNMAN_DEVICE_TYPE_NOZOMI:
464         case CONNMAN_DEVICE_TYPE_HUAWEI:
465         case CONNMAN_DEVICE_TYPE_NOVATEL:
466         case CONNMAN_DEVICE_TYPE_VENDOR:
467                 name = strdup(devname);
468                 break;
469         case CONNMAN_DEVICE_TYPE_MBM:
470                 name = strdup(devname);
471                 addr = index2addr(index);
472                 node = __connman_udev_get_mbm_devnode(devname);
473                 break;
474         }
475
476         device = connman_device_create(name, type);
477         if (device == NULL)
478                 goto done;
479
480         switch (type) {
481         case CONNMAN_DEVICE_TYPE_UNKNOWN:
482         case CONNMAN_DEVICE_TYPE_VENDOR:
483         case CONNMAN_DEVICE_TYPE_NOZOMI:
484         case CONNMAN_DEVICE_TYPE_HUAWEI:
485         case CONNMAN_DEVICE_TYPE_NOVATEL:
486         case CONNMAN_DEVICE_TYPE_GPS:
487                 mode = CONNMAN_DEVICE_MODE_UNKNOWN;
488                 break;
489         case CONNMAN_DEVICE_TYPE_ETHERNET:
490                 mode = CONNMAN_DEVICE_MODE_TRANSPORT_IP;
491                 ident = index2ident(index, NULL);
492                 break;
493         case CONNMAN_DEVICE_TYPE_WIFI:
494         case CONNMAN_DEVICE_TYPE_WIMAX:
495                 mode = CONNMAN_DEVICE_MODE_NETWORK_SINGLE;
496                 ident = index2ident(index, NULL);
497                 break;
498         case CONNMAN_DEVICE_TYPE_BLUETOOTH:
499                 mode = CONNMAN_DEVICE_MODE_NETWORK_MULTIPLE;
500                 break;
501         case CONNMAN_DEVICE_TYPE_MBM:
502         case CONNMAN_DEVICE_TYPE_HSO:
503                 mode = CONNMAN_DEVICE_MODE_NETWORK_SINGLE;
504                 ident = index2ident(index, NULL);
505                 break;
506         }
507
508         connman_device_set_mode(device, mode);
509
510         connman_device_set_index(device, index);
511         connman_device_set_interface(device, devname, node);
512
513         if (ident != NULL) {
514                 connman_device_set_ident(device, ident);
515                 g_free(ident);
516         }
517
518         connman_device_set_string(device, "Address", addr);
519
520 done:
521         g_free(devname);
522         g_free(node);
523         g_free(name);
524         g_free(addr);
525
526         return device;
527 }
528
529 int connman_inet_set_address(int index, struct connman_ipaddress *ipaddress)
530 {
531         struct ifreq ifr;
532         struct sockaddr_in addr;
533         int sk, err;
534
535         sk = socket(PF_INET, SOCK_DGRAM, 0);
536         if (sk < 0)
537                 return -1;
538
539         memset(&ifr, 0, sizeof(ifr));
540         ifr.ifr_ifindex = index;
541
542         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
543                 close(sk);
544                 return -1;
545         }
546
547         DBG("ifname %s", ifr.ifr_name);
548
549         memset(&addr, 0, sizeof(addr));
550         addr.sin_family = AF_INET;
551         addr.sin_addr.s_addr = inet_addr(ipaddress->local);
552         memcpy(&ifr.ifr_addr, &addr, sizeof(ifr.ifr_addr));
553
554         err = ioctl(sk, SIOCSIFADDR, &ifr);
555
556         if (err < 0)
557                 DBG("address setting failed (%s)", strerror(errno));
558
559         memset(&addr, 0, sizeof(addr));
560         addr.sin_family = AF_INET;
561         addr.sin_addr.s_addr = htonl(~(0xfffffffflu >> ipaddress->prefixlen));
562         memcpy(&ifr.ifr_netmask, &addr, sizeof(ifr.ifr_netmask));
563
564         err = ioctl(sk, SIOCSIFNETMASK, &ifr);
565
566         if (err < 0)
567                 DBG("netmask setting failed (%s)", strerror(errno));
568
569         memset(&addr, 0, sizeof(addr));
570         addr.sin_family = AF_INET;
571         addr.sin_addr.s_addr = inet_addr(ipaddress->broadcast);
572         memcpy(&ifr.ifr_broadaddr, &addr, sizeof(ifr.ifr_broadaddr));
573
574         err = ioctl(sk, SIOCSIFBRDADDR, &ifr);
575
576         if (err < 0)
577                 DBG("broadcast setting failed (%s)", strerror(errno));
578
579         close(sk);
580
581         return 0;
582 }
583
584 int connman_inet_clear_address(int index)
585 {
586         struct ifreq ifr;
587         struct sockaddr_in addr;
588         int sk, err;
589
590         sk = socket(PF_INET, SOCK_DGRAM, 0);
591         if (sk < 0)
592                 return -1;
593
594         memset(&ifr, 0, sizeof(ifr));
595         ifr.ifr_ifindex = index;
596
597         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
598                 close(sk);
599                 return -1;
600         }
601
602         DBG("ifname %s", ifr.ifr_name);
603
604         memset(&addr, 0, sizeof(addr));
605         addr.sin_family = AF_INET;
606         addr.sin_addr.s_addr = INADDR_ANY;
607         memcpy(&ifr.ifr_addr, &addr, sizeof(ifr.ifr_addr));
608
609         //err = ioctl(sk, SIOCDIFADDR, &ifr);
610         err = ioctl(sk, SIOCSIFADDR, &ifr);
611
612         close(sk);
613
614         if (err < 0 && errno != EADDRNOTAVAIL) {
615                 DBG("address removal failed (%s)", strerror(errno));
616                 return -1;
617         }
618
619         return 0;
620 }
621
622 int connman_inet_set_gateway(int index, struct in_addr gateway)
623 {
624         struct ifreq ifr;
625         struct rtentry rt;
626         struct sockaddr_in addr;
627         int sk, err;
628
629         sk = socket(PF_INET, SOCK_DGRAM, 0);
630         if (sk < 0)
631                 return -1;
632
633         memset(&ifr, 0, sizeof(ifr));
634         ifr.ifr_ifindex = index;
635
636         if (ioctl(sk, SIOCGIFNAME, &ifr) < 0) {
637                 close(sk);
638                 return -1;
639         }
640
641         DBG("ifname %s", ifr.ifr_name);
642
643         memset(&rt, 0, sizeof(rt));
644         rt.rt_flags = RTF_UP | RTF_HOST;
645
646         memset(&addr, 0, sizeof(addr));
647         addr.sin_family = AF_INET;
648         addr.sin_addr = gateway;
649         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
650
651         memset(&addr, 0, sizeof(addr));
652         addr.sin_family = AF_INET;
653         addr.sin_addr.s_addr = INADDR_ANY;
654         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
655
656         memset(&addr, 0, sizeof(addr));
657         addr.sin_family = AF_INET;
658         addr.sin_addr.s_addr = INADDR_ANY;
659         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
660
661         rt.rt_dev = ifr.ifr_name;
662
663         err = ioctl(sk, SIOCADDRT, &rt);
664         if (err < 0)
665                 connman_error("Setting host gateway route failed (%s)",
666                                                         strerror(errno));
667
668         memset(&rt, 0, sizeof(rt));
669         rt.rt_flags = RTF_UP | RTF_GATEWAY;
670
671         memset(&addr, 0, sizeof(addr));
672         addr.sin_family = AF_INET;
673         addr.sin_addr.s_addr = INADDR_ANY;
674         memcpy(&rt.rt_dst, &addr, sizeof(rt.rt_dst));
675
676         memset(&addr, 0, sizeof(addr));
677         addr.sin_family = AF_INET;
678         addr.sin_addr = gateway;
679         memcpy(&rt.rt_gateway, &addr, sizeof(rt.rt_gateway));
680
681         memset(&addr, 0, sizeof(addr));
682         addr.sin_family = AF_INET;
683         addr.sin_addr.s_addr = INADDR_ANY;
684         memcpy(&rt.rt_genmask, &addr, sizeof(rt.rt_genmask));
685
686         err = ioctl(sk, SIOCADDRT, &rt);
687         if (err < 0)
688                 connman_error("Setting default route failed (%s)",
689                                                         strerror(errno));
690
691         close(sk);
692
693         return err;
694 }