2007-08-31 21:55:27 +02:00
|
|
|
// Routines to let C code use special x86 instructions.
|
2006-09-07 16:12:30 +02:00
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline uchar
|
2007-08-20 20:55:51 +02:00
|
|
|
inb(ushort port)
|
2006-06-12 17:22:12 +02:00
|
|
|
{
|
2006-09-06 19:04:06 +02:00
|
|
|
uchar data;
|
2007-08-27 14:48:20 +02:00
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
asm volatile("in %1,%0" : "=a" (data) : "d" (port));
|
2006-09-06 19:04:06 +02:00
|
|
|
return data;
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2006-06-12 17:22:12 +02:00
|
|
|
insl(int port, void *addr, int cnt)
|
|
|
|
{
|
2009-03-08 22:27:57 +01:00
|
|
|
asm volatile("cld; rep insl" :
|
2009-03-08 21:56:38 +01:00
|
|
|
"=D" (addr), "=c" (cnt) :
|
|
|
|
"d" (port), "0" (addr), "1" (cnt) :
|
|
|
|
"memory", "cc");
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2007-08-20 20:55:51 +02:00
|
|
|
outb(ushort port, uchar data)
|
2006-06-12 17:22:12 +02:00
|
|
|
{
|
2007-08-24 02:34:54 +02:00
|
|
|
asm volatile("out %0,%1" : : "a" (data), "d" (port));
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2007-08-20 20:55:51 +02:00
|
|
|
outw(ushort port, ushort data)
|
2006-06-12 17:22:12 +02:00
|
|
|
{
|
2007-08-24 02:34:54 +02:00
|
|
|
asm volatile("out %0,%1" : : "a" (data), "d" (port));
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2006-06-12 17:22:12 +02:00
|
|
|
outsl(int port, const void *addr, int cnt)
|
|
|
|
{
|
2009-03-08 22:27:57 +01:00
|
|
|
asm volatile("cld; rep outsl" :
|
2009-03-08 21:56:38 +01:00
|
|
|
"=S" (addr), "=c" (cnt) :
|
|
|
|
"d" (port), "0" (addr), "1" (cnt) :
|
|
|
|
"cc");
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2009-03-08 22:27:57 +01:00
|
|
|
static inline void
|
|
|
|
stosb(void *addr, int data, int cnt)
|
|
|
|
{
|
|
|
|
asm volatile("cld; rep stosb" :
|
|
|
|
"=D" (addr), "=c" (cnt) :
|
|
|
|
"0" (addr), "1" (cnt), "a" (data) :
|
|
|
|
"memory", "cc");
|
|
|
|
}
|
|
|
|
|
2006-08-29 16:45:45 +02:00
|
|
|
struct segdesc;
|
2006-06-12 17:22:12 +02:00
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2006-07-17 03:58:13 +02:00
|
|
|
lgdt(struct segdesc *p, int size)
|
2006-06-12 17:22:12 +02:00
|
|
|
{
|
2006-09-06 19:04:06 +02:00
|
|
|
volatile ushort pd[3];
|
2006-09-06 19:27:19 +02:00
|
|
|
|
2006-09-06 19:04:06 +02:00
|
|
|
pd[0] = size-1;
|
|
|
|
pd[1] = (uint)p;
|
|
|
|
pd[2] = (uint)p >> 16;
|
2006-07-16 18:55:52 +02:00
|
|
|
|
2007-08-24 02:02:03 +02:00
|
|
|
asm volatile("lgdt (%0)" : : "r" (pd));
|
2006-07-16 18:55:52 +02:00
|
|
|
}
|
|
|
|
|
2006-08-29 16:45:45 +02:00
|
|
|
struct gatedesc;
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2006-07-17 03:58:13 +02:00
|
|
|
lidt(struct gatedesc *p, int size)
|
2006-07-16 18:55:52 +02:00
|
|
|
{
|
2006-09-06 19:04:06 +02:00
|
|
|
volatile ushort pd[3];
|
2006-09-06 19:27:19 +02:00
|
|
|
|
2006-09-06 19:04:06 +02:00
|
|
|
pd[0] = size-1;
|
|
|
|
pd[1] = (uint)p;
|
|
|
|
pd[2] = (uint)p >> 16;
|
2006-09-06 19:27:19 +02:00
|
|
|
|
2007-08-24 02:02:03 +02:00
|
|
|
asm volatile("lidt (%0)" : : "r" (pd));
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2006-07-20 11:07:53 +02:00
|
|
|
ltr(ushort sel)
|
2006-06-12 17:22:12 +02:00
|
|
|
{
|
2007-08-24 02:34:54 +02:00
|
|
|
asm volatile("ltr %0" : : "r" (sel));
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline uint
|
2009-03-08 23:07:13 +01:00
|
|
|
readeflags(void)
|
2006-06-12 17:22:12 +02:00
|
|
|
{
|
2006-09-06 19:04:06 +02:00
|
|
|
uint eflags;
|
2007-08-24 02:34:54 +02:00
|
|
|
asm volatile("pushfl; popl %0" : "=r" (eflags));
|
2006-09-06 19:04:06 +02:00
|
|
|
return eflags;
|
2006-06-12 17:22:12 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline uint
|
2007-10-01 22:43:15 +02:00
|
|
|
xchg(volatile uint *addr, uint newval)
|
2006-06-22 03:28:57 +02:00
|
|
|
{
|
2006-07-20 11:07:53 +02:00
|
|
|
uint result;
|
2007-08-24 02:34:54 +02:00
|
|
|
|
|
|
|
// The + in "+m" denotes a read-modify-write operand.
|
2007-10-01 22:43:15 +02:00
|
|
|
asm volatile("lock; xchgl %0, %1" :
|
|
|
|
"+m" (*addr), "=a" (result) :
|
|
|
|
"1" (newval) :
|
|
|
|
"cc");
|
2006-06-22 03:28:57 +02:00
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2009-05-31 02:28:45 +02:00
|
|
|
static inline void
|
2009-05-31 03:12:08 +02:00
|
|
|
loadfsgs(ushort v)
|
2009-05-31 02:28:45 +02:00
|
|
|
{
|
2009-05-31 03:12:08 +02:00
|
|
|
asm volatile("movw %0, %%fs" : : "r" (v));
|
|
|
|
asm volatile("movw %0, %%gs" : : "r" (v));
|
2009-05-31 02:28:45 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2006-07-16 03:15:28 +02:00
|
|
|
cli(void)
|
|
|
|
{
|
2007-08-24 02:34:54 +02:00
|
|
|
asm volatile("cli");
|
2006-07-16 03:15:28 +02:00
|
|
|
}
|
|
|
|
|
2007-08-24 02:34:54 +02:00
|
|
|
static inline void
|
2006-07-16 03:15:28 +02:00
|
|
|
sti(void)
|
|
|
|
{
|
2007-08-24 02:34:54 +02:00
|
|
|
asm volatile("sti");
|
2006-07-16 03:15:28 +02:00
|
|
|
}
|
|
|
|
|
2007-08-31 21:55:27 +02:00
|
|
|
// Layout of the trap frame built on the stack by the
|
|
|
|
// hardware and by trapasm.S, and passed to trap().
|
2006-07-17 03:58:13 +02:00
|
|
|
struct trapframe {
|
2006-09-06 19:50:20 +02:00
|
|
|
// registers as pushed by pusha
|
2006-09-06 19:04:06 +02:00
|
|
|
uint edi;
|
|
|
|
uint esi;
|
|
|
|
uint ebp;
|
2006-09-06 19:50:20 +02:00
|
|
|
uint oesp; // useless & ignored
|
2006-09-06 19:04:06 +02:00
|
|
|
uint ebx;
|
|
|
|
uint edx;
|
|
|
|
uint ecx;
|
|
|
|
uint eax;
|
2006-09-06 19:50:20 +02:00
|
|
|
|
|
|
|
// rest of trap frame
|
2008-09-24 03:48:31 +02:00
|
|
|
ushort gs;
|
2006-09-06 19:04:06 +02:00
|
|
|
ushort padding1;
|
2008-09-24 03:48:31 +02:00
|
|
|
ushort fs;
|
2006-09-06 19:04:06 +02:00
|
|
|
ushort padding2;
|
2008-09-24 03:48:31 +02:00
|
|
|
ushort es;
|
|
|
|
ushort padding3;
|
|
|
|
ushort ds;
|
|
|
|
ushort padding4;
|
2006-09-06 19:04:06 +02:00
|
|
|
uint trapno;
|
2006-09-06 19:50:20 +02:00
|
|
|
|
|
|
|
// below here defined by x86 hardware
|
2006-09-06 19:04:06 +02:00
|
|
|
uint err;
|
|
|
|
uint eip;
|
|
|
|
ushort cs;
|
2008-09-24 03:48:31 +02:00
|
|
|
ushort padding5;
|
2006-09-06 19:04:06 +02:00
|
|
|
uint eflags;
|
2006-09-06 19:50:20 +02:00
|
|
|
|
|
|
|
// below here only when crossing rings, such as from user to kernel
|
2006-09-06 19:04:06 +02:00
|
|
|
uint esp;
|
|
|
|
ushort ss;
|
2008-09-24 03:48:31 +02:00
|
|
|
ushort padding6;
|
2006-06-12 17:22:12 +02:00
|
|
|
};
|