Subversion Repositories HelenOS-historic

Rev

Rev 1472 | Rev 1530 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1472 Rev 1485
1
/*
1
/*
2
 * Copyright (C) 2005 Martin Decky
2
 * Copyright (C) 2005 Martin Decky
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
13
 *   documentation and/or other materials provided with the distribution.
14
 * - The name of the author may not be used to endorse or promote products
14
 * - The name of the author may not be used to endorse or promote products
15
 *   derived from this software without specific prior written permission.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
27
 */
28
 
28
 
29
#include <string.h>
29
#include <string.h>
30
#include <unistd.h>
30
#include <unistd.h>
31
#include <ctype.h>
31
#include <ctype.h>
32
#include <limits.h>
32
#include <limits.h>
33
 
33
 
34
 
34
 
35
/* Dummy implementation of mem/ functions */
35
/* Dummy implementation of mem/ functions */
36
 
36
 
37
void * memset(void *s, int c, size_t n)
37
void * memset(void *s, int c, size_t n)
38
{
38
{
39
    char *os = s;
39
    char *os = s;
40
    while (n--)
40
    while (n--)
41
        *(os++) = c;
41
        *(os++) = c;
42
    return s;
42
    return s;
43
}
43
}
44
 
44
 
45
void * memcpy(void *dest, void *src, size_t n)
45
void * memcpy(void *dst, const void *src, size_t n)
46
{
46
{
47
    char *os = src;
47
    int i, j;
-
 
48
 
48
    char *odst = dest;
49
    for (i = 0; i < n/sizeof(unsigned long); i++)
-
 
50
        ((unsigned long *) dst)[i] = ((unsigned long *) src)[i];
49
    while (n--)
51
       
50
        *(odst++) = *(os++);
52
    for (j = 0; j < n%sizeof(unsigned long); j++)
-
 
53
        ((unsigned char *)(((unsigned long *) dst) + i))[j] = ((unsigned char *)(((unsigned long *) src) + i))[j];
-
 
54
       
51
    return dest;
55
    return (char *)src;
52
}
56
}
53
 
57
 
-
 
58
void * memmove(void *dst, const void *src, size_t n)
-
 
59
{
-
 
60
    int i, j;
-
 
61
   
-
 
62
    if (src > dst)
-
 
63
        return memcpy(dst, src, n);
-
 
64
 
-
 
65
    for (j = (n%sizeof(unsigned long))-1; j >= 0; j--)
-
 
66
        ((unsigned char *)(((unsigned long *) dst) + i))[j] = ((unsigned char *)(((unsigned long *) src) + i))[j];
-
 
67
 
-
 
68
    for (i = n/sizeof(unsigned long)-1; i >=0 ; i--)
-
 
69
        ((unsigned long *) dst)[i] = ((unsigned long *) src)[i];
-
 
70
       
-
 
71
    return (char *)src;
-
 
72
}
-
 
73
 
-
 
74
 
54
/** Count the number of characters in the string, not including terminating 0.
75
/** Count the number of characters in the string, not including terminating 0.
55
 * @param str string
76
 * @param str string
56
 * @return number of characters in string.
77
 * @return number of characters in string.
57
 */
78
 */
58
size_t strlen(const char *str)
79
size_t strlen(const char *str)
59
{
80
{
60
    size_t counter = 0;
81
    size_t counter = 0;
61
 
82
 
62
    while (str[counter] != 0) {
83
    while (str[counter] != 0) {
63
        counter++;
84
        counter++;
64
    }
85
    }
65
 
86
 
66
    return counter;
87
    return counter;
67
}
88
}
68
 
89
 
69
int strcmp(const char *a,const char *b)
90
int strcmp(const char *a,const char *b)
70
{
91
{
71
    int c=0;
92
    int c=0;
72
   
93
   
73
    while(a[c]&&b[c]&&(!(a[c]-b[c]))) c++;
94
    while(a[c]&&b[c]&&(!(a[c]-b[c]))) c++;
74
   
95
   
75
    return a[c]-b[c];
96
    return a[c]-b[c];
76
   
97
   
77
}
98
}
78
 
