git.sur5r.net Git - u-boot/blob - lib/string.c

   1 /*
   2  *  linux/lib/string.c
   3  *
   4  *  Copyright (C) 1991, 1992  Linus Torvalds
   5  */
   6
   7 /*
   8  * stupid library routines.. The optimized versions should generally be found
   9  * as inline code in <asm-xx/string.h>
  10  *
  11  * These are buggy as well..
  12  *
  13  * * Fri Jun 25 1999, Ingo Oeser <ioe@informatik.tu-chemnitz.de>
  14  * -  Added strsep() which will replace strtok() soon (because strsep() is
  15  *    reentrant and should be faster). Use only strsep() in new code, please.
  16  */
  17
  18 #include <linux/types.h>
  19 #include <linux/string.h>
  20 #include <linux/ctype.h>
  21 #include <malloc.h>
  22
  23
  24 #if 0 /* not used - was: #ifndef __HAVE_ARCH_STRNICMP */
  25 /**
  26  * strnicmp - Case insensitive, length-limited string comparison
  27  * @s1: One string
  28  * @s2: The other string
  29  * @len: the maximum number of characters to compare
  30  */
  31 int strnicmp(const char *s1, const char *s2, size_t len)
  32 {
  33         /* Yes, Virginia, it had better be unsigned */
  34         unsigned char c1, c2;
  35
  36         c1 = 0; c2 = 0;
  37         if (len) {
  38                 do {
  39                         c1 = *s1; c2 = *s2;
  40                         s1++; s2++;
  41                         if (!c1)
  42                                 break;
  43                         if (!c2)
  44                                 break;
  45                         if (c1 == c2)
  46                                 continue;
  47                         c1 = tolower(c1);
  48                         c2 = tolower(c2);
  49                         if (c1 != c2)
  50                                 break;
  51                 } while (--len);
  52         }
  53         return (int)c1 - (int)c2;
  54 }
  55 #endif
  56
  57 char * ___strtok;
  58
  59 #ifndef __HAVE_ARCH_STRCPY
  60 /**
  61  * strcpy - Copy a %NUL terminated string
  62  * @dest: Where to copy the string to
  63  * @src: Where to copy the string from
  64  */
  65 char * strcpy(char * dest,const char *src)
  66 {
  67         char *tmp = dest;
  68
  69         while ((*dest++ = *src++) != '\0')
  70                 /* nothing */;
  71         return tmp;
  72 }
  73 #endif
  74
  75 #ifndef __HAVE_ARCH_STRNCPY
  76 /**
  77  * strncpy - Copy a length-limited, %NUL-terminated string
  78  * @dest: Where to copy the string to
  79  * @src: Where to copy the string from
  80  * @count: The maximum number of bytes to copy
  81  *
  82  * Note that unlike userspace strncpy, this does not %NUL-pad the buffer.
  83  * However, the result is not %NUL-terminated if the source exceeds
  84  * @count bytes.
  85  */
  86 char * strncpy(char * dest,const char *src,size_t count)
  87 {
  88         char *tmp = dest;
  89
  90         while (count-- && (*dest++ = *src++) != '\0')
  91                 /* nothing */;
  92
  93         return tmp;
  94 }
  95 #endif
  96
  97 #ifndef __HAVE_ARCH_STRCAT
  98 /**
  99  * strcat - Append one %NUL-terminated string to another
 100  * @dest: The string to be appended to
 101  * @src: The string to append to it
 102  */
 103 char * strcat(char * dest, const char * src)
 104 {
 105         char *tmp = dest;
 106
 107         while (*dest)
 108                 dest++;
 109         while ((*dest++ = *src++) != '\0')
 110                 ;
 111
 112         return tmp;
 113 }
 114 #endif
 115
 116 #ifndef __HAVE_ARCH_STRNCAT
 117 /**
 118  * strncat - Append a length-limited, %NUL-terminated string to another
 119  * @dest: The string to be appended to
 120  * @src: The string to append to it
 121  * @count: The maximum numbers of bytes to copy
 122  *
 123  * Note that in contrast to strncpy, strncat ensures the result is
 124  * terminated.
 125  */
 126 char * strncat(char *dest, const char *src, size_t count)
 127 {
 128         char *tmp = dest;
 129
 130         if (count) {
 131                 while (*dest)
 132                         dest++;
 133                 while ((*dest++ = *src++)) {
 134                         if (--count == 0) {
 135                                 *dest = '\0';
 136                                 break;
 137                         }
 138                 }
 139         }
 140
 141         return tmp;
 142 }
 143 #endif
 144
 145 #ifndef __HAVE_ARCH_STRCMP
 146 /**
 147  * strcmp - Compare two strings
 148  * @cs: One string
 149  * @ct: Another string
 150  */
 151 int strcmp(const char * cs,const char * ct)
 152 {
 153         register signed char __res;
 154
 155         while (1) {
 156                 if ((__res = *cs - *ct++) != 0 || !*cs++)
 157                         break;
 158         }
 159
 160         return __res;
 161 }
 162 #endif
 163
 164 #ifndef __HAVE_ARCH_STRNCMP
 165 /**
 166  * strncmp - Compare two length-limited strings
 167  * @cs: One string
 168  * @ct: Another string
 169  * @count: The maximum number of bytes to compare
 170  */
 171 int strncmp(const char * cs,const char * ct,size_t count)
 172 {
 173         register signed char __res = 0;
 174
 175         while (count) {
 176                 if ((__res = *cs - *ct++) != 0 || !*cs++)
 177                         break;
 178                 count--;
 179         }
 180
 181         return __res;
 182 }
 183 #endif
 184
 185 #ifndef __HAVE_ARCH_STRCHR
 186 /**
 187  * strchr - Find the first occurrence of a character in a string
 188  * @s: The string to be searched
 189  * @c: The character to search for
 190  */
 191 char * strchr(const char * s, int c)
 192 {
 193         for(; *s != (char) c; ++s)
 194                 if (*s == '\0')
 195                         return NULL;
 196         return (char *) s;
 197 }
 198 #endif
 199
 200 #ifndef __HAVE_ARCH_STRRCHR
 201 /**
 202  * strrchr - Find the last occurrence of a character in a string
 203  * @s: The string to be searched
 204  * @c: The character to search for
 205  */
 206 char * strrchr(const char * s, int c)
 207 {
 208        const char *p = s + strlen(s);
 209        do {
 210            if (*p == (char)c)
 211                return (char *)p;
 212        } while (--p >= s);
 213        return NULL;
 214 }
 215 #endif
 216
 217 #ifndef __HAVE_ARCH_STRLEN
 218 /**
 219  * strlen - Find the length of a string
 220  * @s: The string to be sized
 221  */
 222 size_t strlen(const char * s)
 223 {
 224         const char *sc;
 225
 226         for (sc = s; *sc != '\0'; ++sc)
 227                 /* nothing */;
 228         return sc - s;
 229 }
 230 #endif
 231
 232 #ifndef __HAVE_ARCH_STRNLEN
 233 /**
 234  * strnlen - Find the length of a length-limited string
 235  * @s: The string to be sized
 236  * @count: The maximum number of bytes to search
 237  */
 238 size_t strnlen(const char * s, size_t count)
 239 {
 240         const char *sc;
 241
 242         for (sc = s; count-- && *sc != '\0'; ++sc)
 243                 /* nothing */;
 244         return sc - s;
 245 }
 246 #endif
 247
 248 #ifndef __HAVE_ARCH_STRDUP
 249 char * strdup(const char *s)
 250 {
 251         char *new;
 252
 253         if ((s == NULL) ||
 254             ((new = malloc (strlen(s) + 1)) == NULL) ) {
 255                 return NULL;
 256         }
 257
 258         strcpy (new, s);
 259         return new;
 260 }
 261 #endif
 262
 263 #ifndef __HAVE_ARCH_STRSPN
 264 /**
 265  * strspn - Calculate the length of the initial substring of @s which only
 266  *      contain letters in @accept
 267  * @s: The string to be searched
 268  * @accept: The string to search for
 269  */
 270 size_t strspn(const char *s, const char *accept)
 271 {
 272         const char *p;
 273         const char *a;
 274         size_t count = 0;
 275
 276         for (p = s; *p != '\0'; ++p) {
 277                 for (a = accept; *a != '\0'; ++a) {
 278                         if (*p == *a)
 279                                 break;
 280                 }
 281                 if (*a == '\0')
 282                         return count;
 283                 ++count;
 284         }
 285
 286         return count;
 287 }
 288 #endif
 289
 290 #ifndef __HAVE_ARCH_STRPBRK
 291 /**
 292  * strpbrk - Find the first occurrence of a set of characters
 293  * @cs: The string to be searched
 294  * @ct: The characters to search for
 295  */
 296 char * strpbrk(const char * cs,const char * ct)
 297 {
 298         const char *sc1,*sc2;
 299
 300         for( sc1 = cs; *sc1 != '\0'; ++sc1) {
 301                 for( sc2 = ct; *sc2 != '\0'; ++sc2) {
 302                         if (*sc1 == *sc2)
 303                                 return (char *) sc1;
 304                 }
 305         }
 306         return NULL;
 307 }
 308 #endif
 309
 310 #ifndef __HAVE_ARCH_STRTOK
 311 /**
 312  * strtok - Split a string into tokens
 313  * @s: The string to be searched
 314  * @ct: The characters to search for
 315  *
 316  * WARNING: strtok is deprecated, use strsep instead.
 317  */
 318 char * strtok(char * s,const char * ct)
 319 {
 320         char *sbegin, *send;
 321
 322         sbegin  = s ? s : ___strtok;
 323         if (!sbegin) {
 324                 return NULL;
 325         }
 326         sbegin += strspn(sbegin,ct);
 327         if (*sbegin == '\0') {
 328                 ___strtok = NULL;
 329                 return( NULL );
 330         }
 331         send = strpbrk( sbegin, ct);
 332         if (send && *send != '\0')
 333                 *send++ = '\0';
 334         ___strtok = send;
 335         return (sbegin);
 336 }
 337 #endif
 338
 339 #ifndef __HAVE_ARCH_STRSEP
 340 /**
 341  * strsep - Split a string into tokens
 342  * @s: The string to be searched
 343  * @ct: The characters to search for
 344  *
 345  * strsep() updates @s to point after the token, ready for the next call.
 346  *
 347  * It returns empty tokens, too, behaving exactly like the libc function
 348  * of that name. In fact, it was stolen from glibc2 and de-fancy-fied.
 349  * Same semantics, slimmer shape. ;)
 350  */
 351 char * strsep(char **s, const char *ct)
 352 {
 353         char *sbegin = *s, *end;
 354
 355         if (sbegin == NULL)
 356                 return NULL;
 357
 358         end = strpbrk(sbegin, ct);
 359         if (end)
 360                 *end++ = '\0';
 361         *s = end;
 362
 363         return sbegin;
 364 }
 365 #endif
 366
 367 #ifndef __HAVE_ARCH_STRSWAB
 368 /**
 369  * strswab - swap adjacent even and odd bytes in %NUL-terminated string
 370  * s: address of the string
 371  *
 372  * returns the address of the swapped string or NULL on error. If
 373  * string length is odd, last byte is untouched.
 374  */
 375 char *strswab(const char *s)
 376 {
 377         char *p, *q;
 378
 379         if ((NULL == s) || ('\0' == *s)) {
 380                 return (NULL);
 381         }
 382
 383         for (p=(char *)s, q=p+1; (*p != '\0') && (*q != '\0'); p+=2, q+=2) {
 384                 char  tmp;
 385
 386                 tmp = *p;
 387                 *p  = *q;
 388                 *q  = tmp;
 389         }
 390
 391         return (char *) s;
 392 }
 393 #endif
 394
 395 #ifndef __HAVE_ARCH_MEMSET
 396 /**
 397  * memset - Fill a region of memory with the given value
 398  * @s: Pointer to the start of the area.
 399  * @c: The byte to fill the area with
 400  * @count: The size of the area.
 401  *
 402  * Do not use memset() to access IO space, use memset_io() instead.
 403  */
 404 void * memset(void * s,int c,size_t count)
 405 {
 406         unsigned long *sl = (unsigned long *) s;
 407         unsigned long cl = 0;
 408         char *s8;
 409         int i;
 410
 411         /* do it one word at a time (32 bits or 64 bits) while possible */
 412         if ( ((ulong)s & (sizeof(*sl) - 1)) == 0) {
 413                 for (i = 0; i < sizeof(*sl); i++) {
 414                         cl <<= 8;
 415                         cl |= c & 0xff;
 416                 }
 417                 while (count >= sizeof(*sl)) {
 418                         *sl++ = cl;
 419                         count -= sizeof(*sl);
 420                 }
 421         }
 422         /* fill 8 bits at a time */
 423         s8 = (char *)sl;
 424         while (count--)
 425                 *s8++ = c;
 426
 427         return s;
 428 }
 429 #endif
 430
 431 #ifndef __HAVE_ARCH_BCOPY
 432 /**
 433  * bcopy - Copy one area of memory to another
 434  * @src: Where to copy from
 435  * @dest: Where to copy to
 436  * @count: The size of the area.
 437  *
 438  * Note that this is the same as memcpy(), with the arguments reversed.
 439  * memcpy() is the standard, bcopy() is a legacy BSD function.
 440  *
 441  * You should not use this function to access IO space, use memcpy_toio()
 442  * or memcpy_fromio() instead.
 443  */
 444 char * bcopy(const char * src, char * dest, int count)
 445 {
 446         char *tmp = dest;
 447
 448         while (count--)
 449                 *tmp++ = *src++;
 450
 451         return dest;
 452 }
 453 #endif
 454
 455 #ifndef __HAVE_ARCH_MEMCPY
 456 /**
 457  * memcpy - Copy one area of memory to another
 458  * @dest: Where to copy to
 459  * @src: Where to copy from
 460  * @count: The size of the area.
 461  *
 462  * You should not use this function to access IO space, use memcpy_toio()
 463  * or memcpy_fromio() instead.
 464  */
 465 void * memcpy(void *dest, const void *src, size_t count)
 466 {
 467         unsigned long *dl = (unsigned long *)dest, *sl = (unsigned long *)src;
 468         char *d8, *s8;
 469
 470         /* while all data is aligned (common case), copy a word at a time */
 471         if ( (((ulong)dest | (ulong)src) & (sizeof(*dl) - 1)) == 0) {
 472                 while (count >= sizeof(*dl)) {
 473                         *dl++ = *sl++;
 474                         count -= sizeof(*dl);
 475                 }
 476         }
 477         /* copy the reset one byte at a time */
 478         d8 = (char *)dl;
 479         s8 = (char *)sl;
 480         while (count--)
 481                 *d8++ = *s8++;
 482
 483         return dest;
 484 }
 485 #endif
 486
 487 #ifndef __HAVE_ARCH_MEMMOVE
 488 /**
 489  * memmove - Copy one area of memory to another
 490  * @dest: Where to copy to
 491  * @src: Where to copy from
 492  * @count: The size of the area.
 493  *
 494  * Unlike memcpy(), memmove() copes with overlapping areas.
 495  */
 496 void * memmove(void * dest,const void *src,size_t count)
 497 {
 498         char *tmp, *s;
 499
 500         if (dest <= src) {
 501                 tmp = (char *) dest;
 502                 s = (char *) src;
 503                 while (count--)
 504                         *tmp++ = *s++;
 505                 }
 506         else {
 507                 tmp = (char *) dest + count;
 508                 s = (char *) src + count;
 509                 while (count--)
 510                         *--tmp = *--s;
 511                 }
 512
 513         return dest;
 514 }
 515 #endif
 516
 517 #ifndef __HAVE_ARCH_MEMCMP
 518 /**
 519  * memcmp - Compare two areas of memory
 520  * @cs: One area of memory
 521  * @ct: Another area of memory
 522  * @count: The size of the area.
 523  */
 524 int memcmp(const void * cs,const void * ct,size_t count)
 525 {
 526         const unsigned char *su1, *su2;
 527         int res = 0;
 528
 529         for( su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
 530                 if ((res = *su1 - *su2) != 0)
 531                         break;
 532         return res;
 533 }
 534 #endif
 535
 536 #ifndef __HAVE_ARCH_MEMSCAN
 537 /**
 538  * memscan - Find a character in an area of memory.
 539  * @addr: The memory area
 540  * @c: The byte to search for
 541  * @size: The size of the area.
 542  *
 543  * returns the address of the first occurrence of @c, or 1 byte past
 544  * the area if @c is not found
 545  */
 546 void * memscan(void * addr, int c, size_t size)
 547 {
 548         unsigned char * p = (unsigned char *) addr;
 549
 550         while (size) {
 551                 if (*p == c)
 552                         return (void *) p;
 553                 p++;
 554                 size--;
 555         }
 556         return (void *) p;
 557 }
 558 #endif
 559
 560 #ifndef __HAVE_ARCH_STRSTR
 561 /**
 562  * strstr - Find the first substring in a %NUL terminated string
 563  * @s1: The string to be searched
 564  * @s2: The string to search for
 565  */
 566 char * strstr(const char * s1,const char * s2)
 567 {
 568         int l1, l2;
 569
 570         l2 = strlen(s2);
 571         if (!l2)
 572                 return (char *) s1;
 573         l1 = strlen(s1);
 574         while (l1 >= l2) {
 575                 l1--;
 576                 if (!memcmp(s1,s2,l2))
 577                         return (char *) s1;
 578                 s1++;
 579         }
 580         return NULL;
 581 }
 582 #endif
 583
 584 #ifndef __HAVE_ARCH_MEMCHR
 585 /**
 586  * memchr - Find a character in an area of memory.
 587  * @s: The memory area
 588  * @c: The byte to search for
 589  * @n: The size of the area.
 590  *
 591  * returns the address of the first occurrence of @c, or %NULL
 592  * if @c is not found
 593  */
 594 void *memchr(const void *s, int c, size_t n)
 595 {
 596         const unsigned char *p = s;
 597         while (n-- != 0) {
 598                 if ((unsigned char)c == *p++) {
 599                         return (void *)(p-1);
 600                 }
 601         }
 602         return NULL;
 603 }
 604
 605 #endif