71 lines
1.8 KiB
C
71 lines
1.8 KiB
C
|
#pragma once
|
||
|
|
|
||
|
|
#define _inline inline __attribute__((always_inline))
|
||
|
|
|
||
|
|
static _inline unsigned short inports(unsigned short _port) {
|
||
|
|
unsigned short rv;
|
||
|
|
asm volatile ("inw %1, %0" : "=a" (rv) : "dN" (_port));
|
||
|
|
return rv;
|
||
|
|
}
|
||
|
|
|
||
|
|
static _inline void outports(unsigned short _port, unsigned short _data) {
|
||
|
|
asm volatile ("outw %1, %0" : : "dN" (_port), "a" (_data));
|
||
|
|
}
|
||
|
|
|
||
|
|
static _inline unsigned int inportl(unsigned short _port) {
|
||
|
|
unsigned int rv;
|
||
|
|
asm volatile ("inl %%dx, %%eax" : "=a" (rv) : "dN" (_port));
|
||
|
|
return rv;
|
||
|
|
}
|
||
|
|
|
||
|
|
static _inline void outportl(unsigned short _port, unsigned int _data) {
|
||
|
|
asm volatile ("outl %%eax, %%dx" : : "dN" (_port), "a" (_data));
|
||
|
|
}
|
||
|
|
|
||
|
|
static _inline unsigned char inportb(unsigned short _port) {
|
||
|
|
unsigned char rv;
|
||
|
|
asm volatile ("inb %1, %0" : "=a" (rv) : "dN" (_port));
|
||
|
|
return rv;
|
||
|
|
}
|
||
|
|
|
||
|
|
static _inline void outportb(unsigned short _port, unsigned char _data) {
|
||
|
|
asm volatile ("outb %1, %0" : : "dN" (_port), "a" (_data));
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
static _inline void inportsm(unsigned short port, unsigned char * data, unsigned long size) {
|
||
|
|
asm volatile ("rep insw" : "+D" (data), "+c" (size) : "d" (port) : "memory");
|
||
|
|
}
|
||
|
|
|
||
|
|
static _inline 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;
|
||
|
|
}
|
||
|
|
|
||
|
|
static _inline 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;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int strcmp(const char * l, const char * r) {
|
||
|
|
for (; *l == *r && *l; l++, r++);
|
||
|
|
return *(unsigned char *)l - *(unsigned char *)r;
|
||
|
|
}
|
||
|
|
|
||
|
|
static char * strchr(const char * s, int c) {
|
||
|
|
while (*s) {
|
||
|
|
if (*s == c) {
|
||
|
|
return (char *)s;
|
||
|
|
}
|
||
|
|
s++;
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|