56 lines
1.1 KiB
C
56 lines
1.1 KiB
C
#include "util.h"
|
|
|
|
void * memcpy(void * restrict dest, const void * restrict src, long n) {
|
|
asm volatile("cld; rep movsb"
|
|
: "=c"((int){0})
|
|
: "D"(dest), "S"(src), "c"(n)
|
|
: "flags", "memory");
|
|
return dest;
|
|
}
|
|
|
|
void * memset(void * dest, int c, long n) {
|
|
asm volatile("cld; rep stosb"
|
|
: "=c"((int){0})
|
|
: "D"(dest), "a"(c), "c"(n)
|
|
: "flags", "memory");
|
|
return dest;
|
|
}
|
|
|
|
int strcmp(const char * l, const char * r) {
|
|
for (; *l == *r && *l; l++, r++);
|
|
return *(unsigned char *)l - *(unsigned char *)r;
|
|
}
|
|
|
|
char * strchr(const char * s, int c) {
|
|
while (*s) {
|
|
if (*s == c) {
|
|
return (char *)s;
|
|
}
|
|
s++;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
char * strcat(char *dest, const char *src) {
|
|
char * end = dest;
|
|
while (*end != '\0') {
|
|
++end;
|
|
}
|
|
while (*src) {
|
|
*end = *src;
|
|
end++;
|
|
src++;
|
|
}
|
|
*end = '\0';
|
|
return dest;
|
|
}
|
|
|
|
void copy_sectors(unsigned long lba, unsigned char * buf, int sectors) {
|
|
memcpy(buf, (char*)(lba * 2048 + DATA_LOAD_BASE), sectors * 2048);
|
|
}
|
|
|
|
void copy_sector(unsigned long lba, unsigned char * buf) {
|
|
memcpy(buf, (char*)(lba * 2048 + DATA_LOAD_BASE), 2048);
|
|
}
|
|
|