common.c revision af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/*
28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_supplicant/hostapd / common helper functions, etc.
38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2002-2007, Jouni Malinen <j@w1.fi>
48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *
5c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * This software may be distributed under the terms of the BSD license.
6c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * See README for more details.
78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h"
108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h"
128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hex2num(char c)
158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (c >= '0' && c <= '9')
178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return c - '0';
188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (c >= 'a' && c <= 'f')
198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return c - 'a' + 10;
208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (c >= 'A' && c <= 'F')
218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return c - 'A' + 10;
228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return -1;
238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hex2byte(const char *hex)
278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int a, b;
298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	a = hex2num(*hex++);
308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (a < 0)
318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	b = hex2num(*hex++);
338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (b < 0)
348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return (a << 4) | b;
368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
39ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidtstatic const char * hwaddr_parse(const char *txt, u8 *addr)
40ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt{
41ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	size_t i;
42ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
43ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	for (i = 0; i < ETH_ALEN; i++) {
44ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		int a;
45ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
46ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		a = hex2byte(txt);
47ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		if (a < 0)
48ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt			return NULL;
49ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		txt += 2;
50ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		addr[i] = a;
51ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		if (i < ETH_ALEN - 1 && *txt++ != ':')
52ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt			return NULL;
53ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	}
54ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	return txt;
55ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt}
56ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
57ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hwaddr_aton - Convert ASCII string to MAC address (colon-delimited format)
608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @txt: MAC address as a string (e.g., "00:11:22:33:44:55")
618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hwaddr_aton(const char *txt, u8 *addr)
658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
66ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	return hwaddr_parse(txt, addr) ? 0 : -1;
67ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt}
688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
70ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt/**
71ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt * hwaddr_masked_aton - Convert ASCII string with optional mask to MAC address (colon-delimited format)
72ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt * @txt: MAC address with optional mask as a string (e.g., "00:11:22:33:44:55/ff:ff:ff:ff:00:00")
73ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
74ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt * @mask: Buffer for the MAC address mask (ETH_ALEN = 6 bytes)
75ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt * @maskable: Flag to indicate whether a mask is allowed
76ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
77ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt */
78ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidtint hwaddr_masked_aton(const char *txt, u8 *addr, u8 *mask, u8 maskable)
79ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt{
80ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	const char *r;
81ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
82ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	/* parse address part */
83ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	r = hwaddr_parse(txt, addr);
84ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	if (!r)
85ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		return -1;
86ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
87ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	/* check for optional mask */
88ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	if (*r == '\0' || isspace(*r)) {
89ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		/* no mask specified, assume default */
90ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		os_memset(mask, 0xff, ETH_ALEN);
91ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	} else if (maskable && *r == '/') {
92ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		/* mask specified and allowed */
93ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		r = hwaddr_parse(r + 1, mask);
94ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		/* parser error? */
95ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		if (!r)
968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
97ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	} else {
98ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		/* mask specified but not allowed or trailing garbage */
99ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		return -1;
1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
105ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hwaddr_compact_aton - Convert ASCII string to MAC address (no colon delimitors format)
1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @txt: MAC address as a string (e.g., "001122334455")
1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hwaddr_compact_aton(const char *txt, u8 *addr)
1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int i;
1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	for (i = 0; i < 6; i++) {
1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		int a, b;
1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		a = hex2num(*txt++);
1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (a < 0)
1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		b = hex2num(*txt++);
1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (b < 0)
1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		*addr++ = (a << 4) | b;
1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hwaddr_aton2 - Convert ASCII string to MAC address (in any known format)
1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @txt: MAC address as a string (e.g., 00:11:22:33:44:55 or 0011.2233.4455)
1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: Characters used (> 0) on success, -1 on failure
1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hwaddr_aton2(const char *txt, u8 *addr)
1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int i;
1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const char *pos = txt;
1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	for (i = 0; i < 6; i++) {
1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		int a, b;
1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		while (*pos == ':' || *pos == '.' || *pos == '-')
1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			pos++;
1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		a = hex2num(*pos++);
1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (a < 0)
1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		b = hex2num(*pos++);
1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (b < 0)
1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		*addr++ = (a << 4) | b;
1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return pos - txt;
1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hexstr2bin - Convert ASCII hex string into binary data
1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @hex: ASCII hex string (e.g., "01ab")
1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf: Buffer for the binary data
1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @len: Length of the text to convert in bytes (of buf); hex will be double
1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * this size
1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: 0 on success, -1 on failure (invalid hex string)
1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hexstr2bin(const char *hex, u8 *buf, size_t len)
1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t i;
1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int a;
1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const char *ipos = hex;
1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	u8 *opos = buf;
1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	for (i = 0; i < len; i++) {
1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		a = hex2byte(ipos);
1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (a < 0)
1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		*opos++ = a;
1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		ipos += 2;
1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
187ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidtint hwaddr_mask_txt(char *buf, size_t len, const u8 *addr, const u8 *mask)
188ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt{
189ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	size_t i;
190ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	int print_mask = 0;
191ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	int res;
192ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
193ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	for (i = 0; i < ETH_ALEN; i++) {
194ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		if (mask[i] != 0xff) {
195ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt			print_mask = 1;
196ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt			break;
197ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		}
198ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	}
199ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
200ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	if (print_mask)
201ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		res = os_snprintf(buf, len, MACSTR "/" MACSTR,
202ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt				  MAC2STR(addr), MAC2STR(mask));
203ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	else
204ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		res = os_snprintf(buf, len, MACSTR, MAC2STR(addr));
205ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	if (os_snprintf_error(len, res))
206ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt		return -1;
207ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt	return res;
208ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt}
209ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
210ff787d557db719adea0fdf2679667500c65cf74dDmitry Shmidt
2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * inc_byte_array - Increment arbitrary length byte array by one
2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @counter: Pointer to byte array
2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @len: Length of the counter in bytes
2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *
2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function increments the last byte of the counter by one and continues
2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * rolling over to more significant bytes if the byte was incremented from
2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 0xff to 0x00.
2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid inc_byte_array(u8 *counter, size_t len)
2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int pos = len - 1;
2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	while (pos >= 0) {
2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		counter[pos]++;
2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (counter[pos] != 0)
2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			break;
2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		pos--;
2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_get_ntp_timestamp(u8 *buf)
2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct os_time now;
2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	u32 sec, usec;
2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	be32 tmp;
2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	/* 64-bit NTP timestamp (time from 1900-01-01 00:00:00) */
2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_get_time(&now);
2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	sec = now.sec + 2208988800U; /* Epoch to 1900 */
2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	/* Estimate 2^32/10^6 = 4295 - 1/32 - 1/512 */
2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	usec = now.usec;
2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	usec = 4295 * usec - (usec >> 5) - (usec >> 9);
2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	tmp = host_to_be32(sec);
2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(buf, (u8 *) &tmp, 4);
2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	tmp = host_to_be32(usec);
2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(buf + 4, (u8 *) &tmp, 4);
2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2506c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt/**
2516c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * wpa_scnprintf - Simpler-to-use snprintf function
2526c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @buf: Output buffer
2536c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @size: Buffer size
2546c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @fmt: format
2556c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt *
2566c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * Simpler snprintf version that doesn't require further error checks - the
2576c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * return value only indicates how many bytes were actually written, excluding
2586c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * the NULL byte (i.e., 0 on error, size-1 if buffer is not big enough).
2596c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt */
2606c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidtint wpa_scnprintf(char *buf, size_t size, const char *fmt, ...)
2616c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt{
2626c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	va_list ap;
2636c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	int ret;
2646c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
2656c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	if (!size)
2666c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		return 0;
2676c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
2686c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	va_start(ap, fmt);
2696c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	ret = vsnprintf(buf, size, fmt, ap);
2706c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	va_end(ap);
2716c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
2726c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	if (ret < 0)
2736c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		return 0;
2746c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	if ((size_t) ret >= size)
2756c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		return size - 1;
2766c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
2776c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	return ret;
2786c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt}
2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
280af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt
281af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidtint wpa_snprintf_hex_sep(char *buf, size_t buf_size, const u8 *data, size_t len,
282af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt			 char sep)
283af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt{
284af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	size_t i;
285af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	char *pos = buf, *end = buf + buf_size;
286af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	int ret;
287af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt
288af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	if (buf_size == 0)
289af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt		return 0;
290af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt
291af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	for (i = 0; i < len; i++) {
292af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt		ret = os_snprintf(pos, end - pos, "%02x%c",
293af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt				  data[i], sep);
294af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt		if (os_snprintf_error(end - pos, ret)) {
295af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt			end[-1] = '\0';
296af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt			return pos - buf;
297af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt		}
298af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt		pos += ret;
299af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	}
300af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	pos[-1] = '\0';
301af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt	return pos - buf;
302af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt}
303af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt
304af9da3180dc20f57df1fc1e1811f3df9fa9e6ab5Dmitry Shmidt
3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic inline int _wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data,
3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				    size_t len, int uppercase)
3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t i;
3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char *pos = buf, *end = buf + buf_size;
3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int ret;
3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (buf_size == 0)
3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	for (i = 0; i < len; i++) {
3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		ret = os_snprintf(pos, end - pos, uppercase ? "%02X" : "%02x",
3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				  data[i]);
3166c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		if (os_snprintf_error(end - pos, ret)) {
3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			end[-1] = '\0';
3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return pos - buf;
3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		pos += ret;
3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	end[-1] = '\0';
3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return pos - buf;
3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_snprintf_hex - Print data as a hex string into a buffer
3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf: Memory area to use as the output buffer
3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1)
3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @data: Data to be printed
3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @len: Length of data in bytes
3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: Number of bytes written
3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data, size_t len)
3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return _wpa_snprintf_hex(buf, buf_size, data, len, 0);
3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_snprintf_hex_uppercase - Print data as a upper case hex string into buf
3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf: Memory area to use as the output buffer
3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1)
3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @data: Data to be printed
3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @len: Length of data in bytes
3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: Number of bytes written
3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wpa_snprintf_hex_uppercase(char *buf, size_t buf_size, const u8 *data,
3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			       size_t len)
3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return _wpa_snprintf_hex(buf, buf_size, data, len, 1);
3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_ANSI_C_EXTRA
3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef _WIN32_WCE
3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid perror(const char *s)
3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_ERROR, "%s: GetLastError: %d",
3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		   s, (int) GetLastError());
3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* _WIN32_WCE */
3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint optind = 1;
3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint optopt;
3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtchar *optarg;
3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint getopt(int argc, char *const argv[], const char *optstring)
3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	static int optchr = 1;
3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char *cp;
3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (optchr == 1) {
3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (optind >= argc) {
3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			/* all arguments processed */
3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return EOF;
3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (argv[optind][0] != '-' || argv[optind][1] == '\0') {
3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			/* no option characters */
3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return EOF;
3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (os_strcmp(argv[optind], "--") == 0) {
3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/* no more options */
3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		optind++;
3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return EOF;
3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	optopt = argv[optind][optchr];
3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cp = os_strchr(optstring, optopt);
3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (cp == NULL || optopt == ':') {
3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (argv[optind][++optchr] == '\0') {
3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			optchr = 1;
3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			optind++;
3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return '?';
4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (cp[1] == ':') {
4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/* Argument required */
4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		optchr = 1;
4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (argv[optind][optchr + 1]) {
4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			/* No space between option and argument */
4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			optarg = &argv[optind++][optchr + 1];
4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		} else if (++optind >= argc) {
4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			/* option requires an argument */
4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return '?';
4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		} else {
4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			/* Argument in the next argv */
4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			optarg = argv[optind++];
4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else {
4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/* No argument */
4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (argv[optind][++optchr] == '\0') {
4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			optchr = 1;
4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			optind++;
4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		optarg = NULL;
4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return *cp;
4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_ANSI_C_EXTRA */
4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_NATIVE_WINDOWS
4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_unicode2ascii_inplace - Convert unicode string into ASCII
4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @str: Pointer to string to convert
4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *
4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function converts a unicode string to ASCII using the same
4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * buffer for output. If UNICODE is not set, the buffer is not
4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * modified.
4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_unicode2ascii_inplace(TCHAR *str)
4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef UNICODE
4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char *dst = (char *) str;
4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	while (*str)
4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		*dst++ = (char) *str++;
4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	*dst = '\0';
4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* UNICODE */
4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry ShmidtTCHAR * wpa_strdup_tchar(const char *str)
4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef UNICODE
4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	TCHAR *buf;
4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	buf = os_malloc((strlen(str) + 1) * sizeof(TCHAR));
4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (buf == NULL)
4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return NULL;
4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wsprintf(buf, L"%S", str);
4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return buf;
4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* UNICODE */
4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return os_strdup(str);
4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* UNICODE */
4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NATIVE_WINDOWS */
4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
46561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtvoid printf_encode(char *txt, size_t maxlen, const u8 *data, size_t len)
46661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
46761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	char *end = txt + maxlen;
46861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	size_t i;
46961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
47061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	for (i = 0; i < len; i++) {
471b5d893b5dec601a58c3ce0fc9e5d6da3816ce97aDmitry Shmidt		if (txt + 4 >= end)
47261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
47361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
47461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		switch (data[i]) {
47561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		case '\"':
47661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\\';
47761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\"';
47861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
47961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		case '\\':
48061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\\';
48161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\\';
48261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
483661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt		case '\033':
48461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\\';
48561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = 'e';
48661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
48761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		case '\n':
48861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\\';
48961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = 'n';
49061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
49161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		case '\r':
49261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\\';
49361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = 'r';
49461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
49561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		case '\t':
49661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = '\\';
49761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			*txt++ = 't';
49861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
49961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		default:
50061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			if (data[i] >= 32 && data[i] <= 127) {
50161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				*txt++ = data[i];
50261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			} else {
50361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				txt += os_snprintf(txt, end - txt, "\\x%02x",
50461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt						   data[i]);
50561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			}
50661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
50761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
50861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
50961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
51061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	*txt = '\0';
51161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
51261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
51361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
51461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtsize_t printf_decode(u8 *buf, size_t maxlen, const char *str)
51561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
51661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	const char *pos = str;
51761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	size_t len = 0;
51861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	int val;
51961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
52061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	while (*pos) {
5215605286c30e1701491bd3af974ae423727750eddDmitry Shmidt		if (len + 1 >= maxlen)
52261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
52361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		switch (*pos) {
52461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		case '\\':
52561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			pos++;
52661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			switch (*pos) {
52761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '\\':
52861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				buf[len++] = '\\';
52961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				pos++;
53061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
53161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '"':
53261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				buf[len++] = '"';
53361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				pos++;
53461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
53561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case 'n':
53661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				buf[len++] = '\n';
53761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				pos++;
53861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
53961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case 'r':
54061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				buf[len++] = '\r';
54161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				pos++;
54261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
54361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case 't':
54461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				buf[len++] = '\t';
54561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				pos++;
54661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
54761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case 'e':
548661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt				buf[len++] = '\033';
54961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				pos++;
55061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
55161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case 'x':
55261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				pos++;
55361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				val = hex2byte(pos);
55461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				if (val < 0) {
55561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					val = hex2num(*pos);
55661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					if (val < 0)
55761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt						break;
55861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					buf[len++] = val;
55961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					pos++;
56061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				} else {
56161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					buf[len++] = val;
56261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					pos += 2;
56361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				}
56461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
56561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '0':
56661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '1':
56761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '2':
56861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '3':
56961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '4':
57061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '5':
57161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '6':
57261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			case '7':
57361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				val = *pos++ - '0';
57461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				if (*pos >= '0' && *pos <= '7')
57561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					val = val * 8 + (*pos++ - '0');
57661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				if (*pos >= '0' && *pos <= '7')
57761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					val = val * 8 + (*pos++ - '0');
57861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				buf[len++] = val;
57961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
58061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			default:
58161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				break;
58261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			}
58361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
58461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		default:
58561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			buf[len++] = *pos++;
58661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			break;
58761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
58861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
5895605286c30e1701491bd3af974ae423727750eddDmitry Shmidt	if (maxlen > len)
5905605286c30e1701491bd3af974ae423727750eddDmitry Shmidt		buf[len] = '\0';
59161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
59261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	return len;
59361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
59461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
59561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/**
5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_ssid_txt - Convert SSID to a printable string
5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @ssid: SSID (32-octet string)
5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @ssid_len: Length of ssid in octets
6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: Pointer to a printable string
6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *
6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function can be used to convert SSIDs into printable form. In most
6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * cases, SSIDs do not use unprintable characters, but IEEE 802.11 standard
6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * does not limit the used character set, so anything could be used in an SSID.
6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *
6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function uses a static buffer, so only one call can be used at the
6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * time, i.e., this is not re-entrant and the returned buffer must be used
6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * before calling this again.
6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst char * wpa_ssid_txt(const u8 *ssid, size_t ssid_len)
6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
61261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	static char ssid_txt[32 * 4 + 1];
61361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
61461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (ssid == NULL) {
61561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		ssid_txt[0] = '\0';
61661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return ssid_txt;
6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
61861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
61961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	printf_encode(ssid_txt, sizeof(ssid_txt), ssid, ssid_len);
6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return ssid_txt;
6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid * __hide_aliasing_typecast(void *foo)
6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return foo;
6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
62861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
62961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
63061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtchar * wpa_config_parse_string(const char *value, size_t *len)
63161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
63261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (*value == '"') {
63361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		const char *pos;
63461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		char *str;
63561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		value++;
63661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		pos = os_strrchr(value, '"');
63761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (pos == NULL || pos[1] != '\0')
63861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
63961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		*len = pos - value;
6404b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt		str = dup_binstr(value, *len);
64161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (str == NULL)
64261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
64361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return str;
64461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	} else if (*value == 'P' && value[1] == '"') {
64561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		const char *pos;
64661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		char *tstr, *str;
64761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		size_t tlen;
64861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		value += 2;
64961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		pos = os_strrchr(value, '"');
65061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (pos == NULL || pos[1] != '\0')
65161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
65261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		tlen = pos - value;
6534b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt		tstr = dup_binstr(value, tlen);
65461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (tstr == NULL)
65561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
65661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
65761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		str = os_malloc(tlen + 1);
65861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (str == NULL) {
65961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			os_free(tstr);
66061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
66161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
66261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
66361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		*len = printf_decode((u8 *) str, tlen + 1, tstr);
66461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		os_free(tstr);
66561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
66661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return str;
66761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	} else {
66861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		u8 *str;
66961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		size_t tlen, hlen = os_strlen(value);
67061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (hlen & 1)
67161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
67261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		tlen = hlen / 2;
67361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		str = os_malloc(tlen + 1);
67461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (str == NULL)
67561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
67661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (hexstr2bin(value, str, tlen)) {
67761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			os_free(str);
67861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return NULL;
67961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
68061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		str[tlen] = '\0';
68161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		*len = tlen;
68261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return (char *) str;
68361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
68461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
68561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
68661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
68761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtint is_hex(const u8 *data, size_t len)
68861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
68961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	size_t i;
69061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
69161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	for (i = 0; i < len; i++) {
69261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (data[i] < 32 || data[i] >= 127)
69361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return 1;
69461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
69561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	return 0;
69661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
69761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
69861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
69961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtsize_t merge_byte_arrays(u8 *res, size_t res_len,
70061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			 const u8 *src1, size_t src1_len,
70161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			 const u8 *src2, size_t src2_len)
70261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
70361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	size_t len = 0;
70461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
70561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_memset(res, 0, res_len);
70661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
70761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (src1) {
70861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (src1_len >= res_len) {
70961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			os_memcpy(res, src1, res_len);
71061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return res_len;
71161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
71261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
71361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		os_memcpy(res, src1, src1_len);
71461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		len += src1_len;
71561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
71661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
71761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (src2) {
71861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (len + src2_len >= res_len) {
71961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			os_memcpy(res + len, src2, res_len - len);
72061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return res_len;
72161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
72261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
72361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		os_memcpy(res + len, src2, src2_len);
72461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		len += src2_len;
72561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
72661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
72761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	return len;
72861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
7294b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt
7304b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt
7314b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidtchar * dup_binstr(const void *src, size_t len)
7324b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt{
7334b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt	char *res;
7344b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt
7354b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt	if (src == NULL)
7364b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt		return NULL;
7374b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt	res = os_malloc(len + 1);
7384b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt	if (res == NULL)
7394b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt		return NULL;
7404b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt	os_memcpy(res, src, len);
7414b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt	res[len] = '\0';
7424b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt
7434b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt	return res;
7444b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt}
7454ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7464ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7474ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidtint freq_range_list_parse(struct wpa_freq_range_list *res, const char *value)
7484ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt{
7494ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	struct wpa_freq_range *freq = NULL, *n;
7504ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	unsigned int count = 0;
7514ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	const char *pos, *pos2, *pos3;
7524ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7534ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	/*
7544ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	 * Comma separated list of frequency ranges.
7554ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	 * For example: 2412-2432,2462,5000-6000
7564ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	 */
7574ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	pos = value;
7584ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	while (pos && pos[0]) {
7594ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		n = os_realloc_array(freq, count + 1,
7604ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt				     sizeof(struct wpa_freq_range));
7614ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		if (n == NULL) {
7624ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			os_free(freq);
7634ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			return -1;
7644ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		}
7654ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		freq = n;
7664ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		freq[count].min = atoi(pos);
7674ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		pos2 = os_strchr(pos, '-');
7684ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		pos3 = os_strchr(pos, ',');
7694ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		if (pos2 && (!pos3 || pos2 < pos3)) {
7704ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			pos2++;
7714ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			freq[count].max = atoi(pos2);
7724ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		} else
7734ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			freq[count].max = freq[count].min;
7744ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		pos = pos3;
7754ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		if (pos)
7764ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			pos++;
7774ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		count++;
7784ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	}
7794ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7804ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	os_free(res->range);
7814ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	res->range = freq;
7824ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	res->num = count;
7834ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7844ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	return 0;
7854ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt}
7864ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7874ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7884ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidtint freq_range_list_includes(const struct wpa_freq_range_list *list,
7894ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			     unsigned int freq)
7904ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt{
7914ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	unsigned int i;
7924ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7934ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	if (list == NULL)
7944ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		return 0;
7954ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
7964ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	for (i = 0; i < list->num; i++) {
7974ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		if (freq >= list->range[i].min && freq <= list->range[i].max)
7984ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			return 1;
7994ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	}
8004ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8014ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	return 0;
8024ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt}
8034ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8044ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8054ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidtchar * freq_range_list_str(const struct wpa_freq_range_list *list)
8064ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt{
8074ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	char *buf, *pos, *end;
8084ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	size_t maxlen;
8094ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	unsigned int i;
8104ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	int res;
8114ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8124ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	if (list->num == 0)
8134ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		return NULL;
8144ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8154ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	maxlen = list->num * 30;
8164ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	buf = os_malloc(maxlen);
8174ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	if (buf == NULL)
8184ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		return NULL;
8194ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	pos = buf;
8204ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	end = buf + maxlen;
8214ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8224ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	for (i = 0; i < list->num; i++) {
8234ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		struct wpa_freq_range *range = &list->range[i];
8244ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8254ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		if (range->min == range->max)
8264ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			res = os_snprintf(pos, end - pos, "%s%u",
8274ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt					  i == 0 ? "" : ",", range->min);
8284ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		else
8294ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			res = os_snprintf(pos, end - pos, "%s%u-%u",
8304ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt					  i == 0 ? "" : ",",
8314ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt					  range->min, range->max);
8326c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		if (os_snprintf_error(end - pos, res)) {
8334ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			os_free(buf);
8344ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt			return NULL;
8354ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		}
8364ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt		pos += res;
8374ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	}
8384ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt
8394ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt	return buf;
8404ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt}
841fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
842fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
843fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtint int_array_len(const int *a)
844fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
845fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int i;
846fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	for (i = 0; a && a[i]; i++)
847fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		;
848fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	return i;
849fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
850fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
851fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
852fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtvoid int_array_concat(int **res, const int *a)
853fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
854fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int reslen, alen, i;
855fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int *n;
856fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
857fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	reslen = int_array_len(*res);
858fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	alen = int_array_len(a);
859fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
860fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	n = os_realloc_array(*res, reslen + alen + 1, sizeof(int));
861fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (n == NULL) {
862fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		os_free(*res);
863fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		*res = NULL;
864fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return;
865fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
866fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	for (i = 0; i <= alen; i++)
867fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		n[reslen + i] = a[i];
868fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	*res = n;
869fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
870fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
871fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
872fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic int freq_cmp(const void *a, const void *b)
873fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
874fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int _a = *(int *) a;
875fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int _b = *(int *) b;
876fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
877fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (_a == 0)
878fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return 1;
879fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (_b == 0)
880fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return -1;
881fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	return _a - _b;
882fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
883fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
884fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
885fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtvoid int_array_sort_unique(int *a)
886fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
887fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int alen;
888fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int i, j;
889fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
890fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (a == NULL)
891fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return;
892fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
893fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	alen = int_array_len(a);
894fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	qsort(a, alen, sizeof(int), freq_cmp);
895fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
896fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	i = 0;
897fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	j = 1;
898fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	while (a[i] && a[j]) {
899fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		if (a[i] == a[j]) {
900fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			j++;
901fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			continue;
902fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		}
903fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		a[++i] = a[j++];
904fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
905fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (a[i])
906fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		i++;
907fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	a[i] = 0;
908fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
909fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
910fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
911fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtvoid int_array_add_unique(int **res, int a)
912fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
913fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int reslen;
914fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int *n;
915fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
916fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	for (reslen = 0; *res && (*res)[reslen]; reslen++) {
917fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		if ((*res)[reslen] == a)
918fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			return; /* already in the list */
919fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
920fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
921fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	n = os_realloc_array(*res, reslen + 2, sizeof(int));
922fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (n == NULL) {
923fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		os_free(*res);
924fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		*res = NULL;
925fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return;
926fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
927fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
928fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	n[reslen] = a;
929fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	n[reslen + 1] = 0;
930fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
931fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	*res = n;
932fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
933c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt
934c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt
935c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidtvoid str_clear_free(char *str)
936c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt{
937c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt	if (str) {
938c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt		size_t len = os_strlen(str);
939c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt		os_memset(str, 0, len);
940c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt		os_free(str);
941c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt	}
942c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt}
943c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt
944c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt
945c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidtvoid bin_clear_free(void *bin, size_t len)
946c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt{
947c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt	if (bin) {
948c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt		os_memset(bin, 0, len);
949c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt		os_free(bin);
950c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt	}
951c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt}
952661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt
953661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt
954661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidtint random_mac_addr(u8 *addr)
955661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt{
956661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	if (os_get_random(addr, ETH_ALEN) < 0)
957661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt		return -1;
958661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	addr[0] &= 0xfe; /* unicast */
959661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	addr[0] |= 0x02; /* locally administered */
960661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	return 0;
961661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt}
962661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt
963661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt
964661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidtint random_mac_addr_keep_oui(u8 *addr)
965661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt{
966661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	if (os_get_random(addr + 3, 3) < 0)
967661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt		return -1;
968661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	addr[0] &= 0xfe; /* unicast */
969661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	addr[0] |= 0x02; /* locally administered */
970661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt	return 0;
971661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt}
9726c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
9736c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
9746c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt/**
9756c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * str_token - Get next token from a string
9766c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @buf: String to tokenize. Note that the string might be modified.
9776c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @delim: String of delimiters
9786c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @context: Pointer to save our context. Should be initialized with
9796c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt *	NULL on the first call, and passed for any further call.
9806c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * Returns: The next token, NULL if there are no more valid tokens.
9816c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt */
9826c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidtchar * str_token(char *str, const char *delim, char **context)
9836c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt{
9846c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	char *end, *pos = str;
9856c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
9866c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	if (*context)
9876c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		pos = *context;
9886c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
9896c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	while (*pos && os_strchr(delim, *pos))
9906c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		pos++;
9916c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	if (!*pos)
9926c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		return NULL;
9936c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
9946c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	end = pos + 1;
9956c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	while (*end && !os_strchr(delim, *end))
9966c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		end++;
9976c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
9986c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	if (*end)
9996c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt		*end++ = '\0';
10006c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt
10016c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	*context = end;
10026c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt	return pos;
10036c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt}
1004216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1005216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1006216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidtsize_t utf8_unescape(const char *inp, size_t in_size,
1007216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		     char *outp, size_t out_size)
1008216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt{
1009216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	size_t res_size = 0;
1010216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1011216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	if (!inp || !outp)
1012216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		return 0;
1013216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1014216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	if (!in_size)
1015216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		in_size = os_strlen(inp);
1016216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1017216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	/* Advance past leading single quote */
1018216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	if (*inp == '\'' && in_size) {
1019216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		inp++;
1020216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		in_size--;
1021216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	}
1022216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1023216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	while (in_size--) {
1024216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		if (res_size >= out_size)
1025216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			return 0;
1026216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1027216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		switch (*inp) {
1028216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		case '\'':
1029216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			/* Terminate on bare single quote */
1030216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			*outp = '\0';
1031216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			return res_size;
1032216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1033216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		case '\\':
1034216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			if (!in_size--)
1035216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt				return 0;
1036216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			inp++;
1037216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			/* fall through */
1038216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1039216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		default:
1040216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			*outp++ = *inp++;
1041216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			res_size++;
1042216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		}
1043216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	}
1044216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1045216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	/* NUL terminate if space allows */
1046216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	if (res_size < out_size)
1047216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		*outp = '\0';
1048216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1049216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	return res_size;
1050216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt}
1051216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1052216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1053216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidtsize_t utf8_escape(const char *inp, size_t in_size,
1054216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		   char *outp, size_t out_size)
1055216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt{
1056216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	size_t res_size = 0;
1057216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1058216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	if (!inp || !outp)
1059216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		return 0;
1060216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1061216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	/* inp may or may not be NUL terminated, but must be if 0 size
1062216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	 * is specified */
1063216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	if (!in_size)
1064216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		in_size = os_strlen(inp);
1065216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1066216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	while (in_size--) {
1067216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		if (res_size++ >= out_size)
1068216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			return 0;
1069216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1070216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		switch (*inp) {
1071216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		case '\\':
1072216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		case '\'':
1073216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			if (res_size++ >= out_size)
1074216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt				return 0;
1075216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			*outp++ = '\\';
1076216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			/* fall through */
1077216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1078216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		default:
1079216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			*outp++ = *inp++;
1080216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt			break;
1081216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		}
1082216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	}
1083216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1084216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	/* NUL terminate if space allows */
1085216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	if (res_size < out_size)
1086216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt		*outp = '\0';
1087216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt
1088216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt	return res_size;
1089216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt}
1090