341 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			341 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 *  linux/lib/string.c
 | 
						|
 *
 | 
						|
 *  Copyright (C) 1991, 1992  Linus Torvalds
 | 
						|
 */
 | 
						|
 | 
						|
/*
 | 
						|
 * stupid library routines.. The optimized versions should generally be found
 | 
						|
 * as inline code in <asm-xx/string.h>
 | 
						|
 *
 | 
						|
 * These are buggy as well..
 | 
						|
 */
 | 
						|
 | 
						|
#include <linux/types.h>
 | 
						|
#include <linux/string.h>
 | 
						|
#include <malloc.h>
 | 
						|
 | 
						|
#define __HAVE_ARCH_BCOPY
 | 
						|
#define __HAVE_ARCH_MEMCMP
 | 
						|
#define __HAVE_ARCH_MEMCPY
 | 
						|
#define __HAVE_ARCH_MEMMOVE
 | 
						|
#define __HAVE_ARCH_MEMSET
 | 
						|
#define __HAVE_ARCH_STRCAT
 | 
						|
#define __HAVE_ARCH_STRCMP
 | 
						|
#define __HAVE_ARCH_STRCPY
 | 
						|
#define __HAVE_ARCH_STRLEN
 | 
						|
#define __HAVE_ARCH_STRNCPY
 | 
						|
 | 
						|
char * ___strtok = NULL;
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRCPY
 | 
						|
