#include <assert.h> #include "cmos_lowlevel.h" #if defined(__FreeBSD__) #include <sys/types.h> #include <machine/cpufunc.h> #define OUTB(x, y) do { u_int tmp = (y); outb(tmp, (x)); } while (0) #define OUTW(x, y) do { u_int tmp = (y); outw(tmp, (x)); } while (0) #define OUTL(x, y) do { u_int tmp = (y); outl(tmp, (x)); } while (0) #define INB(x) __extension__ ({ u_int tmp = (x); inb(tmp); }) #define INW(x) __extension__ ({ u_int tmp = (x); inw(tmp); }) #define INL(x) __extension__ ({ u_int tmp = (x); inl(tmp); }) #else #if defined(__GLIBC__) #include <sys/io.h> #endif #if (defined(__MACH__) && defined(__APPLE__)) #include <DirectHW/DirectHW.h> #endif #if defined(__NetBSD__) #if defined(__i386__) || defined(__x86_64__) #include <machine/sysarch.h> static inline void outb(uint8_t value, uint16_t port) { asm volatile ("outb %b0,%w1": :"a" (value), "Nd" (port)); } static inline uint8_t inb(uint16_t port) { uint8_t value; asm volatile ("inb %w1,%0":"=a" (value):"Nd" (port)); return value; } static inline void outw(uint16_t value, uint16_t port) { asm volatile ("outw %w0,%w1": :"a" (value), "Nd" (port)); } static inline uint16_t inw(uint16_t port) { uint16_t value; asm volatile ("inw %w1,%0":"=a" (value):"Nd" (port)); return value; } static inline void outl(uint32_t value, uint16_t port) { asm volatile ("outl %0,%w1": :"a" (value), "Nd" (port)); } static inline uint32_t inl(uint16_t port) { uint32_t value; asm volatile ("inl %1,%0":"=a" (value):"Nd" (port)); return value; } #endif #ifdef __x86_64__ #define iopl x86_64_iopl #endif #ifdef __i386__ #define iopl i386_iopl #endif #endif #define OUTB outb #define OUTW outw #define OUTL outl #define INB inb #define INW inw #define INL inl #endif static void cmos_hal_init(void* data); static unsigned char cmos_hal_read(unsigned addr); static void cmos_hal_write(unsigned addr, unsigned char value); static void cmos_set_iopl(int level); /* no need to initialize anything */ static void cmos_hal_init(__attribute__((unused)) void *data) { } static unsigned char cmos_hal_read(unsigned index) { unsigned short port_0, port_1; assert(!verify_cmos_byte_index(index)); if (index < 128) { port_0 = 0x70; port_1 = 0x71; } else { port_0 = 0x72; port_1 = 0x73; } OUTB(index, port_0); return INB(port_1); } static void cmos_hal_write(unsigned index, unsigned char value) { unsigned short port_0, port_1; assert(!verify_cmos_byte_index(index)); if (index < 128) { port_0 = 0x70; port_1 = 0x71; } else { port_0 = 0x72; port_1 = 0x73; } OUTB(index, port_0); OUTB(value, port_1); } /**************************************************************************** * cmos_set_iopl * * Set the I/O privilege level of the executing process. Root privileges are * required for performing this action. A sufficient I/O privilege level * allows the process to access x86 I/O address space and to disable/reenable * interrupts while executing in user space. Messing with the I/O privilege * level is therefore somewhat dangerous. ****************************************************************************/ static void cmos_set_iopl(int level) { #if defined(__FreeBSD__) static int io_fd = -1; #endif assert((level >= 0) && (level <= 3)); #if defined(__FreeBSD__) if (level == 0) { if (io_fd != -1) { close(io_fd); io_fd = -1; } } else { if (io_fd == -1) { io_fd = open("/dev/io", O_RDWR); if (io_fd < 0) { perror("/dev/io"); exit(1); } } } #else if (iopl(level)) { fprintf(stderr, "%s: iopl() system call failed. " "You must be root to do this.\n", prog_name); exit(1); } #endif } cmos_access_t cmos_hal = { .init = cmos_hal_init, .read = cmos_hal_read, .write = cmos_hal_write, .set_iopl = cmos_set_iopl, };