1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
|
#include "std.h"
#include "core/sys.h"
#include "ui/vt.h"
int errno = 0;
void abort() {
dbg_printf("ABORT - errno %d\n", errno);
PANIC("abort() called, probably a memory manager failure.");
}
int strlen(const char *str) {
int i = 0;
while (str[i++]);
return i-1;
}
char *strchr(const char *str, char c) {
while (*str) {
if (*str == c) return (char*)str;
str++;
}
return NULL;
}
char *strcpy(char *dest, const char *src) {
memcpy(dest, src, strlen(src) + 1);
return (char*)src;
}
char *strdup(const char *src) {
char* ret = (char*)kmalloc(strlen(src) + 1);
if (ret == NULL) return ret;
strcpy(ret, src);
return ret;
}
char *strcat(char *dest, const char *src) {
char *dest2 = dest;
dest2 += strlen(dest) - 1;
while (*src) {
*dest2 = *src;
src++;
dest2++;
}
*dest2 = 0;
return dest;
}
int strcmp(const char *s1, const char *s2) {
while ((*s1) && (*s1 == *s2)) {
s1++;
s2++;
}
return (* (unsigned char*)s1 - *(unsigned char*)s2);
}
void *memcpy(void *vd, const void *vs, int count) {
uint8_t *dest = (uint8_t*)vd, *src = (uint8_t*)vs;
int f = count % 4, n = count / 4, i;
const uint32_t* s = (uint32_t*)src;
uint32_t* d = (uint32_t*)dest;
for (i = 0; i < n; i++) {
d[i] = s[i];
}
if (f != 0) {
for (i = count - f; i < count; i++) {
dest[i] = src[i];
}
}
return vd;
}
void *memset(void *dest, int val, int count) {
uint8_t *dest_c = (uint8_t*)dest;
int i;
for (i = 0; i < count; i++) {
dest_c[i] = val;
}
return dest;
}
uint16_t *memsetw(uint16_t *dest, uint16_t val, int count) {
int i;
for (i = 0; i < count; i++) {
dest[i] = val;
}
return dest;
}
|
