NetBSD/sys/dev/ic/pcdisplay_subr.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 */