1 /*
2  * wpa_supplicant/hostapd / common helper functions, etc.
3  * Copyright (c) 2002-2007, 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 "includes.h"
10 
11 #include "common/ieee802_11_defs.h"
12 #include "common.h"
13 
14 
hex2num(char c)15 static int hex2num(char c)
16 {
17 	if (c >= '0' && c <= '9')
18 		return c - '0';
19 	if (c >= 'a' && c <= 'f')
20 		return c - 'a' + 10;
21 	if (c >= 'A' && c <= 'F')
22 		return c - 'A' + 10;
23 	return -1;
24 }
25 
26 
hex2byte(const char * hex)27 int hex2byte(const char *hex)
28 {
29 	int a, b;
30 	a = hex2num(*hex++);
31 	if (a < 0)
32 		return -1;
33 	b = hex2num(*hex++);
34 	if (b < 0)
35 		return -1;
36 	return (a << 4) | b;
37 }
38 
39 
hwaddr_parse(const char * txt,u8 * addr)40 static const char * hwaddr_parse(const char *txt, u8 *addr)
41 {
42 	size_t i;
43 
44 	for (i = 0; i < ETH_ALEN; i++) {
45 		int a;
46 
47 		a = hex2byte(txt);
48 		if (a < 0)
49 			return NULL;
50 		txt += 2;
51 		addr[i] = a;
52 		if (i < ETH_ALEN - 1 && *txt++ != ':')
53 			return NULL;
54 	}
55 	return txt;
56 }
57 
58 
59 /**
60  * hwaddr_aton - Convert ASCII string to MAC address (colon-delimited format)
61  * @txt: MAC address as a string (e.g., "00:11:22:33:44:55")
62  * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
63  * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
64  */
hwaddr_aton(const char * txt,u8 * addr)65 int hwaddr_aton(const char *txt, u8 *addr)
66 {
67 	return hwaddr_parse(txt, addr) ? 0 : -1;
68 }
69 
70 
71 /**
72  * hwaddr_masked_aton - Convert ASCII string with optional mask to MAC address (colon-delimited format)
73  * @txt: MAC address with optional mask as a string (e.g., "00:11:22:33:44:55/ff:ff:ff:ff:00:00")
74  * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
75  * @mask: Buffer for the MAC address mask (ETH_ALEN = 6 bytes)
76  * @maskable: Flag to indicate whether a mask is allowed
77  * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
78  */
hwaddr_masked_aton(const char * txt,u8 * addr,u8 * mask,u8 maskable)79 int hwaddr_masked_aton(const char *txt, u8 *addr, u8 *mask, u8 maskable)
80 {
81 	const char *r;
82 
83 	/* parse address part */
84 	r = hwaddr_parse(txt, addr);
85 	if (!r)
86 		return -1;
87 
88 	/* check for optional mask */
89 	if (*r == '\0' || isspace(*r)) {
90 		/* no mask specified, assume default */
91 		os_memset(mask, 0xff, ETH_ALEN);
92 	} else if (maskable && *r == '/') {
93 		/* mask specified and allowed */
94 		r = hwaddr_parse(r + 1, mask);
95 		/* parser error? */
96 		if (!r)
97 			return -1;
98 	} else {
99 		/* mask specified but not allowed or trailing garbage */
100 		return -1;
101 	}
102 
103 	return 0;
104 }
105 
106 
107 /**
108  * hwaddr_compact_aton - Convert ASCII string to MAC address (no colon delimitors format)
109  * @txt: MAC address as a string (e.g., "001122334455")
110  * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
111  * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
112  */
hwaddr_compact_aton(const char * txt,u8 * addr)113 int hwaddr_compact_aton(const char *txt, u8 *addr)
114 {
115 	int i;
116 
117 	for (i = 0; i < 6; i++) {
118 		int a, b;
119 
120 		a = hex2num(*txt++);
121 		if (a < 0)
122 			return -1;
123 		b = hex2num(*txt++);
124 		if (b < 0)
125 			return -1;
126 		*addr++ = (a << 4) | b;
127 	}
128 
129 	return 0;
130 }
131 
132 /**
133  * hwaddr_aton2 - Convert ASCII string to MAC address (in any known format)
134  * @txt: MAC address as a string (e.g., 00:11:22:33:44:55 or 0011.2233.4455)
135  * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
136  * Returns: Characters used (> 0) on success, -1 on failure
137  */
hwaddr_aton2(const char * txt,u8 * addr)138 int hwaddr_aton2(const char *txt, u8 *addr)
139 {
140 	int i;
141 	const char *pos = txt;
142 
143 	for (i = 0; i < 6; i++) {
144 		int a, b;
145 
146 		while (*pos == ':' || *pos == '.' || *pos == '-')
147 			pos++;
148 
149 		a = hex2num(*pos++);
150 		if (a < 0)
151 			return -1;
152 		b = hex2num(*pos++);
153 		if (b < 0)
154 			return -1;
155 		*addr++ = (a << 4) | b;
156 	}
157 
158 	return pos - txt;
159 }
160 
161 
162 /**
163  * hexstr2bin - Convert ASCII hex string into binary data
164  * @hex: ASCII hex string (e.g., "01ab")
165  * @buf: Buffer for the binary data
166  * @len: Length of the text to convert in bytes (of buf); hex will be double
167  * this size
168  * Returns: 0 on success, -1 on failure (invalid hex string)
169  */
hexstr2bin(const char * hex,u8 * buf,size_t len)170 int hexstr2bin(const char *hex, u8 *buf, size_t len)
171 {
172 	size_t i;
173 	int a;
174 	const char *ipos = hex;
175 	u8 *opos = buf;
176 
177 	for (i = 0; i < len; i++) {
178 		a = hex2byte(ipos);
179 		if (a < 0)
180 			return -1;
181 		*opos++ = a;
182 		ipos += 2;
183 	}
184 	return 0;
185 }
186 
187 
hwaddr_mask_txt(char * buf,size_t len,const u8 * addr,const u8 * mask)188 int hwaddr_mask_txt(char *buf, size_t len, const u8 *addr, const u8 *mask)
189 {
190 	size_t i;
191 	int print_mask = 0;
192 	int res;
193 
194 	for (i = 0; i < ETH_ALEN; i++) {
195 		if (mask[i] != 0xff) {
196 			print_mask = 1;
197 			break;
198 		}
199 	}
200 
201 	if (print_mask)
202 		res = os_snprintf(buf, len, MACSTR "/" MACSTR,
203 				  MAC2STR(addr), MAC2STR(mask));
204 	else
205 		res = os_snprintf(buf, len, MACSTR, MAC2STR(addr));
206 	if (os_snprintf_error(len, res))
207 		return -1;
208 	return res;
209 }
210 
211 
212 /**
213  * inc_byte_array - Increment arbitrary length byte array by one
214  * @counter: Pointer to byte array
215  * @len: Length of the counter in bytes
216  *
217  * This function increments the last byte of the counter by one and continues
218  * rolling over to more significant bytes if the byte was incremented from
219  * 0xff to 0x00.
220  */
inc_byte_array(u8 * counter,size_t len)221 void inc_byte_array(u8 *counter, size_t len)
222 {
223 	int pos = len - 1;
224 	while (pos >= 0) {
225 		counter[pos]++;
226 		if (counter[pos] != 0)
227 			break;
228 		pos--;
229 	}
230 }
231 
232 
wpa_get_ntp_timestamp(u8 * buf)233 void wpa_get_ntp_timestamp(u8 *buf)
234 {
235 	struct os_time now;
236 	u32 sec, usec;
237 	be32 tmp;
238 
239 	/* 64-bit NTP timestamp (time from 1900-01-01 00:00:00) */
240 	os_get_time(&now);
241 	sec = now.sec + 2208988800U; /* Epoch to 1900 */
242 	/* Estimate 2^32/10^6 = 4295 - 1/32 - 1/512 */
243 	usec = now.usec;
244 	usec = 4295 * usec - (usec >> 5) - (usec >> 9);
245 	tmp = host_to_be32(sec);
246 	os_memcpy(buf, (u8 *) &tmp, 4);
247 	tmp = host_to_be32(usec);
248 	os_memcpy(buf + 4, (u8 *) &tmp, 4);
249 }
250 
251 /**
252  * wpa_scnprintf - Simpler-to-use snprintf function
253  * @buf: Output buffer
254  * @size: Buffer size
255  * @fmt: format
256  *
257  * Simpler snprintf version that doesn't require further error checks - the
258  * return value only indicates how many bytes were actually written, excluding
259  * the NULL byte (i.e., 0 on error, size-1 if buffer is not big enough).
260  */
wpa_scnprintf(char * buf,size_t size,const char * fmt,...)261 int wpa_scnprintf(char *buf, size_t size, const char *fmt, ...)
262 {
263 	va_list ap;
264 	int ret;
265 
266 	if (!size)
267 		return 0;
268 
269 	va_start(ap, fmt);
270 	ret = vsnprintf(buf, size, fmt, ap);
271 	va_end(ap);
272 
273 	if (ret < 0)
274 		return 0;
275 	if ((size_t) ret >= size)
276 		return size - 1;
277 
278 	return ret;
279 }
280 
281 
wpa_snprintf_hex_sep(char * buf,size_t buf_size,const u8 * data,size_t len,char sep)282 int wpa_snprintf_hex_sep(char *buf, size_t buf_size, const u8 *data, size_t len,
283 			 char sep)
284 {
285 	size_t i;
286 	char *pos = buf, *end = buf + buf_size;
287 	int ret;
288 
289 	if (buf_size == 0)
290 		return 0;
291 
292 	for (i = 0; i < len; i++) {
293 		ret = os_snprintf(pos, end - pos, "%02x%c",
294 				  data[i], sep);
295 		if (os_snprintf_error(end - pos, ret)) {
296 			end[-1] = '\0';
297 			return pos - buf;
298 		}
299 		pos += ret;
300 	}
301 	pos[-1] = '\0';
302 	return pos - buf;
303 }
304 
305 
_wpa_snprintf_hex(char * buf,size_t buf_size,const u8 * data,size_t len,int uppercase)306 static inline int _wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data,
307 				    size_t len, int uppercase)
308 {
309 	size_t i;
310 	char *pos = buf, *end = buf + buf_size;
311 	int ret;
312 	if (buf_size == 0)
313 		return 0;
314 	for (i = 0; i < len; i++) {
315 		ret = os_snprintf(pos, end - pos, uppercase ? "%02X" : "%02x",
316 				  data[i]);
317 		if (os_snprintf_error(end - pos, ret)) {
318 			end[-1] = '\0';
319 			return pos - buf;
320 		}
321 		pos += ret;
322 	}
323 	end[-1] = '\0';
324 	return pos - buf;
325 }
326 
327 /**
328  * wpa_snprintf_hex - Print data as a hex string into a buffer
329  * @buf: Memory area to use as the output buffer
330  * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1)
331  * @data: Data to be printed
332  * @len: Length of data in bytes
333  * Returns: Number of bytes written
334  */
wpa_snprintf_hex(char * buf,size_t buf_size,const u8 * data,size_t len)335 int wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data, size_t len)
336 {
337 	return _wpa_snprintf_hex(buf, buf_size, data, len, 0);
338 }
339 
340 
341 /**
342  * wpa_snprintf_hex_uppercase - Print data as a upper case hex string into buf
343  * @buf: Memory area to use as the output buffer
344  * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1)
345  * @data: Data to be printed
346  * @len: Length of data in bytes
347  * Returns: Number of bytes written
348  */
wpa_snprintf_hex_uppercase(char * buf,size_t buf_size,const u8 * data,size_t len)349 int wpa_snprintf_hex_uppercase(char *buf, size_t buf_size, const u8 *data,
350 			       size_t len)
351 {
352 	return _wpa_snprintf_hex(buf, buf_size, data, len, 1);
353 }
354 
355 
356 #ifdef CONFIG_ANSI_C_EXTRA
357 
358 #ifdef _WIN32_WCE
perror(const char * s)359 void perror(const char *s)
360 {
361 	wpa_printf(MSG_ERROR, "%s: GetLastError: %d",
362 		   s, (int) GetLastError());
363 }
364 #endif /* _WIN32_WCE */
365 
366 
367 int optind = 1;
368 int optopt;
369 char *optarg;
370 
getopt(int argc,char * const argv[],const char * optstring)371 int getopt(int argc, char *const argv[], const char *optstring)
372 {
373 	static int optchr = 1;
374 	char *cp;
375 
376 	if (optchr == 1) {
377 		if (optind >= argc) {
378 			/* all arguments processed */
379 			return EOF;
380 		}
381 
382 		if (argv[optind][0] != '-' || argv[optind][1] == '\0') {
383 			/* no option characters */
384 			return EOF;
385 		}
386 	}
387 
388 	if (os_strcmp(argv[optind], "--") == 0) {
389 		/* no more options */
390 		optind++;
391 		return EOF;
392 	}
393 
394 	optopt = argv[optind][optchr];
395 	cp = os_strchr(optstring, optopt);
396 	if (cp == NULL || optopt == ':') {
397 		if (argv[optind][++optchr] == '\0') {
398 			optchr = 1;
399 			optind++;
400 		}
401 		return '?';
402 	}
403 
404 	if (cp[1] == ':') {
405 		/* Argument required */
406 		optchr = 1;
407 		if (argv[optind][optchr + 1]) {
408 			/* No space between option and argument */
409 			optarg = &argv[optind++][optchr + 1];
410 		} else if (++optind >= argc) {
411 			/* option requires an argument */
412 			return '?';
413 		} else {
414 			/* Argument in the next argv */
415 			optarg = argv[optind++];
416 		}
417 	} else {
418 		/* No argument */
419 		if (argv[optind][++optchr] == '\0') {
420 			optchr = 1;
421 			optind++;
422 		}
423 		optarg = NULL;
424 	}
425 	return *cp;
426 }
427 #endif /* CONFIG_ANSI_C_EXTRA */
428 
429 
430 #ifdef CONFIG_NATIVE_WINDOWS
431 /**
432  * wpa_unicode2ascii_inplace - Convert unicode string into ASCII
433  * @str: Pointer to string to convert
434  *
435  * This function converts a unicode string to ASCII using the same
436  * buffer for output. If UNICODE is not set, the buffer is not
437  * modified.
438  */
wpa_unicode2ascii_inplace(TCHAR * str)439 void wpa_unicode2ascii_inplace(TCHAR *str)
440 {
441 #ifdef UNICODE
442 	char *dst = (char *) str;
443 	while (*str)
444 		*dst++ = (char) *str++;
445 	*dst = '\0';
446 #endif /* UNICODE */
447 }
448 
449 
wpa_strdup_tchar(const char * str)450 TCHAR * wpa_strdup_tchar(const char *str)
451 {
452 #ifdef UNICODE
453 	TCHAR *buf;
454 	buf = os_malloc((strlen(str) + 1) * sizeof(TCHAR));
455 	if (buf == NULL)
456 		return NULL;
457 	wsprintf(buf, L"%S", str);
458 	return buf;
459 #else /* UNICODE */
460 	return os_strdup(str);
461 #endif /* UNICODE */
462 }
463 #endif /* CONFIG_NATIVE_WINDOWS */
464 
465 
printf_encode(char * txt,size_t maxlen,const u8 * data,size_t len)466 void printf_encode(char *txt, size_t maxlen, const u8 *data, size_t len)
467 {
468 	char *end = txt + maxlen;
469 	size_t i;
470 
471 	for (i = 0; i < len; i++) {
472 		if (txt + 4 >= end)
473 			break;
474 
475 		switch (data[i]) {
476 		case '\"':
477 			*txt++ = '\\';
478 			*txt++ = '\"';
479 			break;
480 		case '\\':
481 			*txt++ = '\\';
482 			*txt++ = '\\';
483 			break;
484 		case '\033':
485 			*txt++ = '\\';
486 			*txt++ = 'e';
487 			break;
488 		case '\n':
489 			*txt++ = '\\';
490 			*txt++ = 'n';
491 			break;
492 		case '\r':
493 			*txt++ = '\\';
494 			*txt++ = 'r';
495 			break;
496 		case '\t':
497 			*txt++ = '\\';
498 			*txt++ = 't';
499 			break;
500 		default:
501 			if (data[i] >= 32 && data[i] <= 127) {
502 				*txt++ = data[i];
503 			} else {
504 				txt += os_snprintf(txt, end - txt, "\\x%02x",
505 						   data[i]);
506 			}
507 			break;
508 		}
509 	}
510 
511 	*txt = '\0';
512 }
513 
514 
printf_decode(u8 * buf,size_t maxlen,const char * str)515 size_t printf_decode(u8 *buf, size_t maxlen, const char *str)
516 {
517 	const char *pos = str;
518 	size_t len = 0;
519 	int val;
520 
521 	while (*pos) {
522 		if (len + 1 >= maxlen)
523 			break;
524 		switch (*pos) {
525 		case '\\':
526 			pos++;
527 			switch (*pos) {
528 			case '\\':
529 				buf[len++] = '\\';
530 				pos++;
531 				break;
532 			case '"':
533 				buf[len++] = '"';
534 				pos++;
535 				break;
536 			case 'n':
537 				buf[len++] = '\n';
538 				pos++;
539 				break;
540 			case 'r':
541 				buf[len++] = '\r';
542 				pos++;
543 				break;
544 			case 't':
545 				buf[len++] = '\t';
546 				pos++;
547 				break;
548 			case 'e':
549 				buf[len++] = '\033';
550 				pos++;
551 				break;
552 			case 'x':
553 				pos++;
554 				val = hex2byte(pos);
555 				if (val < 0) {
556 					val = hex2num(*pos);
557 					if (val < 0)
558 						break;
559 					buf[len++] = val;
560 					pos++;
561 				} else {
562 					buf[len++] = val;
563 					pos += 2;
564 				}
565 				break;
566 			case '0':
567 			case '1':
568 			case '2':
569 			case '3':
570 			case '4':
571 			case '5':
572 			case '6':
573 			case '7':
574 				val = *pos++ - '0';
575 				if (*pos >= '0' && *pos <= '7')
576 					val = val * 8 + (*pos++ - '0');
577 				if (*pos >= '0' && *pos <= '7')
578 					val = val * 8 + (*pos++ - '0');
579 				buf[len++] = val;
580 				break;
581 			default:
582 				break;
583 			}
584 			break;
585 		default:
586 			buf[len++] = *pos++;
587 			break;
588 		}
589 	}
590 	if (maxlen > len)
591 		buf[len] = '\0';
592 
593 	return len;
594 }
595 
596 
597 /**
598  * wpa_ssid_txt - Convert SSID to a printable string
599  * @ssid: SSID (32-octet string)
600  * @ssid_len: Length of ssid in octets
601  * Returns: Pointer to a printable string
602  *
603  * This function can be used to convert SSIDs into printable form. In most
604  * cases, SSIDs do not use unprintable characters, but IEEE 802.11 standard
605  * does not limit the used character set, so anything could be used in an SSID.
606  *
607  * This function uses a static buffer, so only one call can be used at the
608  * time, i.e., this is not re-entrant and the returned buffer must be used
609  * before calling this again.
610  */
wpa_ssid_txt(const u8 * ssid,size_t ssid_len)611 const char * wpa_ssid_txt(const u8 *ssid, size_t ssid_len)
612 {
613 	static char ssid_txt[SSID_MAX_LEN * 4 + 1];
614 
615 	if (ssid == NULL) {
616 		ssid_txt[0] = '\0';
617 		return ssid_txt;
618 	}
619 
620 	printf_encode(ssid_txt, sizeof(ssid_txt), ssid, ssid_len);
621 	return ssid_txt;
622 }
623 
624 
__hide_aliasing_typecast(void * foo)625 void * __hide_aliasing_typecast(void *foo)
626 {
627 	return foo;
628 }
629 
630 
wpa_config_parse_string(const char * value,size_t * len)631 char * wpa_config_parse_string(const char *value, size_t *len)
632 {
633 	if (*value == '"') {
634 		const char *pos;
635 		char *str;
636 		value++;
637 		pos = os_strrchr(value, '"');
638 		if (pos == NULL || pos[1] != '\0')
639 			return NULL;
640 		*len = pos - value;
641 		str = dup_binstr(value, *len);
642 		if (str == NULL)
643 			return NULL;
644 		return str;
645 	} else if (*value == 'P' && value[1] == '"') {
646 		const char *pos;
647 		char *tstr, *str;
648 		size_t tlen;
649 		value += 2;
650 		pos = os_strrchr(value, '"');
651 		if (pos == NULL || pos[1] != '\0')
652 			return NULL;
653 		tlen = pos - value;
654 		tstr = dup_binstr(value, tlen);
655 		if (tstr == NULL)
656 			return NULL;
657 
658 		str = os_malloc(tlen + 1);
659 		if (str == NULL) {
660 			os_free(tstr);
661 			return NULL;
662 		}
663 
664 		*len = printf_decode((u8 *) str, tlen + 1, tstr);
665 		os_free(tstr);
666 
667 		return str;
668 	} else {
669 		u8 *str;
670 		size_t tlen, hlen = os_strlen(value);
671 		if (hlen & 1)
672 			return NULL;
673 		tlen = hlen / 2;
674 		str = os_malloc(tlen + 1);
675 		if (str == NULL)
676 			return NULL;
677 		if (hexstr2bin(value, str, tlen)) {
678 			os_free(str);
679 			return NULL;
680 		}
681 		str[tlen] = '\0';
682 		*len = tlen;
683 		return (char *) str;
684 	}
685 }
686 
687 
is_hex(const u8 * data,size_t len)688 int is_hex(const u8 *data, size_t len)
689 {
690 	size_t i;
691 
692 	for (i = 0; i < len; i++) {
693 		if (data[i] < 32 || data[i] >= 127)
694 			return 1;
695 	}
696 	return 0;
697 }
698 
699 
merge_byte_arrays(u8 * res,size_t res_len,const u8 * src1,size_t src1_len,const u8 * src2,size_t src2_len)700 size_t merge_byte_arrays(u8 *res, size_t res_len,
701 			 const u8 *src1, size_t src1_len,
702 			 const u8 *src2, size_t src2_len)
703 {
704 	size_t len = 0;
705 
706 	os_memset(res, 0, res_len);
707 
708 	if (src1) {
709 		if (src1_len >= res_len) {
710 			os_memcpy(res, src1, res_len);
711 			return res_len;
712 		}
713 
714 		os_memcpy(res, src1, src1_len);
715 		len += src1_len;
716 	}
717 
718 	if (src2) {
719 		if (len + src2_len >= res_len) {
720 			os_memcpy(res + len, src2, res_len - len);
721 			return res_len;
722 		}
723 
724 		os_memcpy(res + len, src2, src2_len);
725 		len += src2_len;
726 	}
727 
728 	return len;
729 }
730 
731 
dup_binstr(const void * src,size_t len)732 char * dup_binstr(const void *src, size_t len)
733 {
734 	char *res;
735 
736 	if (src == NULL)
737 		return NULL;
738 	res = os_malloc(len + 1);
739 	if (res == NULL)
740 		return NULL;
741 	os_memcpy(res, src, len);
742 	res[len] = '\0';
743 
744 	return res;
745 }
746 
747 
freq_range_list_parse(struct wpa_freq_range_list * res,const char * value)748 int freq_range_list_parse(struct wpa_freq_range_list *res, const char *value)
749 {
750 	struct wpa_freq_range *freq = NULL, *n;
751 	unsigned int count = 0;
752 	const char *pos, *pos2, *pos3;
753 
754 	/*
755 	 * Comma separated list of frequency ranges.
756 	 * For example: 2412-2432,2462,5000-6000
757 	 */
758 	pos = value;
759 	while (pos && pos[0]) {
760 		n = os_realloc_array(freq, count + 1,
761 				     sizeof(struct wpa_freq_range));
762 		if (n == NULL) {
763 			os_free(freq);
764 			return -1;
765 		}
766 		freq = n;
767 		freq[count].min = atoi(pos);
768 		pos2 = os_strchr(pos, '-');
769 		pos3 = os_strchr(pos, ',');
770 		if (pos2 && (!pos3 || pos2 < pos3)) {
771 			pos2++;
772 			freq[count].max = atoi(pos2);
773 		} else
774 			freq[count].max = freq[count].min;
775 		pos = pos3;
776 		if (pos)
777 			pos++;
778 		count++;
779 	}
780 
781 	os_free(res->range);
782 	res->range = freq;
783 	res->num = count;
784 
785 	return 0;
786 }
787 
788 
freq_range_list_includes(const struct wpa_freq_range_list * list,unsigned int freq)789 int freq_range_list_includes(const struct wpa_freq_range_list *list,
790 			     unsigned int freq)
791 {
792 	unsigned int i;
793 
794 	if (list == NULL)
795 		return 0;
796 
797 	for (i = 0; i < list->num; i++) {
798 		if (freq >= list->range[i].min && freq <= list->range[i].max)
799 			return 1;
800 	}
801 
802 	return 0;
803 }
804 
805 
freq_range_list_str(const struct wpa_freq_range_list * list)806 char * freq_range_list_str(const struct wpa_freq_range_list *list)
807 {
808 	char *buf, *pos, *end;
809 	size_t maxlen;
810 	unsigned int i;
811 	int res;
812 
813 	if (list->num == 0)
814 		return NULL;
815 
816 	maxlen = list->num * 30;
817 	buf = os_malloc(maxlen);
818 	if (buf == NULL)
819 		return NULL;
820 	pos = buf;
821 	end = buf + maxlen;
822 
823 	for (i = 0; i < list->num; i++) {
824 		struct wpa_freq_range *range = &list->range[i];
825 
826 		if (range->min == range->max)
827 			res = os_snprintf(pos, end - pos, "%s%u",
828 					  i == 0 ? "" : ",", range->min);
829 		else
830 			res = os_snprintf(pos, end - pos, "%s%u-%u",
831 					  i == 0 ? "" : ",",
832 					  range->min, range->max);
833 		if (os_snprintf_error(end - pos, res)) {
834 			os_free(buf);
835 			return NULL;
836 		}
837 		pos += res;
838 	}
839 
840 	return buf;
841 }
842 
843 
int_array_len(const int * a)844 int int_array_len(const int *a)
845 {
846 	int i;
847 	for (i = 0; a && a[i]; i++)
848 		;
849 	return i;
850 }
851 
852 
int_array_concat(int ** res,const int * a)853 void int_array_concat(int **res, const int *a)
854 {
855 	int reslen, alen, i;
856 	int *n;
857 
858 	reslen = int_array_len(*res);
859 	alen = int_array_len(a);
860 
861 	n = os_realloc_array(*res, reslen + alen + 1, sizeof(int));
862 	if (n == NULL) {
863 		os_free(*res);
864 		*res = NULL;
865 		return;
866 	}
867 	for (i = 0; i <= alen; i++)
868 		n[reslen + i] = a[i];
869 	*res = n;
870 }
871 
872 
freq_cmp(const void * a,const void * b)873 static int freq_cmp(const void *a, const void *b)
874 {
875 	int _a = *(int *) a;
876 	int _b = *(int *) b;
877 
878 	if (_a == 0)
879 		return 1;
880 	if (_b == 0)
881 		return -1;
882 	return _a - _b;
883 }
884 
885 
int_array_sort_unique(int * a)886 void int_array_sort_unique(int *a)
887 {
888 	int alen;
889 	int i, j;
890 
891 	if (a == NULL)
892 		return;
893 
894 	alen = int_array_len(a);
895 	qsort(a, alen, sizeof(int), freq_cmp);
896 
897 	i = 0;
898 	j = 1;
899 	while (a[i] && a[j]) {
900 		if (a[i] == a[j]) {
901 			j++;
902 			continue;
903 		}
904 		a[++i] = a[j++];
905 	}
906 	if (a[i])
907 		i++;
908 	a[i] = 0;
909 }
910 
911 
int_array_add_unique(int ** res,int a)912 void int_array_add_unique(int **res, int a)
913 {
914 	int reslen;
915 	int *n;
916 
917 	for (reslen = 0; *res && (*res)[reslen]; reslen++) {
918 		if ((*res)[reslen] == a)
919 			return; /* already in the list */
920 	}
921 
922 	n = os_realloc_array(*res, reslen + 2, sizeof(int));
923 	if (n == NULL) {
924 		os_free(*res);
925 		*res = NULL;
926 		return;
927 	}
928 
929 	n[reslen] = a;
930 	n[reslen + 1] = 0;
931 
932 	*res = n;
933 }
934 
935 
str_clear_free(char * str)936 void str_clear_free(char *str)
937 {
938 	if (str) {
939 		size_t len = os_strlen(str);
940 		os_memset(str, 0, len);
941 		os_free(str);
942 	}
943 }
944 
945 
bin_clear_free(void * bin,size_t len)946 void bin_clear_free(void *bin, size_t len)
947 {
948 	if (bin) {
949 		os_memset(bin, 0, len);
950 		os_free(bin);
951 	}
952 }
953 
954 
random_mac_addr(u8 * addr)955 int random_mac_addr(u8 *addr)
956 {
957 	if (os_get_random(addr, ETH_ALEN) < 0)
958 		return -1;
959 	addr[0] &= 0xfe; /* unicast */
960 	addr[0] |= 0x02; /* locally administered */
961 	return 0;
962 }
963 
964 
random_mac_addr_keep_oui(u8 * addr)965 int random_mac_addr_keep_oui(u8 *addr)
966 {
967 	if (os_get_random(addr + 3, 3) < 0)
968 		return -1;
969 	addr[0] &= 0xfe; /* unicast */
970 	addr[0] |= 0x02; /* locally administered */
971 	return 0;
972 }
973 
974 
975 /**
976  * str_token - Get next token from a string
977  * @buf: String to tokenize. Note that the string might be modified.
978  * @delim: String of delimiters
979  * @context: Pointer to save our context. Should be initialized with
980  *	NULL on the first call, and passed for any further call.
981  * Returns: The next token, NULL if there are no more valid tokens.
982  */
str_token(char * str,const char * delim,char ** context)983 char * str_token(char *str, const char *delim, char **context)
984 {
985 	char *end, *pos = str;
986 
987 	if (*context)
988 		pos = *context;
989 
990 	while (*pos && os_strchr(delim, *pos))
991 		pos++;
992 	if (!*pos)
993 		return NULL;
994 
995 	end = pos + 1;
996 	while (*end && !os_strchr(delim, *end))
997 		end++;
998 
999 	if (*end)
1000 		*end++ = '\0';
1001 
1002 	*context = end;
1003 	return pos;
1004 }
1005 
1006 
utf8_unescape(const char * inp,size_t in_size,char * outp,size_t out_size)1007 size_t utf8_unescape(const char *inp, size_t in_size,
1008 		     char *outp, size_t out_size)
1009 {
1010 	size_t res_size = 0;
1011 
1012 	if (!inp || !outp)
1013 		return 0;
1014 
1015 	if (!in_size)
1016 		in_size = os_strlen(inp);
1017 
1018 	/* Advance past leading single quote */
1019 	if (*inp == '\'' && in_size) {
1020 		inp++;
1021 		in_size--;
1022 	}
1023 
1024 	while (in_size--) {
1025 		if (res_size >= out_size)
1026 			return 0;
1027 
1028 		switch (*inp) {
1029 		case '\'':
1030 			/* Terminate on bare single quote */
1031 			*outp = '\0';
1032 			return res_size;
1033 
1034 		case '\\':
1035 			if (!in_size--)
1036 				return 0;
1037 			inp++;
1038 			/* fall through */
1039 
1040 		default:
1041 			*outp++ = *inp++;
1042 			res_size++;
1043 		}
1044 	}
1045 
1046 	/* NUL terminate if space allows */
1047 	if (res_size < out_size)
1048 		*outp = '\0';
1049 
1050 	return res_size;
1051 }
1052 
1053 
utf8_escape(const char * inp,size_t in_size,char * outp,size_t out_size)1054 size_t utf8_escape(const char *inp, size_t in_size,
1055 		   char *outp, size_t out_size)
1056 {
1057 	size_t res_size = 0;
1058 
1059 	if (!inp || !outp)
1060 		return 0;
1061 
1062 	/* inp may or may not be NUL terminated, but must be if 0 size
1063 	 * is specified */
1064 	if (!in_size)
1065 		in_size = os_strlen(inp);
1066 
1067 	while (in_size--) {
1068 		if (res_size++ >= out_size)
1069 			return 0;
1070 
1071 		switch (*inp) {
1072 		case '\\':
1073 		case '\'':
1074 			if (res_size++ >= out_size)
1075 				return 0;
1076 			*outp++ = '\\';
1077 			/* fall through */
1078 
1079 		default:
1080 			*outp++ = *inp++;
1081 			break;
1082 		}
1083 	}
1084 
1085 	/* NUL terminate if space allows */
1086 	if (res_size < out_size)
1087 		*outp = '\0';
1088 
1089 	return res_size;
1090 }
1091 
1092 
is_ctrl_char(char c)1093 int is_ctrl_char(char c)
1094 {
1095 	return c > 0 && c < 32;
1096 }
1097