| 1 | /*␊ |
| 2 | * Copyright (c) 1999-2003 Apple Computer, Inc. All rights reserved.␊ |
| 3 | *␊ |
| 4 | * @APPLE_LICENSE_HEADER_START@␊ |
| 5 | * ␊ |
| 6 | * Portions Copyright (c) 1999-2003 Apple Computer, Inc. All Rights␊ |
| 7 | * Reserved. This file contains Original Code and/or Modifications of␊ |
| 8 | * Original Code as defined in and that are subject to the Apple Public␊ |
| 9 | * Source License Version 2.0 (the "License"). You may not use this file␊ |
| 10 | * except in compliance with the License. Please obtain a copy of the␊ |
| 11 | * License at http://www.apple.com/publicsource and read it before using␊ |
| 12 | * this file.␊ |
| 13 | * ␊ |
| 14 | * The Original Code and all software distributed under the License are␊ |
| 15 | * distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, EITHER␊ |
| 16 | * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,␊ |
| 17 | * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,␊ |
| 18 | * FITNESS FOR A PARTICULAR PURPOSE OR NON- INFRINGEMENT. Please see the␊ |
| 19 | * License for the specific language governing rights and limitations␊ |
| 20 | * under the License.␊ |
| 21 | * ␊ |
| 22 | * @APPLE_LICENSE_HEADER_END@␊ |
| 23 | */␊ |
| 24 | /* string operations */␊ |
| 25 | ␊ |
| 26 | #include "libsa.h"␊ |
| 27 | ␊ |
| 28 | void * memset(void * dst, int val, size_t len)␊ |
| 29 | {␊ |
| 30 | asm volatile ( "rep; stosb"␊ |
| 31 | : "=c" (len), "=D" (dst)␊ |
| 32 | : "0" (len), "1" (dst), "a" (val)␊ |
| 33 | : "memory" );␊ |
| 34 | ␊ |
| 35 | return dst;␊ |
| 36 | }␊ |
| 37 | ␊ |
| 38 | #if 0␊ |
| 39 | void * memcpy(void * dst, const void * src, size_t len)␊ |
| 40 | {␊ |
| 41 | asm volatile ( "rep; movsb"␊ |
| 42 | : "=c" (len), "=D" (dst), "=S" (src)␊ |
| 43 | : "0" (len), "1" (dst), "2" (src)␊ |
| 44 | : "memory" );␊ |
| 45 | ␊ |
| 46 | return dst;␊ |
| 47 | }␊ |
| 48 | ␊ |
| 49 | void bcopy(const void * src, void * dst, size_t len)␊ |
| 50 | {␊ |
| 51 | ␉memcpy(dst, src, len);␊ |
| 52 | }␊ |
| 53 | ␊ |
| 54 | void bzero(void * dst, size_t len)␊ |
| 55 | {␊ |
| 56 | memset(dst, 0, len);␊ |
| 57 | }␊ |
| 58 | ␊ |
| 59 | #else␊ |
| 60 | void * memcpy(void * dst, const void * src, size_t len)␊ |
| 61 | {␊ |
| 62 | asm volatile ( "cld \n\t"␊ |
| 63 | "movl %%ecx, %%edx \n\t"␊ |
| 64 | "shrl $2, %%ecx \n\t"␊ |
| 65 | "rep; movsl \n\t"␊ |
| 66 | "movl %%edx, %%ecx \n\t"␊ |
| 67 | "andl $3, %%ecx \n\t"␊ |
| 68 | "rep; movsb \n\t"␊ |
| 69 | : "=D" (dst)␊ |
| 70 | : "c" (len), "D" (dst), "S" (src)␊ |
| 71 | : "memory", "%edx" );␊ |
| 72 | ␊ |
| 73 | return dst;␊ |
| 74 | }␊ |
| 75 | ␊ |
| 76 | void bcopy(const void * src, void * dst, size_t len)␊ |
| 77 | {␊ |
| 78 | asm volatile ( "cld \n\t"␊ |
| 79 | "movl %%ecx, %%edx \n\t"␊ |
| 80 | "shrl $2, %%ecx \n\t"␊ |
| 81 | "rep; movsl \n\t"␊ |
| 82 | "movl %%edx, %%ecx \n\t"␊ |
| 83 | "andl $3, %%ecx \n\t"␊ |
| 84 | "rep; movsb \n\t"␊ |
| 85 | :␊ |
| 86 | : "c" (len), "D" (dst), "S" (src)␊ |
| 87 | : "memory", "%edx" );␊ |
| 88 | }␊ |
| 89 | ␊ |
| 90 | void bzero(void * dst, size_t len)␊ |
| 91 | {␊ |
| 92 | asm volatile ( "xorl %%eax, %%eax \n\t"␊ |
| 93 | "cld \n\t"␊ |
| 94 | "movl %%ecx, %%edx \n\t"␊ |
| 95 | "shrl $2, %%ecx \n\t"␊ |
| 96 | "rep; stosl \n\t"␊ |
| 97 | "movl %%edx, %%ecx \n\t"␊ |
| 98 | "andl $3, %%ecx \n\t"␊ |
| 99 | "rep; stosb \n\t"␊ |
| 100 | : ␊ |
| 101 | : "c" (len), "D" (dst)␊ |
| 102 | : "memory", "%eax" );␊ |
| 103 | }␊ |
| 104 | #endif␊ |
| 105 | ␊ |
| 106 | /* #if DONT_USE_GCC_BUILT_IN_STRLEN */␊ |
| 107 | ␊ |
| 108 | #define tolower(c) ((int)((c) & ~0x20))␊ |
| 109 | #define toupper(c) ((int)((c) | 0x20))␊ |
| 110 | ␊ |
| 111 | size_t strlen(const char * s)␊ |
| 112 | {␊ |
| 113 | const char* save = s;␊ |
| 114 | while (*s++);␊ |
| 115 | return (--s) - save;␊ |
| 116 | }␊ |
| 117 | ␊ |
| 118 | /*#endif*/␊ |
| 119 | ␊ |
| 120 | /* NOTE: Moved from ntfs.c */␊ |
| 121 | int␊ |
| 122 | memcmp(const void *p1, const void *p2, size_t len)␊ |
| 123 | {␊ |
| 124 | while (len--) {␊ |
| 125 | if (*(const char*)(p1++) != *(const char*)(p2++))␊ |
| 126 | return -1;␊ |
| 127 | }␊ |
| 128 | return 0;␊ |
| 129 | }␊ |
| 130 | ␊ |
| 131 | int␊ |
| 132 | strcmp(const char * s1, const char * s2)␊ |
| 133 | {␊ |
| 134 | ␉while (*s1 && (*s1 == *s2)) {␊ |
| 135 | ␉␉s1++;␊ |
| 136 | ␉␉s2++;␊ |
| 137 | ␉}␊ |
| 138 | ␉return (*s1 - *s2);␊ |
| 139 | }␊ |
| 140 | ␊ |
| 141 | /* Derived from FreeBSD source */␊ |
| 142 | int strncmp(const char * s1, const char * s2, size_t n)␊ |
| 143 | {␊ |
| 144 | if (!n)␊ |
| 145 | return 0;␊ |
| 146 | do {␊ |
| 147 | if (*s1 != *s2++)␊ |
| 148 | return (*(const unsigned char *)s1 -␊ |
| 149 | *(const unsigned char *)(s2 - 1));␊ |
| 150 | if (!*s1++)␊ |
| 151 | break;␊ |
| 152 | } while (--n);␊ |
| 153 | return 0;␊ |
| 154 | }␊ |
| 155 | ␊ |
| 156 | char *␊ |
| 157 | strcpy(char * s1, const char * s2)␊ |
| 158 | {␊ |
| 159 | ␉register char *ret = s1;␊ |
| 160 | ␉while ((*s1++ = *s2++))␊ |
| 161 | ␉␉continue;␊ |
| 162 | ␉return ret;␊ |
| 163 | }␊ |
| 164 | ␊ |
| 165 | char *␊ |
| 166 | strncpy(char * s1, const char * s2, size_t n)␊ |
| 167 | {␊ |
| 168 | ␉register char *ret = s1;␊ |
| 169 | ␉while (n && (*s1++ = *s2++))␊ |
| 170 | --n;␊ |
| 171 | ␉if (n > 0) {␊ |
| 172 | ␉␉bzero(s1, n);␊ |
| 173 | ␉}␊ |
| 174 | ␉return ret;␊ |
| 175 | }␊ |
| 176 | ␊ |
| 177 | char *␊ |
| 178 | strstr(const char *in, const char *str)␊ |
| 179 | {␊ |
| 180 | char c;␊ |
| 181 | size_t len;␊ |
| 182 | ␊ |
| 183 | c = *str++;␊ |
| 184 | if (!c)␊ |
| 185 | return (char *) in;␉// Trivial empty string case␊ |
| 186 | ␊ |
| 187 | len = strlen(str);␊ |
| 188 | do {␊ |
| 189 | char sc;␊ |
| 190 | ␊ |
| 191 | do {␊ |
| 192 | sc = *in++;␊ |
| 193 | if (!sc)␊ |
| 194 | return (char *) 0;␊ |
| 195 | } while (sc != c);␊ |
| 196 | } while (strncmp(in, str, len) != 0);␊ |
| 197 | ␊ |
| 198 | return (char *) (in - 1);␊ |
| 199 | }␊ |
| 200 | ␊ |
| 201 | int␊ |
| 202 | ptol(const char *str)␊ |
| 203 | {␊ |
| 204 | ␉register int c = *str;␊ |
| 205 | ␊ |
| 206 | ␉if (c <= '7' && c >= '0')␊ |
| 207 | ␉␉c -= '0';␊ |
| 208 | ␉else if (c <= 'h' && c >= 'a')␊ |
| 209 | ␉␉c -= 'a';␊ |
| 210 | ␉else c = 0;␊ |
| 211 | ␉return c;␊ |
| 212 | }␊ |
| 213 | ␊ |
| 214 | int␊ |
| 215 | atoi(const char *str)␊ |
| 216 | {␊ |
| 217 | ␉register int sum = 0;␊ |
| 218 | ␉while (*str == ' ' || *str == '\t')␊ |
| 219 | ␉␉str++;␊ |
| 220 | ␉while (*str >= '0' && *str <= '9') {␊ |
| 221 | ␉␉sum *= 10;␊ |
| 222 | ␉␉sum += *str++ - '0';␊ |
| 223 | ␉}␊ |
| 224 | ␉return sum;␊ |
| 225 | }␊ |
| 226 | ␊ |
| 227 | char *strncat(char *s1, const char *s2, size_t n)␊ |
| 228 | {␊ |
| 229 | ␉register char *ret = s1;␊ |
| 230 | ␉while (*s1)␊ |
| 231 | ␉␉s1++;␊ |
| 232 | ␉while (n-- && (*s1++ = *s2++));␊ |
| 233 | ␉return ret;␊ |
| 234 | }␊ |
| 235 | ␊ |
| 236 | char *strcat(char *s1, const char *s2)␊ |
| 237 | {␊ |
| 238 | ␉register char *ret = s1;␊ |
| 239 | ␉while (*s1)␊ |
| 240 | ␉␉s1++;␊ |
| 241 | ␉while ((*s1++ = *s2++));␊ |
| 242 | ␉return ret;␊ |
| 243 | }␊ |
| 244 | ␊ |
| 245 | char *strdup(const char *s1)␊ |
| 246 | {␊ |
| 247 | ␉return strcpy(malloc(strlen(s1) + 1), s1);␊ |
| 248 | }␊ |
| 249 | ␊ |
| 250 | #if STRNCASECMP␊ |
| 251 | int strncasecmp(const char *s1, const char *s2, size_t len)␊ |
| 252 | {␊ |
| 253 | ␉register int n = len;␊ |
| 254 | ␉while (--n >= 0 && tolower(*s1) == tolower(*s2++))␊ |
| 255 | ␉␉if (*s1++ == '\0')␊ |
| 256 | ␉␉␉return(0);␊ |
| 257 | ␉return(n<0 ? 0 : tolower(*s1) - tolower(*--s2));␊ |
| 258 | }␊ |
| 259 | #endif␊ |
| 260 | ␊ |
| 261 | char* strchr(const char *str, int c)␊ |
| 262 | {␊ |
| 263 | do␊ |
| 264 | {␊ |
| 265 | if(*str == c)␊ |
| 266 | return (char*)str;␊ |
| 267 | }␊ |
| 268 | while(*(str++));␊ |
| 269 | ␊ |
| 270 | return 0;␊ |
| 271 | } ␊ |
| 272 | ␊ |
| 273 | char* strbreak(const char *str, char **next, long *len)␊ |
| 274 | {␊ |
| 275 | char *start = (char*)str, *end;␊ |
| 276 | bool quoted = false;␊ |
| 277 | ␊ |
| 278 | if ( !start || !len )␊ |
| 279 | return 0;␊ |
| 280 | ␊ |
| 281 | *len = 0;␊ |
| 282 | ␊ |
| 283 | while ( isspace(*start) )␊ |
| 284 | start++;␊ |
| 285 | ␊ |
| 286 | if (*start == '"')␊ |
| 287 | {␊ |
| 288 | start++;␊ |
| 289 | ␊ |
| 290 | end = strchr(start, '"');␊ |
| 291 | if(end)␊ |
| 292 | quoted = true;␊ |
| 293 | else␊ |
| 294 | end = strchr(start, '\0');␊ |
| 295 | }␊ |
| 296 | else␊ |
| 297 | {␊ |
| 298 | for ( end = start; *end && !isspace(*end); end++ )␊ |
| 299 | {}␊ |
| 300 | }␊ |
| 301 | ␊ |
| 302 | *len = end - start;␊ |
| 303 | ␊ |
| 304 | if(next)␊ |
| 305 | *next = quoted ? end+1 : end;␊ |
| 306 | ␊ |
| 307 | return start;␊ |
| 308 | }␊ |
| 309 | ␊ |
| 310 | /* COPYRIGHT NOTICE: checksum8 from AppleSMBIOS */␊ |
| 311 | uint8_t checksum8( void * start, unsigned int length )␊ |
| 312 | {␊ |
| 313 | uint8_t csum = 0;␊ |
| 314 | uint8_t * cp = (uint8_t *) start;␊ |
| 315 | unsigned int i;␊ |
| 316 | ␊ |
| 317 | for ( i = 0; i < length; i++)␊ |
| 318 | csum += *cp++;␊ |
| 319 | ␊ |
| 320 | return csum;␊ |
| 321 | }␊ |
| 322 | ␊ |
| 323 | |
