#include "opt_amigacons.h"
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ite_cv.c,v 1.8 2007/03/05 20:29:07 he Exp $");
#include "grfcv.h"
#if NGRFCV > 0
#include <sys/param.h>
#include <sys/conf.h>
#include <sys/proc.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/tty.h>
#include <sys/systm.h>
#include <sys/queue.h>
#include <sys/termios.h>
#include <sys/malloc.h>
#include <dev/cons.h>
#include <machine/cpu.h>
#include <amiga/dev/itevar.h>
#include <amiga/dev/iteioctl.h>
#include <amiga/amiga/device.h>
#include <amiga/dev/grfioctl.h>
#include <amiga/dev/grfvar.h>
#include <amiga/dev/grf_cvreg.h>
void cv_ite_init(struct ite_softc *);
void cv_ite_deinit(struct ite_softc *);
static void cv_cursor(struct ite_softc *, int);
static void cv_putc(struct ite_softc *, int, int, int, int);
static void cv_clear(struct ite_softc *, int, int, int, int);
static void cv_scroll(struct ite_softc *, int, int, int, int);
int
grfcv_cnprobe(void)
{
static int done;
int rv;
if (done == 0)
#ifdef CV64CONSOLE
rv = CN_INTERNAL;
#else
rv = CN_DEAD;
#endif
else
#ifdef CV64CONSOLE
rv = CN_NORMAL;
#else
rv = CN_DEAD;
#endif
done = 1;
return(rv);
}
void
grfcv_iteinit(struct grf_softc *gp)
{
gp->g_itecursor = cv_cursor;
gp->g_iteputc = cv_putc;
gp->g_iteclear = cv_clear;
gp->g_itescroll = cv_scroll;
gp->g_iteinit = cv_ite_init;
gp->g_itedeinit = cv_ite_deinit;
}
void
cv_ite_deinit(struct ite_softc *ip)
{
ip->flags &= ~ITE_INITED;
}
static unsigned short cv_rowc[MAXCOLS*(MAXROWS+1)];
static unsigned short *console_buffer;
void
cv_ite_init(register struct ite_softc *ip)
{
struct grfcvtext_mode *md;
int i;
static char first = 1;
volatile unsigned short *fb = (volatile unsigned short *)ip->grf->g_fbkva;
unsigned short *buffer;
ip->priv = ip->grf->g_data;
md = (struct grfcvtext_mode *) ip->grf->g_data;
ip->cols = md->cols;
ip->rows = md->rows;
#if 0
if (cv_rowc)
free(cv_rowc, M_DEVBUF);
cv_rowc = malloc(sizeof(short) * (ip->rows + 1) * (ip->cols + 2),
M_DEVBUF, M_WAITOK);
if (!cv_rowc)
panic("No buffers for ite_cv!");
#endif
console_buffer = cv_rowc + ip->rows + 1;
for (i = 0; i < ip->rows; i++)
cv_rowc[i] = i * ip->cols;
if (first) {
for (i = 0; i < ip->rows * ip->cols; i++)
console_buffer[i] = 0x2007;
first = 0;
} else {
buffer = console_buffer;
for (i = 0; i < ip->rows * ip->cols; i++) {
*fb++ = *buffer++;
*fb++;
}
}
}
void
cv_cursor(struct ite_softc *ip, int flag)
{
volatile void *ba = ip->grf->g_regkva;
switch (flag) {
case DRAW_CURSOR:
case MOVE_CURSOR:
flag = ip->curx + ip->cury * ip->cols;
WCrt(ba, CRT_ID_CURSOR_LOC_LOW, flag & 0xff);
WCrt(ba, CRT_ID_CURSOR_LOC_HIGH, flag >> 8);
ip->cursorx = ip->curx;
ip->cursory = ip->cury;
break;
case ERASE_CURSOR:
case START_CURSOROPT:
case END_CURSOROPT:
default:
break;
}
}
void
cv_putc(struct ite_softc *ip, int c, int dy, int dx, int mode)
{
volatile char *fb = ip->grf->g_fbkva;
unsigned char attr;
volatile unsigned char *cp;
attr = (unsigned char) ((mode & ATTR_INV) ? (0x70) : (0x07));
if (mode & ATTR_UL) attr = 0x01;
if (mode & ATTR_BOLD) attr |= 0x08;
if (mode & ATTR_BLINK) attr |= 0x80;
cp = fb + ((cv_rowc[dy] + dx) << 2);
*cp++ = (unsigned char) c;
*cp = (unsigned char) attr;
cp = (unsigned char *) &console_buffer[cv_rowc[dy]+dx];
*cp++ = (unsigned char) c;
*cp = (unsigned char) attr;
}
void
cv_clear(struct ite_softc *ip, int sy, int sx, int h, int w)
{
volatile unsigned short *dst;
int len;
dst = (volatile unsigned short *)
((volatile char*)ip->grf->g_fbkva +
(((sy * ip->cols) + sx) << 2));
for (len = w * h; len > 0 ; len--) {
*dst = 0x2007;
dst +=2;
}
dst = &console_buffer[(sy * ip->cols) + sx];
for (len = w * h; len > 0 ; len--) {
*dst++ = 0x2007;
}
}
void
cv_scroll(struct ite_softc *ip, int sy, int sx, int count, int dir)
{
volatile unsigned short *src, *dst, *dst2;
int i;
int len;
src = (volatile unsigned short *)
((volatile char*)ip->grf->g_fbkva + (cv_rowc[sy] << 2));
switch (dir) {
case SCROLL_UP:
dst = src - ((cv_rowc[count])<<1);
len = cv_rowc[(ip->bottom_margin + 1 - sy)];
src = &console_buffer[cv_rowc[sy]];
if (count > sy) {
dst2 = console_buffer;
dst = (volatile unsigned short *)(ip->grf->g_fbkva);
len -= cv_rowc[(count - sy)];
src += cv_rowc[(count - sy)];
} else
dst2 = &console_buffer[cv_rowc[(sy-count)]];
bcopy (__UNVOLATILE(src), __UNVOLATILE(dst2), len << 1);
for (i = 0; i < len; i++) {
*dst++ = *dst2++;
dst++;
}
break;
case SCROLL_DOWN:
dst = src + ((cv_rowc[count]) << 1);
len = cv_rowc[(ip->bottom_margin + 1 - (sy + count))];
src = &console_buffer[cv_rowc[sy]];
dst2 = &console_buffer[cv_rowc[(sy + count)]];
if (len < 0)
return;
bcopy (__UNVOLATILE(src), __UNVOLATILE(dst2), len << 1);
for (i = 0; i < len; i++) {
*dst++ = *dst2++;
dst++;
}
break;
case SCROLL_RIGHT:
dst = src + ((sx+count)<<1);
src = &console_buffer[cv_rowc[sy] + sx];
len = ip->cols - (sx + count);
dst2 = &console_buffer[cv_rowc[sy] + sx + count];
bcopy (__UNVOLATILE(src), __UNVOLATILE(dst2), len << 1);
for (i = 0; i < len; i++) {
*dst++ = *dst2++;
dst++;
}
break;
case SCROLL_LEFT:
dst = src + ((sx - count)<<1);
src = &console_buffer[cv_rowc[sy] + sx];
len = ip->cols - sx;
dst2 = &console_buffer[cv_rowc[sy] + sx - count];
bcopy (__UNVOLATILE(src), __UNVOLATILE(dst2), len << 1);
for (i = 0; i < len; i++) {
*dst++ = *dst2++;
dst++;
}
}
}
#endif