Aren
/
NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
NetBSD/sys/dev/rasops/rasops.c

1661 lines
38 KiB
C
Raw Blame History

/* $NetBSD: rasops.c,v 1.122 2019/08/10 01:24:17 rin Exp $ */
/*-
* Copyright (c) 1999 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Andrew Doran.
*
* 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.
* 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.
*
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
* ``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 FOUNDATION OR CONTRIBUTORS
* 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.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: rasops.c,v 1.122 2019/08/10 01:24:17 rin Exp $");
#ifdef _KERNEL_OPT
#include "opt_rasops.h"
#include "opt_wsmsgattrs.h"
#include "rasops_glue.h"
#endif
#include <sys/param.h>
#include <sys/bswap.h>
#include <sys/kmem.h>
#include <machine/endian.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wsfont/wsfont.h>
#define _RASOPS_PRIVATE
#include <dev/rasops/rasops.h>
#include <dev/rasops/rasops_masks.h> /* XXX for MBE */
#ifndef _KERNEL
#include <errno.h>
#endif
#ifdef RASOPS_DEBUG
#define DPRINTF(...) aprint_error(...)
#else
#define DPRINTF(...) __nothing
#endif
struct rasops_matchdata {
struct rasops_info *ri;
int wantcols, wantrows;
int bestscore;
struct wsdisplay_font *pick;
int ident;
};
static const uint32_t rasops_lmask32[4 + 1] = {
MBE(0x00000000), MBE(0x00ffffff), MBE(0x0000ffff), MBE(0x000000ff),
MBE(0x00000000),
};
static const uint32_t rasops_rmask32[4 + 1] = {
MBE(0x00000000), MBE(0xff000000), MBE(0xffff0000), MBE(0xffffff00),
MBE(0xffffffff),
};
/* ANSI colormap (R,G,B). Upper 8 are high-intensity */
const uint8_t rasops_cmap[256 * 3] = {
0x00, 0x00, 0x00, /* black */
0x7f, 0x00, 0x00, /* red */
0x00, 0x7f, 0x00, /* green */
0x7f, 0x7f, 0x00, /* brown */
0x00, 0x00, 0x7f, /* blue */
0x7f, 0x00, 0x7f, /* magenta */
0x00, 0x7f, 0x7f, /* cyan */
0xc7, 0xc7, 0xc7, /* white - XXX too dim? */
0x7f, 0x7f, 0x7f, /* black */
0xff, 0x00, 0x00, /* red */
0x00, 0xff, 0x00, /* green */
0xff, 0xff, 0x00, /* brown */
0x00, 0x00, 0xff, /* blue */
0xff, 0x00, 0xff, /* magenta */
0x00, 0xff, 0xff, /* cyan */
0xff, 0xff, 0xff, /* white */
/*
* For the cursor, we need at least the last (255th)
* color to be white. Fill up white completely for
* simplicity.
*/
#define _CMWHITE 0xff, 0xff, 0xff,
#define _CMWHITE16 _CMWHITE _CMWHITE _CMWHITE _CMWHITE \
_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
_CMWHITE _CMWHITE _CMWHITE _CMWHITE \
_CMWHITE _CMWHITE _CMWHITE _CMWHITE
_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16
_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16
_CMWHITE16 _CMWHITE16 _CMWHITE16 _CMWHITE16 /* but not the last one */
#undef _CMWHITE16
#undef _CMWHITE
/*
* For the cursor the fg/bg indices are bit inverted, so
* provide complimentary colors in the upper 16 entries.
*/
0x7f, 0x7f, 0x7f, /* black */
0xff, 0x00, 0x00, /* red */
0x00, 0xff, 0x00, /* green */
0xff, 0xff, 0x00, /* brown */
0x00, 0x00, 0xff, /* blue */
0xff, 0x00, 0xff, /* magenta */
0x00, 0xff, 0xff, /* cyan */
0xff, 0xff, 0xff, /* white */
0x00, 0x00, 0x00, /* black */
0x7f, 0x00, 0x00, /* red */
0x00, 0x7f, 0x00, /* green */
0x7f, 0x7f, 0x00, /* brown */
0x00, 0x00, 0x7f, /* blue */
0x7f, 0x00, 0x7f, /* magenta */
0x00, 0x7f, 0x7f, /* cyan */
0xc7, 0xc7, 0xc7, /* white - XXX too dim? */
};
/* True if color is gray */
static const uint8_t rasops_isgray[16] = {
1, 0, 0, 0, 0, 0, 0, 1,
1, 0, 0, 0, 0, 0, 0, 1,
};
#ifdef RASOPS_APPLE_PALETTE
/*
* Approximate ANSI colormap for legacy Apple color palettes
*/
static const uint8_t apple8_devcmap[16] = {
0xff, /* black 0x00, 0x00, 0x00 */
0x6b, /* red 0x99, 0x00, 0x00 */
0xc5, /* green 0x00, 0x99, 0x00 */
0x59, /* yellow 0x99, 0x99, 0x00 */
0xd4, /* blue 0x00, 0x00, 0x99 */
0x68, /* magenta 0x99, 0x00, 0x99 */
0xc2, /* cyan 0x00, 0x99, 0x99 */
0x2b, /* white 0xcc, 0xcc, 0xcc */
0x56, /* black 0x99, 0x99, 0x99 */
0x23, /* red 0xff, 0x00, 0x00 */
0xb9, /* green 0x00, 0xff, 0x00 */
0x05, /* yellow 0xff, 0xff, 0x00 */
0xd2, /* blue 0x00, 0x00, 0xff */
0x1e, /* magenta 0xff, 0x00, 0xff */
0xb4, /* cyan 0x00, 0xff, 0xff */
0x00, /* white 0xff, 0xff, 0xff */
};
static const uint8_t apple4_devcmap[16] = {
15, /* black */
3, /* red */
9, /* dark green */
1, /* yellow */
6, /* blue */
4, /* magenta */
7, /* cyan */
12, /* light grey */
13, /* medium grey */
3, /* red */
9, /* dark green */
1, /* yellow */
6, /* blue */
4, /* magenta */
7, /* cyan */
0, /* white */
};
#endif
/* Generic functions */
static void rasops_copyrows(void *, int, int, int);
static void rasops_copycols(void *, int, int, int, int);
static int rasops_mapchar(void *, int, u_int *);
static void rasops_cursor(void *, int, int, int);
static int rasops_allocattr_color(void *, int, int, int, long *);
static int rasops_allocattr_mono(void *, int, int, int, long *);
static void rasops_do_cursor(struct rasops_info *);
static void rasops_init_devcmap(struct rasops_info *);
static void rasops_make_box_chars_8(struct rasops_info *);
static void rasops_make_box_chars_16(struct rasops_info *);
static void rasops_make_box_chars_32(struct rasops_info *);
static void rasops_make_box_chars_alpha(struct rasops_info *);
#if NRASOPS_ROTATION > 0
static void rasops_rotate_font(int *, int);
static void rasops_copychar(void *, int, int, int, int);
/* rotate clockwise */
static void rasops_copycols_rotated_cw(void *, int, int, int, int);
static void rasops_copyrows_rotated_cw(void *, int, int, int);
static void rasops_erasecols_rotated_cw(void *, int, int, int, long);
static void rasops_eraserows_rotated_cw(void *, int, int, long);
static void rasops_putchar_rotated_cw(void *, int, int, u_int, long);
/* rotate counter-clockwise */
static void rasops_copychar_ccw(void *, int, int, int, int);
static void rasops_copycols_rotated_ccw(void *, int, int, int, int);
static void rasops_copyrows_rotated_ccw(void *, int, int, int);
#define rasops_erasecols_rotated_ccw rasops_erasecols_rotated_cw
#define rasops_eraserows_rotated_ccw rasops_eraserows_rotated_cw
static void rasops_putchar_rotated_ccw(void *, int, int, u_int, long);
/*
* List of all rotated fonts
*/
SLIST_HEAD(, rotatedfont) rotatedfonts = SLIST_HEAD_INITIALIZER(rotatedfonts);
struct rotatedfont {
SLIST_ENTRY(rotatedfont) rf_next;
int rf_cookie;
int rf_rotated;
};
#endif /* NRASOPS_ROTATION > 0 */
/*
* Initialize a 'rasops_info' descriptor.
*/
int
rasops_init(struct rasops_info *ri, int wantrows, int wantcols)
{
memset(&ri->ri_optfont, 0, sizeof(ri->ri_optfont));
#ifdef _KERNEL
/* Select a font if the caller doesn't care */
if (ri->ri_font == NULL) {
int cookie = -1;
int flags;
wsfont_init();
/*
* first, try to find something that's as close as possible
* to the caller's requested terminal size
*/
if (wantrows == 0)
wantrows = RASOPS_DEFAULT_HEIGHT;
if (wantcols == 0)
wantcols = RASOPS_DEFAULT_WIDTH;
flags = WSFONT_FIND_BESTWIDTH | WSFONT_FIND_BITMAP;
if ((ri->ri_flg & RI_ENABLE_ALPHA) != 0)
flags |= WSFONT_FIND_ALPHA;
if ((ri->ri_flg & RI_PREFER_ALPHA) != 0)
flags |= WSFONT_PREFER_ALPHA;
cookie = wsfont_find(NULL,
ri->ri_width / wantcols,
0,
0,
WSDISPLAY_FONTORDER_L2R,
WSDISPLAY_FONTORDER_L2R,
flags);
/*
* this means there is no supported font in the list
*/
if (cookie <= 0) {
aprint_error("%s: font table is empty\n", __func__);
return -1;
}
#if NRASOPS_ROTATION > 0
/*
* Pick the rotated version of this font. This will create it
* if necessary.
*/
if (ri->ri_flg & RI_ROTATE_MASK) {
if (ri->ri_flg & RI_ROTATE_CW)
rasops_rotate_font(&cookie, WSFONT_ROTATE_CW);
else if (ri->ri_flg & RI_ROTATE_CCW)
rasops_rotate_font(&cookie, WSFONT_ROTATE_CCW);
}
#endif
if (wsfont_lock(cookie, &ri->ri_font)) {
aprint_error("%s: couldn't lock font\n", __func__);
return -1;
}
ri->ri_wsfcookie = cookie;
}
#endif
/* This should never happen in reality... */
if ((uintptr_t)ri->ri_bits & 3) {
aprint_error("%s: bits not aligned on 32-bit boundary\n",
__func__);
return -1;
}
if (ri->ri_stride & 3) {
aprint_error("%s: stride not aligned on 32-bit boundary\n",
__func__);
return -1;
}
if (rasops_reconfig(ri, wantrows, wantcols))
return -1;
rasops_init_devcmap(ri);
return 0;
}
/*
* Reconfigure (because parameters have changed in some way).
*/
int
rasops_reconfig(struct rasops_info *ri, int wantrows, int wantcols)
{
int bpp, height, s;
size_t len;
s = splhigh();
if (wantrows == 0)
wantrows = RASOPS_DEFAULT_HEIGHT;
if (wantcols == 0)
wantcols = RASOPS_DEFAULT_WIDTH;
/* throw away old line drawing character bitmaps, if we have any */
if (ri->ri_optfont.data != NULL) {
kmem_free(ri->ri_optfont.data, ri->ri_optfont.stride *
ri->ri_optfont.fontheight * ri->ri_optfont.numchars);
ri->ri_optfont.data = NULL;
}
/* autogenerate box drawing characters */
ri->ri_optfont.firstchar = WSFONT_FLAG_OPT;
ri->ri_optfont.numchars = 16;
ri->ri_optfont.fontwidth = ri->ri_font->fontwidth;
ri->ri_optfont.fontheight = ri->ri_font->fontheight;
ri->ri_optfont.stride = ri->ri_font->stride;
len = ri->ri_optfont.fontheight * ri->ri_optfont.stride *
ri->ri_optfont.numchars;
if (ri->ri_font->fontwidth > 32 || ri->ri_font->fontwidth < 4) {
aprint_error("%s: fontwidth assumptions botched", __func__);
splx(s);
return -1;
}
if ((ri->ri_flg & RI_NO_AUTO) == 0) {
ri->ri_optfont.data = kmem_zalloc(len, KM_SLEEP);
if (FONT_IS_ALPHA(&ri->ri_optfont))
rasops_make_box_chars_alpha(ri);
else {
switch (ri->ri_optfont.stride) {
case 1:
rasops_make_box_chars_8(ri);
break;
case 2:
rasops_make_box_chars_16(ri);
break;
case 4:
rasops_make_box_chars_32(ri);
break;
default:
aprint_error(
"%s: font stride assumptions botched",
__func__);
splx(s);
return -1;
}
}
} else
memset(&ri->ri_optfont, 0, sizeof(ri->ri_optfont));
/* Need this to frob the setup below */
bpp = (ri->ri_depth == 15 ? 16 : ri->ri_depth);
if ((ri->ri_flg & RI_CFGDONE) != 0) {
ri->ri_bits = ri->ri_origbits;
ri->ri_hwbits = ri->ri_hworigbits;
}
/* Don't care if the caller wants a hideously small console */
if (wantrows < 10)
wantrows = 10;
if (wantcols < 20)
wantcols = 20;
/* Now constrain what they get */
ri->ri_emuwidth = ri->ri_font->fontwidth * wantcols;
ri->ri_emuheight = ri->ri_font->fontheight * wantrows;
if (ri->ri_emuwidth > ri->ri_width)
ri->ri_emuwidth = ri->ri_width;
if (ri->ri_emuheight > ri->ri_height)
ri->ri_emuheight = ri->ri_height;
/* Reduce width until aligned on a 32-bit boundary */
while ((ri->ri_emuwidth * bpp & 31) != 0)
ri->ri_emuwidth--;
#if NRASOPS_ROTATION > 0
if (ri->ri_flg & (RI_ROTATE_CW|RI_ROTATE_CCW)) {
ri->ri_rows = ri->ri_emuwidth / ri->ri_font->fontwidth;
ri->ri_cols = ri->ri_emuheight / ri->ri_font->fontheight;
} else
#endif
{
ri->ri_cols = ri->ri_emuwidth / ri->ri_font->fontwidth;
ri->ri_rows = ri->ri_emuheight / ri->ri_font->fontheight;
}
ri->ri_emustride = ri->ri_emuwidth * bpp >> 3;
ri->ri_ccol = 0;
ri->ri_crow = 0;
ri->ri_pelbytes = bpp >> 3;
ri->ri_xscale = (ri->ri_font->fontwidth * bpp) >> 3;
ri->ri_yscale = ri->ri_font->fontheight * ri->ri_stride;
ri->ri_fontscale = ri->ri_font->fontheight * ri->ri_font->stride;
ri->ri_origbits = ri->ri_bits;
ri->ri_hworigbits = ri->ri_hwbits;
/* Clear the entire display */
if ((ri->ri_flg & RI_CLEAR) != 0) {
rasops_memset32(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
if (ri->ri_hwbits)
rasops_memset32(ri->ri_hwbits, 0,
ri->ri_stride * ri->ri_height);
}
/* Now centre our window if needs be */
if ((ri->ri_flg & RI_CENTER) != 0) {
uint32_t xoff, yoff;
xoff = ((ri->ri_width * bpp >> 3) - ri->ri_emustride) >> 1;
if (ri->ri_depth != 24) {
/*
* Truncate to word boundary.
*/
xoff &= ~3;
} else {
/*
* Truncate to both word and 24-bit color boundary.
*/
xoff -= xoff % 12;
}
yoff = ((ri->ri_height - ri->ri_emuheight) >> 1) *
ri->ri_stride;
ri->ri_bits += xoff;
ri->ri_bits += yoff;
if (ri->ri_hwbits != NULL) {
ri->ri_hwbits += xoff;
ri->ri_hwbits += yoff;
}
ri->ri_yorigin = (int)(ri->ri_bits - ri->ri_origbits) /
ri->ri_stride;
ri->ri_xorigin = (((int)(ri->ri_bits - ri->ri_origbits) %
ri->ri_stride) * 8 / bpp);
} else
ri->ri_xorigin = ri->ri_yorigin = 0;
/* Scaling underline by font height */
height = ri->ri_font->fontheight;
ri->ri_ul.off = rounddown(height, 16) / 16; /* offset from bottom */
ri->ri_ul.height = roundup(height, 16) / 16; /* height */
/*
* Fill in defaults for operations set. XXX this nukes private
* routines used by accelerated fb drivers.
*/
ri->ri_ops.mapchar = rasops_mapchar;
ri->ri_ops.copyrows = rasops_copyrows;
ri->ri_ops.copycols = rasops_copycols;
ri->ri_ops.erasecols = rasops_erasecols;
ri->ri_ops.eraserows = rasops_eraserows;
ri->ri_ops.cursor = rasops_cursor;
ri->ri_do_cursor = rasops_do_cursor;
ri->ri_caps &= ~(WSSCREEN_UNDERLINE | WSSCREEN_HILIT |
WSSCREEN_WSCOLORS | WSSCREEN_REVERSE);
if ((ri->ri_flg & RI_FORCEMONO) != 0 ||
#ifndef RASOPS_APPLE_PALETTE
ri->ri_depth < 8
#else
ri->ri_depth < 4
#endif
) {
ri->ri_ops.allocattr = rasops_allocattr_mono;
ri->ri_caps |= WSSCREEN_UNDERLINE | WSSCREEN_REVERSE;
} else {
ri->ri_ops.allocattr = rasops_allocattr_color;
ri->ri_caps |= WSSCREEN_UNDERLINE | WSSCREEN_HILIT |
WSSCREEN_WSCOLORS | WSSCREEN_REVERSE;
}
switch (ri->ri_depth) {
#if NRASOPS1 > 0
case 1:
rasops1_init(ri);
break;
#endif
#if NRASOPS2 > 0
case 2:
rasops2_init(ri);
break;
#endif
#if NRASOPS4 > 0
case 4:
rasops4_init(ri);
break;
#endif
#if NRASOPS8 > 0
case 8:
rasops8_init(ri);
break;
#endif
#if (NRASOPS15 + NRASOPS16) > 0
case 15:
case 16:
rasops15_init(ri);
break;
#endif
#if NRASOPS24 > 0
case 24:
rasops24_init(ri);
break;
#endif
#if NRASOPS32 > 0
case 32:
rasops32_init(ri);
break;
#endif
default:
ri->ri_flg &= ~RI_CFGDONE;
aprint_error("%s: depth not supported\n", __func__);
splx(s);
return -1;
}
#if NRASOPS_ROTATION > 0
if (ri->ri_flg & RI_ROTATE_MASK) {
if (ri->ri_flg & RI_ROTATE_CW) {
ri->ri_real_ops = ri->ri_ops;
ri->ri_ops.copycols = rasops_copycols_rotated_cw;
ri->ri_ops.copyrows = rasops_copyrows_rotated_cw;
ri->ri_ops.erasecols = rasops_erasecols_rotated_cw;
ri->ri_ops.eraserows = rasops_eraserows_rotated_cw;
ri->ri_ops.putchar = rasops_putchar_rotated_cw;
} else if (ri->ri_flg & RI_ROTATE_CCW) {
ri->ri_real_ops = ri->ri_ops;
ri->ri_ops.copycols = rasops_copycols_rotated_ccw;
ri->ri_ops.copyrows = rasops_copyrows_rotated_ccw;
ri->ri_ops.erasecols = rasops_erasecols_rotated_ccw;
ri->ri_ops.eraserows = rasops_eraserows_rotated_ccw;
ri->ri_ops.putchar = rasops_putchar_rotated_ccw;
}
}
#endif
ri->ri_flg |= RI_CFGDONE;
splx(s);
return 0;
}
/*
* Map a character.
*/
static int
rasops_mapchar(void *cookie, int c, u_int *cp)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
KASSERT(ri->ri_font != NULL);
if ((c = wsfont_map_unichar(ri->ri_font, c)) < 0 ||
!CHAR_IN_FONT(c, ri->ri_font)) {
*cp = ' ';
return 0;
}
*cp = c;
return 5;
}
/*
* Allocate a color attribute.
*/
static int
rasops_allocattr_color(void *cookie, int fg0, int bg0, int flg, long *attr)
{
uint32_t fg = fg0, bg = bg0;
if (__predict_false(fg >= sizeof(rasops_isgray) ||
bg >= sizeof(rasops_isgray)))
return EINVAL;
#ifdef RASOPS_CLIPPING
fg &= 7;
bg &= 7;
#endif
if ((flg & WSATTR_BLINK) != 0)
return EINVAL;
if ((flg & WSATTR_WSCOLORS) == 0) {
#ifdef WS_DEFAULT_FG
fg = WS_DEFAULT_FG;
#else
fg = WSCOL_WHITE;
#endif
#ifdef WS_DEFAULT_BG
bg = WS_DEFAULT_BG;
#else
bg = WSCOL_BLACK;
#endif
}
if ((flg & WSATTR_HILIT) != 0 && fg < 8)
fg += 8;
if ((flg & WSATTR_REVERSE) != 0) {
uint32_t swap = fg;
fg = bg;
bg = swap;
}
flg &= WSATTR_USERMASK;
if (rasops_isgray[fg])
flg |= WSATTR_PRIVATE1;
if (rasops_isgray[bg])
flg |= WSATTR_PRIVATE2;
*attr = (bg << 16) | (fg << 24) | flg;
return 0;
}
/*
* Allocate a mono attribute.
*/
static int
rasops_allocattr_mono(void *cookie, int fg0, int bg0, int flg, long *attr)
{
uint32_t fg = fg0, bg = bg0;
if ((flg & (WSATTR_BLINK | WSATTR_HILIT | WSATTR_WSCOLORS)) != 0)
return EINVAL;
fg = 0xff;
bg = 0;
if ((flg & WSATTR_REVERSE) != 0) {
uint32_t swap = fg;
fg = bg;
bg = swap;
}
*attr = (bg << 16) | (fg << 24) | flg;
return 0;
}
/*
* Copy rows.
*/
static void
rasops_copyrows(void *cookie, int src, int dst, int num)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int stride;
uint8_t *sp, *dp, *hp;
hp = NULL; /* XXX GCC */
if (__predict_false(dst == src))
return;
#ifdef RASOPS_CLIPPING
if (src < 0) {
num += src;
src = 0;
}
if (src + num > ri->ri_rows)
num = ri->ri_rows - src;
if (dst < 0) {
num += dst;
dst = 0;
}
if (dst + num > ri->ri_rows)
num = ri->ri_rows - dst;
if (num <= 0)
return;
#endif
src *= ri->ri_yscale;
dst *= ri->ri_yscale;
num *= ri->ri_font->fontheight;
stride = ri->ri_stride;
if (src < dst) {
/* backward copy */
src += (num - 1) * stride;
dst += (num - 1) * stride;
stride *= -1;
}
sp = ri->ri_bits + src;
dp = ri->ri_bits + dst;
if (ri->ri_hwbits)
hp = ri->ri_hwbits + dst;
while (num--) {
memcpy(dp, sp, ri->ri_emustride);
if (ri->ri_hwbits) {
memcpy(hp, dp, ri->ri_emustride);
hp += stride;
}
sp += stride;
dp += stride;
}
}
/*
* Copy columns. This is slow, and hard to optimize due to alignment,
* and the fact that we have to copy both left->right and right->left.
* We simply cop-out here and use memmove(), since it handles all of
* these cases anyway.
*/
static void
rasops_copycols(void *cookie, int row, int src, int dst, int num)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int height;
uint8_t *sp, *dp, *hp;
hp = NULL; /* XXX GCC */
if (__predict_false(dst == src))
return;
#ifdef RASOPS_CLIPPING
/* Catches < 0 case too */
if ((unsigned)row >= (unsigned)ri->ri_rows)
return;
if (src < 0) {
num += src;
src = 0;
}
if (src + num > ri->ri_cols)
num = ri->ri_cols - src;
if (dst < 0) {
num += dst;
dst = 0;
}
if (dst + num > ri->ri_cols)
num = ri->ri_cols - dst;
if (num <= 0)
return;
#endif
height = ri->ri_font->fontheight;
row *= ri->ri_yscale;
num *= ri->ri_xscale;
sp = ri->ri_bits + row + src * ri->ri_xscale;
dp = ri->ri_bits + row + dst * ri->ri_xscale;
if (ri->ri_hwbits)
hp = ri->ri_hwbits + row + dst * ri->ri_xscale;
while (height--) {
memmove(dp, sp, num);
if (ri->ri_hwbits) {
memcpy(hp, dp, num);
hp += ri->ri_stride;
}
sp += ri->ri_stride;
dp += ri->ri_stride;
}
}
/*
* Turn cursor off/on.
*/
static void
rasops_cursor(void *cookie, int on, int row, int col)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
/* Turn old cursor off */
if ((ri->ri_flg & RI_CURSOR) != 0)
#ifdef RASOPS_CLIPPING
if ((ri->ri_flg & RI_CURSORCLIP) == 0)
#endif
ri->ri_do_cursor(ri);
/* Select new cursor */
ri->ri_crow = row;
ri->ri_ccol = col;
#ifdef RASOPS_CLIPPING
ri->ri_flg &= ~RI_CURSORCLIP;
if (row < 0 || row >= ri->ri_rows)
ri->ri_flg |= RI_CURSORCLIP;
else if (col < 0 || col >= ri->ri_cols)
ri->ri_flg |= RI_CURSORCLIP;
#endif
if (on) {
ri->ri_flg |= RI_CURSOR;
#ifdef RASOPS_CLIPPING
if ((ri->ri_flg & RI_CURSORCLIP) == 0)
#endif
ri->ri_do_cursor(ri);
} else
ri->ri_flg &= ~RI_CURSOR;
}
/*
* Make the device colormap
*/
static void
rasops_init_devcmap(struct rasops_info *ri)
{
int i;
uint32_t c;
const uint8_t *p;
switch (ri->ri_depth) {
case 1:
ri->ri_devcmap[0] = 0;
for (i = 1; i < 16; i++)
ri->ri_devcmap[i] = -1;
return;
case 2:
for (i = 1; i < 15; i++)
ri->ri_devcmap[i] = 0xaaaaaaaa;
ri->ri_devcmap[0] = 0;
ri->ri_devcmap[8] = 0x55555555;
ri->ri_devcmap[15] = -1;
return;
case 4:
for (i = 0; i < 16; i++) {
#ifdef RASOPS_APPLE_PALETTE
c = apple4_devcmap[i];
#else
c = i;
#endif
ri->ri_devcmap[i] =
(c << 0) | (c << 4) | (c << 8) | (c << 12) |
(c << 16) | (c << 20) | (c << 24) | (c << 28);
}
return;
case 8:
if ((ri->ri_flg & RI_8BIT_IS_RGB) == 0) {
for (i = 0; i < 16; i++) {
#ifdef RASOPS_APPLE_PALETTE
c = apple8_devcmap[i];
#else
c = i;
#endif
ri->ri_devcmap[i] =
c | (c << 8) | (c << 16) | (c << 24);
}
return;
}
}
p = rasops_cmap;
for (i = 0; i < 16; i++) {
if (ri->ri_rnum <= 8)
c = (uint32_t)(*p >> (8 - ri->ri_rnum)) << ri->ri_rpos;
else
c = (uint32_t)(*p << (ri->ri_rnum - 8)) << ri->ri_rpos;
p++;
if (ri->ri_gnum <= 8)
c |= (uint32_t)(*p >> (8 - ri->ri_gnum)) << ri->ri_gpos;
else
c |= (uint32_t)(*p << (ri->ri_gnum - 8)) << ri->ri_gpos;
p++;
if (ri->ri_bnum <= 8)
c |= (uint32_t)(*p >> (8 - ri->ri_bnum)) << ri->ri_bpos;
else
c |= (uint32_t)(*p << (ri->ri_bnum - 8)) << ri->ri_bpos;
p++;
/*
* Swap byte order if necessary. Then, fill the word for
* generic routines, which want this.
*/
switch (ri->ri_depth) {
case 8:
c |= c << 8;
c |= c << 16;
break;
case 15:
case 16:
if ((ri->ri_flg & RI_BSWAP) != 0)
c = bswap16(c);
c |= c << 16;
break;
case 24:
#if BYTE_ORDER == LITTLE_ENDIAN
if ((ri->ri_flg & RI_BSWAP) == 0)
#else
if ((ri->ri_flg & RI_BSWAP) != 0)
#endif
{
/*
* Convert to ``big endian'' if not RI_BSWAP.
*/
c = (c & 0x0000ff) << 16|
(c & 0x00ff00) |
(c & 0xff0000) >> 16;
}
/*
* No worries, we use generic routines only for
* gray colors, where all 3 bytes are same.
*/
c |= (c & 0xff) << 24;
break;
case 32:
if ((ri->ri_flg & RI_BSWAP) != 0)
c = bswap32(c);
break;
}
ri->ri_devcmap[i] = c;
}
}
/*
* Unpack a rasops attribute
*/
void
rasops_unpack_attr(long attr, int *fg, int *bg, int *underline)
{
*fg = ((uint32_t)attr >> 24) & 0xf;
*bg = ((uint32_t)attr >> 16) & 0xf;
if (underline != NULL)
*underline = (uint32_t)attr & WSATTR_UNDERLINE;
}
/*
* Erase rows. This isn't static, since 24-bpp uses it in special cases.
*/
void
rasops_eraserows(void *cookie, int row, int num, long attr)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int bytes;
uint32_t bg, *rp, *hp;
hp = NULL; /* XXX GCC */
#ifdef RASOPS_CLIPPING
if (row < 0) {
num += row;
row = 0;
}
if (row + num > ri->ri_rows)
num = ri->ri_rows - row;
if (num <= 0)
return;
#endif
/*
* XXX The wsdisplay_emulops interface seems a little deficient in
* that there is no way to clear the *entire* screen. We provide a
* workaround here: if the entire console area is being cleared, and
* the RI_FULLCLEAR flag is set, clear the entire display.
*/
if (num == ri->ri_rows && (ri->ri_flg & RI_FULLCLEAR) != 0) {
bytes = ri->ri_stride;
num = ri->ri_height;
rp = (uint32_t *)ri->ri_origbits;
if (ri->ri_hwbits)
hp = (uint32_t *)ri->ri_hworigbits;
} else {
bytes = ri->ri_emustride;
num *= ri->ri_font->fontheight;
rp = (uint32_t *)(ri->ri_bits + row * ri->ri_yscale);
if (ri->ri_hwbits)
hp = (uint32_t *)(ri->ri_hwbits + row * ri->ri_yscale);
}
bg = ATTR_BG(ri, attr);
while (num--) {
rasops_memset32(rp, bg, bytes);
if (ri->ri_hwbits) {
memcpy(hp, rp, bytes);
DELTA(hp, ri->ri_stride, uint32_t *);
}
DELTA(rp, ri->ri_stride, uint32_t *);
}
}
/*
* Actually turn the cursor on or off. This does the dirty work for
* rasops_cursor().
*/
static void
rasops_do_cursor(struct rasops_info *ri)
{
int row, col, height, slop1, slop2, full, cnt;
uint32_t mask1, mask2, *dp;
uint8_t tmp, *rp, *hp;
hp = NULL; /* XXX GCC */
#if NRASOPS_ROTATION > 0
if (ri->ri_flg & RI_ROTATE_MASK) {
if (ri->ri_flg & RI_ROTATE_CW) {
/* Rotate rows/columns */
row = ri->ri_ccol;
col = ri->ri_rows - ri->ri_crow - 1;
} else if (ri->ri_flg & RI_ROTATE_CCW) {
/* Rotate rows/columns */
row = ri->ri_cols - ri->ri_ccol - 1;
col = ri->ri_crow;
} else { /* upside-down */
row = ri->ri_crow;
col = ri->ri_ccol;
}
} else
#endif
{
row = ri->ri_crow;
col = ri->ri_ccol;
}
height = ri->ri_font->fontheight;
rp = ri->ri_bits + FBOFFSET(ri, row, col);
if (ri->ri_hwbits)
hp = ri->ri_hwbits + FBOFFSET(ri, row, col);
/*
* For ri_xscale = 1:
*
* Logic below does not work for ri_xscale = 1, e.g.,
* fontwidth = 8 and bpp = 1. So we take care of it.
*/
if (ri->ri_xscale == 1) {
while (height--) {
tmp = ~*rp;
*rp = tmp;
if (ri->ri_hwbits) {
*hp = tmp;
hp += ri->ri_stride;
}
rp += ri->ri_stride;
}
return;
}
/*
* For ri_xscale = 2, 3, 4, ...:
*
* Note that siop1 <= ri_xscale even for ri_xscale = 2,
* since rp % 3 = 0 or 2 (ri_stride % 4 = 0).
*/
slop1 = (4 - ((uintptr_t)rp & 3)) & 3;
slop2 = (ri->ri_xscale - slop1) & 3;
full = (ri->ri_xscale - slop1 /* - slop2 */) >> 2;
rp = (uint8_t *)((uintptr_t)rp & ~3);
hp = (uint8_t *)((uintptr_t)hp & ~3);
mask1 = rasops_lmask32[4 - slop1];
mask2 = rasops_rmask32[slop2];
while (height--) {
dp = (uint32_t *)rp;
if (slop1) {
*dp = *dp ^ mask1;
dp++;
}
for (cnt = full; cnt; cnt--) {
*dp = ~*(uint32_t *)dp;
dp++;
}
if (slop2)
*dp = *dp ^ mask2;
if (ri->ri_hwbits) {
memcpy(hp, rp, ((slop1 != 0) + full +
(slop2 != 0)) << 2);
hp += ri->ri_stride;
}
rp += ri->ri_stride;
}
}
/*
* Erase columns.
*/
void
rasops_erasecols(void *cookie, int row, int col, int num, long attr)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int height;
uint32_t bg, *rp, *hp;
hp = NULL; /* XXX GCC */
#ifdef RASOPS_CLIPPING
if ((unsigned)row >= (unsigned)ri->ri_rows)
return;
if (col < 0) {
num += col;
col = 0;
}
if (col + num > ri->ri_cols)
num = ri->ri_cols - col;
if (num <= 0)
return;
#endif
height = ri->ri_font->fontheight;
num *= ri->ri_xscale;
rp = (uint32_t *)(ri->ri_bits + FBOFFSET(ri, row, col));
if (ri->ri_hwbits)
hp = (uint32_t *)(ri->ri_hwbits + FBOFFSET(ri, row, col));
bg = ATTR_BG(ri, attr);
while (height--) {
rasops_memset32(rp, bg, num);
if (ri->ri_hwbits) {
memcpy(hp, rp, num);
DELTA(hp, ri->ri_stride, uint32_t *);
}
DELTA(rp, ri->ri_stride, uint32_t *);
}
}
void
rasops_make_box_chars_16(struct rasops_info *ri)
{
int c, i, mid;
uint16_t vert_mask, hmask_left, hmask_right;
uint16_t *data = (uint16_t *)ri->ri_optfont.data;
vert_mask = 0xc000U >> ((ri->ri_font->fontwidth >> 1) - 1);
hmask_left = 0xff00U << (8 - (ri->ri_font->fontwidth >> 1));
hmask_right = hmask_left >> ((ri->ri_font->fontwidth + 1) >> 1);
mid = (ri->ri_font->fontheight + 1) >> 1;
/* 0x00 would be empty anyway so don't bother */
for (c = 1; c < 16; c++) {
data += ri->ri_font->fontheight;
if (c & 1) {
/* upper segment */
for (i = 0; i < mid; i++)
data[i] = vert_mask;
}
if (c & 4) {
/* lower segment */
for (i = mid; i < ri->ri_font->fontheight; i++)
data[i] = vert_mask;
}
if (c & 2) {
/* right segment */
i = ri->ri_font->fontheight >> 1;
data[mid - 1] |= hmask_right;
data[mid] |= hmask_right;
}
if (c & 8) {
/* left segment */
data[mid - 1] |= hmask_left;
data[mid] |= hmask_left;
}
}
}
void
rasops_make_box_chars_8(struct rasops_info *ri)
{
int c, i, mid;
uint8_t vert_mask, hmask_left, hmask_right;
uint8_t *data = (uint8_t *)ri->ri_optfont.data;
vert_mask = 0xc0U >> ((ri->ri_font->fontwidth >> 1) - 1);
hmask_left = 0xf0U << (4 - (ri->ri_font->fontwidth >> 1));
hmask_right = hmask_left >> ((ri->ri_font->fontwidth + 1) >> 1);
mid = (ri->ri_font->fontheight + 1) >> 1;
/* 0x00 would be empty anyway so don't bother */
for (c = 1; c < 16; c++) {
data += ri->ri_font->fontheight;
if (c & 1) {
/* upper segment */
for (i = 0; i < mid; i++)
data[i] = vert_mask;
}
if (c & 4) {
/* lower segment */
for (i = mid; i < ri->ri_font->fontheight; i++)
data[i] = vert_mask;
}
if (c & 2) {
/* right segment */
i = ri->ri_font->fontheight >> 1;
data[mid - 1] |= hmask_right;
data[mid] |= hmask_right;
}
if (c & 8) {
/* left segment */
data[mid - 1] |= hmask_left;
data[mid] |= hmask_left;
}
}
}
void
rasops_make_box_chars_32(struct rasops_info *ri)
{
int c, i, mid;
uint32_t vert_mask, hmask_left, hmask_right;
uint32_t *data = (uint32_t *)ri->ri_optfont.data;
vert_mask = 0xc0000000U >> ((ri->ri_font->fontwidth >> 1) - 1);
hmask_left = 0xffff0000U << (16 - (ri->ri_font->fontwidth >> 1));
hmask_right = hmask_left >> ((ri->ri_font->fontwidth + 1) >> 1);
mid = (ri->ri_font->fontheight + 1) >> 1;
/* 0x00 would be empty anyway so don't bother */
for (c = 1; c < 16; c++) {
data += ri->ri_font->fontheight;
if (c & 1) {
/* upper segment */
for (i = 0; i < mid; i++)
data[i] = vert_mask;
}
if (c & 4) {
/* lower segment */
for (i = mid; i < ri->ri_font->fontheight; i++)
data[i] = vert_mask;
}
if (c & 2) {
/* right segment */
i = ri->ri_font->fontheight >> 1;
data[mid - 1] |= hmask_right;
data[mid] |= hmask_right;
}
if (c & 8) {
/* left segment */
data[mid - 1] |= hmask_left;
data[mid] |= hmask_left;
}
}
}
void
rasops_make_box_chars_alpha(struct rasops_info *ri)
{
int c, i, hmid, vmid, wi, he;
uint8_t *data = (uint8_t *)ri->ri_optfont.data;
uint8_t *ddata;
he = ri->ri_font->fontheight;
wi = ri->ri_font->fontwidth;
vmid = (he + 1) >> 1;
hmid = (wi + 1) >> 1;
/* 0x00 would be empty anyway so don't bother */
for (c = 1; c < 16; c++) {
data += ri->ri_fontscale;
if (c & 1) {
/* upper segment */
ddata = data + hmid;
for (i = 0; i <= vmid; i++) {
*ddata = 0xff;
ddata += wi;
}
}
if (c & 4) {
/* lower segment */
ddata = data + wi * vmid + hmid;
for (i = vmid; i < he; i++) {
*ddata = 0xff;
ddata += wi;
}
}
if (c & 2) {
/* right segment */
ddata = data + wi * vmid + hmid;
for (i = hmid; i < wi; i++) {
*ddata = 0xff;
ddata++;
}
}
if (c & 8) {
/* left segment */
ddata = data + wi * vmid;
for (i = 0; i <= hmid; i++) {
*ddata = 0xff;
ddata++;
}
}
}
}
/*
* Return a colour map appropriate for the given struct rasops_info in the
* same form used by rasops_cmap[]
* For now this is either a copy of rasops_cmap[] or an R3G3B2 map, it should
* probably be a linear ( or gamma corrected? ) ramp for higher depths.
*/
int
rasops_get_cmap(struct rasops_info *ri, uint8_t *palette, size_t bytes)
{
if ((ri->ri_depth == 8) && ((ri->ri_flg & RI_8BIT_IS_RGB) != 0)) {
/* generate an R3G3B2 palette */
int i, idx = 0;
uint8_t tmp;
if (bytes < 256 * 3)
return EINVAL;
for (i = 0; i < 256; i++) {
tmp = i & 0xe0;
/*
* replicate bits so 0xe0 maps to a red value of 0xff
* in order to make white look actually white
*/
tmp |= (tmp >> 3) | (tmp >> 6);
palette[idx] = tmp;
idx++;
tmp = (i & 0x1c) << 3;
tmp |= (tmp >> 3) | (tmp >> 6);
palette[idx] = tmp;
idx++;
tmp = (i & 0x03) << 6;
tmp |= tmp >> 2;
tmp |= tmp >> 4;
palette[idx] = tmp;
idx++;
}
} else
memcpy(palette, rasops_cmap, uimin(bytes, sizeof(rasops_cmap)));
return 0;
}
#if NRASOPS_ROTATION > 0
/*
* Quarter clockwise rotation routines (originally intended for the
* built-in Zaurus C3x00 display in 16bpp).
*/
static void
rasops_rotate_font(int *cookie, int rotate)
{
struct rotatedfont *f;
int ncookie;
SLIST_FOREACH(f, &rotatedfonts, rf_next) {
if (f->rf_cookie == *cookie) {
*cookie = f->rf_rotated;
return;
}
}
/*
* We did not find a rotated version of this font. Ask the wsfont
* code to compute one for us.
*/
f = kmem_alloc(sizeof(*f), KM_SLEEP);
if ((ncookie = wsfont_rotate(*cookie, rotate)) == -1)
goto fail;
f->rf_cookie = *cookie;
f->rf_rotated = ncookie;
SLIST_INSERT_HEAD(&rotatedfonts, f, rf_next);
*cookie = ncookie;
return;
fail: kmem_free(f, sizeof(*f));
return;
}
static void
rasops_copychar(void *cookie, int srcrow, int dstrow, int srccol, int dstcol)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int r_srcrow, r_dstrow, r_srccol, r_dstcol, height;
uint8_t *sp, *dp;
r_srcrow = srccol;
r_dstrow = dstcol;
r_srccol = ri->ri_rows - srcrow - 1;
r_dstcol = ri->ri_rows - dstrow - 1;
r_srcrow *= ri->ri_yscale;
r_dstrow *= ri->ri_yscale;
height = ri->ri_font->fontheight;
sp = ri->ri_bits + r_srcrow + r_srccol * ri->ri_xscale;
dp = ri->ri_bits + r_dstrow + r_dstcol * ri->ri_xscale;
while (height--) {
memmove(dp, sp, ri->ri_xscale);
dp += ri->ri_stride;
sp += ri->ri_stride;
}
}
static void
rasops_putchar_rotated_cw(void *cookie, int row, int col, u_int uc, long attr)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int height;
uint16_t fg, *rp;
if (__predict_false((unsigned int)row > ri->ri_rows ||
(unsigned int)col > ri->ri_cols))
return;
/* Avoid underflow */
if (ri->ri_rows - row - 1 < 0)
return;
/* Do rotated char sans (side)underline */
ri->ri_real_ops.putchar(cookie, col, ri->ri_rows - row - 1, uc,
attr & ~WSATTR_UNDERLINE);
/*
* Do rotated underline
* XXX this assumes 16-bit color depth
*/
if ((attr & WSATTR_UNDERLINE) != 0) {
height = ri->ri_font->fontheight;
rp = (uint16_t *)(ri->ri_bits + col * ri->ri_yscale +
(ri->ri_rows - row - 1) * ri->ri_xscale);
fg = (uint16_t)ATTR_FG(ri, attr);
while (height--) {
*rp = fg;
DELTA(rp, ri->ri_stride, uint16_t *);
}
}
}
static void
rasops_erasecols_rotated_cw(void *cookie, int row, int col, int num, long attr)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int i;
for (i = col; i < col + num; i++)
ri->ri_ops.putchar(cookie, row, i, ' ', attr);
}
/* XXX: these could likely be optimised somewhat. */
static void
rasops_copyrows_rotated_cw(void *cookie, int src, int dst, int num)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int col, roff;
if (src > dst)
for (roff = 0; roff < num; roff++)
for (col = 0; col < ri->ri_cols; col++)
rasops_copychar(cookie, src + roff, dst + roff,
col, col);
else
for (roff = num - 1; roff >= 0; roff--)
for (col = 0; col < ri->ri_cols; col++)
rasops_copychar(cookie, src + roff, dst + roff,
col, col);
}
static void
rasops_copycols_rotated_cw(void *cookie, int row, int src, int dst, int num)
{
int coff;
if (src > dst)
for (coff = 0; coff < num; coff++)
rasops_copychar(cookie, row, row, src + coff,
dst + coff);
else
for (coff = num - 1; coff >= 0; coff--)
rasops_copychar(cookie, row, row, src + coff,
dst + coff);
}
static void
rasops_eraserows_rotated_cw(void *cookie, int row, int num, long attr)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int col, rn;
for (rn = row; rn < row + num; rn++)
for (col = 0; col < ri->ri_cols; col++)
ri->ri_ops.putchar(cookie, rn, col, ' ', attr);
}
/*
* Quarter counter-clockwise rotation routines (originally intended for the
* built-in Sharp W-ZERO3 display in 16bpp).
*/
static void
rasops_copychar_ccw(void *cookie, int srcrow, int dstrow, int srccol,
int dstcol)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int r_srcrow, r_dstrow, r_srccol, r_dstcol, height;
uint8_t *sp, *dp;
r_srcrow = ri->ri_cols - srccol - 1;
r_dstrow = ri->ri_cols - dstcol - 1;
r_srccol = srcrow;
r_dstcol = dstrow;
r_srcrow *= ri->ri_yscale;
r_dstrow *= ri->ri_yscale;
height = ri->ri_font->fontheight;
sp = ri->ri_bits + r_srcrow + r_srccol * ri->ri_xscale;
dp = ri->ri_bits + r_dstrow + r_dstcol * ri->ri_xscale;
while (height--) {
memmove(dp, sp, ri->ri_xscale);
dp += ri->ri_stride;
sp += ri->ri_stride;
}
}
static void
rasops_putchar_rotated_ccw(void *cookie, int row, int col, u_int uc, long attr)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int height;
uint16_t fg, *rp;
if (__predict_false((unsigned int)row > ri->ri_rows ||
(unsigned int)col > ri->ri_cols))
return;
/* Avoid underflow */
if (ri->ri_cols - col - 1 < 0)
return;
/* Do rotated char sans (side)underline */
ri->ri_real_ops.putchar(cookie, ri->ri_cols - col - 1, row, uc,
attr & ~WSATTR_UNDERLINE);
/*
* Do rotated underline
* XXX this assumes 16-bit color depth
*/
if ((attr & WSATTR_UNDERLINE) != 0) {
height = ri->ri_font->fontheight;
rp = (uint16_t *)(ri->ri_bits +
(ri->ri_cols - col - 1) * ri->ri_yscale +
row * ri->ri_xscale +
(ri->ri_font->fontwidth - 1) * ri->ri_pelbytes);
fg = (uint16_t)ATTR_FG(ri, attr);
while (height--) {
*rp = fg;
DELTA(rp, ri->ri_stride, uint16_t *);
}
}
}
/* XXX: these could likely be optimised somewhat. */
static void
rasops_copyrows_rotated_ccw(void *cookie, int src, int dst, int num)
{
struct rasops_info *ri = (struct rasops_info *)cookie;
int col, roff;
if (src > dst)
for (roff = 0; roff < num; roff++)
for (col = 0; col < ri->ri_cols; col++)
rasops_copychar_ccw(cookie,
src + roff, dst + roff, col, col);
else
for (roff = num - 1; roff >= 0; roff--)
for (col = 0; col < ri->ri_cols; col++)
rasops_copychar_ccw(cookie,
src + roff, dst + roff, col, col);
}
static void
rasops_copycols_rotated_ccw(void *cookie, int row, int src, int dst, int num)
{
int coff;
if (src > dst)
for (coff = 0; coff < num; coff++)
rasops_copychar_ccw(cookie, row, row,
src + coff, dst + coff);
else
for (coff = num - 1; coff >= 0; coff--)
rasops_copychar_ccw(cookie, row, row,
src + coff, dst + coff);
}
#endif /* NRASOPS_ROTATION */
Reference in New Issue View Git Blame Copy Permalink