1#include <string.h>
2#include <stdio.h>
3#include <lib/sys/vesa/vesa.h>
4#include "sysdump.h"
5
6void dump_vesa_tables(struct upload_backend *be)
7{
8    com32sys_t rm;
9    struct vesa_info *vip;
10    struct vesa_general_info *gip, gi;
11    struct vesa_mode_info *mip, mi;
12    uint16_t mode, *mode_ptr;
13    char modefile[64];
14
15    printf("Scanning VESA BIOS... ");
16
17    /* Allocate space in the bounce buffer for these structures */
18    vip = lmalloc(sizeof *vip);
19    gip = &vip->gi;
20    mip = &vip->mi;
21
22    memset(&rm, 0, sizeof rm);
23    memset(gip, 0, sizeof *gip);
24
25    gip->signature = VBE2_MAGIC;	/* Get VBE2 extended data */
26    rm.eax.w[0] = 0x4F00;		/* Get SVGA general information */
27    rm.edi.w[0] = OFFS(gip);
28    rm.es = SEG(gip);
29    __intcall(0x10, &rm, &rm);
30    memcpy(&gi, gip, sizeof gi);
31
32    if (rm.eax.w[0] != 0x004F)
33	return;		/* Function call failed */
34    if (gi.signature != VESA_MAGIC)
35	return;		/* No magic */
36
37    cpio_mkdir(be, "vesa");
38
39    cpio_writefile(be, "vesa/global.bin", &gi, sizeof gi);
40
41    mode_ptr = GET_PTR(gi.video_mode_ptr);
42    while ((mode = *mode_ptr++) != 0xFFFF) {
43	memset(mip, 0, sizeof *mip);
44        memset(&rm, 0, sizeof rm);
45	rm.eax.w[0] = 0x4F01;	/* Get SVGA mode information */
46	rm.ecx.w[0] = mode;
47	rm.edi.w[0] = OFFS(mip);
48	rm.es = SEG(mip);
49	__intcall(0x10, &rm, &rm);
50
51	/* Must be a supported mode */
52	if (rm.eax.w[0] != 0x004f)
53	    continue;
54
55	memcpy(&mi, mip, sizeof mi);
56
57	sprintf(modefile, "vesa/mode%04x.bin", mode);
58	cpio_writefile(be, modefile, &mi, sizeof mi);
59    }
60
61    lfree(vip);
62    printf("done.\n");
63}
64