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