char * strcpy(char * dest,const char *src)
 | 
						|
{
 | 
						|
	char *tmp = dest;
 | 
						|
 | 
						|
	while ((*dest++ = *src++) != '\0')
 | 
						|
		/* nothing */;
 | 
						|
	return tmp;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRNCPY
 | 
						|
char * strncpy(char * dest,const char *src,size_t count)
 | 
						|
{
 | 
						|
	char *tmp = dest;
 | 
						|
 | 
						|
	while (count-- && (*dest++ = *src++) != '\0')
 | 
						|
		/* nothing */;
 | 
						|
 | 
						|
	return tmp;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRCAT
 | 
						|
char * strcat(char * dest, const char * src)
 | 
						|
{
 | 
						|
	char *tmp = dest;
 | 
						|
 | 
						|
	while (*dest)
 | 
						|
		dest++;
 | 
						|
	while ((*dest++ = *src++) != '\0')
 | 
						|
		;
 | 
						|
 | 
						|
	return tmp;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRNCAT
 | 
						|
char * strncat(char *dest, const char *src, size_t count)
 | 
						|
{
 | 
						|
	char *tmp = dest;
 | 
						|
 | 
						|
	if (count) {
 | 
						|
		while (*dest)
 | 
						|
			dest++;
 | 
						|
		while ((*dest++ = *src++)) {
 | 
						|
			if (--count == 0) {
 | 
						|
				*dest = '\0';
 | 
						|
				break;
 | 
						|
			}
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	return tmp;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRCMP
 | 
						|
int strcmp(const char * cs,const char * ct)
 | 
						|
{
 | 
						|
	register signed char __res;
 | 
						|
 | 
						|
	while (1) {
 | 
						|
		if ((__res = *cs - *ct++) != 0 || !*cs++)
 | 
						|
			break;
 | 
						|
	}
 | 
						|
 | 
						|
	return __res;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRNCMP
 | 
						|
int strncmp(const char * cs,const char * ct,size_t count)
 | 
						|
{
 | 
						|
	register signed char __res = 0;
 | 
						|
 | 
						|
	while (count) {
 | 
						|
		if ((__res = *cs - *ct++) != 0 || !*cs++)
 | 
						|
			break;
 | 
						|
		count--;
 | 
						|
	}
 | 
						|
 | 
						|
	return __res;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRCHR
 | 
						|
char * strchr(const char * s, int c)
 | 
						|
{
 | 
						|
	for(; *s != (char) c; ++s)
 | 
						|
		if (*s == '\0')
 | 
						|
			return NULL;
 | 
						|
	return (char *) s;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRRCHR
 | 
						|
char * strrchr(const char * s, int c)
 | 
						|
{
 | 
						|
       const char *p = s + strlen(s);
 | 
						|
       do {
 | 
						|
	   if (*p == (char)c)
 | 
						|
	       return (char *)p;
 | 
						|
       } while (--p >= s);
 | 
						|
       return NULL;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRLEN
 | 
						|
size_t strlen(const char * s)
 | 
						|
{
 | 
						|
	const char *sc;
 | 
						|
 | 
						|
	for (sc = s; *sc != '\0'; ++sc)
 | 
						|
		/* nothing */;
 | 
						|
	return sc - s;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRNLEN
 | 
						|
size_t strnlen(const char * s, size_t count)
 | 
						|
{
 | 
						|
	const char *sc;
 | 
						|
 | 
						|
	for (sc = s; count-- && *sc != '\0'; ++sc)
 | 
						|
		/* nothing */;
 | 
						|
	return sc - s;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRDUP
 | 
						|
char * strdup(const char *s)
 | 
						|
{
 | 
						|
	char *new;
 | 
						|
 | 
						|
	if ((s == NULL)	||
 | 
						|
	    ((new = malloc (strlen(s) + 1)) == NULL) ) {
 | 
						|
		return NULL;
 | 
						|
	}
 | 
						|
 | 
						|
	strcpy (new, s);
 | 
						|
	return new;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRSPN
 | 
						|
size_t strspn(const char *s, const char *accept)
 | 
						|
{
 | 
						|
	const char *p;
 | 
						|
	const char *a;
 | 
						|
	size_t count = 0;
 | 
						|
 | 
						|
	for (p = s; *p != '\0'; ++p) {
 | 
						|
		for (a = accept; *a != '\0'; ++a) {
 | 
						|
			if (*p == *a)
 | 
						|
				break;
 | 
						|
		}
 | 
						|
		if (*a == '\0')
 | 
						|
			return count;
 | 
						|
		++count;
 | 
						|
	}
 | 
						|
 | 
						|
	return count;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRPBRK
 | 
						|
char * strpbrk(const char * cs,const char * ct)
 | 
						|
{
 | 
						|
	const char *sc1,*sc2;
 | 
						|
 | 
						|
	for( sc1 = cs; *sc1 != '\0'; ++sc1) {
 | 
						|
		for( sc2 = ct; *sc2 != '\0'; ++sc2) {
 | 
						|
			if (*sc1 == *sc2)
 | 
						|
				return (char *) sc1;
 | 
						|
		}
 | 
						|
	}
 | 
						|
	return NULL;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRTOK
 | 
						|
char * strtok(char * s,const char * ct)
 | 
						|
{
 | 
						|
	char *sbegin, *send;
 | 
						|
 | 
						|
	sbegin  = s ? s : ___strtok;
 | 
						|
	if (!sbegin) {
 | 
						|
		return NULL;
 | 
						|
	}
 | 
						|
	sbegin += strspn(sbegin,ct);
 | 
						|
	if (*sbegin == '\0') {
 | 
						|
		___strtok = NULL;
 | 
						|
		return( NULL );
 | 
						|
	}
 | 
						|
	send = strpbrk( sbegin, ct);
 | 
						|
	if (send && *send != '\0')
 | 
						|
		*send++ = '\0';
 | 
						|
	___strtok = send;
 | 
						|
	return (sbegin);
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_MEMSET
 | 
						|
void * memset(void * s,char c,size_t count)
 | 
						|
{
 | 
						|
	char *xs = (char *) s;
 | 
						|
 | 
						|
	while (count--)
 | 
						|
		*xs++ = c;
 | 
						|
 | 
						|
	return s;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_BCOPY
 | 
						|
char * bcopy(const char * src, char * dest, int count)
 | 
						|
{
 | 
						|
	char *tmp = dest;
 | 
						|
 | 
						|
	while (count--)
 | 
						|
		*tmp++ = *src++;
 | 
						|
 | 
						|
	return dest;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_MEMCPY
 | 
						|
void * memcpy(void * dest,const void *src,size_t count)
 | 
						|
{
 | 
						|
	char *tmp = (char *) dest, *s = (char *) src;
 | 
						|
 | 
						|
	while (count--)
 | 
						|
		*tmp++ = *s++;
 | 
						|
 | 
						|
	return dest;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_MEMMOVE
 | 
						|
void * memmove(void * dest,const void *src,size_t count)
 | 
						|
{
 | 
						|
	char *tmp, *s;
 | 
						|
 | 
						|
	if (dest <= src) {
 | 
						|
		tmp = (char *) dest;
 | 
						|
		s = (char *) src;
 | 
						|
		while (count--)
 | 
						|
			*tmp++ = *s++;
 | 
						|
		}
 | 
						|
	else {
 | 
						|
		tmp = (char *) dest + count;
 | 
						|
		s = (char *) src + count;
 | 
						|
		while (count--)
 | 
						|
			*--tmp = *--s;
 | 
						|
		}
 | 
						|
 | 
						|
	return dest;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_MEMCMP
 | 
						|
int memcmp(const void * cs,const void * ct,size_t count)
 | 
						|
{
 | 
						|
	const unsigned char *su1, *su2;
 | 
						|
	signed char res = 0;
 | 
						|
 | 
						|
	for( su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
 | 
						|
		if ((res = *su1 - *su2) != 0)
 | 
						|
			break;
 | 
						|
	return res;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*
 | 
						|
 * find the first occurrence of byte 'c', or 1 past the area if none
 | 
						|
 */
 | 
						|
#ifndef __HAVE_ARCH_MEMSCAN
 | 
						|
void * memscan(void * addr, int c, size_t size)
 | 
						|
{
 | 
						|
	unsigned char * p = (unsigned char *) addr;
 | 
						|
 | 
						|
	while (size) {
 | 
						|
		if (*p == c)
 | 
						|
			return (void *) p;
 | 
						|
		p++;
 | 
						|
		size--;
 | 
						|
	}
 | 
						|
	return (void *) p;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
#ifndef __HAVE_ARCH_STRSTR
 | 
						|
char * strstr(const char * s1,const char * s2)
 | 
						|
{
 | 
						|
	int l1, l2;
 | 
						|
 | 
						|
	l2 = strlen(s2);
 | 
						|
	if (!l2)
 | 
						|
		return (char *) s1;
 | 
						|
	l1 = strlen(s1);
 | 
						|
	while (l1 >= l2) {
 | 
						|
		l1--;
 | 
						|
		if (!memcmp(s1,s2,l2))
 | 
						|
			return (char *) s1;
 | 
						|
		s1++;
 | 
						|
	}
 | 
						|
	return NULL;
 | 
						|
}
 | 
						|
#endif
 |