144 lines
2.7 KiB
C
144 lines
2.7 KiB
C
#include <stddef.h>
|
|
#include <stdint.h>
|
|
#include <lib/libc.h>
|
|
#include <limits.h>
|
|
#include <stdbool.h>
|
|
#include <lib/blib.h>
|
|
|
|
int toupper(int c) {
|
|
if (c >= 'a' && c <= 'z') {
|
|
return c - 0x20;
|
|
}
|
|
return c;
|
|
}
|
|
|
|
int tolower(int c) {
|
|
if (c >= 'A' && c <= 'Z') {
|
|
return c + 0x20;
|
|
}
|
|
return c;
|
|
}
|
|
|
|
void *memcpy(void *dest, const void *src, size_t n) {
|
|
uint8_t *pdest = dest;
|
|
const uint8_t *psrc = src;
|
|
|
|
for (size_t i = 0; i < n; i++) {
|
|
pdest[i] = psrc[i];
|
|
}
|
|
|
|
return dest;
|
|
}
|
|
|
|
void *memset(void *s, int c, size_t n) {
|
|
uint8_t *p = s;
|
|
|
|
for (size_t i = 0; i < n; i++) {
|
|
p[i] = (uint8_t)c;
|
|
}
|
|
|
|
return s;
|
|
}
|
|
|
|
void *memmove(void *dest, const void *src, size_t n) {
|
|
uint8_t *pdest = dest;
|
|
const uint8_t *psrc = src;
|
|
|
|
if (src > dest) {
|
|
for (size_t i = 0; i < n; i++) {
|
|
pdest[i] = psrc[i];
|
|
}
|
|
} else if (src < dest) {
|
|
for (size_t i = n; i > 0; i--) {
|
|
pdest[i-1] = psrc[i-1];
|
|
}
|
|
}
|
|
|
|
return dest;
|
|
}
|
|
|
|
int memcmp(const void *s1, const void *s2, size_t n) {
|
|
const uint8_t *p1 = s1;
|
|
const uint8_t *p2 = s2;
|
|
|
|
for (size_t i = 0; i < n; i++) {
|
|
if (p1[i] != p2[i])
|
|
return p1[i] < p2[i] ? -1 : 1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
char *strcpy(char *dest, const char *src) {
|
|
size_t i;
|
|
|
|
for (i = 0; src[i]; i++)
|
|
dest[i] = src[i];
|
|
|
|
dest[i] = 0;
|
|
|
|
return dest;
|
|
}
|
|
|
|
char *strncpy(char *dest, const char *src, size_t n) {
|
|
size_t i;
|
|
|
|
for (i = 0; i < n && src[i]; i++)
|
|
dest[i] = src[i];
|
|
for ( ; i < n; i++)
|
|
dest[i] = 0;
|
|
|
|
return dest;
|
|
}
|
|
|
|
int strcmp(const char *s1, const char *s2) {
|
|
for (size_t i = 0; ; i++) {
|
|
char c1 = s1[i], c2 = s2[i];
|
|
if (c1 != c2)
|
|
return c1 < c2 ? -1 : 1;
|
|
if (!c1)
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
int strncmp(const char *s1, const char *s2, size_t n) {
|
|
for (size_t i = 0; i < n; i++) {
|
|
char c1 = s1[i], c2 = s2[i];
|
|
if (c1 != c2)
|
|
return c1 < c2 ? -1 : 1;
|
|
if (!c1)
|
|
return 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
size_t strlen(const char *str) {
|
|
size_t len;
|
|
|
|
for (len = 0; str[len]; len++);
|
|
|
|
return len;
|
|
}
|
|
|
|
int inet_pton(const char *src, void *dst) {
|
|
uint8_t array[4];
|
|
const char *current = src;
|
|
|
|
for (int i = 0; i < 4; i++) {
|
|
const char *newcur;
|
|
uint64_t value = strtoui(current, &newcur, 10);
|
|
if (current == newcur)
|
|
return -1;
|
|
current = newcur;
|
|
if (*current == 0 && i < 3)
|
|
return -1;
|
|
if (value > 255)
|
|
return -1;
|
|
current++;
|
|
array[i] = value;
|
|
}
|
|
memcpy(dst, array, 4);
|
|
return 0;
|
|
}
|