/* Copyright (C) 2004 David Decotigny (with INSA Rennes for vsnprintf)
Copyright (C) 2003 The KOS Team
Copyright (C) 1999 Free Software Foundation
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., 59 Temple Place - Suite 330, Boston, MA 02111-1307,
USA.
*/
#include "klibc.h"
/* For an optimized version, see BSD sources ;) */
void *memcpy(void *dst0, const void *src0, register unsigned int size)
{
char *dst;
const char *src;
for (dst = (char*)dst0, src = (const char*)src0 ;
size > 0 ;
dst++, src++, size--)
*dst = *src;
return dst0;
}
/* ditto */
void *memset(void *dst0, register int c, register unsigned int length)
{
char *dst;
for (dst = (char*) dst0 ;
length > 0 ;
dst++, length --)
*dst = (char)c;
return dst0;
}
int memcmp(const void *s1, const void *s2, sos_size_t len)
{
const unsigned char *c1, *c2;
unsigned int i;
for (i = 0, c1 = s1, c2 = s2; i < len; i++, c1++, c2++)
{
if(*c1 != *c2)
return *c1 - *c2;
}
return 0;
}
unsigned int strlen(register const char *str)
{
unsigned int retval = 0;
while (*str++)
retval++;
return retval;
}
unsigned int strnlen(const char * s, sos_size_t count)
{
const char *sc;
for (sc = s; count-- && *sc != '\0'; ++sc)
/* nothing */continue;
return sc - s;
}
char *strzcpy(register char *dst, register const char *src, register int len)
{
int i;
if (len <= 0)
return dst;
for (i = 0; i < len; i++)
{
dst[i] = src[i];
if(src[i] == '\0')
return dst;
}
dst[len-1] = '\0';
return dst;
}
char *strzcat (char *dest, const char *src, sos_size_t n)
{
char *res = dest;
for ( ; *dest ; dest++);
for ( ; *src ; src++, dest++) {
*dest = *src;
n--;
if (n <= 0)
break;
}
*dest = '\0';
return res;
}
int strcmp(register const char *s1, register const char *s2)
{
while (*s1 == *s2++)
if (*s1++ == 0)
return (0);
return (*(const unsigned char *)s1 - *(const unsigned char *)(s2 - 1));
}
int strncmp(register const char *s1, register const char *s2, register int len)
{
char c1 = '\0', c2 = '\0';
while (len > 0)
{
c1 = (unsigned char) *s1++;
c2 = (unsigned char) *s2++;
if (c1 == '\0' || c1 != c2)
return c1 - c2;
len--;
}
return c1 - c2;
}
/* I (d2) borrowed and rewrote this for Nachos/INSA Rennes. Thanks to
them for having kindly allowed me to do so. */
int vsnprintf(char *buff, sos_size_t len, const char * format, va_list ap)
{
sos_size_t i, result;
if (!buff || !format || (len < 0))
return -1;
#define PUTCHAR(thechar) \
do { \
if (result < len-1) \
*buff++ = (thechar); \
result++; \
} while (0)
result = 0;
for(i=0 ; format[i] != '\0' ; i++){
switch (format[i])
{
case '%':
i++;
switch(format[i])
{
case '%':
{
PUTCHAR('%');
break;
}
case 'i':;
case 'd':
{
int integer = va_arg(ap,int);
int cpt2 = 0;
char buff_int[16];
if (integer<0)
PUTCHAR('-');
/* Ne fait pas integer = -integer ici parce que INT_MIN
n'a pas d'equivalent positif (int = [-2^31, 2^31-1]) */
do {
int m10 = integer%10;
m10 = (m10 < 0)? -m10:m10;
buff_int[cpt2++]=(char)('0'+ m10);
integer=integer/10;
} while(integer!=0);
for(cpt2 = cpt2 - 1 ; cpt2 >= 0 ; cpt2--)
PUTCHAR(buff_int[cpt2]);
break;
}
case 'c':
{
int value = va_arg(ap,int);
PUTCHAR((char)value);
break;
}
case 's':
{
char *string = va_arg(ap,char *);
if (! string)
string = "(null)";
for( ; *string != '\0' ; string++)
PUTCHAR(*string);
break;
}
case 'x':
{
unsigned int hexa = va_arg(ap,int);
unsigned int nb;
int i, had_nonzero = 0;
for(i=0 ; i < 8 ; i++)
{
nb = (unsigned int)(hexa << (i*4));
nb = (nb >> 28) & 0xf;
// Skip the leading zeros
if (nb == 0)
{
if (had_nonzero)
PUTCHAR('0');
}
else
{
had_nonzero = 1;
if (nb < 10)
PUTCHAR('0'+nb);
else
PUTCHAR('a'+(nb-10));
}
}
if (! had_nonzero)
PUTCHAR('0');
break;
}
break;
default:
PUTCHAR('%');
PUTCHAR(format[i]);
}
break;
default:
PUTCHAR(format[i]);
}
}
*buff = '\0';
return result;
}
int snprintf(char * buff, sos_size_t len, const char *format, ...)
{
va_list ap;
va_start(ap, format);
len = vsnprintf(buff, len, format, ap);
va_end(ap);
return len;
}