com32/lib/sys/farcall.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32

/*
 * farcall.c
 */

#include <com32.h>

static inline uint32_t eflags(void)
{
    //uint32_t v;

#if __SIZEOF_POINTER__ == 4
    uint32_t v;
    asm volatile("pushfl ; popl %0" : "=rm" (v));
#elif __SIZEOF_POINTER__ == 8
    uint64_t v;
    asm volatile("pushfq ; pop %0" : "=rm" (v));
#else
#error "Unable to build for to-be-defined architecture type"
#endif
    return v;
}

void __farcall(uint16_t cs, uint16_t ip,
	       const com32sys_t * ireg, com32sys_t * oreg)
{
    com32sys_t xreg = *ireg;

    /* Enable interrupts if and only if they are enabled in the caller */
    xreg.eflags.l = (xreg.eflags.l & ~EFLAGS_IF) | (eflags() & EFLAGS_IF);

    __com32.cs_farcall((cs << 16) + ip, &xreg, oreg);
}