89 lines
2.1 KiB
C
89 lines
2.1 KiB
C
/* vim: tabstop=4 shiftwidth=4 noexpandtab
|
|
* This file is part of ToaruOS and is released under the terms
|
|
* of the NCSA / University of Illinois License - see LICENSE.md
|
|
* Copyright (C) 2011-2013 Kevin Lange
|
|
*
|
|
* System Functions
|
|
*
|
|
*/
|
|
#include <system.h>
|
|
|
|
char * boot_arg = NULL;
|
|
char * boot_arg_extra = NULL;
|
|
|
|
/*
|
|
* memsetw
|
|
* Set `count` shorts to `val`.
|
|
*/
|
|
unsigned short * memsetw(unsigned short * dest, unsigned short val, int count) {
|
|
int i = 0;
|
|
for ( ; i < count; ++i ) {
|
|
dest[i] = val;
|
|
}
|
|
return dest;
|
|
}
|
|
|
|
uint32_t __attribute__ ((pure)) krand(void) {
|
|
static uint32_t x = 123456789;
|
|
static uint32_t y = 362436069;
|
|
static uint32_t z = 521288629;
|
|
static uint32_t w = 88675123;
|
|
|
|
uint32_t t;
|
|
|
|
t = x ^ (x << 11);
|
|
x = y; y = z; z = w;
|
|
return w = w ^ (w >> 19) ^ t ^ (t >> 8);
|
|
}
|
|
|
|
unsigned short inports(unsigned short _port) {
|
|
unsigned short rv;
|
|
asm volatile ("inw %1, %0" : "=a" (rv) : "dN" (_port));
|
|
return rv;
|
|
}
|
|
|
|
void outports(unsigned short _port, unsigned short _data) {
|
|
asm volatile ("outw %1, %0" : : "dN" (_port), "a" (_data));
|
|
}
|
|
|
|
unsigned int inportl(unsigned short _port) {
|
|
unsigned int rv;
|
|
asm volatile ("inl %%dx, %%eax" : "=a" (rv) : "dN" (_port));
|
|
return rv;
|
|
}
|
|
|
|
void outportl(unsigned short _port, unsigned int _data) {
|
|
asm volatile ("outl %%eax, %%dx" : : "dN" (_port), "a" (_data));
|
|
}
|
|
|
|
unsigned char inportb(unsigned short _port) {
|
|
unsigned char rv;
|
|
asm volatile ("inb %1, %0" : "=a" (rv) : "dN" (_port));
|
|
return rv;
|
|
}
|
|
|
|
void outportb(unsigned short _port, unsigned char _data) {
|
|
asm volatile ("outb %1, %0" : : "dN" (_port), "a" (_data));
|
|
}
|
|
|
|
void outportsm(unsigned short port, unsigned char * data, unsigned long size) {
|
|
asm volatile ("rep outsw" : "+S" (data), "+c" (size) : "d" (port));
|
|
}
|
|
|
|
void inportsm(unsigned short port, unsigned char * data, unsigned long size) {
|
|
asm volatile ("rep insw" : "+D" (data), "+c" (size) : "d" (port) : "memory");
|
|
}
|
|
|
|
size_t lfind(const char * str, const char accept) {
|
|
return (size_t)strchr(str, accept);
|
|
}
|
|
|
|
size_t rfind(const char * str, const char accept) {
|
|
return (size_t)strrchr(str, accept);
|
|
}
|
|
|
|
uint8_t startswith(const char * str, const char * accept) {
|
|
return strstr(str, accept) == str;
|
|
}
|
|
|