99
 
79
 
100
 
80
 
101
 
81
/** Return pointer to the first occurence of character c in string
102
/** Return pointer to the first occurence of character c in string
82
 * @param str scanned string
103
 * @param str scanned string
83
 * @param c searched character (taken as one byte)
104
 * @param c searched character (taken as one byte)
84
 * @return pointer to the matched character or NULL if it is not found in given string.
105
 * @return pointer to the matched character or NULL if it is not found in given string.
85
 */
106
 */
86
char *strchr(const char *str, int c)
107
char *strchr(const char *str, int c)
87
{
108
{
88
    while (*str != '\0') {
109
    while (*str != '\0') {
89
        if (*str == (char)c)
110
        if (*str == (char)c)
90
            return (char *)str;
111
            return (char *)str;
91
        str++;
112
        str++;
92
    }
113
    }
93
 
114
 
94
    return NULL;
115
    return NULL;
95
}
116
}
96
 
117
 
97
/** Return pointer to the last occurence of character c in string
118
/** Return pointer to the last occurence of character c in string
98
 * @param str scanned string
119
 * @param str scanned string
99
 * @param c searched character (taken as one byte)
120
 * @param c searched character (taken as one byte)
100
 * @return pointer to the matched character or NULL if it is not found in given string.
121
 * @return pointer to the matched character or NULL if it is not found in given string.
101
 */
122
 */
102
char *strrchr(const char *str, int c)
123
char *strrchr(const char *str, int c)
103
{
124
{
104
    char *retval = NULL;
125
    char *retval = NULL;
105
 
126
 
106
    while (*str != '\0') {
127
    while (*str != '\0') {
107
        if (*str == (char)c)
128
        if (*str == (char)c)
108
            retval = (char *)str;
129
            retval = (char *)str;
109
        str++;
130
        str++;
110
    }
131
    }
111
 
132
 
112
    return (char *)retval;
133
    return (char *)retval;
113
}
134
}
114
 
135
 
115
/** Convert string to a number.
136
/** Convert string to a number.
116
 * Core of strtol and strtoul functions.
137
 * Core of strtol and strtoul functions.
117
 * @param nptr pointer to string
138
 * @param nptr pointer to string
118
 * @param endptr if not NULL, function stores here pointer to the first invalid character
139
 * @param endptr if not NULL, function stores here pointer to the first invalid character
119
 * @param base zero or number between 2 and 36 inclusive
140
 * @param base zero or number between 2 and 36 inclusive
120
 * @param sgn its set to 1 if minus found
141
 * @param sgn its set to 1 if minus found
121
 * @return result of conversion.
142
 * @return result of conversion.
122
 */
143
 */
