2 * wpa_supplicant/hostapd / common helper functions, etc.
3 * Copyright (c) 2002-2007, Jouni Malinen <j@w1.fi>
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
14 static int hex2num(char c)
16 if (c >= '0' && c <= '9')
18 if (c >= 'a' && c <= 'f')
20 if (c >= 'A' && c <= 'F')
26 int hex2byte(const char *hex)
40 * hwaddr_aton - Convert ASCII string to MAC address (colon-delimited format)
41 * @txt: MAC address as a string (e.g., "00:11:22:33:44:55")
42 * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
43 * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
45 int hwaddr_aton(const char *txt, u8 *addr)
49 for (i = 0; i < 6; i++) {
58 *addr++ = (a << 4) | b;
59 if (i < 5 && *txt++ != ':')
67 * hwaddr_compact_aton - Convert ASCII string to MAC address (no colon delimitors format)
68 * @txt: MAC address as a string (e.g., "001122334455")
69 * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
70 * Returns: 0 on success, -1 on failure (e.g., string not a MAC address)
72 int hwaddr_compact_aton(const char *txt, u8 *addr)
76 for (i = 0; i < 6; i++) {
85 *addr++ = (a << 4) | b;
92 * hwaddr_aton2 - Convert ASCII string to MAC address (in any known format)
93 * @txt: MAC address as a string (e.g., 00:11:22:33:44:55 or 0011.2233.4455)
94 * @addr: Buffer for the MAC address (ETH_ALEN = 6 bytes)
95 * Returns: Characters used (> 0) on success, -1 on failure
97 int hwaddr_aton2(const char *txt, u8 *addr)
100 const char *pos = txt;
102 for (i = 0; i < 6; i++) {
105 while (*pos == ':' || *pos == '.' || *pos == '-')
114 *addr++ = (a << 4) | b;
122 * hexstr2bin - Convert ASCII hex string into binary data
123 * @hex: ASCII hex string (e.g., "01ab")
124 * @buf: Buffer for the binary data
125 * @len: Length of the text to convert in bytes (of buf); hex will be double
127 * Returns: 0 on success, -1 on failure (invalid hex string)
129 int hexstr2bin(const char *hex, u8 *buf, size_t len)
133 const char *ipos = hex;
136 for (i = 0; i < len; i++) {
148 * inc_byte_array - Increment arbitrary length byte array by one
149 * @counter: Pointer to byte array
150 * @len: Length of the counter in bytes
152 * This function increments the last byte of the counter by one and continues
153 * rolling over to more significant bytes if the byte was incremented from
156 void inc_byte_array(u8 *counter, size_t len)
161 if (counter[pos] != 0)
168 void wpa_get_ntp_timestamp(u8 *buf)
174 /* 64-bit NTP timestamp (time from 1900-01-01 00:00:00) */
176 sec = now.sec + 2208988800U; /* Epoch to 1900 */
177 /* Estimate 2^32/10^6 = 4295 - 1/32 - 1/512 */
179 usec = 4295 * usec - (usec >> 5) - (usec >> 9);
180 tmp = host_to_be32(sec);
181 os_memcpy(buf, (u8 *) &tmp, 4);
182 tmp = host_to_be32(usec);
183 os_memcpy(buf + 4, (u8 *) &tmp, 4);
187 static inline int _wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data,
188 size_t len, int uppercase)
191 char *pos = buf, *end = buf + buf_size;
195 for (i = 0; i < len; i++) {
196 ret = os_snprintf(pos, end - pos, uppercase ? "%02X" : "%02x",
198 if (ret < 0 || ret >= end - pos) {
209 * wpa_snprintf_hex - Print data as a hex string into a buffer
210 * @buf: Memory area to use as the output buffer
211 * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1)
212 * @data: Data to be printed
213 * @len: Length of data in bytes
214 * Returns: Number of bytes written
216 int wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data, size_t len)
218 return _wpa_snprintf_hex(buf, buf_size, data, len, 0);
223 * wpa_snprintf_hex_uppercase - Print data as a upper case hex string into buf
224 * @buf: Memory area to use as the output buffer
225 * @buf_size: Maximum buffer size in bytes (should be at least 2 * len + 1)
226 * @data: Data to be printed
227 * @len: Length of data in bytes
228 * Returns: Number of bytes written
230 int wpa_snprintf_hex_uppercase(char *buf, size_t buf_size, const u8 *data,
233 return _wpa_snprintf_hex(buf, buf_size, data, len, 1);
237 #ifdef CONFIG_ANSI_C_EXTRA
240 void perror(const char *s)
242 wpa_printf(MSG_ERROR, "%s: GetLastError: %d",
243 s, (int) GetLastError());
245 #endif /* _WIN32_WCE */
252 int getopt(int argc, char *const argv[], const char *optstring)
254 static int optchr = 1;
258 if (optind >= argc) {
259 /* all arguments processed */
263 if (argv[optind][0] != '-' || argv[optind][1] == '\0') {
264 /* no option characters */
269 if (os_strcmp(argv[optind], "--") == 0) {
270 /* no more options */
275 optopt = argv[optind][optchr];
276 cp = os_strchr(optstring, optopt);
277 if (cp == NULL || optopt == ':') {
278 if (argv[optind][++optchr] == '\0') {
286 /* Argument required */
288 if (argv[optind][optchr + 1]) {
289 /* No space between option and argument */
290 optarg = &argv[optind++][optchr + 1];
291 } else if (++optind >= argc) {
292 /* option requires an argument */
295 /* Argument in the next argv */
296 optarg = argv[optind++];
300 if (argv[optind][++optchr] == '\0') {
308 #endif /* CONFIG_ANSI_C_EXTRA */
311 #ifdef CONFIG_NATIVE_WINDOWS
313 * wpa_unicode2ascii_inplace - Convert unicode string into ASCII
314 * @str: Pointer to string to convert
316 * This function converts a unicode string to ASCII using the same
317 * buffer for output. If UNICODE is not set, the buffer is not
320 void wpa_unicode2ascii_inplace(TCHAR *str)
323 char *dst = (char *) str;
325 *dst++ = (char) *str++;
331 TCHAR * wpa_strdup_tchar(const char *str)
335 buf = os_malloc((strlen(str) + 1) * sizeof(TCHAR));
338 wsprintf(buf, L"%S", str);
341 return os_strdup(str);
344 #endif /* CONFIG_NATIVE_WINDOWS */
347 void printf_encode(char *txt, size_t maxlen, const u8 *data, size_t len)
349 char *end = txt + maxlen;
352 for (i = 0; i < len; i++) {
382 if (data[i] >= 32 && data[i] <= 127) {
385 txt += os_snprintf(txt, end - txt, "\\x%02x",
396 size_t printf_decode(u8 *buf, size_t maxlen, const char *str)
398 const char *pos = str;
403 if (len + 1 >= maxlen)
456 if (*pos >= '0' && *pos <= '7')
457 val = val * 8 + (*pos++ - '0');
458 if (*pos >= '0' && *pos <= '7')
459 val = val * 8 + (*pos++ - '0');
479 * wpa_ssid_txt - Convert SSID to a printable string
480 * @ssid: SSID (32-octet string)
481 * @ssid_len: Length of ssid in octets
482 * Returns: Pointer to a printable string
484 * This function can be used to convert SSIDs into printable form. In most
485 * cases, SSIDs do not use unprintable characters, but IEEE 802.11 standard
486 * does not limit the used character set, so anything could be used in an SSID.
488 * This function uses a static buffer, so only one call can be used at the
489 * time, i.e., this is not re-entrant and the returned buffer must be used
490 * before calling this again.
492 const char * wpa_ssid_txt(const u8 *ssid, size_t ssid_len)
494 static char ssid_txt[32 * 4 + 1];
501 printf_encode(ssid_txt, sizeof(ssid_txt), ssid, ssid_len);
506 void * __hide_aliasing_typecast(void *foo)
512 char * wpa_config_parse_string(const char *value, size_t *len)
518 pos = os_strrchr(value, '"');
519 if (pos == NULL || pos[1] != '\0')
522 str = dup_binstr(value, *len);
526 } else if (*value == 'P' && value[1] == '"') {
531 pos = os_strrchr(value, '"');
532 if (pos == NULL || pos[1] != '\0')
535 tstr = dup_binstr(value, tlen);
539 str = os_malloc(tlen + 1);
545 *len = printf_decode((u8 *) str, tlen + 1, tstr);
551 size_t tlen, hlen = os_strlen(value);
555 str = os_malloc(tlen + 1);
558 if (hexstr2bin(value, str, tlen)) {
569 int is_hex(const u8 *data, size_t len)
573 for (i = 0; i < len; i++) {
574 if (data[i] < 32 || data[i] >= 127)
581 int find_first_bit(u32 value)
596 size_t merge_byte_arrays(u8 *res, size_t res_len,
597 const u8 *src1, size_t src1_len,
598 const u8 *src2, size_t src2_len)
602 os_memset(res, 0, res_len);
605 if (src1_len >= res_len) {
606 os_memcpy(res, src1, res_len);
610 os_memcpy(res, src1, src1_len);
615 if (len + src2_len >= res_len) {
616 os_memcpy(res + len, src2, res_len - len);
620 os_memcpy(res + len, src2, src2_len);
628 char * dup_binstr(const void *src, size_t len)
634 res = os_malloc(len + 1);
637 os_memcpy(res, src, len);
644 int freq_range_list_parse(struct wpa_freq_range_list *res, const char *value)
646 struct wpa_freq_range *freq = NULL, *n;
647 unsigned int count = 0;
648 const char *pos, *pos2, *pos3;
651 * Comma separated list of frequency ranges.
652 * For example: 2412-2432,2462,5000-6000
655 while (pos && pos[0]) {
656 n = os_realloc_array(freq, count + 1,
657 sizeof(struct wpa_freq_range));
663 freq[count].min = atoi(pos);
664 pos2 = os_strchr(pos, '-');
665 pos3 = os_strchr(pos, ',');
666 if (pos2 && (!pos3 || pos2 < pos3)) {
668 freq[count].max = atoi(pos2);
670 freq[count].max = freq[count].min;
685 int freq_range_list_includes(const struct wpa_freq_range_list *list,
693 for (i = 0; i < list->num; i++) {
694 if (freq >= list->range[i].min && freq <= list->range[i].max)
702 char * freq_range_list_str(const struct wpa_freq_range_list *list)
704 char *buf, *pos, *end;
712 maxlen = list->num * 30;
713 buf = os_malloc(maxlen);
719 for (i = 0; i < list->num; i++) {
720 struct wpa_freq_range *range = &list->range[i];
722 if (range->min == range->max)
723 res = os_snprintf(pos, end - pos, "%s%u",
724 i == 0 ? "" : ",", range->min);
726 res = os_snprintf(pos, end - pos, "%s%u-%u",
728 range->min, range->max);
729 if (res < 0 || res > end - pos) {
740 int int_array_len(const int *a)
743 for (i = 0; a && a[i]; i++)
749 void int_array_concat(int **res, const int *a)
754 reslen = int_array_len(*res);
755 alen = int_array_len(a);
757 n = os_realloc_array(*res, reslen + alen + 1, sizeof(int));
763 for (i = 0; i <= alen; i++)
764 n[reslen + i] = a[i];
769 static int freq_cmp(const void *a, const void *b)
782 void int_array_sort_unique(int *a)
790 alen = int_array_len(a);
791 qsort(a, alen, sizeof(int), freq_cmp);
795 while (a[i] && a[j]) {
808 void int_array_add_unique(int **res, int a)
813 for (reslen = 0; *res && (*res)[reslen]; reslen++) {
814 if ((*res)[reslen] == a)
815 return; /* already in the list */
818 n = os_realloc_array(*res, reslen + 2, sizeof(int));
832 void str_clear_free(char *str)
835 size_t len = os_strlen(str);
836 os_memset(str, 0, len);
842 void bin_clear_free(void *bin, size_t len)
845 os_memset(bin, 0, len);