| 1 | #include <stddef.h> |
| 2 | #include <stdint.h> |
| 3 | #include <limits.h> |
| 4 | #include <stdlib.h> |
| 5 | #include <string.h> |
| 6 | #include <lib/libc.h> |
| 7 | #include <lib/misc.h> |
| 8 | #include <mm/pmm.h> |
| 9 | |
| 10 | // Slightly adapted strtoul() implementation from FreeBSD. |
| 11 | // https://github.com/freebsd/freebsd-src/blob/de1aa3dab23c06fec962a14da3e7b4755c5880cf/lib/libc/stdlib/strtoul.c |
| 12 | unsigned long strtoul(const char *nptr, char **endptr, int base) { |
| 13 | const char *s; |
| 14 | unsigned long acc; |
| 15 | char c; |
| 16 | unsigned long cutoff; |
| 17 | int neg, any, cutlim; |
| 18 | |
| 19 | s = nptr; |
| 20 | do { |
| 21 | c = *s++; |
| 22 | } while (isspace((unsigned char)c)); |
| 23 | if (c == '-') { |
| 24 | neg = 1; |
| 25 | c = *s++; |
| 26 | } else { |
| 27 | neg = 0; |
| 28 | if (c == '+') |
| 29 | c = *s++; |
| 30 | } |
| 31 | if ((base == 0 || base == 16) && |
| 32 | c == '0' && (*s == 'x' || *s == 'X') && |
| 33 | ((s[1] >= '0' && s[1] <= '9') || |
| 34 | (s[1] >= 'A' && s[1] <= 'F') || |
| 35 | (s[1] >= 'a' && s[1] <= 'f'))) { |
| 36 | c = s[1]; |
| 37 | s += 2; |
| 38 | base = 16; |
| 39 | } |
| 40 | if (base == 0) |
| 41 | base = c == '0' ? 8 : 10; |
| 42 | acc = any = 0; |
| 43 | if (base < 2 || base > 36) |
| 44 | goto noconv; |
| 45 | |
| 46 | cutoff = ULONG_MAX / base; |
| 47 | cutlim = ULONG_MAX % base; |
| 48 | for ( ; ; c = *s++) { |
| 49 | if (c >= '0' && c <= '9') |
| 50 | c -= '0'; |
| 51 | else if (c >= 'A' && c <= 'Z') |
| 52 | c -= 'A' - 10; |
| 53 | else if (c >= 'a' && c <= 'z') |
| 54 | c -= 'a' - 10; |
| 55 | else |
| 56 | break; |
| 57 | if (c >= base) |
| 58 | break; |
| 59 | if (any < 0 || acc > cutoff || (acc == cutoff && c > cutlim)) |
| 60 | any = -1; |
| 61 | else { |
| 62 | any = 1; |
| 63 | acc *= base; |
| 64 | acc += c; |
| 65 | } |
| 66 | } |
| 67 | if (any < 0) { |
| 68 | acc = ULONG_MAX; |
| 69 | //errno = ERANGE; |
| 70 | } else if (!any) { |
| 71 | noconv: |
| 72 | ;//errno = EINVAL; |
| 73 | } else if (neg) |
| 74 | acc = -acc; |
| 75 | if (endptr != NULL) |
| 76 | *endptr = (char *)(any ? s - 1 : nptr); |
| 77 | return (acc); |
| 78 | } |
| 79 | |
| 80 | size_t strnlen(const char *str, size_t maxlen) { |
| 81 | size_t len; |
| 82 | |
| 83 | for (len = 0; len < maxlen && str[len]; len++); |
| 84 | |
| 85 | return len; |
| 86 | } |
| 87 | |
| 88 | void *memchr(const void *ptr, int ch, size_t n) { |
| 89 | uint8_t *p = (uint8_t *)ptr; |
| 90 | |
| 91 | for (size_t i = 0; i < n; i++) { |
| 92 | if (p[i] == ch) { |
| 93 | return (void *)ptr + i; |
| 94 | } |
| 95 | } |
| 96 | |
| 97 | return NULL; |
| 98 | } |
| 99 | |
| 100 | char *strchr(const char *str, int ch) { |
| 101 | for (size_t i = 0; ; i++) { |
| 102 | if (str[i] == (char)ch) { |
| 103 | return (char *)str + i; |
| 104 | } |
| 105 | if (str[i] == '\0') { |
| 106 | return NULL; |
| 107 | } |
| 108 | } |
| 109 | } |
| 110 | |
| 111 | char *strrchr(const char *str, int ch) { |
| 112 | char *p = NULL; |
| 113 | |
| 114 | for (size_t i = 0; ; i++) { |
| 115 | if (str[i] == (char)ch) { |
| 116 | p = (char *)str + i; |
| 117 | } |
| 118 | if (str[i] == '\0') { |
| 119 | break; |
| 120 | } |
| 121 | } |
| 122 | |
| 123 | return p; |
| 124 | } |
| 125 | |
| 126 | char *strdup(const char *s) { |
| 127 | size_t len = strlen(s) + 1; |
| 128 | char *buf = ext_mem_alloc(len); |
| 129 | memcpy(buf, s, len); |
| 130 | return buf; |
| 131 | } |