123
static unsigned long _strtoul(const char *nptr, char **endptr, int base, char *sgn)
144
static unsigned long _strtoul(const char *nptr, char **endptr, int base, char *sgn)
124
{
145
{
125
    unsigned char c;
146
    unsigned char c;
126
    unsigned long result = 0;
147
    unsigned long result = 0;
127
    unsigned long a, b;
148
    unsigned long a, b;
128
    const char *str = nptr;
149
    const char *str = nptr;
129
    const char *tmpptr;
150
    const char *tmpptr;
130
   
151
   
131
    while (isspace(*str))
152
    while (isspace(*str))
132
        str++;
153
        str++;
133
   
154
   
134
    if (*str == '-') {
155
    if (*str == '-') {
135
        *sgn = 1;
156
        *sgn = 1;
136
        ++str;
157
        ++str;
137
    } else if (*str == '+')
158
    } else if (*str == '+')
138
        ++str;
159
        ++str;
139
   
160
   
140
    if (base) {
161
    if (base) {
141
        if ((base == 1) || (base > 36)) {
162
        if ((base == 1) || (base > 36)) {
142
            /* FIXME: set errno to EINVAL */
163
            /* FIXME: set errno to EINVAL */
143
            return 0;
164
            return 0;
144
        }
165
        }
145
        if ((base == 16) && (*str == '0') && ((str[1] == 'x') || (str[1] == 'X'))) {
166
        if ((base == 16) && (*str == '0') && ((str[1] == 'x') || (str[1] == 'X'))) {
146
            str += 2;
167
            str += 2;
147
        }
168
        }
148
    } else {
169
    } else {
149
        base = 10;
170
        base = 10;
150
       
171
       
151
        if (*str == '0') {
172
        if (*str == '0') {
152
            base = 8;
173
            base = 8;
153
            if ((str[1] == 'X') || (str[1] == 'x'))  {
174
            if ((str[1] == 'X') || (str[1] == 'x'))  {
154
                base = 16;
175
                base = 16;
155
                str += 2;
176
                str += 2;
156
            }
177
            }
157
        }
178
        }
158
    }
179
    }
159
   
180
   
160
    tmpptr = str;
181
    tmpptr = str;
161
 
182
 
162
    while (*str) {
183
    while (*str) {
163
        c = *str;
184
        c = *str;
164
        c = ( c >= 'a'? c-'a'+10:(c >= 'A'?c-'A'+10:(c <= '9'?c-'0':0xff)));
185
        c = ( c >= 'a'? c-'a'+10:(c >= 'A'?c-'A'+10:(c <= '9'?c-'0':0xff)));
165
        if (c > base) {
186
        if (c > base) {
166
            break;
187
            break;
167
        }
188
        }
168
       
189
       
169
        a = (result & 0xff) * base + c;
190
        a = (result & 0xff) * base + c;
170
        b = (result >> 8) * base + (a >> 8);
191
        b = (result >> 8) * base + (a >> 8);
171
       
192
       
172
        if (b > (ULONG_MAX >> 8)) {
193
        if (b > (ULONG_MAX >> 8)) {
173
            /* overflow */
194
            /* overflow */
174
            /* FIXME: errno = ERANGE*/
195
            /* FIXME: errno = ERANGE*/
175
            return ULONG_MAX;
196
            return ULONG_MAX;
176
        }
197
        }
177
   
198
   
178
        result = (b << 8) + (a & 0xff);
199
        result = (b << 8) + (a & 0xff);
179
        ++str;
200
        ++str;
180
    }
201
    }
181
   
202
   
182
    if (str == tmpptr) {
203
    if (str == tmpptr) {
183
        /* no number was found => first invalid character is the first character of the string */
204
        /* no number was found => first invalid character is the first character of the string */
184
        /* FIXME: set errno to EINVAL */
205
        /* FIXME: set errno to EINVAL */
185
        str = nptr;
206
        str = nptr;
186
        result = 0;
207
        result = 0;
187
    }
208
    }
188
   
209
   
189
    if (endptr)
210
    if (endptr)
190
        *endptr = (char *)str;
211
        *endptr = (char *)str;
191
 
212
 
192
    if (nptr == str) {
213
    if (nptr == str) {
193
        /*FIXME: errno = EINVAL*/
214
        /*FIXME: errno = EINVAL*/
194
        return 0;
215
        return 0;
195
    }
216
    }
196
 
217
 
197
    return result;
218
    return result;
198
}
219
}
199
 
220
 
200
/** Convert initial part of string to long int according to given base.
221
/** Convert initial part of string to long int according to given base.
201
 * The number may begin with an arbitrary number of whitespaces followed by optional sign (`+' or `-').
222
 * The number may begin with an arbitrary number of whitespaces followed by optional sign (`+' or `-').
202
 * If the base is 0 or 16, the prefix `0x' may be inserted and the number will be taken as hexadecimal one.
223
 * If the base is 0 or 16, the prefix `0x' may be inserted and the number will be taken as hexadecimal one.
203
 * If the base is 0 and the number begin with a zero, number will be taken as octal one (as with base 8).
224
 * If the base is 0 and the number begin with a zero, number will be taken as octal one (as with base 8).
204
 * Otherwise the base 0 is taken as decimal.
225
 * Otherwise the base 0 is taken as decimal.
205
 * @param nptr pointer to string
226
 * @param nptr pointer to string
206
 * @param endptr if not NULL, function stores here pointer to the first invalid character
227
 * @param endptr if not NULL, function stores here pointer to the first invalid character
207
 * @param base zero or number between 2 and 36 inclusive
228
 * @param base zero or number between 2 and 36 inclusive
208
 * @return result of conversion.
229
 * @return result of conversion.
209
 */
