Navigation
- Accueil
- Présentation :
- FAQ
- Bugs et errata
- Contributions de lecteurs
- Téléchargements
- LXR (référencement des sources)
- Mailing-list
- Liens et Projets reliés
Site hébergé par :
Site hébergé par :
|
[ source navigation ] [ diff markup ] [ identifier search ] [ general search ] |
|||
|
||||
001 /* Copyright (C) 2004 David Decotigny (with I 001 /* Copyright (C) 2004 David Decotigny (with INSA Rennes for vsnprintf) 002 Copyright (C) 2003 The KOS Team 002 Copyright (C) 2003 The KOS Team 003 Copyright (C) 1999 Free Software Foundatio 003 Copyright (C) 1999 Free Software Foundation 004 004 005 This program is free software; you can redi 005 This program is free software; you can redistribute it and/or 006 modify it under the terms of the GNU Genera 006 modify it under the terms of the GNU General Public License 007 as published by the Free Software Foundatio 007 as published by the Free Software Foundation; either version 2 008 of the License, or (at your option) any lat 008 of the License, or (at your option) any later version. 009 009 010 This program is distributed in the hope tha 010 This program is distributed in the hope that it will be useful, 011 but WITHOUT ANY WARRANTY; without even the 011 but WITHOUT ANY WARRANTY; without even the implied warranty of 012 MERCHANTABILITY or FITNESS FOR A PARTICULAR 012 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 013 GNU General Public License for more details 013 GNU General Public License for more details. 014 014 015 You should have received a copy of the GNU 015 You should have received a copy of the GNU General Public License 016 along with this program; if not, write to t 016 along with this program; if not, write to the Free Software 017 Foundation, Inc., 59 Temple Place - Suite 3 017 Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, 018 USA. 018 USA. 019 */ 019 */ 020 #include "klibc.h" 020 #include "klibc.h" 021 021 022 /* For an optimized version, see BSD sources ; 022 /* For an optimized version, see BSD sources ;) */ 023 void *memcpy(void *dst0, const void *src0, reg 023 void *memcpy(void *dst0, const void *src0, register unsigned int size) 024 { 024 { 025 char *dst; 025 char *dst; 026 const char *src; 026 const char *src; 027 for (dst = (char*)dst0, src = (const char*)s 027 for (dst = (char*)dst0, src = (const char*)src0 ; 028 size > 0 ; 028 size > 0 ; 029 dst++, src++, size--) 029 dst++, src++, size--) 030 *dst = *src; 030 *dst = *src; 031 return dst0; 031 return dst0; 032 } 032 } 033 033 034 /* ditto */ 034 /* ditto */ 035 void *memset(void *dst0, register int c, regis 035 void *memset(void *dst0, register int c, register unsigned int length) 036 { 036 { 037 char *dst; 037 char *dst; 038 for (dst = (char*) dst0 ; 038 for (dst = (char*) dst0 ; 039 length > 0 ; 039 length > 0 ; 040 dst++, length --) 040 dst++, length --) 041 *dst = (char)c; 041 *dst = (char)c; 042 return dst0; 042 return dst0; 043 } 043 } 044 044 045 int memcmp(const void *s1, const void *s2, sos 045 int memcmp(const void *s1, const void *s2, sos_size_t len) 046 { 046 { 047 const unsigned char *c1, *c2; 047 const unsigned char *c1, *c2; 048 unsigned int i; 048 unsigned int i; 049 049 050 for (i = 0, c1 = s1, c2 = s2; i < len; i++, 050 for (i = 0, c1 = s1, c2 = s2; i < len; i++, c1++, c2++) 051 { 051 { 052 if(*c1 != *c2) 052 if(*c1 != *c2) 053 return *c1 - *c2; 053 return *c1 - *c2; 054 } 054 } 055 055 056 return 0; 056 return 0; 057 } 057 } 058 058 059 059 060 unsigned int strlen(register const char *str) 060 unsigned int strlen(register const char *str) 061 { 061 { 062 unsigned int retval = 0; 062 unsigned int retval = 0; 063 063 064 while (*str++) 064 while (*str++) 065 retval++; 065 retval++; 066 066 067 return retval; 067 return retval; 068 } 068 } 069 069 070 070 071 unsigned int strnlen(const char * s, sos_size_ 071 unsigned int strnlen(const char * s, sos_size_t count) 072 { 072 { 073 const char *sc; 073 const char *sc; 074 074 075 for (sc = s; count-- && *sc != '\0'; ++sc) 075 for (sc = s; count-- && *sc != '\0'; ++sc) 076 /* nothing */continue; !! 076 /* nothing */; 077 << 078 return sc - s; 077 return sc - s; 079 } 078 } 080 079 081 080 082 char *strzcpy(register char *dst, register con 081 char *strzcpy(register char *dst, register const char *src, register int len) 083 { 082 { 084 int i; 083 int i; 085 << 086 if (len <= 0) << 087 return dst; << 088 084 089 for (i = 0; i < len; i++) 085 for (i = 0; i < len; i++) 090 { 086 { 091 dst[i] = src[i]; 087 dst[i] = src[i]; 092 if(src[i] == '\0') 088 if(src[i] == '\0') 093 return dst; 089 return dst; 094 } 090 } 095 091 096 dst[len-1] = '\0'; 092 dst[len-1] = '\0'; 097 return dst; 093 return dst; 098 } 094 } 099 << 100 095 101 char *strzcat (char *dest, const char *src, so 096 char *strzcat (char *dest, const char *src, sos_size_t n) 102 { 097 { 103 char *res = dest; 098 char *res = dest; 104 099 105 for ( ; *dest ; dest++); 100 for ( ; *dest ; dest++); 106 101 107 for ( ; *src ; src++, dest++) { 102 for ( ; *src ; src++, dest++) { 108 *dest = *src; 103 *dest = *src; 109 n--; 104 n--; 110 if (n <= 0) 105 if (n <= 0) 111 break; 106 break; 112 } 107 } 113 108 114 *dest = '\0'; 109 *dest = '\0'; 115 return res; 110 return res; 116 } 111 } 117 112 118 int strcmp(register const char *s1, register c 113 int strcmp(register const char *s1, register const char *s2) 119 { 114 { 120 while (*s1 == *s2++) 115 while (*s1 == *s2++) 121 if (*s1++ == 0) 116 if (*s1++ == 0) 122 return (0); 117 return (0); 123 118 124 return (*(const unsigned char *)s1 - *(const 119 return (*(const unsigned char *)s1 - *(const unsigned char *)(s2 - 1)); 125 } 120 } 126 121 127 122 128 int strncmp(register const char *s1, register 123 int strncmp(register const char *s1, register const char *s2, register int len) 129 { 124 { 130 char c1 = '\0', c2 = '\0'; 125 char c1 = '\0', c2 = '\0'; 131 126 132 while (len > 0) 127 while (len > 0) 133 { 128 { 134 c1 = (unsigned char) *s1++; 129 c1 = (unsigned char) *s1++; 135 c2 = (unsigned char) *s2++; 130 c2 = (unsigned char) *s2++; 136 if (c1 == '\0' || c1 != c2) 131 if (c1 == '\0' || c1 != c2) 137 return c1 - c2; 132 return c1 - c2; 138 len--; 133 len--; 139 } 134 } 140 135 141 return c1 - c2; 136 return c1 - c2; 142 } 137 } 143 138 144 139 145 /* I (d2) borrowed and rewrote this for Nachos 140 /* I (d2) borrowed and rewrote this for Nachos/INSA Rennes. Thanks to 146 them for having kindly allowed me to do so. 141 them for having kindly allowed me to do so. */ 147 int vsnprintf(char *buff, sos_size_t len, cons 142 int vsnprintf(char *buff, sos_size_t len, const char * format, va_list ap) 148 { 143 { 149 sos_size_t i, result; 144 sos_size_t i, result; 150 145 151 if (!buff || !format || (len < 0)) 146 if (!buff || !format || (len < 0)) 152 return -1; 147 return -1; 153 148 154 #define PUTCHAR(thechar) \ 149 #define PUTCHAR(thechar) \ 155 do { \ 150 do { \ 156 if (result < len-1) \ 151 if (result < len-1) \ 157 *buff++ = (thechar); \ 152 *buff++ = (thechar); \ 158 result++; \ 153 result++; \ 159 } while (0) 154 } while (0) 160 155 161 result = 0; 156 result = 0; 162 for(i=0 ; format[i] != '\0' ; i++){ 157 for(i=0 ; format[i] != '\0' ; i++){ 163 switch (format[i]) 158 switch (format[i]) 164 { 159 { 165 case '%': 160 case '%': 166 i++; 161 i++; 167 switch(format[i]) 162 switch(format[i]) 168 { 163 { 169 case '%': 164 case '%': 170 { 165 { 171 PUTCHAR('%'); 166 PUTCHAR('%'); 172 break; 167 break; 173 } 168 } 174 case 'i':; 169 case 'i':; 175 case 'd': 170 case 'd': 176 { 171 { 177 int integer = va_arg(ap,int); 172 int integer = va_arg(ap,int); 178 int cpt2 = 0; 173 int cpt2 = 0; 179 char buff_int[16]; 174 char buff_int[16]; 180 175 181 if (integer<0) 176 if (integer<0) 182 PUTCHAR('-'); 177 PUTCHAR('-'); 183 /* Ne fait pas integer = -intege 178 /* Ne fait pas integer = -integer ici parce que INT_MIN 184 n'a pas d'equivalent positif 179 n'a pas d'equivalent positif (int = [-2^31, 2^31-1]) */ 185 180 186 do { 181 do { 187 int m10 = integer%10; 182 int m10 = integer%10; 188 m10 = (m10 < 0)? -m10:m10; 183 m10 = (m10 < 0)? -m10:m10; 189 buff_int[cpt2++]=(char)('0'+ m 184 buff_int[cpt2++]=(char)('0'+ m10); 190 integer=integer/10; 185 integer=integer/10; 191 } while(integer!=0); 186 } while(integer!=0); 192 187 193 for(cpt2 = cpt2 - 1 ; cpt2 >= 0 188 for(cpt2 = cpt2 - 1 ; cpt2 >= 0 ; cpt2--) 194 PUTCHAR(buff_int[cpt2]); 189 PUTCHAR(buff_int[cpt2]); 195 190 196 break; 191 break; 197 } 192 } 198 193 199 case 'c': 194 case 'c': 200 { 195 { 201 int value = va_arg(ap,int); 196 int value = va_arg(ap,int); 202 PUTCHAR((char)value); 197 PUTCHAR((char)value); 203 break; 198 break; 204 } 199 } 205 200 206 case 's': 201 case 's': 207 { 202 { 208 char *string = va_arg(ap,char *) 203 char *string = va_arg(ap,char *); 209 if (! string) 204 if (! string) 210 string = "(null)"; 205 string = "(null)"; 211 for( ; *string != '\0' ; string+ 206 for( ; *string != '\0' ; string++) 212 PUTCHAR(*string); 207 PUTCHAR(*string); 213 break; 208 break; 214 } 209 } 215 210 216 case 'x': 211 case 'x': 217 { 212 { 218 unsigned int hexa = va_arg(ap,in 213 unsigned int hexa = va_arg(ap,int); 219 unsigned int nb; 214 unsigned int nb; 220 int i, had_nonzero = 0; 215 int i, had_nonzero = 0; 221 for(i=0 ; i < 8 ; i++) 216 for(i=0 ; i < 8 ; i++) 222 { 217 { 223 nb = (unsigned int)(hexa << 218 nb = (unsigned int)(hexa << (i*4)); 224 nb = (nb >> 28) & 0xf; 219 nb = (nb >> 28) & 0xf; 225 // Skip the leading zeros 220 // Skip the leading zeros 226 if (nb == 0) 221 if (nb == 0) 227 { 222 { 228 if (had_nonzero) 223 if (had_nonzero) 229 PUTCHAR('0'); 224 PUTCHAR('0'); 230 } 225 } 231 else 226 else 232 { 227 { 233 had_nonzero = 1; 228 had_nonzero = 1; 234 if (nb < 10) 229 if (nb < 10) 235 PUTCHAR('0'+nb); 230 PUTCHAR('0'+nb); 236 else 231 else 237 PUTCHAR('a'+(nb-10)); 232 PUTCHAR('a'+(nb-10)); 238 } 233 } 239 } 234 } 240 if (! had_nonzero) 235 if (! had_nonzero) 241 PUTCHAR('0'); 236 PUTCHAR('0'); 242 break; 237 break; 243 } 238 } 244 break; 239 break; 245 240 246 default: 241 default: 247 PUTCHAR('%'); 242 PUTCHAR('%'); 248 PUTCHAR(format[i]); 243 PUTCHAR(format[i]); 249 } 244 } 250 break; 245 break; 251 246 252 default: 247 default: 253 PUTCHAR(format[i]); 248 PUTCHAR(format[i]); 254 } 249 } 255 } 250 } 256 251 257 *buff = '\0'; 252 *buff = '\0'; 258 return result; 253 return result; 259 } 254 } 260 255 261 256 262 int snprintf(char * buff, sos_size_t len, cons 257 int snprintf(char * buff, sos_size_t len, const char *format, ...) 263 { 258 { 264 va_list ap; 259 va_list ap; 265 260 266 va_start(ap, format); 261 va_start(ap, format); 267 len = vsnprintf(buff, len, format, ap); 262 len = vsnprintf(buff, len, format, ap); 268 va_end(ap); 263 va_end(ap); 269 264 270 return len; 265 return len; 271 } 266 }
| [ source navigation ] | [ diff markup ] | [ identifier search ] | [ general search ] |