common.c revision 216983bceec7c450951e2fbcd076b5c75d432e57
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 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic inline int _wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data, 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len, int uppercase) 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos = buf, *end = buf + buf_size; 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf_size == 0) 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < len; i++) { 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, uppercase ? "%02X" : "%02x", 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data[i]); 2916c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (os_snprintf_error(end - pos, ret)) { 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end[-1] = '\0'; 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return pos - buf; 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end[-1] = '\0'; 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return pos - buf; 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_snprintf_hex - Print data as a hex string into a buffer 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf: Memory area to use as the output buffer 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1) 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @data: Data to be printed 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @len: Length of data in bytes 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: Number of bytes written 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data, size_t len) 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return _wpa_snprintf_hex(buf, buf_size, data, len, 0); 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_snprintf_hex_uppercase - Print data as a upper case hex string into buf 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf: Memory area to use as the output buffer 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1) 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @data: Data to be printed 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @len: Length of data in bytes 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: Number of bytes written 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint wpa_snprintf_hex_uppercase(char *buf, size_t buf_size, const u8 *data, 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len) 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return _wpa_snprintf_hex(buf, buf_size, data, len, 1); 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_ANSI_C_EXTRA 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef _WIN32_WCE 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid perror(const char *s) 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "%s: GetLastError: %d", 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt s, (int) GetLastError()); 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* _WIN32_WCE */ 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint optind = 1; 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint optopt; 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtchar *optarg; 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint getopt(int argc, char *const argv[], const char *optstring) 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static int optchr = 1; 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *cp; 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (optchr == 1) { 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (optind >= argc) { 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* all arguments processed */ 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return EOF; 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (argv[optind][0] != '-' || argv[optind][1] == '\0') { 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* no option characters */ 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return EOF; 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strcmp(argv[optind], "--") == 0) { 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* no more options */ 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optind++; 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return EOF; 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optopt = argv[optind][optchr]; 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cp = os_strchr(optstring, optopt); 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cp == NULL || optopt == ':') { 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (argv[optind][++optchr] == '\0') { 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optchr = 1; 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optind++; 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return '?'; 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cp[1] == ':') { 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Argument required */ 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optchr = 1; 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (argv[optind][optchr + 1]) { 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* No space between option and argument */ 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optarg = &argv[optind++][optchr + 1]; 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (++optind >= argc) { 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* option requires an argument */ 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return '?'; 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Argument in the next argv */ 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optarg = argv[optind++]; 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* No argument */ 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (argv[optind][++optchr] == '\0') { 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optchr = 1; 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optind++; 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt optarg = NULL; 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return *cp; 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_ANSI_C_EXTRA */ 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_NATIVE_WINDOWS 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_unicode2ascii_inplace - Convert unicode string into ASCII 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @str: Pointer to string to convert 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function converts a unicode string to ASCII using the same 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * buffer for output. If UNICODE is not set, the buffer is not 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * modified. 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid wpa_unicode2ascii_inplace(TCHAR *str) 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef UNICODE 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dst = (char *) str; 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (*str) 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *dst++ = (char) *str++; 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *dst = '\0'; 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* UNICODE */ 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry ShmidtTCHAR * wpa_strdup_tchar(const char *str) 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef UNICODE 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt TCHAR *buf; 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = os_malloc((strlen(str) + 1) * sizeof(TCHAR)); 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wsprintf(buf, L"%S", str); 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return buf; 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* UNICODE */ 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return os_strdup(str); 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* UNICODE */ 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NATIVE_WINDOWS */ 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 44061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtvoid printf_encode(char *txt, size_t maxlen, const u8 *data, size_t len) 44161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 44261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt char *end = txt + maxlen; 44361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t i; 44461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 44561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt for (i = 0; i < len; i++) { 446b5d893b5dec601a58c3ce0fc9e5d6da3816ce97aDmitry Shmidt if (txt + 4 >= end) 44761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 44861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 44961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (data[i]) { 45061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '\"': 45161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\\'; 45261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\"'; 45361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 45461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '\\': 45561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\\'; 45661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\\'; 45761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 458661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt case '\033': 45961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\\'; 46061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = 'e'; 46161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 46261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '\n': 46361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\\'; 46461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = 'n'; 46561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 46661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '\r': 46761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\\'; 46861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = 'r'; 46961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 47061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '\t': 47161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = '\\'; 47261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = 't'; 47361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 47461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 47561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data[i] >= 32 && data[i] <= 127) { 47661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt++ = data[i]; 47761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 47861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt txt += os_snprintf(txt, end - txt, "\\x%02x", 47961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data[i]); 48061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 48161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 48261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 48361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 48461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 48561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *txt = '\0'; 48661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 48761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 48861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 48961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtsize_t printf_decode(u8 *buf, size_t maxlen, const char *str) 49061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 49161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const char *pos = str; 49261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t len = 0; 49361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int val; 49461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 49561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt while (*pos) { 4965605286c30e1701491bd3af974ae423727750eddDmitry Shmidt if (len + 1 >= maxlen) 49761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 49861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (*pos) { 49961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '\\': 50061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 50161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (*pos) { 50261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '\\': 50361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = '\\'; 50461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 50561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 50661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '"': 50761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = '"'; 50861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 50961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 51061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case 'n': 51161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = '\n'; 51261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 51361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 51461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case 'r': 51561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = '\r'; 51661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 51761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 51861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case 't': 51961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = '\t'; 52061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 52161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 52261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case 'e': 523661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt buf[len++] = '\033'; 52461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 52561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 52661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case 'x': 52761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 52861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = hex2byte(pos); 52961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (val < 0) { 53061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = hex2num(*pos); 53161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (val < 0) 53261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 53361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = val; 53461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos++; 53561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 53661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = val; 53761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += 2; 53861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 53961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 54061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '0': 54161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '1': 54261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '2': 54361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '3': 54461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '4': 54561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '5': 54661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '6': 54761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case '7': 54861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = *pos++ - '0'; 54961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*pos >= '0' && *pos <= '7') 55061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = val * 8 + (*pos++ - '0'); 55161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*pos >= '0' && *pos <= '7') 55261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = val * 8 + (*pos++ - '0'); 55361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = val; 55461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 55561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 55661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 55761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 55861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 55961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 56061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf[len++] = *pos++; 56161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 56261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 56361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 5645605286c30e1701491bd3af974ae423727750eddDmitry Shmidt if (maxlen > len) 5655605286c30e1701491bd3af974ae423727750eddDmitry Shmidt buf[len] = '\0'; 56661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 56761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return len; 56861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 56961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 57061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/** 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wpa_ssid_txt - Convert SSID to a printable string 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @ssid: SSID (32-octet string) 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * @ssid_len: Length of ssid in octets 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Returns: Pointer to a printable string 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function can be used to convert SSIDs into printable form. In most 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * cases, SSIDs do not use unprintable characters, but IEEE 802.11 standard 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * does not limit the used character set, so anything could be used in an SSID. 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This function uses a static buffer, so only one call can be used at the 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * time, i.e., this is not re-entrant and the returned buffer must be used 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * before calling this again. 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst char * wpa_ssid_txt(const u8 *ssid, size_t ssid_len) 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 58761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt static char ssid_txt[32 * 4 + 1]; 58861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 58961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ssid == NULL) { 59061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ssid_txt[0] = '\0'; 59161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return ssid_txt; 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 59361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 59461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt printf_encode(ssid_txt, sizeof(ssid_txt), ssid, ssid_len); 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ssid_txt; 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid * __hide_aliasing_typecast(void *foo) 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return foo; 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 60361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 60461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 60561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtchar * wpa_config_parse_string(const char *value, size_t *len) 60661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 60761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*value == '"') { 60861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const char *pos; 60961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt char *str; 61061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt value++; 61161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos = os_strrchr(value, '"'); 61261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (pos == NULL || pos[1] != '\0') 61361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 61461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = pos - value; 6154b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt str = dup_binstr(value, *len); 61661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (str == NULL) 61761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 61861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return str; 61961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else if (*value == 'P' && value[1] == '"') { 62061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const char *pos; 62161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt char *tstr, *str; 62261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t tlen; 62361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt value += 2; 62461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos = os_strrchr(value, '"'); 62561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (pos == NULL || pos[1] != '\0') 62661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 62761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tlen = pos - value; 6284b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt tstr = dup_binstr(value, tlen); 62961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (tstr == NULL) 63061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 63161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 63261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt str = os_malloc(tlen + 1); 63361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (str == NULL) { 63461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(tstr); 63561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 63661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 63761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 63861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = printf_decode((u8 *) str, tlen + 1, tstr); 63961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(tstr); 64061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 64161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return str; 64261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 64361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *str; 64461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t tlen, hlen = os_strlen(value); 64561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (hlen & 1) 64661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 64761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tlen = hlen / 2; 64861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt str = os_malloc(tlen + 1); 64961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (str == NULL) 65061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 65161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (hexstr2bin(value, str, tlen)) { 65261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(str); 65361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return NULL; 65461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 65561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt str[tlen] = '\0'; 65661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = tlen; 65761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return (char *) str; 65861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 65961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 66061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 66161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 66261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtint is_hex(const u8 *data, size_t len) 66361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 66461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t i; 66561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 66661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt for (i = 0; i < len; i++) { 66761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data[i] < 32 || data[i] >= 127) 66861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 1; 66961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 67061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 67161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 67261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 67361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 67461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtsize_t merge_byte_arrays(u8 *res, size_t res_len, 67561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *src1, size_t src1_len, 67661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *src2, size_t src2_len) 67761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 67861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t len = 0; 67961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 68061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(res, 0, res_len); 68161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 68261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (src1) { 68361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (src1_len >= res_len) { 68461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(res, src1, res_len); 68561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res_len; 68661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 68761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 68861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(res, src1, src1_len); 68961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt len += src1_len; 69061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 69161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 69261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (src2) { 69361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len + src2_len >= res_len) { 69461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(res + len, src2, res_len - len); 69561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res_len; 69661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 69761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 69861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(res + len, src2, src2_len); 69961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt len += src2_len; 70061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 70161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 70261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return len; 70361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 7044b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt 7054b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt 7064b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidtchar * dup_binstr(const void *src, size_t len) 7074b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt{ 7084b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt char *res; 7094b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt 7104b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt if (src == NULL) 7114b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt return NULL; 7124b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt res = os_malloc(len + 1); 7134b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt if (res == NULL) 7144b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt return NULL; 7154b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt os_memcpy(res, src, len); 7164b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt res[len] = '\0'; 7174b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt 7184b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt return res; 7194b06059785b935dd1f4f09314e4e12c417d2c6a4Dmitry Shmidt} 7204ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7214ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7224ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidtint freq_range_list_parse(struct wpa_freq_range_list *res, const char *value) 7234ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt{ 7244ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt struct wpa_freq_range *freq = NULL, *n; 7254ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt unsigned int count = 0; 7264ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt const char *pos, *pos2, *pos3; 7274ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7284ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt /* 7294ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt * Comma separated list of frequency ranges. 7304ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt * For example: 2412-2432,2462,5000-6000 7314ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt */ 7324ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos = value; 7334ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt while (pos && pos[0]) { 7344ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt n = os_realloc_array(freq, count + 1, 7354ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt sizeof(struct wpa_freq_range)); 7364ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (n == NULL) { 7374ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt os_free(freq); 7384ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return -1; 7394ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt } 7404ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt freq = n; 7414ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt freq[count].min = atoi(pos); 7424ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos2 = os_strchr(pos, '-'); 7434ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos3 = os_strchr(pos, ','); 7444ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (pos2 && (!pos3 || pos2 < pos3)) { 7454ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos2++; 7464ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt freq[count].max = atoi(pos2); 7474ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt } else 7484ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt freq[count].max = freq[count].min; 7494ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos = pos3; 7504ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (pos) 7514ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos++; 7524ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt count++; 7534ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt } 7544ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7554ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt os_free(res->range); 7564ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt res->range = freq; 7574ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt res->num = count; 7584ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7594ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return 0; 7604ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt} 7614ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7624ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7634ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidtint freq_range_list_includes(const struct wpa_freq_range_list *list, 7644ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt unsigned int freq) 7654ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt{ 7664ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt unsigned int i; 7674ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7684ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (list == NULL) 7694ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return 0; 7704ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7714ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt for (i = 0; i < list->num; i++) { 7724ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (freq >= list->range[i].min && freq <= list->range[i].max) 7734ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return 1; 7744ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt } 7754ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7764ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return 0; 7774ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt} 7784ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7794ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7804ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidtchar * freq_range_list_str(const struct wpa_freq_range_list *list) 7814ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt{ 7824ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt char *buf, *pos, *end; 7834ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt size_t maxlen; 7844ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt unsigned int i; 7854ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt int res; 7864ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7874ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (list->num == 0) 7884ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return NULL; 7894ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7904ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt maxlen = list->num * 30; 7914ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt buf = os_malloc(maxlen); 7924ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (buf == NULL) 7934ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return NULL; 7944ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos = buf; 7954ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt end = buf + maxlen; 7964ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 7974ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt for (i = 0; i < list->num; i++) { 7984ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt struct wpa_freq_range *range = &list->range[i]; 7994ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 8004ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt if (range->min == range->max) 8014ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt res = os_snprintf(pos, end - pos, "%s%u", 8024ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt i == 0 ? "" : ",", range->min); 8034ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt else 8044ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt res = os_snprintf(pos, end - pos, "%s%u-%u", 8054ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt i == 0 ? "" : ",", 8064ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt range->min, range->max); 8076c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (os_snprintf_error(end - pos, res)) { 8084ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt os_free(buf); 8094ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return NULL; 8104ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt } 8114ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt pos += res; 8124ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt } 8134ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt 8144ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt return buf; 8154ce9c87407c036fc83eb5a6044ddf976c86f53fcDmitry Shmidt} 816fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 817fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 818fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtint int_array_len(const int *a) 819fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 820fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int i; 821fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt for (i = 0; a && a[i]; i++) 822fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt ; 823fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return i; 824fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 825fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 826fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 827fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtvoid int_array_concat(int **res, const int *a) 828fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 829fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int reslen, alen, i; 830fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int *n; 831fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 832fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt reslen = int_array_len(*res); 833fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt alen = int_array_len(a); 834fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 835fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt n = os_realloc_array(*res, reslen + alen + 1, sizeof(int)); 836fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (n == NULL) { 837fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_free(*res); 838fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt *res = NULL; 839fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return; 840fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 841fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt for (i = 0; i <= alen; i++) 842fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt n[reslen + i] = a[i]; 843fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt *res = n; 844fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 845fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 846fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 847fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic int freq_cmp(const void *a, const void *b) 848fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 849fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int _a = *(int *) a; 850fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int _b = *(int *) b; 851fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 852fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (_a == 0) 853fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return 1; 854fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (_b == 0) 855fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return -1; 856fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return _a - _b; 857fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 858fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 859fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 860fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtvoid int_array_sort_unique(int *a) 861fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 862fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int alen; 863fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int i, j; 864fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 865fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (a == NULL) 866fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return; 867fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 868fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt alen = int_array_len(a); 869fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt qsort(a, alen, sizeof(int), freq_cmp); 870fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 871fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt i = 0; 872fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt j = 1; 873fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt while (a[i] && a[j]) { 874fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (a[i] == a[j]) { 875fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt j++; 876fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt continue; 877fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 878fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt a[++i] = a[j++]; 879fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 880fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (a[i]) 881fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt i++; 882fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt a[i] = 0; 883fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 884fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 885fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 886fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtvoid int_array_add_unique(int **res, int a) 887fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 888fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int reslen; 889fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int *n; 890fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 891fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt for (reslen = 0; *res && (*res)[reslen]; reslen++) { 892fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if ((*res)[reslen] == a) 893fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return; /* already in the list */ 894fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 895fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 896fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt n = os_realloc_array(*res, reslen + 2, sizeof(int)); 897fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (n == NULL) { 898fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_free(*res); 899fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt *res = NULL; 900fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return; 901fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 902fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 903fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt n[reslen] = a; 904fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt n[reslen + 1] = 0; 905fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 906fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt *res = n; 907fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 908c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt 909c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt 910c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidtvoid str_clear_free(char *str) 911c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt{ 912c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt if (str) { 913c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt size_t len = os_strlen(str); 914c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt os_memset(str, 0, len); 915c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt os_free(str); 916c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt } 917c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt} 918c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt 919c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt 920c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidtvoid bin_clear_free(void *bin, size_t len) 921c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt{ 922c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt if (bin) { 923c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt os_memset(bin, 0, len); 924c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt os_free(bin); 925c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt } 926c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt} 927661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt 928661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt 929661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidtint random_mac_addr(u8 *addr) 930661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt{ 931661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt if (os_get_random(addr, ETH_ALEN) < 0) 932661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt return -1; 933661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt addr[0] &= 0xfe; /* unicast */ 934661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt addr[0] |= 0x02; /* locally administered */ 935661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt return 0; 936661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt} 937661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt 938661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt 939661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidtint random_mac_addr_keep_oui(u8 *addr) 940661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt{ 941661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt if (os_get_random(addr + 3, 3) < 0) 942661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt return -1; 943661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt addr[0] &= 0xfe; /* unicast */ 944661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt addr[0] |= 0x02; /* locally administered */ 945661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt return 0; 946661b4f78e48c697429dc46154a4125892c001718Dmitry Shmidt} 9476c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 9486c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 9496c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt/** 9506c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * str_token - Get next token from a string 9516c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @buf: String to tokenize. Note that the string might be modified. 9526c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @delim: String of delimiters 9536c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * @context: Pointer to save our context. Should be initialized with 9546c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * NULL on the first call, and passed for any further call. 9556c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt * Returns: The next token, NULL if there are no more valid tokens. 9566c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt */ 9576c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidtchar * str_token(char *str, const char *delim, char **context) 9586c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt{ 9596c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt char *end, *pos = str; 9606c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 9616c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (*context) 9626c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt pos = *context; 9636c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 9646c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt while (*pos && os_strchr(delim, *pos)) 9656c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt pos++; 9666c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (!*pos) 9676c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt return NULL; 9686c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 9696c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt end = pos + 1; 9706c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt while (*end && !os_strchr(delim, *end)) 9716c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt end++; 9726c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 9736c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (*end) 9746c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt *end++ = '\0'; 9756c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 9766c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt *context = end; 9776c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt return pos; 9786c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt} 979216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 980216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 981216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidtsize_t utf8_unescape(const char *inp, size_t in_size, 982216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt char *outp, size_t out_size) 983216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt{ 984216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt size_t res_size = 0; 985216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 986216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (!inp || !outp) 987216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return 0; 988216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 989216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (!in_size) 990216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt in_size = os_strlen(inp); 991216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 992216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt /* Advance past leading single quote */ 993216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (*inp == '\'' && in_size) { 994216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt inp++; 995216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt in_size--; 996216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt } 997216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 998216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt while (in_size--) { 999216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (res_size >= out_size) 1000216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return 0; 1001216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1002216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt switch (*inp) { 1003216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt case '\'': 1004216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt /* Terminate on bare single quote */ 1005216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt *outp = '\0'; 1006216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return res_size; 1007216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1008216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt case '\\': 1009216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (!in_size--) 1010216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return 0; 1011216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt inp++; 1012216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt /* fall through */ 1013216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1014216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt default: 1015216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt *outp++ = *inp++; 1016216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt res_size++; 1017216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt } 1018216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt } 1019216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1020216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt /* NUL terminate if space allows */ 1021216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (res_size < out_size) 1022216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt *outp = '\0'; 1023216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1024216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return res_size; 1025216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt} 1026216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1027216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1028216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidtsize_t utf8_escape(const char *inp, size_t in_size, 1029216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt char *outp, size_t out_size) 1030216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt{ 1031216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt size_t res_size = 0; 1032216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1033216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (!inp || !outp) 1034216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return 0; 1035216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1036216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt /* inp may or may not be NUL terminated, but must be if 0 size 1037216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt * is specified */ 1038216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (!in_size) 1039216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt in_size = os_strlen(inp); 1040216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1041216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt while (in_size--) { 1042216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (res_size++ >= out_size) 1043216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return 0; 1044216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1045216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt switch (*inp) { 1046216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt case '\\': 1047216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt case '\'': 1048216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (res_size++ >= out_size) 1049216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return 0; 1050216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt *outp++ = '\\'; 1051216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt /* fall through */ 1052216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1053216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt default: 1054216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt *outp++ = *inp++; 1055216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt break; 1056216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt } 1057216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt } 1058216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1059216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt /* NUL terminate if space allows */ 1060216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt if (res_size < out_size) 1061216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt *outp = '\0'; 1062216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt 1063216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt return res_size; 1064216983bceec7c450951e2fbcd076b5c75d432e57Dmitry Shmidt} 1065