169 lines
3.7 KiB
C
169 lines
3.7 KiB
C
#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,
|
|
};
|