/* 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_from(char *data)
{
struct LRMI_regs r;
/* VGA BIOS mode 3 is text mode */
do_set_mode(3,1);
memset(&r, 0, sizeof(r));
r.eax = 0x4f04;
r.ecx = 0xf; /* all states */
r.edx = 2; /* restore state */
r.es = (unsigned int) (data - LRMI_base_addr()) >> 4;
r.ebx = (unsigned int) (data - LRMI_base_addr()) & 0xf;
r.ds = 0x0040;
if (!LRMI_int(0x10, &r)) {
fprintf(stderr,
"Can't restore video state (vm86 failure)\n");
} else if ((r.eax & 0xffff) != 0x4f) {
fprintf(stderr, "Restore video state failed\n");
}
LRMI_free_real(data);
ioctl(0, KDSETMODE, KD_TEXT);
}
inline void v86_mem_free(u32 m) {
LRMI_free_real((void*)m);
}
/* 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;
}
