382 lines
9.3 KiB
C
382 lines
9.3 KiB
C
/* $NetBSD: pcdisplay_subr.c,v 1.27 2004/07/28 12:34:04 jmmv Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1995, 1996 Carnegie-Mellon University.
|
|
* All rights reserved.
|
|
*
|
|
* Author: Chris G. Demetriou
|
|
*
|
|
* Permission to use, copy, modify and distribute this software and
|
|
* its documentation is hereby granted, provided that both the copyright
|
|
* notice and this permission notice appear in all copies of the
|
|
* software, derivative works or modified versions, and any portions
|
|
* thereof, and that both notices appear in supporting documentation.
|
|
*
|
|
* CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
|
|
* CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND
|
|
* FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
|
|
*
|
|
* Carnegie Mellon requests users of this software to return to
|
|
*
|
|
* Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU
|
|
* School of Computer Science
|
|
* Carnegie Mellon University
|
|
* Pittsburgh PA 15213-3890
|
|
*
|
|
* any improvements or extensions that they make and grant Carnegie the
|
|
* rights to redistribute these changes.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: pcdisplay_subr.c,v 1.27 2004/07/28 12:34:04 jmmv Exp $");
|
|
|
|
#include "opt_wsdisplay_compat.h" /* for WSDISPLAY_CHARFUNCS */
|
|
#include "opt_wsmsgattrs.h" /* for WSDISPLAY_CUSTOM_OUTPUT */
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <machine/bus.h>
|
|
|
|
#include <dev/ic/mc6845reg.h>
|
|
#include <dev/ic/pcdisplayvar.h>
|
|
#include <dev/wscons/wsconsio.h>
|
|
|
|
#include <dev/wscons/wsdisplayvar.h>
|
|
|
|
void
|
|
pcdisplay_cursor_init(scr, existing)
|
|
struct pcdisplayscreen *scr;
|
|
int existing;
|
|
{
|
|
#ifdef PCDISPLAY_SOFTCURSOR
|
|
bus_space_tag_t memt;
|
|
bus_space_handle_t memh;
|
|
int off;
|
|
|
|
pcdisplay_6845_write(scr->hdl, curstart, 0x10);
|
|
pcdisplay_6845_write(scr->hdl, curend, 0x10);
|
|
|
|
if (existing) {
|
|
/*
|
|
* This is the first screen. At this point, scr->mem is NULL
|
|
* (no backing store), so we can't use pcdisplay_cursor() to
|
|
* do this.
|
|
*/
|
|
memt = scr->hdl->ph_memt;
|
|
memh = scr->hdl->ph_memh;
|
|
off = (scr->cursorrow * scr->type->ncols + scr->cursorcol) * 2
|
|
+ scr->dispoffset;
|
|
|
|
scr->cursortmp = bus_space_read_2(memt, memh, off);
|
|
bus_space_write_2(memt, memh, off, scr->cursortmp ^ 0x7700);
|
|
} else
|
|
scr->cursortmp = 0;
|
|
#else
|
|
/*
|
|
* Firmware might not have initialized the cursor shape. Make
|
|
* sure there's something we can see.
|
|
* Don't touch the hardware if this is not the first screen.
|
|
*/
|
|
if (existing) {
|
|
pcdisplay_6845_write(scr->hdl, curstart,
|
|
scr->type->fontheight - 2);
|
|
pcdisplay_6845_write(scr->hdl, curend,
|
|
scr->type->fontheight - 1);
|
|
}
|
|
#endif
|
|
scr->cursoron = 1;
|
|
}
|
|
|
|
void
|
|
pcdisplay_cursor(id, on, row, col)
|
|
void *id;
|
|
int on, row, col;
|
|
{
|
|
#ifdef PCDISPLAY_SOFTCURSOR
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
int off;
|
|
|
|
/* Remove old cursor image */
|
|
if (scr->cursoron) {
|
|
off = scr->cursorrow * scr->type->ncols + scr->cursorcol;
|
|
if (scr->active)
|
|
bus_space_write_2(memt, memh, scr->dispoffset + off * 2,
|
|
scr->cursortmp);
|
|
else
|
|
scr->mem[off] = scr->cursortmp;
|
|
}
|
|
|
|
scr->cursorrow = row;
|
|
scr->cursorcol = col;
|
|
|
|
if ((scr->cursoron = on) == 0)
|
|
return;
|
|
|
|
off = (scr->cursorrow * scr->type->ncols + scr->cursorcol);
|
|
if (scr->active) {
|
|
off = off * 2 + scr->dispoffset;
|
|
scr->cursortmp = bus_space_read_2(memt, memh, off);
|
|
bus_space_write_2(memt, memh, off, scr->cursortmp ^ 0x7700);
|
|
} else {
|
|
scr->cursortmp = scr->mem[off];
|
|
scr->mem[off] = scr->cursortmp ^ 0x7700;
|
|
}
|
|
#else /* PCDISPLAY_SOFTCURSOR */
|
|
struct pcdisplayscreen *scr = id;
|
|
int pos;
|
|
|
|
scr->cursorrow = row;
|
|
scr->cursorcol = col;
|
|
scr->cursoron = on;
|
|
|
|
if (scr->active) {
|
|
if (!on)
|
|
pos = 0x3fff;
|
|
else
|
|
pos = scr->dispoffset / 2
|
|
+ row * scr->type->ncols + col;
|
|
|
|
pcdisplay_6845_write(scr->hdl, cursorh, pos >> 8);
|
|
pcdisplay_6845_write(scr->hdl, cursorl, pos);
|
|
}
|
|
#endif /* PCDISPLAY_SOFTCURSOR */
|
|
}
|
|
|
|
#if 0
|
|
unsigned int
|
|
pcdisplay_mapchar_simple(id, uni)
|
|
void *id;
|
|
int uni;
|
|
{
|
|
if (uni < 128)
|
|
return (uni);
|
|
|
|
return (1); /* XXX ??? smiley */
|
|
}
|
|
#endif
|
|
|
|
void
|
|
pcdisplay_putchar(id, row, col, c, attr)
|
|
void *id;
|
|
int row, col;
|
|
u_int c;
|
|
long attr;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
int off;
|
|
|
|
off = row * scr->type->ncols + col;
|
|
|
|
if (scr->active)
|
|
bus_space_write_2(memt, memh, scr->dispoffset + off * 2,
|
|
c | (attr << 8));
|
|
else
|
|
scr->mem[off] = c | (attr << 8);
|
|
|
|
scr->visibleoffset = scr->dispoffset;
|
|
}
|
|
|
|
void
|
|
pcdisplay_copycols(id, row, srccol, dstcol, ncols)
|
|
void *id;
|
|
int row, srccol, dstcol, ncols;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
bus_size_t srcoff, dstoff;
|
|
|
|
srcoff = dstoff = row * scr->type->ncols;
|
|
srcoff += srccol;
|
|
dstoff += dstcol;
|
|
|
|
if (scr->active)
|
|
bus_space_copy_region_2(memt, memh,
|
|
scr->dispoffset + srcoff * 2,
|
|
memh, scr->dispoffset + dstoff * 2,
|
|
ncols);
|
|
else
|
|
memcpy(&scr->mem[dstoff], &scr->mem[srcoff], ncols * 2);
|
|
}
|
|
|
|
void
|
|
pcdisplay_erasecols(id, row, startcol, ncols, fillattr)
|
|
void *id;
|
|
int row, startcol, ncols;
|
|
long fillattr;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
bus_size_t off;
|
|
u_int16_t val;
|
|
int i;
|
|
|
|
off = row * scr->type->ncols + startcol;
|
|
|
|
val = (fillattr << 8) | ' ';
|
|
|
|
if (scr->active)
|
|
bus_space_set_region_2(memt, memh, scr->dispoffset + off * 2,
|
|
val, ncols);
|
|
else
|
|
for (i = 0; i < ncols; i++)
|
|
scr->mem[off + i] = val;
|
|
}
|
|
|
|
void
|
|
pcdisplay_copyrows(id, srcrow, dstrow, nrows)
|
|
void *id;
|
|
int srcrow, dstrow, nrows;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
int ncols = scr->type->ncols;
|
|
bus_size_t srcoff, dstoff;
|
|
|
|
srcoff = srcrow * ncols + 0;
|
|
dstoff = dstrow * ncols + 0;
|
|
|
|
if (scr->active)
|
|
bus_space_copy_region_2(memt, memh,
|
|
scr->dispoffset + srcoff * 2,
|
|
memh, scr->dispoffset + dstoff * 2,
|
|
nrows * ncols);
|
|
else
|
|
memcpy(&scr->mem[dstoff], &scr->mem[srcoff],
|
|
nrows * ncols * 2);
|
|
}
|
|
|
|
void
|
|
pcdisplay_eraserows(id, startrow, nrows, fillattr)
|
|
void *id;
|
|
int startrow, nrows;
|
|
long fillattr;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
bus_size_t off, count;
|
|
u_int16_t val;
|
|
u_int i;
|
|
|
|
off = startrow * scr->type->ncols;
|
|
count = nrows * scr->type->ncols;
|
|
|
|
val = (fillattr << 8) | ' ';
|
|
|
|
if (scr->active)
|
|
bus_space_set_region_2(memt, memh, scr->dispoffset + off * 2,
|
|
val, count);
|
|
else
|
|
for (i = 0; i < count; i++)
|
|
scr->mem[off + i] = val;
|
|
}
|
|
|
|
#ifdef WSDISPLAY_CUSTOM_OUTPUT
|
|
void
|
|
pcdisplay_replaceattr(id, oldattr, newattr)
|
|
void *id;
|
|
long oldattr, newattr;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
int off;
|
|
uint16_t chardata;
|
|
|
|
if (scr->active)
|
|
for (off = 0; off < scr->type->nrows * scr->type->ncols;
|
|
off++) {
|
|
chardata = bus_space_read_2(memt, memh,
|
|
scr->dispoffset + off * 2);
|
|
if ((long)(chardata >> 8) == oldattr)
|
|
bus_space_write_2(memt, memh,
|
|
scr->dispoffset + off * 2,
|
|
((u_int16_t)(newattr << 8)) |
|
|
(chardata & 0x00FF));
|
|
}
|
|
else
|
|
for (off = 0; off < scr->type->nrows * scr->type->ncols;
|
|
off++) {
|
|
chardata = scr->mem[off];
|
|
if ((long)(chardata >> 8) == oldattr)
|
|
scr->mem[off] = ((u_int16_t)(newattr << 8)) |
|
|
(chardata & 0x00FF);
|
|
}
|
|
}
|
|
#endif /* WSDISPLAY_CUSTOM_OUTPUT */
|
|
|
|
#ifdef WSDISPLAY_CHARFUNCS
|
|
int
|
|
pcdisplay_getwschar(id, wschar)
|
|
void *id;
|
|
struct wsdisplay_char *wschar;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
int off;
|
|
uint16_t chardata;
|
|
uint8_t attrbyte;
|
|
|
|
off = wschar->row * scr->type->ncols + wschar->col;
|
|
if (off >= scr->type->ncols * scr->type->nrows)
|
|
return -1;
|
|
|
|
if (scr->active)
|
|
chardata = bus_space_read_2(memt, memh,
|
|
scr->dispoffset + off * 2);
|
|
else
|
|
chardata = scr->mem[off];
|
|
|
|
wschar->letter = (chardata & 0x00FF);
|
|
wschar->flags = 0;
|
|
attrbyte = (chardata & 0xFF00) >> 8;
|
|
if ((attrbyte & 0x08)) wschar->flags |= WSDISPLAY_CHAR_BRIGHT;
|
|
if ((attrbyte & 0x80)) wschar->flags |= WSDISPLAY_CHAR_BLINK;
|
|
wschar->foreground = attrbyte & 0x07;
|
|
wschar->background = (attrbyte >> 4) & 0x07;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
pcdisplay_putwschar(id, wschar)
|
|
void *id;
|
|
struct wsdisplay_char *wschar;
|
|
{
|
|
struct pcdisplayscreen *scr = id;
|
|
bus_space_tag_t memt = scr->hdl->ph_memt;
|
|
bus_space_handle_t memh = scr->hdl->ph_memh;
|
|
int off;
|
|
uint16_t chardata;
|
|
uint8_t attrbyte;
|
|
|
|
off = wschar->row * scr->type->ncols + wschar->col;
|
|
if (off >= (scr->type->ncols * scr->type->nrows))
|
|
return -1;
|
|
|
|
attrbyte = wschar->background & 0x07;
|
|
if (wschar->flags & WSDISPLAY_CHAR_BLINK) attrbyte |= 0x08;
|
|
attrbyte <<= 4;
|
|
attrbyte |= wschar->foreground & 0x07;
|
|
if (wschar->flags & WSDISPLAY_CHAR_BRIGHT) attrbyte |= 0x08;
|
|
chardata = (attrbyte << 8) | wschar->letter;
|
|
|
|
if (scr->active)
|
|
bus_space_write_2(memt, memh, scr->dispoffset + off * 2,
|
|
chardata);
|
|
else
|
|
scr->mem[off] = chardata;
|
|
|
|
return 0;
|
|
}
|
|
#endif /* WSDISPLAY_CHARFUNCS */
|