Blame |
Last modification |
View Log
| RSS feed
#include <ll/i386/hw-data.h>
#include <ll/i386/mem.h>
#include <ll/i386/string.h>
#include <ll/i386/x-dos.h>
#include <ll/i386/x-dosmem.h>
#include <ll/i386/cons.h>
#include <ll/sys/ll/ll-func.h>
#include "vesa.h"
#include "chips.h"
VbeInfoBlock VbeInfo
; /* VBE 2.0 Informations */
DWORD vbe_screen
; /* Frame Linear Buffer Address */
char VideoModeNames
[96][40] = {
"100 - 640x400 256 colors", "101 - 640x480 256 colors", "102 - 800x600 16 colors",
"103 - 800x600 256 colors", "104 - 1024x768 16 colors", "105 - 1024x768 256 colors",
"106 - 1280x1024 16 colors", "107 - 1280x1024 256 colors", "108 - 80x60 Text Mode",
"109 - 132x25 Text Mode", "10A - 132x43 Text Mode", "10B - 132x50 Text Mode",
"10C - 132x60 Text Mode", "10D - 320x200 32,768 colors", "10E - 320x200 65,536 colors",
"10F - 320x200 16m colors", "110 - 640x480 32,768 colors", "111 - 640x480 65,536 colors",
"112 - 640x480 16m colors", "113 - 800x600 32,768 colors", "114 - 800x600 65,536 colors",
"115 - 800x600 16m colors", "116 - 1024x768 32,768 colors", "117 - 1024x768 65,536 colors",
"118 - 1024x768 16m colors", "119 - 1280x1024 32,768 colors", "11A - 1280x1024 65,536 colors",
"11B - 1280x1024 16m colors", "11C - 640x350 256 colors", "11D - 640x350 32,768 colors",
"11E - 640x400 32,768 colors", "11F - 640x350 65,536 colors", "120 - 640x400 65,536 colors",
"121 - 640x350 16m colors", "122 - 640x400 16m colors", "123 - 1600x1200 16 colors",
"124 - 1600x1200 256 colors", "125 - 1600x1200 32,768 colors", "126 - 1600x1200 65,536 colors",
"127 - 1600x1200 16m colors", "128 - 640x480 16m colors(*)", "129 - 800x600 16m colors(*)",
"12A - 1024x768 16m colors(*)", "12B - 1280x1024 16m colors(*)", "12C - 1600x1200 16m colors(*)",
"12D - 320x240 32,768 colors", "12E - 320x400 32,768 colors", "12F - 360x200 32,768 colors",
"130 - 360x240 32,768 colors", "131 - 360x400 32,768 colors", "132 - 320x240 65,536 colors",
"133 - 320x400 65,536 colors", "134 - 360x200 65,536 colors", "135 - 360x240 65,536 colors",
"136 - 360x400 65,536 colors", "137 - 320x240 16m colors", "138 - 320x400 16m colors",
"139 - name n/a", "13A - name n/a", "13B - name n/a",
"13C - name n/a", "13D - name n/a", "13E - name n/a",
"13F - name n/a", "140 - name n/a", "141 - name n/a",
"142 - 640x350 16m colors(*)", "143 - 640x400 16m colors(*)", "144 - name n/a",
"145 - name n/a", "146 - name n/a", "147 - name n/a",
"148 - name n/a", "149 - name n/a", "14A - name n/a",
"14B - name n/a", "14C - name n/a", "14D - name n/a",
"14E - name n/a", "14F - name n/a", "150 - 640x350 16 colors",
"151 - 640x400 16 colors", "152 - 640x480 16 colors", "153 - 320x200 256 colors",
"154 - 320x240 256 colors", "155 - 320x400 256 colors", "156 - 360x200 256 colors",
"157 - 360x240 256 colors", "158 - 360x400 256 colors", "159 - name n/a",
"15A - name n/a", "15B - name n/a", "15C - name n/a",
"15D - name n/a", "15E - name n/a", "15F - name n/a"
};
int vbe_check_status
(WORD vbe_function_result
)
{
/*
if (vbe_function_result != 0x004f) {
cprintf("\nWarning! There was an error: (%x) ", vbe_function_result);
switch (vbe_function_result) {
case 0x014f : cprintf("generic."); break;
case 0x024f : cprintf("hardware incompatibility."); break;
case 0x034f : cprintf("unvalid function."); break;
default : cprintf("unknown error %x.\n", vbe_function_result);
}
*/
if (vbe_function_result
!= 0x004f) {
switch (vbe_function_result
) {
case 0x014f : return -1; /* VBE Generic error */
case 0x024f : return -2; /* Hardware incompatibility error */
case 0x034f : return -3; /* Unvalid function requested */
default : return -4; /* Unknown error */
}
}
return 1;
}
int vbe_getinfo
(void)
{
BYTE p1
,p2
;
X_REGS16 inregs
, outregs
; /* registri normali */
X_SREGS16 sregs
; /* registri estesi */
LIN_ADDR DOSaddr
;
DWORD linearaddr
;
/* Allochiamo mem per il nostro blocco */
if ((DOSaddr
= DOS_alloc
(sizeof(VbeInfoBlock
))) == 0) {
/* set_text_mode ();*/
return -1;
} else {
/* linearaddr = appl2linear(DOSaddr);*/
linearaddr
= (DWORD
) DOSaddr
;
/* 0x00 = Get Vbe2.0 Info */
inregs.
x.
ax = 0x4f00;
/* Indirizzo reale del nostro blocco */
inregs.
x.
di = linearaddr
& 0x000F;
sregs.
es = ((linearaddr
& 0xFFFF0) >> 4);
sregs.
ds = ((linearaddr
& 0xFFFF0) >> 4);
/* Settiamo il VbeSignature correttamente */
VbeInfo.
VbeSignature[0] = 'V';
VbeInfo.
VbeSignature[1] = 'B';
VbeInfo.
VbeSignature[2] = 'E';
VbeInfo.
VbeSignature[3] = '2';
memcpy((void *)linearaddr
, &VbeInfo
, sizeof(VbeInfo
));
p1
= inp
(0x21);
p2
= inp
(0xA1);
outp
(0x21,0xFF);
outp
(0xA1,0xFF);
X_callBIOS
(0x10, &inregs
, &outregs
, &sregs
);
outp
(0x21,p1
);
outp
(0xA1,p2
);
if (vbe_check_status
(outregs.
x.
ax) < 0)
return -1;
memcpy(&VbeInfo
, (void *)linearaddr
, sizeof(VbeInfo
));
return 1;
}
}
int vbe_check
(char *key
)
{
LIN_ADDR VendorNameaddr
;
char VendorName
[256];
int i
, k
, len
, found
;
found
= CHIP_NOT_FOUND
;
VendorNameaddr
= (void *)((VbeInfo.
OemNameSegment<<4) + VbeInfo.
OemNameOffset);
memcpy(VendorName
, VendorNameaddr
, 256);
len
= strlen(key
);
for (i
= 0; i
<= 512 - len
; i
++) {
if (VendorName
[i
] == key
[0]) {
found
= CHIP_FOUND
;
for (k
= 1; k
< len
; k
++) {
if (VendorName
[i
+ k
] != key
[k
]) found
= CHIP_NOT_FOUND
;
}
if (found
== CHIP_FOUND
) return found
;
}
}
return found
;
}
int vbe_check_id
(void)
{
if (vbe_check
("Chips") == CHIP_FOUND
) return CHIPS
;
if (vbe_check
("Cirrus") == CHIP_FOUND
) return CIRRUS
;
if (vbe_check
("Diamond") == CHIP_FOUND
) return DIAMOND
;
if (vbe_check
("ITT") == CHIP_FOUND
) return ITT
;
if (vbe_check
("Western Digital") == CHIP_FOUND
) return WD
;
if (vbe_check
("S3") == CHIP_FOUND
) return S3
;
if (vbe_check
("Trident") == CHIP_FOUND
) return TRIDENT
;
if (vbe_check
("Tseng") == CHIP_FOUND
) return TSENG
;
return UNKNOWN
;
}
void vbe_showinfo
(void)
{
char Name
[256], VendorName
[256], ProductName
[256], ProductRev
[256];
LIN_ADDR Nameaddr
, VendorNameaddr
, ProductNameaddr
, ProductRevaddr
;
Nameaddr
= (LIN_ADDR
)((VbeInfo.
OemNameSegment<<4) + VbeInfo.
OemNameOffset);
memcpy(Name
, Nameaddr
, 256);
VendorNameaddr
= (LIN_ADDR
)((VbeInfo.
OemVendorNameSegment<<4) + VbeInfo.
OemVendorNameOffset);
memcpy(VendorName
, VendorNameaddr
, 256);
ProductNameaddr
= (LIN_ADDR
)((VbeInfo.
OemProductNameSegment<<4) + VbeInfo.
OemProductNameOffset);
memcpy(ProductName
, ProductNameaddr
, 256);
ProductRevaddr
= (LIN_ADDR
)((VbeInfo.
OemProductRevSegment<<4) + VbeInfo.
OemProductRevOffset);
memcpy(ProductRev
, ProductRevaddr
, 256);
cprintf
("\n");
cprintf
("Software ................. %s\n", Name
);
if (VendorNameaddr
== 0) cprintf
("Vendor Name .............. n/a\n");
else cprintf
("Vendor Name .............. %s\n", VendorName
);
if (ProductNameaddr
== 0) cprintf
("Product Name ............. n/a\n");
else cprintf
("Product Name ............. %s\n", ProductName
);
if (ProductRevaddr
== 0) cprintf
("Product Revision ......... n/a\n");
else cprintf
("Product Revision ......... %s\n", ProductRev
);
cprintf
("--------------------------------------------------------\n");
cprintf
("Driver Version............ %d.%d\n", VbeInfo.
VbeVersion/100,
VbeInfo.
VbeVersion%100);
cprintf
("Total Memory OnBoard...... %d Kb\n", VbeInfo.
TotalMemory<<6);
cprintf
("Capabilities:\n");
(VbeInfo.
Capabilities[0]&1) ? cprintf
(" - DAC is fixed width, with 6 bits per primary color\n")
: cprintf
(" - DAC width is switchable to 8 bits per primary color\n");
(VbeInfo.
Capabilities[0]&2) ? cprintf
(" - Controller is VGA compatible\n")
: cprintf
(" - Controller is not VGA compatible\n");
(VbeInfo.
Capabilities[0]&3) ? cprintf
(" - Normal RAMDAC operation\n")
: cprintf
(" - RAMDAC recommends programming during blank period only\n");
}
void vbe_showmodes
(void)
{
short int modec
;
WORD list
;
LIN_ADDR VideoModeaddr
;
list
=0;
VideoModeaddr
= (LIN_ADDR
)((VbeInfo.
SupportedModesSegment<<4) + VbeInfo.
SupportedModesOffset);
cprintf
("\nList of modes supported:\n");
do {
/*modec = (unsigned char) DOSPeek(VideoModePtr);*/
memcpy(&modec
, VideoModeaddr
, 2);
VideoModeaddr
+= 2;
if (modec
!= -1) cprintf
(" %s ", VideoModeNames
[modec
- 0x100]);
/* cprintf("%x/%d ", modec, (modec & 0xFF));*/
list
++;
if (list
% 2 == 0) cprintf
("\n");
} while ((modec
!= -1) && (list
< 40));
cprintf
("\nToal modes supported: %d", list
);
}
DWORD vbe_getmodeinfo
(ModeInfoBlock
*ModeInfo
, WORD Vbe_Mode
)
{
BYTE p1
,p2
;
X_REGS16 inregs
, outregs
;
X_SREGS16 sregs
;
LIN_ADDR dosaddr
;
if ((dosaddr
= DOS_alloc
(sizeof(ModeInfoBlock
))) == 0) {
/* set_text_mode ();*/
return(-1);
}
/* linearaddr = far2linear(DOSaddr); */
/* 0x01 = Get Vbe Mode Info */
inregs.
x.
ax = 0x4f01;
inregs.
x.
cx = Vbe_Mode
;
inregs.
x.
di = (DWORD
)dosaddr
& 0x000F;
sregs.
es = (((DWORD
)dosaddr
& 0xFFFF0) >> 4);
sregs.
ds = (((DWORD
)dosaddr
& 0xFFFF0) >> 4);
p1
= inp
(0x21);
p2
= inp
(0xA1);
outp
(0x21,0xFF);
outp
(0xA1,0xFF);
X_callBIOS
(0x10, &inregs
, &outregs
, &sregs
);
outp
(0x21,p1
);
outp
(0xA1,p2
);
if (vbe_check_status
(outregs.
x.
ax) < 0) {
return -1;
}
memcpy(ModeInfo
, dosaddr
, sizeof(ModeInfoBlock
));
vbe_screen
= ModeInfo
->PhysBasePtr
;
if(vbe_screen
== -1) {
return -1;
}
return vbe_screen
;
}
DWORD vbe_getflb
(void)
{
return vbe_screen
;
}
int vbe_setmode
(WORD Vbe_Mode
)
{
BYTE p1
,p2
;
X_REGS16 inregs
, outregs
;
X_SREGS16 sregs
;
/* Se volessimo il Linear Frame Buffer, dovremmo fare
Vbe_Mode = Vbe_Mode | 0x4000;
*/
memset (&inregs
, 0, sizeof(inregs
));
/* Set Vesa Vbe mode */
inregs.
x.
ax = 0x4f02;
inregs.
x.
bx = Vbe_Mode
;
p1
= inp
(0x21);
p2
= inp
(0xA1);
outp
(0x21,0xFF);
outp
(0xA1,0xFF);
X_callBIOS
(0x10, &inregs
, &outregs
, &sregs
);
outp
(0x21,p1
);
outp
(0xA1,p2
);
return vbe_check_status
(outregs.
x.
ax);
}
WORD vbe_getbpr
(ModeInfoBlock
*ModeInfo
)
{
return ModeInfo
->BytesPerScanLine
;
}
int vbe_setbank
(ModeInfoBlock
*ModeInfo
, BYTE bank
)
{
BYTE p1
,p2
;
X_REGS16 inregs
, outregs
;
X_SREGS16 sregs
;
memset (&inregs
, 0, sizeof(inregs
));
memset (&sregs
, 0, sizeof(sregs
));
/* Set Window */
inregs.
x.
ax = 0x4f05;
inregs.
h.
bh = 0x00;
inregs.
h.
bl = 0x00;
inregs.
x.
dx = (64 / ModeInfo
->WinGranularity
) * bank
;
p1
= inp
(0x21);
p2
= inp
(0xA1);
outp
(0x21,0xFF);
outp
(0xA1,0xFF);
X_callBIOS
(0x10, &inregs
, &outregs
, &sregs
);
outp
(0x21,p1
);
outp
(0xA1,p2
);
return vbe_check_status
(outregs.
x.
ax);
}
void vbe_showmodeinfo
(ModeInfoBlock
*ModeInfo
)
{
cprintf
("\n Mode: %dx%dx%d (%d bits)", ModeInfo
->XResolution
,
ModeInfo
->YResolution
,
ModeInfo
->BitsPerPixel
<<5,
ModeInfo
->BitsPerPixel
);
(ModeInfo
->ModeAttributes
&1)? cprintf
("\n - Mode SUPPORTED in hardware configuration")
: cprintf
("\n - Mode NOT supported in hardware configuration");
(ModeInfo
->ModeAttributes
&5)? cprintf
("\n - Color Mode")
: cprintf
("\n - Text Mode");
(ModeInfo
->ModeAttributes
&6)? cprintf
("\n - Not VGA compatible")
: cprintf
("\n - VGA compatible");
(ModeInfo
->ModeAttributes
&7)? cprintf
("\n - Windowed memory mode available")
: cprintf
("\n - Windowed memory NOT mode available");
(ModeInfo
->ModeAttributes
&8)? cprintf
("\n - Linear Frame Buffer available :-)")
: cprintf
("\n - Linear Frame Buffer NOT available :-(");
cprintf
("\n\n Bytes Per ScanLine %d", ModeInfo
->BytesPerScanLine
);
cprintf
("\n\n Window A Attributes:");
(ModeInfo
->WinAAttributes
&1)? cprintf
("\n - Window is relocatable")
: cprintf
("\n - Window is not relocatable");
(ModeInfo
->WinAAttributes
&2)? cprintf
("\n - Window is readable")
: cprintf
("\n - Window is not readable");
(ModeInfo
->WinAAttributes
&3)? cprintf
("\n - Window is writeable")
: cprintf
("\n - Window is not writeable");
/* Tolgo x leggere...
cprintf ("\n\n Window B Attributes:");
(ModeInfo->WinBAttributes&1)? cprintf ("\n - Window is relocatable")
: cprintf ("\n - Window is not relocatable");
(ModeInfo->WinBAttributes&2)? cprintf ("\n - Window is readable")
: cprintf ("\n - Window is not readable");
(ModeInfo->WinBAttributes&3)? cprintf ("\n - Window is writeable")
: cprintf ("\n - Window is not writeable");
*/
cprintf
("\n\n Window granularity %u Kb", ModeInfo
->WinGranularity
);
cprintf
("\n Window size %u Kb", ModeInfo
->WinSize
);
cprintf
("\n Segment: %x", ModeInfo
->WinBSegment
);
cprintf
("\n\n Memory Model is ");
switch (ModeInfo
->MemoryModel
)
{
case 0x00: cprintf
("Text Mode"); break;
case 0x01: cprintf
("CGA Graphics"); break;
case 0x02: cprintf
("Hercules Graphics"); break;
case 0x03: cprintf
("Planar"); break;
case 0x04: cprintf
("Packed Pixel"); break;
case 0x05: cprintf
("Non-chain 4, 256 color"); break;
case 0x06: cprintf
("Direct Color"); break;
case 0x07: cprintf
("YUV Color"); break;
default: cprintf
("to be defined by OEM");
}
cprintf
("\n Number of Banks %u", ModeInfo
->NumberOfBanks
);
cprintf
("\n Bank Size %u Kb\n", ModeInfo
->BankSize
);
/* cprintf ("\n Red Mask Size %d (%d)", ModeInfo->RedMaskSize, ModeInfo->RedFieldPosition);
cprintf ("\n Green Mask Size %d (%d)", ModeInfo->GreenMaskSize, ModeInfo->GreenFieldPosition);
cprintf ("\n Blue Mask Size %d (%d)", ModeInfo->BlueMaskSize, ModeInfo->BlueFieldPosition);
cprintf ("\n\nColor Mode Info:");
(ModeInfo->DirectColorModeInfo&1)? cprintf ("\n - Color ramp is programmable")
: cprintf ("\n - Color ramp is fixed");
(ModeInfo->DirectColorModeInfo&2)? cprintf ("\n - Bits in Rsvd are usable")
: cprintf ("\n - Bits in Rsvd are reserved");*/
}
int vbe_checkmode
(WORD mode
)
{
LIN_ADDR VideoModeaddr
;
short int modec
;
BYTE done
;
done
= 0;
VideoModeaddr
= (LIN_ADDR
)((VbeInfo.
SupportedModesSegment<<4) + VbeInfo.
SupportedModesOffset);
do {
memcpy(&modec
, VideoModeaddr
, 2);
VideoModeaddr
+= 2;
if ((modec
!= -1) && (modec
== mode
)) {
done
= 1;
}
} while ((modec
!= -1) && (!done
));
if (done
== 1) return 1;
return -1;
}
DWORD vbe_getmem
(void)
{
return (VbeInfo.
TotalMemory<<6) * 1024;
}