1: #include "global.h"
2: #include "dwds.h"
3:
4:
5: static inline int
6: wifi_getParent(const char *csVAP, char *psParent, size_t plen)
7: {
8: char szOID[STRSIZ] = { 0 };
9:
10: FTRACE(5);
11:
12: assert(csVAP);
13: assert(psParent);
14:
15: memset(psParent, 0, plen);
16: snprintf(szOID, STRSIZ, "net.wlan.%s.%%parent", csVAP + 4);
17: if (sysctlbyname(szOID, psParent, &plen, NULL, 0) == -1) {
18: // syslog(LOG_ERR, "Error:: can`t get parent #%d - %s\n", errno, strerror(errno));
19: return -1;
20: } else
21: psParent[plen] = 0;
22:
23: return 0;
24: }
25:
26: inline int
27: wifi_chkIface(const char *csVAP, char **ppsIF, int nIF)
28: {
29: char szParent[IFNAMSIZ];
30: register int i;
31:
32: FTRACE(5);
33:
34: assert(csVAP);
35:
36: if (wifi_getParent(csVAP, szParent, IFNAMSIZ) == -1)
37: return 0;
38:
39: for (i = 0; i < nIF; i++)
40: if (!strcasecmp(ppsIF[i], "any") || !strcmp(ppsIF[i], szParent))
41: return 1; /* OK, vap is child */
42:
43: VERB(2) syslog(LOG_ERR, "Error:: Interface %s parent %s not being monitored", csVAP, szParent);
44: return 0;
45: }
46:
47: static inline int
48: wifi_isWDS(int fd, const char *csVAP)
49: {
50: struct ifmediareq ifmr;
51:
52: FTRACE(5);
53:
54: assert(csVAP);
55:
56: memset(&ifmr, 0, sizeof ifmr);
57: strlcpy(ifmr.ifm_name, csVAP, sizeof ifmr.ifm_name);
58: if (ioctl(fd, SIOCGIFMEDIA, &ifmr) == -1) {
59: syslog(LOG_ERR, "Error:: can`t get media for %s #%d - %s\n", csVAP,
60: errno, strerror(errno));
61: return -1;
62: }
63:
64: return (ifmr.ifm_current & IFM_IEEE80211_WDS) != 0;
65: }
66:
67: static inline int
68: wifi_getBSSID(int fd, const char *csVAP, uint8_t *psBSSID, int len)
69: {
70: struct ieee80211req ireq;
71:
72: FTRACE(5);
73:
74: assert(csVAP);
75: assert(psBSSID);
76:
77: memset(&ireq, 0, sizeof ireq);
78: strlcpy(ireq.i_name, csVAP, sizeof ireq.i_name);
79: ireq.i_type = IEEE80211_IOC_BSSID;
80: ireq.i_data = psBSSID;
81: ireq.i_len = len;
82: if (ioctl(fd, SIOCG80211, &ireq) == -1) {
83: syslog(LOG_ERR, "Error:: can`t get BSSID for %s #%d - %s\n", csVAP,
84: errno, strerror(errno));
85: return -1;
86: }
87:
88: return 0;
89: }
90:
91: struct dwds_if *
92: wifi_buildWDS(int fd, char **ppsIF, int nIF)
93: {
94: struct dwds_if *p, *wds = NULL;
95: char szVAP[IFNAMSIZ];
96: struct ether_addr bssid;
97: register int i;
98:
99: FTRACE(5);
100:
101: for (i = 0; i < 128; i++) {
102: memset(szVAP, 0, IFNAMSIZ);
103: snprintf(szVAP, IFNAMSIZ, "wlan%d", i);
104: if (wifi_chkIface(szVAP, ppsIF, nIF) && !wifi_isWDS(fd, szVAP)) {
105: p = malloc(sizeof(struct dwds_if));
106: if (!p) {
107: syslog(LOG_ERR, "Error:: can`t allocate memory #%d - %s\n",
108: errno, strerror(errno));
109: i = -1;
110: break;
111: }
112: strlcpy(p->if_name, szVAP, IFNAMSIZ);
113: if (wifi_getBSSID(fd, szVAP, p->if_bssid, IEEE80211_ADDR_LEN) == -1) {
114: syslog(LOG_ERR, "Error:: can`t get BSSID #%d - %s\n",
115: errno, strerror(errno));
116: i = -1;
117: break;
118: }
119: p->if_next = wds;
120: wds = p;
121:
122: memcpy(&bssid, p->if_bssid, ETHER_ADDR_LEN);
123: syslog(LOG_INFO, "BSSID:%s discover WDS vap %s\n", ether_ntoa(&bssid), szVAP);
124: }
125: }
126:
127: if (i == -1)
128: while ((p = wds)) {
129: wds = wds->if_next;
130: free(p);
131: }
132:
133: return wds;
134: }
135:
136: inline int
137: wifi_destroyWDS(const char *csIface, struct dwds_if **wds)
138: {
139: struct dwds_if *p, **pp;
140:
141: FTRACE(5);
142:
143: assert(csIface);
144: assert(wds);
145:
146: for (pp = wds; (p = *pp); pp = &p->if_next)
147: if (!strncmp(p->if_name, csIface, IFNAMSIZ))
148: break;
149: if (p) {
150: *pp = p->if_next;
151: free(p);
152: return 0;
153: }
154:
155: return 1;
156: }
157:
158: static int
159: wifi_vapDestroy(const char *csVAP)
160: {
161: struct ieee80211req ifr;
162: int s;
163:
164: FTRACE(5);
165:
166: assert(csVAP);
167:
168: s = socket(PF_INET, SOCK_DGRAM, 0);
169: if (s == -1) {
170: syslog(LOG_ERR, "Error:: destroy socket(vap) %m\n");
171: return -1;
172: }
173:
174: memset(&ifr, 0, sizeof ifr);
175: strlcpy(ifr.i_name, csVAP, IFNAMSIZ);
176: if (ioctl(s, SIOCIFDESTROY, &ifr) == -1) {
177: syslog(LOG_ERR, "Error:: destroy ioctl(vap) %m\n");
178: close(s);
179: return -1;
180: } else
181: close(s);
182:
183: return 0;
184: }
185:
186: inline int
187: wifi_leaveWDS(struct ether_addr bssid, struct dwds_if **wds, char *psVAP, int vapLen)
188: {
189: struct dwds_if *p, **pp;
190:
191: FTRACE(5);
192:
193: assert(wds);
194: assert(psVAP);
195:
196: for (pp = wds; (p = *pp); pp = &p->if_next)
197: if (!memcmp(p->if_bssid, &bssid, IEEE80211_ADDR_LEN))
198: break;
199: if (p) {
200: *pp = p->if_next;
201: strlcpy(psVAP, p->if_name, vapLen);
202: if (wifi_vapDestroy(p->if_name) != -1)
203: VERB(1) syslog(LOG_INFO, "BSSID:%s WDS VAP %s destroyed\n",
204: ether_ntoa(&bssid), p->if_name);
205: free(p);
206: return 0;
207: }
208:
209: return 1;
210: }
211:
212: static int
213: wifi_vapCreate(const char *csIface, struct dwds_if *p)
214: {
215: struct ieee80211_clone_params cp;
216: struct ifreq ifr;
217: struct ether_addr bssid;
218: int s;
219:
220: FTRACE(5);
221:
222: assert(csIface);
223: assert(p);
224:
225: s = socket(PF_INET, SOCK_DGRAM, 0);
226: if (s == -1) {
227: syslog(LOG_ERR, "Error:: create socket(vap) %m\n");
228: return -1;
229: }
230:
231: memset(&cp, 0, sizeof cp);
232: strlcpy(cp.icp_parent, csIface, IFNAMSIZ);
233: cp.icp_opmode = IEEE80211_M_WDS;
234: memcpy(cp.icp_bssid, p->if_bssid, IEEE80211_ADDR_LEN);
235:
236: memset(&ifr, 0, sizeof ifr);
237: strlcpy(ifr.ifr_name, "wlan", IFNAMSIZ);
238: ifr.ifr_data = (void *) &cp;
239:
240: if (ioctl(s, SIOCIFCREATE2, &ifr) == -1) {
241: memcpy(&bssid, cp.icp_bssid, IEEE80211_ADDR_LEN);
242: syslog(LOG_ERR, "Error:: create ioctl(vap) mode %u flags 0x%x parent %s bssid %s %m\n",
243: cp.icp_opmode, cp.icp_flags, cp.icp_parent, ether_ntoa(&bssid));
244: close(s);
245: return -1;
246: } else {
247: strlcpy(p->if_name, ifr.ifr_name, IFNAMSIZ);
248: close(s);
249: }
250:
251: return 0;
252: }
253:
254: inline int
255: wifi_createWDS(const char *csIface, struct ether_addr bssid, struct dwds_if **wds)
256: {
257: struct dwds_if *p;
258: char szParent[IFNAMSIZ];
259:
260: FTRACE(5);
261:
262: assert(csIface);
263: assert(wds);
264:
265: for (p = *wds; p; p = p->if_next)
266: if (!memcmp(p->if_bssid, &bssid, IEEE80211_ADDR_LEN)) {
267: VERB(1) syslog(LOG_INFO, "BSSID:%s WDS VAP already created (%s)\n",
268: ether_ntoa(&bssid), csIface);
269: return 1;
270: }
271: if (wifi_getParent(csIface, szParent, IFNAMSIZ) == -1) {
272: syslog(LOG_ERR, "Error:: %s no pointer to parent interface\n", csIface);
273: return -1;
274: }
275:
276: p = malloc(sizeof(struct dwds_if));
277: if (!p) {
278: syslog(LOG_ERR, "Error:: malloc failed: %m\n");
279: return -1;
280: } else
281: memcpy(p->if_bssid, &bssid, IEEE80211_ADDR_LEN);
282: if (wifi_vapCreate(szParent, p) == -1) {
283: free(p);
284: return -1;
285: } else {
286: p->if_next = *wds;
287: *wds = p;
288: VERB(1) syslog(LOG_INFO, "BSSID:%s create WDS VAP %s\n", ether_ntoa(&bssid), p->if_name);
289: }
290:
291: return 0;
292: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to vap.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedtools / src