Prex Home / Browse Source - Prex Version: 0.9.0

root/bsp/drv/dev/video/vga.c

DEFINITIONS

1. crtc_read
2. crtc_write
3. vga_on
4. vga_off
5. vga_cursor
6. vga_putc
7. vga_copyrows
8. vga_eraserows
9. vga_set_attr
10. vga_get_cursor
11. vga_devctl
12. vga_init

   1 /*-
   2  * Copyright (c) 2005-2009, Kohsuke Ohtani
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. Neither the name of the author nor the names of any co-contributors
  14  *    may be used to endorse or promote products derived from this software
  15  *    without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  */
  30 /*
  31  * vga.c - vga driver
  32  */
  34 #include <driver.h>
  35 #include <wscons.h>
  36 #include <devctl.h>
  37 #include <pm.h>
  39 /* #define DEBUG_VGA 1 */
  41 #ifdef DEBUG_VGA
  42 #define DPRINTF(a) printf a
  43 #else
  44 #define DPRINTF(a)
  45 #endif
  47 #define CRTC_INDEX      0x3d4
  48 #define CRTC_DATA       0x3d5
  49 #define SEQ_INDEX       0x3c4
  50 #define SEQ_DATA        0x3c5
  52 #define VID_RAM         0xB8000
  54 struct vga_softc {
device_t        dev;
  56         short           *vram;
  57         int             cols;
  58         int             attr;
  59         int             blank;
  60 };
  62 static int      vga_devctl(device_t, u_long, void *);
  63 static int      vga_init(struct driver *);
  64 static void     vga_cursor(void*, int, int);
  65 static void     vga_putc(void *, int, int, int);
  66 static void     vga_copyrows(void *,int, int, int);
  67 static void     vga_eraserows(void *,int, int);
  68 static void     vga_set_attr(void *, int);
  69 static void     vga_get_cursor(void *, int *, int *);
  71 static struct devops vga_devops = {
  72         /* open */      no_open,
  73         /* close */     no_close,
  74         /* read */      no_read,
  75         /* write */     no_write,
  76         /* ioctl */     no_ioctl,
  77         /* devctl */    vga_devctl,
  78 };
  80 struct driver vga_driver = {
  81         /* name */      "vga",
  82         /* devops */    &vga_devops,
  83         /* devsz */     sizeof(struct vga_softc),
  84         /* flags */     0,
  85         /* probe */     NULL,
  86         /* init */      vga_init,
  87         /* shutdown */  NULL,
  88 };
  90 static struct wscons_video_ops wscons_vga_ops = {
vga_cursor,     /* cursor */
vga_putc,       /* putc */
vga_copyrows,   /* copyrows */
vga_eraserows,  /* eraserows */
vga_set_attr,   /* set_attr */
vga_get_cursor, /* set_cursor */
  97 };
 100 static u_char
crtc_read(u_char index)
 102 {
bus_write_8(CRTC_INDEX, index);
 105         return bus_read_8(CRTC_DATA);
 106 }
 108 static void
crtc_write(u_char index, u_char val)
 110 {
bus_write_8(CRTC_INDEX, index);
bus_write_8(CRTC_DATA, val);
 114 }
 116 static void
vga_on(void)
 118 {
u_char val;
bus_write_8(SEQ_INDEX, 1);
val = bus_read_8(SEQ_DATA);
bus_write_8(SEQ_DATA, val & ~0x20);
 124 }
 126 static void
vga_off(void)
 128 {
u_char val;
bus_write_8(SEQ_INDEX, 1);
val = bus_read_8(SEQ_DATA);
bus_write_8(SEQ_DATA, val | 0x20);
 134 }
 136 static void
vga_cursor(void *aux, int row, int col)
 138 {
 139         struct vga_softc *sc = aux;
 140         int pos, s;
pos = row * sc->cols + col;
s = splhigh();
crtc_write(0x0e, (u_char)((pos >> 8) & 0xff));
crtc_write(0x0f, (u_char)(pos & 0xff));
splx(s);
 148 }
 150 static void
vga_putc(void *aux, int row, int col, int ch)
 152 {
 153         struct vga_softc *sc = aux;
sc->vram[row * sc->cols + col] = ch | (sc->attr << 8);
 156 }
 158 static void
vga_copyrows(void *aux, int srcrow, int dstrow, int nrows)
 160 {
 161         struct vga_softc *sc = aux;
memcpy(sc->vram + dstrow * sc->cols,
sc->vram + srcrow * sc->cols,
 165                (size_t)nrows * sc->cols * 2);
 166 }
 168 static void
vga_eraserows(void *aux, int row, int nrows)
 170 {
 171         struct vga_softc *sc = aux;
 172         int i, start, end;
start = row * sc->cols;
end = start + nrows * sc->cols;
 177         for (i = start; i < end; i++)
sc->vram[i] = ' ' | (sc->attr << 8);
 179 }
 181 static void
vga_set_attr(void *aux, int attr)
 183 {
 184         struct vga_softc *sc = aux;
sc->attr = attr;
 187 }
 190 static void
vga_get_cursor(void *aux, int *col, int *row)
 192 {
 193         struct vga_softc *sc = aux;
u_int offset;
 195         int s;
s = splhigh();
offset = crtc_read(0x0e);
offset <<= 8;
offset += crtc_read(0x0f);
 201         *col = (int)offset % sc->cols;
 202         *row = (int)offset / sc->cols;
splx(s);
 204 }
 206 static int
vga_devctl(device_t dev, u_long cmd, void *arg)
 208 {
 209         struct vga_softc *sc = device_private(dev);
 210         int s;
DPRINTF(("vga: devctl cmd=%x\n", cmd));
s = splhigh();
 215         switch (cmd) {
 216         case DEVCTL_PM_LCDOFF:
 217                 if (!sc->blank) {
DPRINTF(("vga: LCD off\n"));
vga_off();
sc->blank = 1;
 221                 }
 222                 break;
 223         case DEVCTL_PM_LCDON:
 224                 if (sc->blank) {
vga_on();
sc->blank = 0;
DPRINTF(("vga: LCD on\n"));
 228                 }
 229                 break;
 230         }
splx(s);
 232         return 0;
 233 }
 235 static int
vga_init(struct driver *self)
 237 {
device_t dev;
 239         struct bootinfo *bi;
 240         struct vga_softc *sc;
machine_bootinfo(&bi);
dev = device_create(self, "vga", D_CHR);
sc = device_private(dev);
sc->vram = ptokv(VID_RAM);
sc->cols = bi->video.text_x;
sc->attr = 0x0f;
sc->blank = 0;
wscons_attach_video(&wscons_vga_ops, sc);
pm_attach_lcd(dev);
 255         return 0;
 256 }