230
 */
210
long int strtol(const char *nptr, char **endptr, int base)
231
long int strtol(const char *nptr, char **endptr, int base)
211
{
232
{
212
    char sgn = 0;
233
    char sgn = 0;
213
    unsigned long number = 0;
234
    unsigned long number = 0;
214
   
235
   
215
    number = _strtoul(nptr, endptr, base, &sgn);
236
    number = _strtoul(nptr, endptr, base, &sgn);
216
 
237
 
217
    if (number > LONG_MAX) {
238
    if (number > LONG_MAX) {
218
        if ((sgn) && (number == (unsigned long)(LONG_MAX) + 1)) {
239
        if ((sgn) && (number == (unsigned long)(LONG_MAX) + 1)) {
219
            /* FIXME: set 0 to errno */
240
            /* FIXME: set 0 to errno */
220
            return number;     
241
            return number;     
221
        }
242
        }
222
        /* FIXME: set ERANGE to errno */
243
        /* FIXME: set ERANGE to errno */
223
        return (sgn?LONG_MIN:LONG_MAX);
244
        return (sgn?LONG_MIN:LONG_MAX);
224
    }
245
    }
225
   
246
   
226
    return (sgn?-number:number);
247
    return (sgn?-number:number);
227
}
248
}
228
 
249
 
229
 
250
 
230
/** Convert initial part of string to unsigned long according to given base.
251
/** Convert initial part of string to unsigned long according to given base.
231
 * The number may begin with an arbitrary number of whitespaces followed by optional sign (`+' or `-').
252
 * The number may begin with an arbitrary number of whitespaces followed by optional sign (`+' or `-').
232
 * If the base is 0 or 16, the prefix `0x' may be inserted and the number will be taken as hexadecimal one.
253
 * If the base is 0 or 16, the prefix `0x' may be inserted and the number will be taken as hexadecimal one.
233
 * If the base is 0 and the number begin with a zero, number will be taken as octal one (as with base 8).
254
 * If the base is 0 and the number begin with a zero, number will be taken as octal one (as with base 8).
234
 * Otherwise the base 0 is taken as decimal.
255
 * Otherwise the base 0 is taken as decimal.
235
 * @param nptr pointer to string
256
 * @param nptr pointer to string
236
 * @param endptr if not NULL, function stores here pointer to the first invalid character
257
 * @param endptr if not NULL, function stores here pointer to the first invalid character
237
 * @param base zero or number between 2 and 36 inclusive
258
 * @param base zero or number between 2 and 36 inclusive
238
 * @return result of conversion.
259
 * @return result of conversion.
239
 */
260
 */
240
unsigned long strtoul(const char *nptr, char **endptr, int base)
261
unsigned long strtoul(const char *nptr, char **endptr, int base)
241
{
262
{
242
    char sgn = 0;
263
    char sgn = 0;
243
    unsigned long number = 0;
264
    unsigned long number = 0;
244
   
265
   
245
    number = _strtoul(nptr, endptr, base, &sgn);
266
    number = _strtoul(nptr, endptr, base, &sgn);
246
 
267
 
247
    return (sgn?-number:number);
268
    return (sgn?-number:number);
248
}
269
}
249
 
270
 
250
char *strcpy(char *dest, const char *src)
271
char *strcpy(char *dest, const char *src)
251
{
272
{
252
    while (*(dest++) = *(src++))
273
    while (*(dest++) = *(src++))
253
        ;
274
        ;
254
}
275
}
255
 
276
 
256
char *strncpy(char *dest, const char *src, size_t n)
277
char *strncpy(char *dest, const char *src, size_t n)
257
{
278
{
258
    while (*(dest++) = *(src++) && --n)
279
    while (*(dest++) = *(src++) && --n)
259
        ;
280
        ;
260
}
281
}
261
 
282