225 lines
5.2 KiB
C
225 lines
5.2 KiB
C
|
/*
|
|||
|
*
|
|||
|
* Copyright <EFBFBD> 2000 Keith Packard
|
|||
|
*
|
|||
|
* Permission to use, copy, modify, distribute, and sell this software and its
|
|||
|
* documentation for any purpose is hereby granted without fee, provided that
|
|||
|
* the above copyright notice appear in all copies and that both that
|
|||
|
* copyright notice and this permission notice appear in supporting
|
|||
|
* documentation, and that the name of Keith Packard not be used in
|
|||
|
* advertising or publicity pertaining to distribution of the software without
|
|||
|
* specific, written prior permission. Keith Packard makes no
|
|||
|
* representations about the suitability of this software for any purpose. It
|
|||
|
* is provided "as is" without express or implied warranty.
|
|||
|
*
|
|||
|
* KEITH PACKARD DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
|
|||
|
* INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
|
|||
|
* EVENT SHALL KEITH PACKARD BE LIABLE FOR ANY SPECIAL, INDIRECT OR
|
|||
|
* CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
|
|||
|
* DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
|
|||
|
* TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
|||
|
* PERFORMANCE OF THIS SOFTWARE.
|
|||
|
*/
|
|||
|
|
|||
|
#ifdef HAVE_CONFIG_H
|
|||
|
#include <kdrive-config.h>
|
|||
|
#endif
|
|||
|
#include "vesa.h"
|
|||
|
|
|||
|
static const VesaModeRec vgaModes[] = {
|
|||
|
{
|
|||
|
6, 0,
|
|||
|
MODE_SUPPORTED | MODE_GRAPHICS | MODE_VGA | MODE_LINEAR,
|
|||
|
1, 1, MEMORY_PLANAR,
|
|||
|
0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|||
|
640, 200, 80,
|
|||
|
},
|
|||
|
{
|
|||
|
0xd, 0,
|
|||
|
MODE_SUPPORTED | MODE_GRAPHICS | MODE_VGA | MODE_COLOUR,
|
|||
|
4, 4, MEMORY_PLANAR,
|
|||
|
0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|||
|
320, 200, 40,
|
|||
|
},
|
|||
|
{
|
|||
|
0xe, 0,
|
|||
|
MODE_SUPPORTED | MODE_GRAPHICS | MODE_VGA | MODE_COLOUR,
|
|||
|
4, 4, MEMORY_PLANAR,
|
|||
|
0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|||
|
640, 200, 80,
|
|||
|
},
|
|||
|
{
|
|||
|
0x10, 0,
|
|||
|
MODE_SUPPORTED | MODE_GRAPHICS | MODE_VGA | MODE_COLOUR,
|
|||
|
4, 4, MEMORY_PLANAR,
|
|||
|
0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|||
|
640, 350, 80,
|
|||
|
},
|
|||
|
{
|
|||
|
0x11, 0,
|
|||
|
MODE_SUPPORTED | MODE_GRAPHICS | MODE_VGA | MODE_LINEAR,
|
|||
|
1, 1, MEMORY_PLANAR,
|
|||
|
0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|||
|
640, 480, 80,
|
|||
|
},
|
|||
|
{
|
|||
|
0x12, 0,
|
|||
|
MODE_SUPPORTED | MODE_GRAPHICS | MODE_VGA | MODE_COLOUR,
|
|||
|
4, 4, MEMORY_PLANAR,
|
|||
|
0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|||
|
640, 480, 80,
|
|||
|
},
|
|||
|
{
|
|||
|
0x13, 0,
|
|||
|
MODE_SUPPORTED | MODE_GRAPHICS | MODE_VGA | MODE_COLOUR | MODE_LINEAR,
|
|||
|
8, 8, MEMORY_PSEUDO,
|
|||
|
0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|||
|
320, 200, 320,
|
|||
|
},
|
|||
|
};
|
|||
|
|
|||
|
#define NUM_VGA_MODE (sizeof vgaModes / sizeof vgaModes[0])
|
|||
|
|
|||
|
int VgaGetNmode(Vm86InfoPtr vi)
|
|||
|
{
|
|||
|
return NUM_VGA_MODE;
|
|||
|
}
|
|||
|
|
|||
|
int VgaGetModes(Vm86InfoPtr vi, VesaModePtr mode, int nmode)
|
|||
|
{
|
|||
|
if (nmode > NUM_VGA_MODE)
|
|||
|
nmode = NUM_VGA_MODE;
|
|||
|
memcpy(mode, vgaModes, nmode * sizeof(VesaModeRec));
|
|||
|
return nmode;
|
|||
|
}
|
|||
|
|
|||
|
int VgaSetMode(Vm86InfoPtr vi, int mode)
|
|||
|
{
|
|||
|
int code;
|
|||
|
|
|||
|
vi->vms.regs.eax = mode & 0x7f;
|
|||
|
code = Vm86DoInterrupt(vi, 0x10);
|
|||
|
if (code < 0)
|
|||
|
return -1;
|
|||
|
return 0;
|
|||
|
}
|
|||
|
|
|||
|
int VgaGetMode(Vm86InfoPtr vi, int *mode)
|
|||
|
{
|
|||
|
*mode = Vm86Memory(vi, 0x449);
|
|||
|
return 0;
|
|||
|
}
|
|||
|
|
|||
|
void VgaSetWritePlaneMask(Vm86InfoPtr vi, int mask)
|
|||
|
{
|
|||
|
asm volatile ("outb %b0,%w1"::"a" (2), "d"(0x3c4));
|
|||
|
asm volatile ("outb %b0,%w1"::"a" (mask), "d"(0x3c5));
|
|||
|
}
|
|||
|
|
|||
|
int VgaSetPalette(Vm86InfoPtr vi, int first, int number, U8 * entries)
|
|||
|
{
|
|||
|
U8 *palette_scratch;
|
|||
|
int mark;
|
|||
|
int palette_base;
|
|||
|
int i, j, code;
|
|||
|
|
|||
|
if (number == 0)
|
|||
|
return 0;
|
|||
|
|
|||
|
if (first < 0 || number < 0 || first + number > 256) {
|
|||
|
ErrorF("Cannot set %d, %d palette entries\n", first, number);
|
|||
|
return -1;
|
|||
|
}
|
|||
|
|
|||
|
mark = Vm86MarkMemory(vi);
|
|||
|
palette_base = Vm86AllocateMemory(vi, 3 * 256);
|
|||
|
|
|||
|
palette_scratch = &LM(vi, palette_base);
|
|||
|
|
|||
|
vi->vms.regs.eax = 0x1012;
|
|||
|
vi->vms.regs.ebx = first;
|
|||
|
vi->vms.regs.ecx = number;
|
|||
|
vi->vms.regs.es = POINTER_SEGMENT(palette_base);
|
|||
|
vi->vms.regs.edx = POINTER_OFFSET(palette_base);
|
|||
|
j = 0;
|
|||
|
i = 0;
|
|||
|
while (number--) {
|
|||
|
palette_scratch[j++] = entries[i++] >> 2;
|
|||
|
palette_scratch[j++] = entries[i++] >> 2;
|
|||
|
palette_scratch[j++] = entries[i++] >> 2;
|
|||
|
i++;
|
|||
|
}
|
|||
|
code = Vm86DoInterrupt(vi, 0x10);
|
|||
|
Vm86ReleaseMemory(vi, mark);
|
|||
|
|
|||
|
if (code < 0)
|
|||
|
return -1;
|
|||
|
return 0;
|
|||
|
}
|
|||
|
|
|||
|
int VgaGetPalette(Vm86InfoPtr vi, int first, int number, U8 * entries)
|
|||
|
{
|
|||
|
U8 *palette_scratch;
|
|||
|
int mark;
|
|||
|
int palette_base;
|
|||
|
int i, j, code;
|
|||
|
|
|||
|
if (number == 0)
|
|||
|
return 0;
|
|||
|
|
|||
|
if (first < 0 || number < 0 || first + number > 256) {
|
|||
|
ErrorF("Cannot get %d, %d palette entries\n", first, number);
|
|||
|
return -1;
|
|||
|
}
|
|||
|
|
|||
|
mark = Vm86MarkMemory(vi);
|
|||
|
palette_base = Vm86AllocateMemory(vi, 3 * 256);
|
|||
|
|
|||
|
palette_scratch = &LM(vi, palette_base);
|
|||
|
|
|||
|
vi->vms.regs.eax = 0x1017;
|
|||
|
vi->vms.regs.ebx = first;
|
|||
|
vi->vms.regs.ecx = number;
|
|||
|
vi->vms.regs.es = POINTER_SEGMENT(palette_base);
|
|||
|
vi->vms.regs.edx = POINTER_OFFSET(palette_base);
|
|||
|
|
|||
|
code = VbeDoInterrupt10(vi);
|
|||
|
if (code < 0)
|
|||
|
return -1;
|
|||
|
|
|||
|
j = 0;
|
|||
|
i = 0;
|
|||
|
while (number--) {
|
|||
|
entries[i++] = palette_scratch[j++] << 2;
|
|||
|
entries[i++] = palette_scratch[j++] << 2;
|
|||
|
entries[i++] = palette_scratch[j++] << 2;
|
|||
|
entries[i++] = 0;
|
|||
|
}
|
|||
|
|
|||
|
Vm86ReleaseMemory(vi, mark);
|
|||
|
|
|||
|
return 0;
|
|||
|
}
|
|||
|
|
|||
|
#define VGA_FB(vm) ((vm) < 8 ? 0xb8000 : 0xa0000)
|
|||
|
|
|||
|
void *VgaSetWindow(Vm86InfoPtr vi, int vmode, int bytes, int mode, int *size)
|
|||
|
{
|
|||
|
*size = 0x10000 - bytes;
|
|||
|
return &LM(vi, VGA_FB(vmode) + bytes);
|
|||
|
}
|
|||
|
|
|||
|
void *VgaMapFramebuffer(Vm86InfoPtr vi, int vmode, int *size, CARD32 * ret_phys)
|
|||
|
{
|
|||
|
if (VGA_FB(vmode) == 0xa0000)
|
|||
|
*size = 0x10000;
|
|||
|
else
|
|||
|
*size = 0x4000;
|
|||
|
*ret_phys = VGA_FB(vmode);
|
|||
|
return &LM(vi, VGA_FB(vmode));
|
|||
|
}
|
|||
|
|
|||
|
void VgaUnmapFramebuffer(Vm86InfoPtr vi)
|
|||
|
{
|
|||
|
}
|