1 /*
2 * Linux ioctl helper functions for driver wrappers
3 * Copyright (c) 2002-2010, Jouni Malinen <j@w1.fi>
4 *
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
7 */
8
9 #include "utils/includes.h"
10 #include <sys/ioctl.h>
11 #include <net/if.h>
12 #include <net/if_arp.h>
13
14 #include "utils/common.h"
15 #include "common/linux_bridge.h"
16 #include "linux_ioctl.h"
17
18
linux_set_iface_flags(int sock,const char * ifname,int dev_up)19 int linux_set_iface_flags(int sock, const char *ifname, int dev_up)
20 {
21 struct ifreq ifr;
22 int ret;
23
24 if (sock < 0)
25 return -1;
26
27 os_memset(&ifr, 0, sizeof(ifr));
28 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
29
30 if (ioctl(sock, SIOCGIFFLAGS, &ifr) != 0) {
31 ret = errno ? -errno : -999;
32 wpa_printf(MSG_ERROR, "Could not read interface %s flags: %s",
33 ifname, strerror(errno));
34 return ret;
35 }
36
37 if (dev_up) {
38 if (ifr.ifr_flags & IFF_UP)
39 return 0;
40 ifr.ifr_flags |= IFF_UP;
41 } else {
42 if (!(ifr.ifr_flags & IFF_UP))
43 return 0;
44 ifr.ifr_flags &= ~IFF_UP;
45 }
46
47 if (ioctl(sock, SIOCSIFFLAGS, &ifr) != 0) {
48 ret = errno ? -errno : -999;
49 wpa_printf(MSG_ERROR, "Could not set interface %s flags (%s): "
50 "%s",
51 ifname, dev_up ? "UP" : "DOWN", strerror(errno));
52 return ret;
53 }
54
55 return 0;
56 }
57
58
linux_iface_up(int sock,const char * ifname)59 int linux_iface_up(int sock, const char *ifname)
60 {
61 struct ifreq ifr;
62 int ret;
63
64 if (sock < 0)
65 return -1;
66
67 os_memset(&ifr, 0, sizeof(ifr));
68 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
69
70 if (ioctl(sock, SIOCGIFFLAGS, &ifr) != 0) {
71 ret = errno ? -errno : -999;
72 wpa_printf(MSG_ERROR, "Could not read interface %s flags: %s",
73 ifname, strerror(errno));
74 return ret;
75 }
76
77 return !!(ifr.ifr_flags & IFF_UP);
78 }
79
80
linux_get_ifhwaddr(int sock,const char * ifname,u8 * addr)81 int linux_get_ifhwaddr(int sock, const char *ifname, u8 *addr)
82 {
83 struct ifreq ifr;
84
85 os_memset(&ifr, 0, sizeof(ifr));
86 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
87 if (ioctl(sock, SIOCGIFHWADDR, &ifr)) {
88 wpa_printf(MSG_ERROR, "Could not get interface %s hwaddr: %s",
89 ifname, strerror(errno));
90 return -1;
91 }
92
93 if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
94 wpa_printf(MSG_ERROR, "%s: Invalid HW-addr family 0x%04x",
95 ifname, ifr.ifr_hwaddr.sa_family);
96 return -1;
97 }
98 os_memcpy(addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
99
100 return 0;
101 }
102
103
linux_set_ifhwaddr(int sock,const char * ifname,const u8 * addr)104 int linux_set_ifhwaddr(int sock, const char *ifname, const u8 *addr)
105 {
106 struct ifreq ifr;
107
108 os_memset(&ifr, 0, sizeof(ifr));
109 os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
110 os_memcpy(ifr.ifr_hwaddr.sa_data, addr, ETH_ALEN);
111 ifr.ifr_hwaddr.sa_family = ARPHRD_ETHER;
112
113 if (ioctl(sock, SIOCSIFHWADDR, &ifr)) {
114 wpa_printf(MSG_DEBUG, "Could not set interface %s hwaddr: %s",
115 ifname, strerror(errno));
116 return -1;
117 }
118
119 return 0;
120 }
121
122
linux_br_add(int sock,const char * brname)123 int linux_br_add(int sock, const char *brname)
124 {
125 if (ioctl(sock, SIOCBRADDBR, brname) < 0) {
126 int saved_errno = errno;
127
128 wpa_printf(MSG_DEBUG, "Could not add bridge %s: %s",
129 brname, strerror(errno));
130 errno = saved_errno;
131 return -1;
132 }
133
134 return 0;
135 }
136
137
linux_br_del(int sock,const char * brname)138 int linux_br_del(int sock, const char *brname)
139 {
140 if (ioctl(sock, SIOCBRDELBR, brname) < 0) {
141 wpa_printf(MSG_DEBUG, "Could not remove bridge %s: %s",
142 brname, strerror(errno));
143 return -1;
144 }
145
146 return 0;
147 }
148
149
linux_br_add_if(int sock,const char * brname,const char * ifname)150 int linux_br_add_if(int sock, const char *brname, const char *ifname)
151 {
152 struct ifreq ifr;
153 int ifindex;
154
155 ifindex = if_nametoindex(ifname);
156 if (ifindex == 0)
157 return -1;
158
159 os_memset(&ifr, 0, sizeof(ifr));
160 os_strlcpy(ifr.ifr_name, brname, IFNAMSIZ);
161 ifr.ifr_ifindex = ifindex;
162 if (ioctl(sock, SIOCBRADDIF, &ifr) < 0) {
163 int saved_errno = errno;
164
165 wpa_printf(MSG_DEBUG, "Could not add interface %s into bridge "
166 "%s: %s", ifname, brname, strerror(errno));
167 errno = saved_errno;
168 return -1;
169 }
170
171 return 0;
172 }
173
174
linux_br_del_if(int sock,const char * brname,const char * ifname)175 int linux_br_del_if(int sock, const char *brname, const char *ifname)
176 {
177 struct ifreq ifr;
178 int ifindex;
179
180 ifindex = if_nametoindex(ifname);
181 if (ifindex == 0)
182 return -1;
183
184 os_memset(&ifr, 0, sizeof(ifr));
185 os_strlcpy(ifr.ifr_name, brname, IFNAMSIZ);
186 ifr.ifr_ifindex = ifindex;
187 if (ioctl(sock, SIOCBRDELIF, &ifr) < 0) {
188 wpa_printf(MSG_DEBUG, "Could not remove interface %s from "
189 "bridge %s: %s", ifname, brname, strerror(errno));
190 return -1;
191 }
192
193 return 0;
194 }
195
196
linux_br_get(char * brname,const char * ifname)197 int linux_br_get(char *brname, const char *ifname)
198 {
199 char path[128], brlink[128], *pos;
200 ssize_t res;
201
202 os_snprintf(path, sizeof(path), "/sys/class/net/%s/brport/bridge",
203 ifname);
204 res = readlink(path, brlink, sizeof(brlink));
205 if (res < 0 || (size_t) res >= sizeof(brlink))
206 return -1;
207 brlink[res] = '\0';
208 pos = os_strrchr(brlink, '/');
209 if (pos == NULL)
210 return -1;
211 pos++;
212 os_strlcpy(brname, pos, IFNAMSIZ);
213 return 0;
214 }
215
216
linux_master_get(char * master_ifname,const char * ifname)217 int linux_master_get(char *master_ifname, const char *ifname)
218 {
219 char buf[128], masterlink[128], *pos;
220 ssize_t res;
221
222 /* check whether there is a master */
223 os_snprintf(buf, sizeof(buf), "/sys/class/net/%s/master", ifname);
224
225 res = readlink(buf, masterlink, sizeof(masterlink));
226 if (res < 0 || (size_t) res >= sizeof(masterlink))
227 return -1;
228
229 masterlink[res] = '\0';
230
231 pos = os_strrchr(masterlink, '/');
232 if (pos == NULL)
233 return -1;
234 pos++;
235 os_strlcpy(master_ifname, pos, IFNAMSIZ);
236 return 0;
237 }
238