char *__save_state(int *psize)
{
struct LRMI_regs r;
char *buffer;
unsigned int size;
memset(&r, 0, sizeof(r));
r.eax = 0x4f04;
r.ecx = 0xf; /* all states */
r.edx = 0; /* get buffer size */
r.ds = 0x0040;
if (!LRMI_int(0x10, &r)) {
fprintf(stderr,
"Can't get video state buffer size (vm86 failure)\n");
}
if ((r.eax & 0xffff) != 0x4f) {
fprintf(stderr, "Get video state buffer size failed\n");
}
*psize = size = (r.ebx & 0xffff) * 64;
buffer = LRMI_alloc_real(size);
if (buffer == NULL) {
fprintf(stderr, "Can't allocate video state buffer\n");
return NULL;
}
memset(&r, 0, sizeof(r));
fprintf(stderr, "Allocated buffer at %p (base is 0x%x)\n", buffer,
LRMI_base_addr());
r.eax = 0x4f04;
r.ecx = 0xf; /* all states */
r.edx = 1; /* save state */
r.es = (unsigned int) (buffer - LRMI_base_addr()) >> 4;
r.ebx = (unsigned int) (buffer - LRMI_base_addr()) & 0xf;
r.ds = 0x0040;
fprintf(stderr, "ES: 0x%04X EBX: 0x%04X\n", r.es, r.ebx);
if (!LRMI_int(0x10, &r)) {
fprintf(stderr, "Can't save video state (vm86 failure)\n");
}
if ((r.eax & 0xffff) != 0x4f) {
fprintf(stderr, "Save video state failed\n");
}
return buffer;
}
/* Return information about a particular video mode. */
struct vbe_mode_info *vbe_get_mode_info(u_int16_t mode)
{
struct LRMI_regs regs;
char *mem;
struct vbe_mode_info *ret = NULL;
/* Initialize LRMI. */
if(LRMI_init() == 0) {
return NULL;
}
/* Allocate a chunk of memory. */
mem = LRMI_alloc_real(sizeof(struct vbe_mode_info));
if(mem == NULL) {
return NULL;
}
memset(mem, 0, sizeof(struct vbe_mode_info));
memset(®s, 0, sizeof(regs));
regs.eax = 0x4f01;
regs.ecx = mode;
regs.es = ((u_int32_t)mem) >> 4;
regs.edi = ((u_int32_t)mem) & 0x0f;
/* Do it. */
iopl(3);
ioperm(0, 0x400, 1);
if(LRMI_int(0x10, ®s) == 0) {
LRMI_free_real(mem);
return NULL;
}
/* Check for successful return. */
if((regs.eax & 0xffff) != 0x004f) {
LRMI_free_real(mem);
return NULL;
}
/* Get memory for return. */
ret = malloc(sizeof(struct vbe_mode_info));
if(ret == NULL) {
LRMI_free_real(mem);
return NULL;
}
/* Copy the buffer for return. */
memcpy(ret, mem, sizeof(struct vbe_mode_info));
/* Clean up and return. */
LRMI_free_real(mem);
return ret;
}
void restore_state(void)
{
char *data = NULL;
char tmpbuffer[524288];
int i, length = 0;
/* We really, really don't want to fail to read the entire set */
while ((i = read(0, tmpbuffer + length, sizeof(tmpbuffer)-length))) {
if (i == -1) {
if (errno != EAGAIN && errno != EINTR) {
perror("Failed to read state - ");
return;
}
} else {
length += i;
}
}
data = LRMI_alloc_real(length);
memcpy(data, tmpbuffer, length);
restore_state_from(data);
}
/* Based on xserver-xorg-driver-i810/src/i830_driver.c */
struct panel_id {
int hsize:16, vsize:16;
int fptype:16;
int redbpp:8, greenbpp:8, bluebpp:8, reservedbpp:8;
int rsvdoffscrnmemsize:32, rsvdoffscrnmemptr:32;
char reserved[14];
} __attribute__((packed));
int do_get_panel_id(int just_dimensions)
{
reg_frame r = {
.eax = 0x4f11,
.ebx = 0x0001
};
struct panel_id *id = LRMI_alloc_real(sizeof(struct panel_id));
r.es = (unsigned short)(((int)(id-LRMI_base_addr()) >> 4) & 0xffff);
r.edi = (unsigned long)(id-LRMI_base_addr()) & 0xf;
if(sizeof(struct panel_id) != 32)
return fprintf(stderr, "oops: panel_id, sizeof struct panel_id != 32, it's %ld...\n", sizeof(struct panel_id)), 7;
if(real_mode_int(0x10, &r))
return fprintf(stderr, "Can't get panel id (vm86 failure)\n"), 8;
if((r.eax & 0xff) != 0x4f)
return fprintf(stderr, "Panel id function not supported\n"), 9;
if(r.eax & 0xff00)
{
if((r.eax & 0xff00) == 0x100)
inline u32 v86_mem_alloc(int size) {
return (u32)LRMI_alloc_real(size);
}
/* Get VBE info. */
struct vbe_info *vbe_get_vbe_info()
{
struct LRMI_regs regs;
unsigned char *mem;
struct vbe_info *ret = NULL;
int i;
/* Initialize LRMI. */
if(LRMI_init() == 0) {
return NULL;
}
/* Allocate a chunk of memory. */
mem = LRMI_alloc_real(sizeof(struct vbe_mode_info));
if(mem == NULL) {
return NULL;
}
memset(mem, 0, sizeof(struct vbe_mode_info));
/* Set up registers for the interrupt call. */
memset(®s, 0, sizeof(regs));
regs.eax = 0x4f00;
regs.es = ((u_int32_t)mem) >> 4;
regs.edi = ((u_int32_t)mem) & 0x0f;
memcpy(mem, "VBE2", 4);
/* Do it. */
iopl(3);
ioperm(0, 0x400, 1);
if(LRMI_int(0x10, ®s) == 0) {
LRMI_free_real(mem);
return NULL;
}
/* Check for successful return code. */
if((regs.eax & 0xffff) != 0x004f) {
LRMI_free_real(mem);
return NULL;
}
/* Get memory to return the information. */
ret = malloc(sizeof(struct vbe_info));
if(ret == NULL) {
LRMI_free_real(mem);
return NULL;
}
memcpy(ret, mem, sizeof(struct vbe_info));
/* Set up pointers to usable memory. */
ret->mode_list.list = (u_int16_t*) ((ret->mode_list.addr.seg << 4) +
(ret->mode_list.addr.ofs));
ret->oem_name.string = (char*) ((ret->oem_name.addr.seg << 4) +
(ret->oem_name.addr.ofs));
/* Snip, snip. */
mem = strdup(ret->oem_name.string); /* leak */
while(((i = strlen(mem)) > 0) && isspace(mem[i - 1])) {
mem[i - 1] = '\0';
}
ret->oem_name.string = mem;
/* Set up pointers for VESA 3.0+ strings. */
if(ret->version[1] >= 3) {
/* Vendor name. */
ret->vendor_name.string = (char*)
((ret->vendor_name.addr.seg << 4)
+ (ret->vendor_name.addr.ofs));
mem = strdup(ret->vendor_name.string); /* leak */
while(((i = strlen(mem)) > 0) && isspace(mem[i - 1])) {
mem[i - 1] = '\0';
}
ret->vendor_name.string = mem;
/* Product name. */
ret->product_name.string = (char*)
((ret->product_name.addr.seg << 4)
+ (ret->product_name.addr.ofs));
mem = strdup(ret->product_name.string); /* leak */
while(((i = strlen(mem)) > 0) && isspace(mem[i - 1])) {
mem[i - 1] = '\0';
}
ret->product_name.string = mem;
/* Product revision. */
ret->product_revision.string = (char*)
((ret->product_revision.addr.seg << 4)
+ (ret->product_revision.addr.ofs));
mem = strdup(ret->product_revision.string); /* leak */
while(((i = strlen(mem)) > 0) && isspace(mem[i - 1])) {
mem[i - 1] = '\0';
}
ret->product_revision.string = mem;
}
/* Cleanup. */
LRMI_free_real(mem);
return ret;
}
void vbe_restore_svga_state(const void *state)
{
struct LRMI_regs regs;
unsigned char *mem;
u_int16_t block_size;
/* Initialize LRMI. */
if(LRMI_init() == 0) {
return;
}
memset(®s, 0, sizeof(regs));
regs.eax = 0x4f04;
regs.ecx = 0x000f;
regs.edx = 0;
/* Find out how much memory we need. */
iopl(3);
ioperm(0, 0x400, 1);
if(LRMI_int(0x10, ®s) == 0) {
return;
}
if((regs.eax & 0xff) != 0x4f) {
fprintf(stderr, "Get SuperVGA Video State not supported.\n");
return;
}
if((regs.eax & 0xffff) != 0x004f) {
fprintf(stderr, "Get SuperVGA Video State Info failed.\n");
return;
}
block_size = 64 * (regs.ebx & 0xffff);
/* Allocate a chunk of memory. */
mem = LRMI_alloc_real(block_size);
if(mem == NULL) {
return;
}
memset(mem, 0, sizeof(block_size));
memset(®s, 0, sizeof(regs));
regs.eax = 0x4f04;
regs.ecx = 0x000f;
regs.edx = 0x0002;
regs.es = 0x2000;
regs.ebx = 0x0000;
memcpy(mem, state, block_size);
iopl(3);
ioperm(0, 0x400, 1);
if(LRMI_int(0x10, ®s) == 0) {
LRMI_free_real(mem);
return;
}
if((regs.eax & 0xffff) != 0x004f) {
fprintf(stderr, "Get SuperVGA Video State Restore failed.\n");
return;
}
}
const void *vbe_save_svga_state()
{
struct LRMI_regs regs;
unsigned char *mem;
u_int16_t block_size;
void *data;
/* Initialize LRMI. */
if(LRMI_init() == 0) {
return NULL;
}
memset(®s, 0, sizeof(regs));
regs.eax = 0x4f04;
regs.ecx = 0xffff;
regs.edx = 0;
iopl(3);
ioperm(0, 0x400, 1);
if(LRMI_int(0x10, ®s) == 0) {
return NULL;
}
if((regs.eax & 0xff) != 0x4f) {
fprintf(stderr, "Get SuperVGA Video State not supported.\n");
return NULL;
}
if((regs.eax & 0xffff) != 0x004f) {
fprintf(stderr, "Get SuperVGA Video State Info failed.\n");
return NULL;
}
block_size = 64 * (regs.ebx & 0xffff);
/* Allocate a chunk of memory. */
mem = LRMI_alloc_real(block_size);
if(mem == NULL) {
return NULL;
}
memset(mem, 0, sizeof(block_size));
memset(®s, 0, sizeof(regs));
regs.eax = 0x4f04;
regs.ecx = 0x000f;
regs.edx = 0x0001;
regs.es = ((u_int32_t)mem) >> 4;
regs.ebx = ((u_int32_t)mem) & 0x0f;
memset(mem, 0, block_size);
iopl(3);
ioperm(0, 0x400, 1);
if(LRMI_int(0x10, ®s) == 0) {
LRMI_free_real(mem);
return NULL;
}
if((regs.eax & 0xffff) != 0x004f) {
fprintf(stderr, "Get SuperVGA Video State Save failed.\n");
return NULL;
}
data = malloc(block_size);
if(data == NULL) {
LRMI_free_real(mem);
return NULL;
}
/* Clean up and return. */
memcpy(data, mem, block_size);
LRMI_free_real(mem);
return data;
}
/* Get EDID info. */
struct vbe_edid1_info *vbe_get_edid_info(int adapter)
{
struct LRMI_regs regs;
unsigned char *mem;
struct vbe_edid1_info *ret = NULL;
u_int16_t man;
/* Initialize LRMI. */
if(LRMI_init() == 0) {
return NULL;
}
/* Allocate a chunk of memory. */
mem = LRMI_alloc_real(sizeof(struct vbe_edid1_info));
if(mem == NULL) {
return NULL;
}
memset(mem, 0, sizeof(struct vbe_edid1_info));
memset(®s, 0, sizeof(regs));
regs.eax = 0x4f15;
regs.ebx = 0x0001;
regs.ecx = adapter;
regs.es = ((u_int32_t)mem) >> 4;
regs.edi = ((u_int32_t)mem) & 0x0f;
/* Do it. */
iopl(3);
ioperm(0, 0x400, 1);
if(LRMI_int(0x10, ®s) == 0) {
LRMI_free_real(mem);
return NULL;
}
#if 0
/* Check for successful return. */
if((regs.eax & 0xffff) != 0x004f) {
LRMI_free_real(mem);
return NULL;
}
#elseif
/* Check for successful return. */
if((regs.eax & 0xff) != 0x4f) {
LRMI_free_real(mem);
return NULL;
}
#endif
/* Get memory for return. */
ret = malloc(sizeof(struct vbe_edid1_info));
if(ret == NULL) {
LRMI_free_real(mem);
return NULL;
}
/* Copy the buffer for return. */
memcpy(ret, mem, sizeof(struct vbe_edid1_info));
memcpy(&man, &ret->manufacturer_name, 2);
man = ntohs(man);
memcpy(&ret->manufacturer_name, &man, 2);
LRMI_free_real(mem);
return ret;
}
