arch/x86_64-pc/bootstrap/support.c

   1 /*
   2     Copyright (C) 2006 The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: A very primitive clib replacements.
   6     Lang: English
   7 */
   8
   9 #include "support.h"
  10
  11 void *memset(void *ptr, int c, long len)
  12 {
  13     void *p = ptr;
  14     long c32 = c | (c << 8) | (c << 16) | (c << 24);
  15
  16     while (len >= 4)
  17     {
  18         *(unsigned long *)ptr = c32;
  19         len-=4;
  20         ptr+=4;
  21     }
  22     if (len >= 2)
  23     {
  24         *(unsigned short *)ptr = c32;
  25         ptr+=2;
  26         len-=2;
  27     }
  28     if (len == 1)
  29     {
  30         *(unsigned char *)ptr = c32;
  31     }
  32     return p;
  33 }
  34
  35 void *bzero(void *ptr, long len)
  36 {
  37     return memset(ptr, 0, len);
  38 }
  39
  40 void memcpy(void *dest, const void *src, long len)
  41 {
  42     while (len >= 4)
  43     {
  44         *(unsigned long *)dest = *(unsigned long *)src;
  45         len-=4;
  46         dest+=4;
  47         src+=4;
  48     }
  49     if (len >= 2)
  50     {
  51         *(unsigned short *)dest = *(unsigned short *)src;
  52         dest+=2;
  53         src+=2;
  54         len-=2;
  55     }
  56     if (len == 1)
  57     {
  58         *(unsigned char *)dest = *(unsigned char *)src;
  59     }
  60 }
  61
  62 int strncmp(const char *s1, const char*s2, long length)
  63 {
  64     if (!length)
  65         return 0;
  66
  67     while (length-- && *s1 && *s2)
  68     {
  69         if (*s1 != *s2) return (*s1-*s2);
  70         s1++; s2++;
  71     }
  72     return 0;
  73 }
  74
  75 int strlen(const char *s)
  76 {
  77     int len=0;
  78     while(*s++ != 0) len++;
  79     return len;
  80 }
  81
  82 const char *remove_path(const char *in)
  83 {
  84     const char *p = &in[strlen(in)-1];
  85     while (p > in && p[-1] != '/' && p[-1] != ':') p--;
  86     return p;
  87 }
  88
  89 char *strstr (const char * str, const char * search)
  90 {
  91     long done;
  92     long len_s = strlen(search);
  93     const char * t;
  94
  95     do
  96     {
  97         if (*search == *str)
  98         {
  99             done = len_s;
 100
 101             t = search + 1;
 102             str++;
 103
 104             while ((--done) && (*t == *str))
 105             {
 106                 t++;
 107                 str++;
 108             }
 109
 110             if (!done)
 111             {
 112                 str -= len_s;
 113                 return ((char *)str);
 114             }
 115             else
 116             {
 117                 str -= len_s - done;
 118             }
 119         }
 120     } while (*str++);
 121
 122     return(0);
 123 }
 124