[kernel] 2.6.31: update generic config
[openwrt.git] / package / broadcom-wl / src / wlc / ioctl.c
1 /*
2 * Wireless network adapter utilities
3 *
4 * Copyright 2006, Broadcom Corporation
5 * All Rights Reserved.
6 *
7 * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
8 * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
9 * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
10 * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
11 *
12 */
13 #include <stdio.h>
14 #include <unistd.h>
15 #include <string.h>
16 #include <errno.h>
17 #include <sys/ioctl.h>
18 #include <net/if.h>
19 #include <linux/types.h>
20
21 typedef u_int64_t u64;
22 typedef u_int32_t u32;
23 typedef u_int16_t u16;
24 typedef u_int8_t u8;
25 #include <linux/sockios.h>
26 #include <linux/ethtool.h>
27
28 #include <typedefs.h>
29 #include <wlioctl.h>
30 #include <bcmutils.h>
31 #include <wlutils.h>
32
33 int
34 wl_ioctl(char *name, int cmd, void *buf, int len)
35 {
36 struct ifreq ifr;
37 wl_ioctl_t ioc;
38 int ret = 0;
39 int s;
40
41 /* open socket to kernel */
42 if ((s = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
43 perror("socket");
44 return errno;
45 }
46
47 /* do it */
48 ioc.cmd = cmd;
49 ioc.buf = buf;
50 ioc.len = len;
51 strncpy(ifr.ifr_name, name, IFNAMSIZ);
52 ifr.ifr_data = (caddr_t) &ioc;
53 if ((ret = ioctl(s, SIOCDEVPRIVATE, &ifr)) < 0)
54
55 /* cleanup */
56 close(s);
57 return ret;
58 }
59
60 static inline int
61 wl_get_dev_type(char *name, void *buf, int len)
62 {
63 int s;
64 int ret;
65 struct ifreq ifr;
66 struct ethtool_drvinfo info;
67
68 /* open socket to kernel */
69 if ((s = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
70 perror("socket");
71 return -1;
72 }
73
74 /* get device type */
75 memset(&info, 0, sizeof(info));
76 info.cmd = ETHTOOL_GDRVINFO;
77 ifr.ifr_data = (caddr_t)&info;
78 strncpy(ifr.ifr_name, name, IFNAMSIZ);
79 if ((ret = ioctl(s, SIOCETHTOOL, &ifr)) < 0) {
80 *(char *)buf = '\0';
81 } else
82 strncpy(buf, info.driver, len);
83
84 close(s);
85 return ret;
86 }
87
88 int
89 wl_probe(char *name)
90 {
91 int ret, val;
92 char buf[3];
93 if ((ret = wl_get_dev_type(name, buf, 3)) < 0)
94 return ret;
95 /* Check interface */
96 if (strncmp(buf, "wl", 2))
97 return -1;
98 if ((ret = wl_ioctl(name, WLC_GET_VERSION, &val, sizeof(val))))
99 return ret;
100 if (val > WLC_IOCTL_VERSION)
101 return -1;
102
103 return ret;
104 }
105
106 static int
107 wl_iovar_getbuf(char *ifname, char *iovar, void *param, int paramlen, void *bufptr, int buflen)
108 {
109 int err;
110 uint namelen;
111 uint iolen;
112
113 namelen = strlen(iovar) + 1; /* length of iovar name plus null */
114 iolen = namelen + paramlen;
115
116 /* check for overflow */
117 if (iolen > buflen)
118 return (BCME_BUFTOOSHORT);
119
120 memcpy(bufptr, iovar, namelen); /* copy iovar name including null */
121 memcpy((int8*)bufptr + namelen, param, paramlen);
122
123 err = wl_ioctl(ifname, WLC_GET_VAR, bufptr, buflen);
124
125 return (err);
126 }
127
128 static int
129 wl_iovar_setbuf(char *ifname, char *iovar, void *param, int paramlen, void *bufptr, int buflen)
130 {
131 uint namelen;
132 uint iolen;
133
134 namelen = strlen(iovar) + 1; /* length of iovar name plus null */
135 iolen = namelen + paramlen;
136
137 /* check for overflow */
138 if (iolen > buflen)
139 return (BCME_BUFTOOSHORT);
140
141 memcpy(bufptr, iovar, namelen); /* copy iovar name including null */
142 memcpy((int8*)bufptr + namelen, param, paramlen);
143
144 return wl_ioctl(ifname, WLC_SET_VAR, bufptr, iolen);
145 }
146
147 int
148 wl_iovar_set(char *ifname, char *iovar, void *param, int paramlen)
149 {
150 char smbuf[WLC_IOCTL_SMLEN];
151
152 return wl_iovar_setbuf(ifname, iovar, param, paramlen, smbuf, sizeof(smbuf));
153 }
154
155 int
156 wl_iovar_get(char *ifname, char *iovar, void *bufptr, int buflen)
157 {
158 char smbuf[WLC_IOCTL_SMLEN];
159 int ret;
160
161 /* use the return buffer if it is bigger than what we have on the stack */
162 if (buflen > sizeof(smbuf)) {
163 ret = wl_iovar_getbuf(ifname, iovar, NULL, 0, bufptr, buflen);
164 } else {
165 ret = wl_iovar_getbuf(ifname, iovar, NULL, 0, smbuf, sizeof(smbuf));
166 if (ret == 0)
167 memcpy(bufptr, smbuf, buflen);
168 }
169
170 return ret;
171 }
172
173
174 /*
175 * format a bsscfg indexed iovar buffer
176 */
177 static int
178 wl_bssiovar_mkbuf(char *iovar, int bssidx, void *param, int paramlen, void *bufptr, int buflen,
179 int *plen)
180 {
181 char *prefix = "bsscfg:";
182 int8* p;
183 uint prefixlen;
184 uint namelen;
185 uint iolen;
186
187 prefixlen = strlen(prefix); /* length of bsscfg prefix */
188 namelen = strlen(iovar) + 1; /* length of iovar name + null */
189 iolen = prefixlen + namelen + sizeof(int) + paramlen;
190
191 /* check for overflow */
192 if (buflen < 0 || iolen > (uint)buflen) {
193 *plen = 0;
194 return BCME_BUFTOOSHORT;
195 }
196
197 p = (int8*)bufptr;
198
199 /* copy prefix, no null */
200 memcpy(p, prefix, prefixlen);
201 p += prefixlen;
202
203 /* copy iovar name including null */
204 memcpy(p, iovar, namelen);
205 p += namelen;
206
207 /* bss config index as first param */
208 memcpy(p, &bssidx, sizeof(int32));
209 p += sizeof(int32);
210
211 /* parameter buffer follows */
212 if (paramlen)
213 memcpy(p, param, paramlen);
214
215 *plen = iolen;
216 return 0;
217 }
218
219 /*
220 * set named & bss indexed driver variable to buffer value
221 */
222 static int
223 wl_bssiovar_setbuf(char *ifname, char *iovar, int bssidx, void *param, int paramlen, void *bufptr,
224 int buflen)
225 {
226 int err;
227 int iolen;
228
229 err = wl_bssiovar_mkbuf(iovar, bssidx, param, paramlen, bufptr, buflen, &iolen);
230 if (err)
231 return err;
232
233 return wl_ioctl(ifname, WLC_SET_VAR, bufptr, iolen);
234 }
235
236 /*
237 * get named & bss indexed driver variable buffer value
238 */
239 static int
240 wl_bssiovar_getbuf(char *ifname, char *iovar, int bssidx, void *param, int paramlen, void *bufptr,
241 int buflen)
242 {
243 int err;
244 int iolen;
245
246 err = wl_bssiovar_mkbuf(iovar, bssidx, param, paramlen, bufptr, buflen, &iolen);
247 if (err)
248 return err;
249
250 return wl_ioctl(ifname, WLC_GET_VAR, bufptr, buflen);
251 }
252
253 /*
254 * set named & bss indexed driver variable to buffer value
255 */
256 int
257 wl_bssiovar_set(char *ifname, char *iovar, int bssidx, void *param, int paramlen)
258 {
259 char smbuf[WLC_IOCTL_SMLEN];
260
261 return wl_bssiovar_setbuf(ifname, iovar, bssidx, param, paramlen, smbuf, sizeof(smbuf));
262 }
263
264 /*
265 * get named & bss indexed driver variable buffer value
266 */
267 int
268 wl_bssiovar_get(char *ifname, char *iovar, int bssidx, void *outbuf, int len)
269 {
270 char smbuf[WLC_IOCTL_SMLEN];
271 int err;
272
273 /* use the return buffer if it is bigger than what we have on the stack */
274 if (len > (int)sizeof(smbuf)) {
275 err = wl_bssiovar_getbuf(ifname, iovar, bssidx, NULL, 0, outbuf, len);
276 } else {
277 memset(smbuf, 0, sizeof(smbuf));
278 err = wl_bssiovar_getbuf(ifname, iovar, bssidx, NULL, 0, smbuf, sizeof(smbuf));
279 if (err == 0)
280 memcpy(outbuf, smbuf, len);
281 }
282
283 return err;
284 }
285
286 void
287 wl_printlasterror(char *name)
288 {
289 char err_buf[WLC_IOCTL_SMLEN];
290 strcpy(err_buf, "bcmerrstr");
291
292 fprintf(stderr, "Error: ");
293 if ( wl_ioctl(name, WLC_GET_VAR, err_buf, sizeof (err_buf)) != 0)
294 fprintf(stderr, "Error getting the Errorstring from driver\n");
295 else
296 fprintf(stderr, err_buf);
297 }
This page took 0.05461 seconds and 5 git commands to generate.