WebSVN - shark - Rev 1621 - /shark/branches/xen/drivers/grx/drivers/gdvesa.c

/*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*
*/

#include <ll/i386/hw-data.h>
#include <ll/i386/mem.h>
#include <arch/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)
{
X_REGS16 inregs, outregs; /* registri normali */
X_SREGS16 sregs; /* registri estesi */
LIN_ADDR DOSaddr;
DWORD linearaddr;
#ifndef VM86
BYTE p1, p2;
#endif

/* 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));
#ifndef VM86
p1 = inp(0x21);
p2 = inp(0xA1);
outp(0x21,0xFF);
outp(0xA1,0xFF);
X_callBIOS(0x10, &inregs, &outregs, &sregs);
outp(0x21,p1);
outp(0xA1,p2);
#else
vm86_callBIOS(0x10, &inregs, &outregs, &sregs);
#endif
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]) {
//cprintf("%c", VendorName[i]);
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)
{
X_REGS16 inregs, outregs;
X_SREGS16 sregs;
LIN_ADDR dosaddr;
#ifndef VM86
BYTE p1, p2;
#endif

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);

#ifndef VM86
p1 = inp(0x21);
p2 = inp(0xA1);
outp(0x21,0xFF);
outp(0xA1,0xFF);
X_callBIOS(0x10, &inregs, &outregs, &sregs);
outp(0x21,p1);
outp(0xA1,p2);
#else
vm86_callBIOS(0x10, &inregs, &outregs, &sregs);
#endif
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)
{
X_REGS16 inregs, outregs;
X_SREGS16 sregs;
#ifndef VM86
BYTE p1, p2;
#endif

memset (&inregs, 0, sizeof(inregs));
/* Set Vesa Vbe mode */
inregs.x.ax = 0x4f02;
inregs.x.bx = Vbe_Mode;
#ifndef VM86
p1 = inp(0x21);
p2 = inp(0xA1);
outp(0x21,0xFF);
outp(0xA1,0xFF);
X_callBIOS(0x10, &inregs, &outregs, &sregs);
outp(0x21,p1);
outp(0xA1,p2);
#else
vm86_callBIOS(0x10, &inregs, &outregs, &sregs);
#endif

return 1; //vbe_check_status (outregs.x.ax);

}

WORD vbe_getbpr(ModeInfoBlock *ModeInfo)
{
return ModeInfo->BytesPerScanLine;
}

int vbe_setbank(ModeInfoBlock *ModeInfo, BYTE bank)
{
X_REGS16 inregs, outregs;
X_SREGS16 sregs;
#ifndef VM86
BYTE p1, p2;
#endif

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;
#ifndef VM86
p1 = inp(0x21);
p2 = inp(0xA1);
outp(0x21,0xFF);
outp(0xA1,0xFF);
X_callBIOS(0x10, &inregs, &outregs, &sregs);
outp(0x21,p1);
outp(0xA1,p2);
#else
vm86_callBIOS(0x10, &inregs, &outregs, &sregs);
#endif
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;
}

Subversion Repositories shark

(root)/shark/branches/xen/drivers/grx/drivers/gdvesa.c - Rev 1621