123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152 |
- /* 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>
- #endif /* __OpenBSD__ || __NetBSD__ */
- #if defined(__OpenBSD__)
- #if defined(__amd64__)
- #include <amd64/pio.h>
- #elif defined(__i386__)
- #include <i386/pio.h>
- #endif /* __i386__ */
- #endif /* __OpenBSD__ */
- #if defined(__FreeBSD__)
- #include <fcntl.h>
- #include <sys/types.h>
- #include <machine/cpufunc.h>
- #include <unistd.h>
- #endif /* __FreeBSD__ */
- #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__) || defined(__FreeBSD__)
- outb(port, data);
- #endif
- #if defined(__NetBSD__)
- __asm__ volatile ("outb %b0, %w1" : : "a"(data), "d"(port));
- #endif
- }
- void
- sys_outl(unsigned int port, uint32_t data)
- {
- #if defined(__linux__)
- outl(data, port);
- #endif
- #if defined(__OpenBSD__) || defined(__FreeBSD__)
- outl(port, data);
- #endif
- #if defined(__NetBSD__)
- __asm__ volatile ("outl %0, %w1" : : "a"(data), "d"(port));
- #endif
- }
- uint8_t
- sys_inb(unsigned int port)
- {
- #if defined(__linux__) || defined (__OpenBSD__) \
- || defined(__FreeBSD__)
- return inb(port);
- #endif
- #if defined(__NetBSD__)
- uint8_t retval;
- __asm__ volatile ("inb %w1, %b0" : "=a" (retval) : "d" (port));
- return retval;
- #endif
- return 0;
- }
- uint32_t
- sys_inl(unsigned int port)
- {
- #if defined(__linux__) || defined (__OpenBSD__) \
- || defined(__FreeBSD__)
- return inl(port);
- #endif
- #if defined(__NetBSD__)
- int retval;
- __asm__ volatile ("inl %w1, %0" : "=a" (retval) : "d" (port));
- 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__ */
- #if defined(__FreeBSD__)
- /* Refer to io(4) manual page. This assumes the legacy behavior
- * where opening /dev/io raises the IOPL of the process */
- static int io_fd = -1;
- /* Requesting privileged access */
- if (level > 0) {
- if (io_fd == -1) {
- io_fd = open("/dev/io", O_RDONLY);
- return (io_fd == -1) ? -1 : 0;
- }
- /* Lowering access to lowest level */
- } else if (level == 0 && io_fd != -1) {
- if (close(io_fd) == -1) {
- return -1;
- } else {
- io_fd = -1;
- }
- }
- return 0;
- #endif /* __FreeBSD__ */
- errno = ENOSYS;
- return -1;
- }
|