Subversion Repositories openrisc_2011-10-31

/*
    string.h -- String manipulation
    Implements (some) of the standard string routines
    Copyright (C) 2002 Richard Herveille, rherveille@opencores.org
 
    This file is part of OpenRISC 1000 Reference Platform Monitor (ORPmon)
 
    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version
 
    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.
 
    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
 
#include <stddef.h>
#include "string.h"
 
/* Basic string functions */
 
/*
  s t r l e n
 
  returns number of characters in s (not including terminating null character)
*/
size_t strlen(const char *s)
{
  size_t cnt = 0;
 
  /* count the length of string s, not including the \0 character */
  while (*s++)
    cnt++;
 
  return cnt;
}
 
/*
  s t r c p y
 
  Copy 'src' to 'dest'. Strings may not overlap.
*/
char *strcpy(char *dest, const char *src)
{
  char *d = dest;
 
  /* copy src to dest */
  while ( (*dest++ = *src++) )
  ;
 
  return d;
}
 
 
char *strncpy(char *dest, const char *src, size_t n)
{
  char *d = dest;
 
  /* copy src to dest */
  while ( *src && n ) {
    *dest++ = *src++;
    n--;
  }
 
  /* fill the remainder of d with nulls */
  while (n--)
    *dest++ = '\0';
 
  return d;
}
 
 
char *strcat(char *dest, const char *src)
{
  char *d = dest;
 
  /* find the end of the destination string */
  while (*dest++)
  ;
 
  /* append the source string to the destination string */
  while ( (*dest++ = *src++) )
  ;
 
  return d;
}
 
 
char *strncat(char *dest, const char *src, size_t n)
{
  char *d = dest;
 
  /* find the end of the destination string */
  while (*dest++)
  ;
 
  /* copy src to dest */
  while ( (*dest = *src) && n-- ) {
    dest++;
    src++;
  }
 
 
  /* add terminating '\0' character */
  *dest = '\0';
 
  return d;
}
 
 
int strcmp(const char *s1, const char *s2)
{
  while ( *s1 && (*s1 == *s2) ) {
    s1++;
    s2++;
  }
 
  return *s1 - *s2;
}
 
 
int strncmp(const char *s1, const char *s2, size_t n)
{
  while ( *s1 && (*s1 == *s2) && n-- ) {
    s1++;
    s2++;
  }
 
  return *s1 - *s2;
}
 
 
char *strchr(const char *s, int c)
{
  /* search for the character c */
  while (*s && (*s != c) )
    s++;
 
  return (char *)s;
}
 
 
char *strrchr(const char *s, int c)
{
  char *fnd = NULL;
 
  /* search for the character c */
  while (*s) {
    if (*s == c)
      fnd = (char *)s;
    s++;
  }
 
  return fnd;
}
 
 
/* Basic mem functions */
void *memcpy(void *dest, const void *src, size_t n)
{
  /* check if 'src' and 'dest' are on LONG boundaries */
  if ( (sizeof(unsigned long) -1) & ((unsigned long)dest | (unsigned long)src) )
  {
      /* no, do a byte-wide copy */
      char *cs = (char *) src;
      char *cd = (char *) dest;
 
      while (n--)
          *cd++ = *cs++;
  }
  else
  {
      /* yes, speed up copy process */
      /* copy as many LONGs as possible */
      long *ls = (long *)src;
      long *ld = (long *)dest;
 
      size_t cnt = n >> 2;
      while (cnt--)
        *ld++ = *ls++;
 
      /* finally copy the remaining bytes */
      char *cs = (char *) (src + (n & ~0x03));
      char *cd = (char *) (dest + (n & ~0x03));
 
      cnt = n & 0x3;
      while (cnt--)
        *cd++ = *cs++;
  }
 
  return dest;
}
 
/* memcpy, return  checksum of bytes copied instead of pointer to dest */
unsigned char memcpy_crc(void *dest, const void *src, size_t n)
{
  unsigned char sum = 0;
  unsigned char tmp;
 
  char *cs = (char *) src;
  char *cd = (char *) dest;
 
  while (n--)
    {
      tmp = *cs++;
      sum += tmp;
      *cd++ = tmp;
    }
  return sum;
}
 
void *memmove(void *dest, void *src, size_t n)
{
  char *d = dest;
  char *s = src;
 
  while (n--)
    *d++ = *s++;
 
  return dest;
}
 
 
int memcmp(const void *s1, const void *s2, size_t n)
{
  char *p1 = (void *)s1;
  char *p2 = (void *)s2;
 
  while ( (*p1 == *p2) && n-- ) {
    p1++;
    p2++;
  }
 
  return *p1 - *p2;
}
 
 
void *memchr(const void *s, char c, size_t n)
{
  char *p = (void *)s;
 
  /* search for the character c */
  while ( (*p != c) && n-- )
    p++;
 
  return (*p == c) ? p : NULL;
}
 
 
void *memset(void *s, int c, size_t n)
{
  char *p = s;
 
  while (n--)
    *p++ = c;
 
  return s;
}