diff options
Diffstat (limited to 'lib/libvgl/main.c')
| -rw-r--r-- | lib/libvgl/main.c | 477 |
1 files changed, 477 insertions, 0 deletions
diff --git a/lib/libvgl/main.c b/lib/libvgl/main.c new file mode 100644 index 0000000..8211842 --- /dev/null +++ b/lib/libvgl/main.c @@ -0,0 +1,477 @@ +/*- + * Copyright (c) 1991-1997 Søren Schmidt + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer + * in this position and unchanged. + * 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. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software withough specific prior written permission + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS 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 AUTHOR 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. + * + * $FreeBSD$ + */ + +#include <stdio.h> +#include <sys/types.h> +#include <sys/signal.h> +#include <sys/file.h> +#include <sys/ioctl.h> +#include <sys/mman.h> +#include <machine/console.h> +#include "vgl.h" + +#define min(x, y) (((x) < (y)) ? (x) : (y)) +#define max(x, y) (((x) > (y)) ? (x) : (y)) + +VGLBitmap *VGLDisplay; +video_info_t VGLModeInfo; +video_adapter_info_t VGLAdpInfo; +byte *VGLBuf; + +static int VGLMode; +static int VGLOldMode; +static size_t VGLBufSize; +static byte *VGLMem = MAP_FAILED; +static int VGLSwitchPending; +static int VGLOnDisplay; +static unsigned int VGLCurWindow; +static int VGLInitDone = 0; + +void +VGLEnd() +{ +struct vt_mode smode; + + if (!VGLInitDone) + return; + VGLInitDone = 0; + + signal(SIGUSR1, SIG_IGN); + + if (VGLMem != MAP_FAILED) { + VGLClear(VGLDisplay, 0); + munmap(VGLMem, VGLAdpInfo.va_window_size); + } + + if (VGLOldMode >= M_VESA_BASE) { + /* ugly, but necessary */ + ioctl(0, _IO('V', VGLOldMode - M_VESA_BASE), 0); + if (VGLOldMode == M_VESA_800x600) { + int size[3]; + size[0] = 80; + size[1] = 25; + size[2] = 16; + ioctl(0, KDRASTER, size); + } + } else { + ioctl(0, _IO('S', VGLOldMode), 0); + } + ioctl(0, KDDISABIO, 0); + ioctl(0, KDSETMODE, KD_TEXT); + smode.mode = VT_AUTO; + ioctl(0, VT_SETMODE, &smode); + if (VGLBuf) + free(VGLBuf); + VGLBuf = NULL; + free(VGLDisplay); + VGLDisplay = NULL; + VGLKeyboardEnd(); +} + +static void +VGLAbort() +{ + VGLEnd(); + exit(0); +} + +static void +VGLSwitch() +{ + if (!VGLOnDisplay) + VGLOnDisplay = 1; + else + VGLOnDisplay = 0; + VGLSwitchPending = 1; + signal(SIGUSR1, VGLSwitch); +} + +int +VGLInit(int mode) +{ + struct vt_mode smode; + int adptype; + + if (VGLInitDone) + return -1; + + signal(SIGUSR1, VGLSwitch); + signal(SIGINT, VGLAbort); + signal(SIGTERM, VGLAbort); + signal(SIGSEGV, VGLAbort); + signal(SIGBUS, VGLAbort); + + VGLOnDisplay = 1; + VGLSwitchPending = 0; + + if (ioctl(0, CONS_GET, &VGLOldMode) || ioctl(0, CONS_CURRENT, &adptype)) + return -1; + if (IOCGROUP(mode) == 'V') /* XXX: this is ugly */ + VGLModeInfo.vi_mode = (mode & 0x0ff) + M_VESA_BASE; + else + VGLModeInfo.vi_mode = mode & 0x0ff; + if (ioctl(0, CONS_MODEINFO, &VGLModeInfo)) /* FBIO_MODEINFO */ + return -1; + + VGLDisplay = (VGLBitmap *)malloc(sizeof(VGLBitmap)); + if (VGLDisplay == NULL) + return -2; + + if (ioctl(0, KDENABIO, 0)) { + free(VGLDisplay); + return -3; + } + + VGLInitDone = 1; + + /* + * vi_mem_model specifies the memory model of the current video mode + * in -CURRENT. + */ + switch (VGLModeInfo.vi_mem_model) { + case V_INFO_MM_PLANAR: + /* we can handle EGA/VGA planner modes only */ + if (VGLModeInfo.vi_depth != 4 || VGLModeInfo.vi_planes != 4 + || (adptype != KD_EGA && adptype != KD_VGA)) { + VGLEnd(); + return -4; + } + VGLDisplay->Type = VIDBUF4; + break; + case V_INFO_MM_PACKED: + /* we can do only 256 color packed modes */ + if (VGLModeInfo.vi_depth != 8) { + VGLEnd(); + return -4; + } + VGLDisplay->Type = VIDBUF8; + break; + case V_INFO_MM_VGAX: + VGLDisplay->Type = VIDBUF8X; + break; + default: + VGLEnd(); + return -4; + } + + ioctl(0, VT_WAITACTIVE, 0); + ioctl(0, KDSETMODE, KD_GRAPHICS); + if (ioctl(0, mode, 0)) { + VGLEnd(); + return -5; + } + if (ioctl(0, CONS_ADPINFO, &VGLAdpInfo)) { /* FBIO_ADPINFO */ + VGLEnd(); + return -6; + } + + /* + * Calculate the shadow screen buffer size. In -CURRENT, va_buffer_size + * always holds the entire frame buffer size, wheather it's in the linear + * mode or windowed mode. + * VGLBufSize = VGLAdpInfo.va_buffer_size; + * In -STABLE, va_buffer_size holds the frame buffer size, only if + * the linear frame buffer mode is supported. Otherwise the field is zero. + * We shall calculate the minimal size in this case: + * VGLAdpInfo.va_line_width*VGLModeInfo.vi_height*VGLModeInfo.vi_planes + * or + * VGLAdpInfo.va_window_size*VGLModeInfo.vi_planes; + * Use whichever is larger. + */ + if (VGLAdpInfo.va_buffer_size != 0) + VGLBufSize = VGLAdpInfo.va_buffer_size; + else + VGLBufSize = max(VGLAdpInfo.va_line_width*VGLModeInfo.vi_height, + VGLAdpInfo.va_window_size)*VGLModeInfo.vi_planes; + VGLBuf = malloc(VGLBufSize); + if (VGLBuf == NULL) { + VGLEnd(); + return -7; + } + +#ifdef LIBVGL_DEBUG + fprintf(stderr, "VGLBufSize:0x%x\n", VGLBufSize); +#endif + + /* see if we are in the windowed buffer mode or in the linear buffer mode */ + if (VGLBufSize/VGLModeInfo.vi_planes > VGLAdpInfo.va_window_size) { + if (VGLDisplay->Type == VIDBUF4) + VGLDisplay->Type = VIDBUF4S; + else if (VGLDisplay->Type == VIDBUF8) + VGLDisplay->Type = VIDBUF8S; + } + + VGLMode = mode; + VGLCurWindow = 0; + + VGLDisplay->Xsize = VGLModeInfo.vi_width; + VGLDisplay->Ysize = VGLModeInfo.vi_height; + VGLDisplay->VXsize = VGLAdpInfo.va_line_width + *8/(VGLModeInfo.vi_depth/VGLModeInfo.vi_planes); + VGLDisplay->VYsize = VGLBufSize/VGLModeInfo.vi_planes/VGLAdpInfo.va_line_width; + VGLDisplay->Xorigin = 0; + VGLDisplay->Yorigin = 0; + + VGLMem = (byte*)mmap(0, VGLAdpInfo.va_window_size, PROT_READ|PROT_WRITE, + MAP_FILE, 0, 0); + if (VGLMem == MAP_FAILED) { + VGLEnd(); + return -7; + } + VGLDisplay->Bitmap = VGLMem; + + VGLSavePalette(); + +#ifdef LIBVGL_DEBUG + fprintf(stderr, "va_line_width:%d\n", VGLAdpInfo.va_line_width); + fprintf(stderr, "VGLXsize:%d, Ysize:%d, VXsize:%d, VYsize:%d\n", + VGLDisplay->Xsize, VGLDisplay->Ysize, + VGLDisplay->VXsize, VGLDisplay->VYsize); +#endif + + smode.mode = VT_PROCESS; + smode.waitv = 0; + smode.relsig = SIGUSR1; + smode.acqsig = SIGUSR1; + smode.frsig = SIGINT; + if (ioctl(0, VT_SETMODE, &smode)) { + VGLEnd(); + return -9; + } + VGLTextSetFontFile((byte*)0); + VGLClear(VGLDisplay, 0); + return 0; +} + +void +VGLCheckSwitch() +{ + while (VGLSwitchPending) { + unsigned int offset; + unsigned int len; + int i; + + VGLSwitchPending = 0; + if (VGLOnDisplay) { + ioctl(0, KDENABIO, 0); + ioctl(0, KDSETMODE, KD_GRAPHICS); + ioctl(0, VGLMode, 0); + VGLCurWindow = 0; + VGLMem = (byte*)mmap(0, VGLAdpInfo.va_window_size, PROT_READ|PROT_WRITE, + MAP_FILE, 0, 0); + + /* XXX: what if mmap() has failed! */ + VGLDisplay->Type = VIDBUF8; /* XXX */ + switch (VGLModeInfo.vi_mem_model) { + case V_INFO_MM_PLANAR: + if (VGLModeInfo.vi_depth == 4 && VGLModeInfo.vi_planes == 4) { + if (VGLBufSize/VGLModeInfo.vi_planes > VGLAdpInfo.va_window_size) + VGLDisplay->Type = VIDBUF4S; + else + VGLDisplay->Type = VIDBUF4; + } else { + /* shouldn't be happening */ + } + break; + case V_INFO_MM_PACKED: + if (VGLModeInfo.vi_depth == 8) { + if (VGLBufSize/VGLModeInfo.vi_planes > VGLAdpInfo.va_window_size) + VGLDisplay->Type = VIDBUF8S; + else + VGLDisplay->Type = VIDBUF8; + } else { + /* shouldn't be happening */ + } + break; + case V_INFO_MM_VGAX: + VGLDisplay->Type = VIDBUF8X; + break; + default: + /* shouldn't be happening */ + break; + } + + VGLDisplay->Bitmap = VGLMem; + VGLDisplay->Xsize = VGLModeInfo.vi_width; + VGLDisplay->Ysize = VGLModeInfo.vi_height; + VGLSetVScreenSize(VGLDisplay, VGLDisplay->VXsize, VGLDisplay->VYsize); + VGLPanScreen(VGLDisplay, VGLDisplay->Xorigin, VGLDisplay->Yorigin); + switch (VGLDisplay->Type) { + case VIDBUF4S: + outb(0x3c6, 0xff); + outb(0x3ce, 0x01); outb(0x3cf, 0x00); /* set/reset enable */ + outb(0x3ce, 0x08); outb(0x3cf, 0xff); /* bit mask */ + for (offset = 0; offset < VGLBufSize/VGLModeInfo.vi_planes; + offset += len) { + VGLSetSegment(offset); + len = min(VGLBufSize/VGLModeInfo.vi_planes - offset, + VGLAdpInfo.va_window_size); + for (i = 0; i < VGLModeInfo.vi_planes; i++) { + outb(0x3c4, 0x02); + outb(0x3c5, 0x01<<i); + bcopy(&VGLBuf[i*VGLBufSize/VGLModeInfo.vi_planes + offset], + VGLMem, len); + } + } + break; + case VIDBUF4: + case VIDBUF8X: + outb(0x3c6, 0xff); + outb(0x3ce, 0x01); outb(0x3cf, 0x00); /* set/reset enable */ + outb(0x3ce, 0x08); outb(0x3cf, 0xff); /* bit mask */ + for (i = 0; i < VGLModeInfo.vi_planes; i++) { + outb(0x3c4, 0x02); + outb(0x3c5, 0x01<<i); + bcopy(&VGLBuf[i*VGLAdpInfo.va_window_size], VGLMem, + VGLAdpInfo.va_window_size); + } + break; + case VIDBUF8: + case VIDBUF8S: + for (offset = 0; offset < VGLBufSize; offset += len) { + VGLSetSegment(offset); + len = min(VGLBufSize - offset, VGLAdpInfo.va_window_size); + bcopy(&VGLBuf[offset], VGLMem, len); + } + break; + } + VGLRestorePalette(); + ioctl(0, VT_RELDISP, VT_ACKACQ); + } + else { + switch (VGLDisplay->Type) { + case VIDBUF4S: + for (offset = 0; offset < VGLBufSize/VGLModeInfo.vi_planes; + offset += len) { + VGLSetSegment(offset); + len = min(VGLBufSize/VGLModeInfo.vi_planes - offset, + VGLAdpInfo.va_window_size); + for (i = 0; i < VGLModeInfo.vi_planes; i++) { + outb(0x3ce, 0x04); + outb(0x3cf, i); + bcopy(VGLMem, &VGLBuf[i*VGLBufSize/VGLModeInfo.vi_planes + offset], + len); + } + } + break; + case VIDBUF4: + case VIDBUF8X: + /* + * NOTE: the saved buffer is NOT in the MEMBUF format which + * the ordinary memory bitmap object is stored in. XXX + */ + for (i = 0; i < VGLModeInfo.vi_planes; i++) { + outb(0x3ce, 0x04); + outb(0x3cf, i); + bcopy(VGLMem, &VGLBuf[i*VGLAdpInfo.va_window_size], + VGLAdpInfo.va_window_size); + } + break; + case VIDBUF8: + case VIDBUF8S: + for (offset = 0; offset < VGLBufSize; offset += len) { + VGLSetSegment(offset); + len = min(VGLBufSize - offset, VGLAdpInfo.va_window_size); + bcopy(VGLMem, &VGLBuf[offset], len); + } + break; + } + VGLMem = MAP_FAILED; + munmap(VGLDisplay->Bitmap, VGLAdpInfo.va_window_size); + ioctl(0, VGLOldMode, 0); + ioctl(0, KDSETMODE, KD_TEXT); + ioctl(0, KDDISABIO, 0); + ioctl(0, VT_RELDISP, VT_TRUE); + VGLDisplay->Bitmap = VGLBuf; + VGLDisplay->Type = MEMBUF; + VGLDisplay->Xsize = VGLDisplay->VXsize; + VGLDisplay->Ysize = VGLDisplay->VYsize; + while (!VGLOnDisplay) pause(); + } + } +} + +int +VGLSetSegment(unsigned int offset) +{ + if (offset/VGLAdpInfo.va_window_size != VGLCurWindow) { + ioctl(0, CONS_SETWINORG, offset); /* FBIO_SETWINORG */ + VGLCurWindow = offset/VGLAdpInfo.va_window_size; + } + return (offset%VGLAdpInfo.va_window_size); +} + +int +VGLSetVScreenSize(VGLBitmap *object, int VXsize, int VYsize) +{ + if (VXsize < object->Xsize || VYsize < object->Ysize) + return -1; + if (object->Type == MEMBUF) + return -1; + if (ioctl(0, FBIO_SETLINEWIDTH, &VXsize)) + return -1; + ioctl(0, CONS_ADPINFO, &VGLAdpInfo); /* FBIO_ADPINFO */ + object->VXsize = VGLAdpInfo.va_line_width + *8/(VGLModeInfo.vi_depth/VGLModeInfo.vi_planes); + object->VYsize = VGLBufSize/VGLModeInfo.vi_planes/VGLAdpInfo.va_line_width; + if (VYsize < object->VYsize) + object->VYsize = VYsize; + +#ifdef LIBVGL_DEBUG + fprintf(stderr, "new size: VGLXsize:%d, Ysize:%d, VXsize:%d, VYsize:%d\n", + object->Xsize, object->Ysize, object->VXsize, object->VYsize); +#endif + + return 0; +} + +int +VGLPanScreen(VGLBitmap *object, int x, int y) +{ + video_display_start_t origin; + + if (x < 0 || x + object->Xsize > object->VXsize + || y < 0 || y + object->Ysize > object->VYsize) + return -1; + if (object->Type == MEMBUF) + return 0; + origin.x = x; + origin.y = y; + if (ioctl(0, FBIO_SETDISPSTART, &origin)) + return -1; + object->Xorigin = x; + object->Yorigin = y; + +#ifdef LIBVGL_DEBUG + fprintf(stderr, "new origin: (%d, %d)\n", x, y); +#endif + + return 0; +} |
