2014-11-06 13:19:51 +01:00

288 lines
8.3 KiB
C

/*
* $XFree86: xc/programs/Xserver/hw/tinyx/vesa/vga.c,v 1.1 2004/06/02 22:43:03 dawes Exp $
*
* Copyright © 2000 Keith Packard, member of The XFree86 Project, Inc.
*
* 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.
*/
/*
* Copyright (c) 2004 by The XFree86 Project, Inc.
* All rights reserved.
*
* Permission is hereby granted, free of charge, to any person obtaining
* a copy of this software and associated documentation files (the
* "Software"), to deal in the Software without restriction, including
* without limitation the rights to use, copy, modify, merge, publish,
* distribute, sublicense, and/or sell copies of the Software, and to
* permit persons to whom the Software is furnished to do so, subject
* to the following conditions:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions, and the following disclaimer.
*
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer
* in the documentation and/or other materials provided with the
* distribution, and in the same place and form as other copyright,
* license and disclaimer information.
*
* 3. The end-user documentation included with the redistribution,
* if any, must include the following acknowledgment: "This product
* includes software developed by The XFree86 Project, Inc
* (http://www.xfree86.org/) and its contributors", in the same
* place and form as other third-party acknowledgments. Alternately,
* this acknowledgment may appear in the software itself, in the
* same form and location as other such third-party acknowledgments.
*
* 4. Except as contained in this notice, the name of The XFree86
* Project, Inc shall not be used in advertising or otherwise to
* promote the sale, use or other dealings in this Software without
* prior written authorization from The XFree86 Project, Inc.
*
* THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESSED OR IMPLIED
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE XFREE86 PROJECT, INC OR ITS CONTRIBUTORS BE
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
* OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
* OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#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));
}
void
VgaSetReadPlaneMap(Vm86InfoPtr vi, int map)
{
__asm__ volatile ("outb %b0,%w1" : : "a" (4), "d" (0x3ce));
__asm__ volatile ("outb %b0,%w1" : : "a" (map), "d" (0x3cf));
}
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 = (U8 *)&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 = (U8 *)&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)
{
}