118 lines
2.2 KiB
C
118 lines
2.2 KiB
C
/* SPDX-License-Identifier: MIT */
|
|
/* SPDX-FileCopyrightText: 2023 Nicholas Chin */
|
|
|
|
#if defined(__linux__)
|
|
#include <sys/io.h>
|
|
#endif
|
|
|
|
#if defined(__OpenBSD__) || defined(__NetBSD__)
|
|
#include <sys/types.h>
|
|
#include <machine/sysarch.h>
|
|
#if defined(__amd64__)
|
|
#include <amd64/pio.h>
|
|
#elif defined(__i386__)
|
|
#include <i386/pio.h>
|
|
#endif /* __i386__ */
|
|
#endif /* __OpenBSD__ || __NetBSD__ */
|
|
|
|
#include <errno.h>
|
|
|
|
#include "accessors.h"
|
|
|
|
uint32_t
|
|
pci_read_32(uint32_t dev, uint8_t reg)
|
|
{
|
|
sys_outl(PCI_CFG_ADDR, dev | reg);
|
|
return sys_inl(PCI_CFG_DATA);
|
|
}
|
|
|
|
void
|
|
pci_write_32(uint32_t dev, uint8_t reg, uint32_t value)
|
|
{
|
|
sys_outl(PCI_CFG_ADDR, dev | reg);
|
|
sys_outl(PCI_CFG_DATA, value);
|
|
}
|
|
|
|
void
|
|
sys_outb(unsigned int port, uint8_t data)
|
|
{
|
|
#if defined(__linux__)
|
|
outb(data, port);
|
|
#endif
|
|
#if defined(__OpenBSD__)
|
|
outb(port, data);
|
|
#endif
|
|
#if defined(__NetBSD__)
|
|
__asm__ volatile ( "outb %b0, %w1" : : "a"(data), "d"(port) : "memory");
|
|
#endif
|
|
}
|
|
|
|
void
|
|
sys_outl(unsigned int port, uint32_t data)
|
|
{
|
|
#if defined(__linux__)
|
|
outl(data, port);
|
|
#endif
|
|
#if defined(__OpenBSD__)
|
|
outl(port, data);
|
|
#endif
|
|
#if defined(__NetBSD__)
|
|
__asm__ volatile ( "outl %0, %w1" : : "a"(data), "d"(port) : "memory");
|
|
#endif
|
|
}
|
|
|
|
uint8_t
|
|
sys_inb(unsigned int port)
|
|
{
|
|
#if defined(__linux__) || defined (__OpenBSD__)
|
|
return inb(port);
|
|
#endif
|
|
|
|
#if defined(__NetBSD__)
|
|
uint8_t retval;
|
|
__asm__ volatile("inb %w1, %b0" : "=a" (retval) : "d" (port) : "memory");
|
|
return retval;
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
uint32_t
|
|
sys_inl(unsigned int port)
|
|
{
|
|
#if defined(__linux__) || defined (__OpenBSD__)
|
|
return inl(port);
|
|
#endif
|
|
#if defined(__NetBSD__)
|
|
int retval;
|
|
__asm__ volatile("inl %w1, %0" : "=a" (retval) : "d" (port) : "memory");
|
|
return retval;
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
sys_iopl(int level)
|
|
{
|
|
#if defined(__linux__)
|
|
return iopl(level);
|
|
#endif
|
|
#if defined(__OpenBSD__)
|
|
#if defined(__i386__)
|
|
return i386_iopl(level);
|
|
#elif defined(__amd64__)
|
|
return amd64_iopl(level);
|
|
#endif /* __amd64__ */
|
|
#endif /* __OpenBSD__ */
|
|
|
|
#if defined(__NetBSD__)
|
|
#if defined(__i386__)
|
|
return i386_iopl(level);
|
|
#elif defined(__amd64__)
|
|
return x86_64_iopl(level);
|
|
#endif /* __amd64__ */
|
|
#endif /* __NetBSD__ */
|
|
|
|
errno = ENOSYS;
|
|
return -1;
|
|
}
|