/* 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;
 }