Home | History | Annotate | Line # | Download | only in dev
ite_tv.c revision 1.18
      1  1.18   tsutsui /*	$NetBSD: ite_tv.c,v 1.18 2022/06/25 03:18:38 tsutsui Exp $	*/
      2   1.1       oki 
      3   1.1       oki /*
      4   1.1       oki  * Copyright (c) 1997 Masaru Oki.
      5   1.1       oki  * All rights reserved.
      6   1.1       oki  *
      7   1.1       oki  * Redistribution and use in source and binary forms, with or without
      8   1.1       oki  * modification, are permitted provided that the following conditions
      9   1.1       oki  * are met:
     10   1.1       oki  * 1. Redistributions of source code must retain the above copyright
     11   1.1       oki  *    notice, this list of conditions and the following disclaimer.
     12   1.1       oki  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1       oki  *    notice, this list of conditions and the following disclaimer in the
     14   1.1       oki  *    documentation and/or other materials provided with the distribution.
     15   1.1       oki  * 3. All advertising materials mentioning features or use of this software
     16   1.1       oki  *    must display the following acknowledgement:
     17   1.1       oki  *      This product includes software developed by Masaru Oki.
     18   1.1       oki  * 4. The name of the author may not be used to endorse or promote products
     19   1.1       oki  *    derived from this software without specific prior written permission
     20   1.1       oki  *
     21   1.1       oki  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22   1.1       oki  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23   1.1       oki  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24   1.1       oki  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25   1.1       oki  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26   1.1       oki  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27   1.1       oki  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28   1.1       oki  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29   1.1       oki  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30   1.1       oki  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31   1.1       oki  */
     32  1.10     lukem 
     33  1.10     lukem #include <sys/cdefs.h>
     34  1.18   tsutsui __KERNEL_RCSID(0, "$NetBSD: ite_tv.c,v 1.18 2022/06/25 03:18:38 tsutsui Exp $");
     35   1.1       oki 
     36   1.1       oki #include <sys/param.h>
     37   1.1       oki #include <sys/device.h>
     38   1.1       oki #include <sys/proc.h>
     39   1.1       oki #include <sys/systm.h>
     40   1.1       oki 
     41   1.6   minoura #include <machine/bus.h>
     42   1.5   minoura #include <machine/grfioctl.h>
     43   1.5   minoura 
     44   1.6   minoura #include <arch/x68k/x68k/iodevice.h>
     45   1.6   minoura #include <arch/x68k/dev/itevar.h>
     46   1.6   minoura #include <arch/x68k/dev/grfvar.h>
     47   1.6   minoura #include <arch/x68k/dev/mfp.h>
     48   1.1       oki 
     49   1.1       oki /*
     50   1.1       oki  * ITE device dependent routine for X680x0 Text-Video framebuffer.
     51   1.1       oki  * Use X680x0 ROM fixed width font (8x16)
     52   1.1       oki  */
     53   1.1       oki 
     54   1.1       oki #define CRTC    (IODEVbase->io_crtc)
     55   1.1       oki 
     56   1.1       oki /*
     57   1.1       oki  * font constant
     58   1.1       oki  */
     59   1.1       oki #define FONTWIDTH   8
     60   1.1       oki #define FONTHEIGHT  16
     61   1.1       oki #define UNDERLINE   14
     62   1.1       oki 
     63   1.1       oki /*
     64   1.1       oki  * framebuffer constant
     65   1.1       oki  */
     66   1.1       oki #define PLANEWIDTH  1024
     67   1.1       oki #define PLANEHEIGHT 1024
     68   1.1       oki #define PLANELINES  (PLANEHEIGHT / FONTHEIGHT)
     69   1.1       oki #define ROWBYTES    (PLANEWIDTH  / FONTWIDTH)
     70   1.1       oki #define PLANESIZE   (PLANEHEIGHT * ROWBYTES)
     71   1.1       oki 
     72  1.18   tsutsui static u_int  tv_top;
     73  1.18   tsutsui static uint8_t *tv_row[PLANELINES];
     74  1.18   tsutsui static uint8_t *tv_font[256];
     75  1.18   tsutsui static volatile uint8_t *tv_kfont[0x7f];
     76   1.1       oki 
     77  1.18   tsutsui uint8_t kern_font[256 * FONTHEIGHT];
     78   1.1       oki 
     79   1.1       oki #define PHYSLINE(y)  ((tv_top + (y)) % PLANELINES)
     80   1.1       oki #define ROWOFFSET(y) ((y) * FONTHEIGHT * ROWBYTES)
     81   1.1       oki #define CHADDR(y, x) (tv_row[PHYSLINE(y)] + (x))
     82   1.1       oki 
     83  1.18   tsutsui #define SETGLYPH(to,from)	\
     84  1.18   tsutsui 	memcpy(&kern_font[(from) * 16],&kern_font[(to) * 16], 16)
     85   1.3       oki #define KFONTBASE(left)   ((left) * 32 * 0x5e - 0x21 * 32)
     86   1.2       oki 
     87   1.1       oki /* prototype */
     88  1.18   tsutsui static void tv_putc(struct ite_softc *, int, int, int, int);
     89  1.18   tsutsui static void tv_cursor(struct ite_softc *, int);
     90  1.18   tsutsui static void tv_clear(struct ite_softc *, int, int, int, int);
     91  1.18   tsutsui static void tv_scroll(struct ite_softc *, int, int, int, int);
     92   1.1       oki 
     93  1.18   tsutsui static inline uint32_t expbits(uint32_t);
     94  1.18   tsutsui static inline void txrascpy(uint8_t, uint8_t, int16_t, uint16_t);
     95   1.1       oki 
     96  1.14     perry static inline void
     97  1.18   tsutsui txrascpy(uint8_t src, uint8_t dst, int16_t size, uint16_t mode)
     98   1.1       oki {
     99   1.1       oki 	/*int s;*/
    100  1.18   tsutsui 	uint16_t saved_r21 = CRTC.r21;
    101  1.18   tsutsui 	int8_t d;
    102   1.1       oki 
    103  1.18   tsutsui 	d = ((mode & 0x8000) != 0) ? -1 : 1;
    104   1.1       oki 	src *= FONTHEIGHT / 4;
    105   1.1       oki 	dst *= FONTHEIGHT / 4;
    106   1.1       oki 	size *= 4;
    107   1.1       oki 	if (d < 0) {
    108   1.1       oki 		src += (FONTHEIGHT / 4) - 1;
    109   1.1       oki 		dst += (FONTHEIGHT / 4) - 1;
    110   1.1       oki 	}
    111   1.1       oki 
    112   1.1       oki 	/* specify same time write mode & page */
    113   1.1       oki 	CRTC.r21 = (mode & 0x0f) | 0x0100;
    114   1.1       oki 	/*mfp.ddr = 0;*/			/* port is input */
    115   1.1       oki 
    116   1.1       oki 	/*s = splhigh();*/
    117   1.1       oki 	while (--size >= 0) {
    118   1.1       oki 		/* wait for hsync */
    119  1.18   tsutsui 		mfp_wait_for_hsync();
    120   1.1       oki 		CRTC.r22 = (src << 8) | dst;	/* specify raster number */
    121   1.1       oki 		/* start raster copy */
    122  1.18   tsutsui 		CRTC.crtctrl = 0x0008;
    123   1.1       oki 
    124   1.1       oki 		src += d;
    125   1.1       oki 		dst += d;
    126   1.1       oki 	}
    127   1.1       oki 	/*splx(s);*/
    128   1.1       oki 
    129   1.1       oki 	/* wait for hsync */
    130  1.18   tsutsui 	mfp_wait_for_hsync();
    131   1.6   minoura 
    132   1.1       oki 	/* stop raster copy */
    133  1.18   tsutsui 	CRTC.crtctrl = 0x0000;
    134   1.1       oki 
    135   1.1       oki 	CRTC.r21 = saved_r21;
    136   1.1       oki }
    137   1.1       oki 
    138   1.1       oki /*
    139   1.8     isaki  * Change glyphs from SRAM switch.
    140   1.8     isaki  */
    141   1.8     isaki void
    142   1.8     isaki ite_set_glyph(void)
    143   1.8     isaki {
    144  1.18   tsutsui 	uint8_t glyph = IODEVbase->io_sram[0x59];
    145   1.8     isaki 
    146  1.18   tsutsui 	if ((glyph & 4) != 0)
    147   1.8     isaki 		SETGLYPH(0x82, '|');
    148  1.18   tsutsui 	if ((glyph & 2) != 0)
    149   1.8     isaki 		SETGLYPH(0x81, '~');
    150  1.18   tsutsui 	if ((glyph & 1) != 0)
    151   1.8     isaki 		SETGLYPH(0x80, '\\');
    152   1.8     isaki }
    153   1.8     isaki 
    154   1.8     isaki /*
    155   1.1       oki  * Initialize
    156   1.1       oki  */
    157  1.15     isaki void
    158  1.11       chs tv_init(struct ite_softc *ip)
    159   1.1       oki {
    160   1.1       oki 	short i;
    161   1.1       oki 
    162   1.1       oki 	/*
    163   1.1       oki 	 * initialize private variables
    164   1.1       oki 	 */
    165   1.1       oki 	tv_top = 0;
    166   1.1       oki 	for (i = 0; i < PLANELINES; i++)
    167  1.18   tsutsui 		tv_row[i] =
    168  1.18   tsutsui 		    (void *)__UNVOLATILE(&IODEVbase->tvram[ROWOFFSET(i)]);
    169   1.1       oki 	/* shadow ANK font */
    170   1.9       wiz 	memcpy(kern_font, (void *)&IODEVbase->cgrom0_8x16, 256 * FONTHEIGHT);
    171   1.8     isaki 	ite_set_glyph();
    172   1.1       oki 	/* set font address cache */
    173   1.1       oki 	for (i = 0; i < 256; i++)
    174   1.1       oki 		tv_font[i] = &kern_font[i * FONTHEIGHT];
    175   1.1       oki 	for (i = 0x21; i < 0x30; i++)
    176   1.2       oki 		tv_kfont[i] = &IODEVbase->cgrom0_16x16[KFONTBASE(i-0x21)];
    177   1.1       oki 	for (; i < 0x50; i++)
    178   1.2       oki 		tv_kfont[i] = &IODEVbase->cgrom1_16x16[KFONTBASE(i-0x30)];
    179   1.1       oki 	for (; i < 0x7f; i++)
    180   1.2       oki 		tv_kfont[i] = &IODEVbase->cgrom2_16x16[KFONTBASE(i-0x50)];
    181   1.1       oki 
    182   1.1       oki 	/*
    183   1.1       oki 	 * initialize part of ip
    184   1.1       oki 	 */
    185   1.1       oki 	ip->cols = ip->grf->g_display.gd_dwidth  / FONTWIDTH;
    186   1.1       oki 	ip->rows = ip->grf->g_display.gd_dheight / FONTHEIGHT;
    187   1.1       oki 	/* set draw routine dynamically */
    188   1.1       oki 	ip->isw->ite_putc   = tv_putc;
    189   1.1       oki 	ip->isw->ite_cursor = tv_cursor;
    190   1.1       oki 	ip->isw->ite_clear  = tv_clear;
    191   1.1       oki 	ip->isw->ite_scroll = tv_scroll;
    192   1.1       oki 
    193   1.1       oki 	/*
    194  1.17  dholland 	 * Initialize colormap
    195   1.1       oki 	 */
    196   1.1       oki #define RED   (0x1f << 6)
    197   1.1       oki #define BLUE  (0x1f << 1)
    198   1.1       oki #define GREEN (0x1f << 11)
    199   1.1       oki 	IODEVbase->tpalet[0] = 0;			/* black */
    200   1.1       oki 	IODEVbase->tpalet[1] = 1 | RED;			/* red */
    201   1.1       oki 	IODEVbase->tpalet[2] = 1 | GREEN;		/* green */
    202   1.1       oki 	IODEVbase->tpalet[3] = 1 | RED | GREEN;		/* yellow */
    203   1.1       oki 	IODEVbase->tpalet[4] = 1 | BLUE;		/* blue */
    204   1.1       oki 	IODEVbase->tpalet[5] = 1 | BLUE | RED;		/* magenta */
    205   1.1       oki 	IODEVbase->tpalet[6] = 1 | BLUE | GREEN;	/* cyan */
    206   1.1       oki 	IODEVbase->tpalet[7] = 1 | BLUE | RED | GREEN;	/* white */
    207   1.1       oki }
    208   1.1       oki 
    209   1.1       oki /*
    210   1.1       oki  * Deinitialize
    211   1.1       oki  */
    212  1.15     isaki void
    213  1.11       chs tv_deinit(struct ite_softc *ip)
    214   1.1       oki {
    215  1.18   tsutsui 
    216   1.1       oki 	ip->flags &= ~ITE_INITED; /* XXX? */
    217   1.1       oki }
    218   1.1       oki 
    219  1.18   tsutsui static inline uint8_t *tv_getfont(int, int);
    220  1.11       chs typedef void tv_putcfunc(struct ite_softc *, int, char *);
    221   1.1       oki static tv_putcfunc tv_putc_nm;
    222   1.1       oki static tv_putcfunc tv_putc_in;
    223   1.1       oki static tv_putcfunc tv_putc_ul;
    224   1.1       oki static tv_putcfunc tv_putc_ul_in;
    225   1.1       oki static tv_putcfunc tv_putc_bd;
    226   1.1       oki static tv_putcfunc tv_putc_bd_in;
    227   1.1       oki static tv_putcfunc tv_putc_bd_ul;
    228   1.1       oki static tv_putcfunc tv_putc_bd_ul_in;
    229   1.1       oki 
    230   1.1       oki static tv_putcfunc *putc_func[ATTR_ALL + 1] = {
    231  1.18   tsutsui 	[ATTR_NOR]					= tv_putc_nm,
    232  1.18   tsutsui 	[ATTR_INV]					= tv_putc_in,
    233  1.18   tsutsui 	[ATTR_UL]					= tv_putc_ul,
    234  1.18   tsutsui 	[ATTR_INV | ATTR_UL]				= tv_putc_ul_in,
    235  1.18   tsutsui 	[ATTR_BOLD]					= tv_putc_bd,
    236  1.18   tsutsui 	[ATTR_BOLD | ATTR_INV]				= tv_putc_bd_in,
    237  1.18   tsutsui 	[ATTR_BOLD | ATTR_UL]				= tv_putc_bd_ul,
    238  1.18   tsutsui 	[ATTR_BOLD | ATTR_UL | ATTR_INV]		= tv_putc_bd_ul_in,
    239   1.1       oki 	/* no support for blink */
    240  1.18   tsutsui 	[ATTR_BLINK]					= tv_putc_nm,
    241  1.18   tsutsui 	[ATTR_BLINK | ATTR_INV]				= tv_putc_in,
    242  1.18   tsutsui 	[ATTR_BLINK | ATTR_UL]				= tv_putc_ul,
    243  1.18   tsutsui 	[ATTR_BLINK | ATTR_UL | ATTR_INV]		= tv_putc_ul_in,
    244  1.18   tsutsui 	[ATTR_BLINK | ATTR_BOLD]			= tv_putc_bd,
    245  1.18   tsutsui 	[ATTR_BLINK | ATTR_BOLD | ATTR_INV]		= tv_putc_bd_in,
    246  1.18   tsutsui 	[ATTR_BLINK | ATTR_BOLD | ATTR_UL]		= tv_putc_bd_ul,
    247  1.18   tsutsui 	[ATTR_BLINK | ATTR_BOLD | ATTR_UL | ATTR_INV]	= tv_putc_bd_ul_in,
    248   1.1       oki };
    249   1.1       oki 
    250   1.1       oki /*
    251   1.1       oki  * simple put character function
    252   1.1       oki  */
    253  1.18   tsutsui static void
    254  1.11       chs tv_putc(struct ite_softc *ip, int ch, int y, int x, int mode)
    255   1.1       oki {
    256  1.18   tsutsui 	uint8_t *p = CHADDR(y, x);
    257   1.1       oki 	short fh;
    258   1.1       oki 
    259   1.1       oki 	/* multi page write mode */
    260   1.1       oki 	CRTC.r21 = 0x0100 | ip->fgcolor << 4;
    261   1.1       oki 
    262   1.1       oki 	/* draw plane */
    263   1.1       oki 	putc_func[mode](ip, ch, p);
    264   1.1       oki 
    265   1.1       oki 	/* erase plane */
    266   1.1       oki 	CRTC.r21 ^= 0x00f0;
    267   1.1       oki 	if (ip->save_char) {
    268   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    269  1.18   tsutsui 			*(uint16_t *)p = 0;
    270   1.1       oki 	} else {
    271   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    272   1.1       oki 			*p = 0;
    273   1.1       oki 	}
    274   1.1       oki 
    275   1.1       oki 	/* crtc mode reset */
    276   1.1       oki 	CRTC.r21 = 0;
    277   1.1       oki }
    278   1.1       oki 
    279  1.18   tsutsui static inline uint8_t *
    280  1.18   tsutsui tv_getfont(int cset, int ch)
    281  1.18   tsutsui {
    282  1.18   tsutsui 
    283  1.18   tsutsui 	if (cset == CSET_JISKANA) {
    284  1.18   tsutsui 		ch |= 0x80;
    285  1.18   tsutsui 	} else if (cset == CSET_DECGRAPH) {
    286  1.18   tsutsui 		if (ch < 0x80) {
    287  1.18   tsutsui 			ch = ite_decgraph2ascii[ch];
    288  1.18   tsutsui 		}
    289  1.18   tsutsui 	}
    290  1.18   tsutsui 
    291  1.18   tsutsui 	return tv_font[ch];
    292  1.18   tsutsui }
    293  1.18   tsutsui 
    294  1.18   tsutsui static void
    295  1.11       chs tv_putc_nm(struct ite_softc *ip, int ch, char *p)
    296   1.1       oki {
    297   1.1       oki 	short fh, hi;
    298  1.18   tsutsui 	volatile uint16_t *kf;
    299  1.18   tsutsui 	uint8_t *f;
    300   1.1       oki 
    301   1.1       oki 	hi = ip->save_char & 0x7f;
    302   1.1       oki 
    303  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    304  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    305   1.1       oki 		/* multibyte character */
    306  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    307  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    308   1.1       oki 		/* draw plane */
    309   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    310  1.18   tsutsui 			*(uint16_t *)p = *kf++;
    311   1.1       oki 		return;
    312   1.1       oki 	}
    313   1.1       oki 
    314   1.1       oki 	/* singlebyte character */
    315  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    316   1.1       oki 
    317   1.1       oki 	/* draw plane */
    318   1.1       oki 	for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    319   1.1       oki 		*p = *f++;
    320   1.1       oki }
    321   1.1       oki 
    322  1.18   tsutsui static void
    323  1.11       chs tv_putc_in(struct ite_softc *ip, int ch, char *p)
    324   1.1       oki {
    325   1.1       oki 	short fh, hi;
    326  1.18   tsutsui 	volatile uint16_t *kf;
    327  1.18   tsutsui 	uint8_t *f;
    328   1.1       oki 
    329   1.1       oki 	hi = ip->save_char & 0x7f;
    330   1.1       oki 
    331  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    332  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    333   1.1       oki 		/* multibyte character */
    334  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    335  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    336   1.1       oki 		/* draw plane */
    337   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    338  1.18   tsutsui 			*(uint16_t *)p = ~*kf++;
    339   1.1       oki 		return;
    340   1.1       oki 	}
    341   1.1       oki 
    342   1.1       oki 	/* singlebyte character */
    343  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    344   1.1       oki 
    345   1.1       oki 	/* draw plane */
    346   1.1       oki 	for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    347   1.1       oki 		*p = ~*f++;
    348   1.1       oki }
    349   1.1       oki 
    350  1.18   tsutsui static void
    351  1.11       chs tv_putc_bd(struct ite_softc *ip, int ch, char *p)
    352   1.1       oki {
    353   1.1       oki 	short fh, hi;
    354  1.18   tsutsui 	u_int data;
    355  1.18   tsutsui 	volatile uint16_t *kf;
    356  1.18   tsutsui 	uint8_t *f;
    357   1.1       oki 
    358   1.1       oki 	hi = ip->save_char & 0x7f;
    359   1.1       oki 
    360  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    361  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    362   1.1       oki 		/* multibyte character */
    363  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    364  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    365   1.1       oki 		/* draw plane */
    366   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    367  1.18   tsutsui 			data = *kf++;
    368  1.18   tsutsui 			*(uint16_t *)p = data | (data >> 1);
    369   1.1       oki 		}
    370   1.1       oki 		return;
    371   1.1       oki 	}
    372   1.1       oki 
    373   1.1       oki 	/* singlebyte character */
    374  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    375   1.1       oki 
    376   1.1       oki 	/* draw plane */
    377   1.1       oki 	for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    378  1.18   tsutsui 		data = *f++;
    379  1.18   tsutsui 		*p = data | (data >> 1);
    380   1.1       oki 	}
    381   1.1       oki }
    382   1.1       oki 
    383  1.18   tsutsui static inline uint32_t
    384  1.18   tsutsui expbits(uint32_t data)
    385   1.1       oki {
    386  1.18   tsutsui 	int i;
    387  1.18   tsutsui 	u_int nd = 0;
    388  1.18   tsutsui 
    389  1.18   tsutsui 	if ((data & 1) != 0)
    390   1.1       oki 		nd |= 0x02;
    391  1.18   tsutsui 	for (i = 1; i < 32; i++) {
    392  1.18   tsutsui 		if ((data & (1 << i)) != 0)
    393  1.18   tsutsui 			nd |= 0x5 << (i - 1);
    394   1.1       oki 	}
    395   1.1       oki 	nd &= ~data;
    396  1.18   tsutsui 	return ~nd;
    397   1.1       oki }
    398   1.1       oki 
    399  1.18   tsutsui static void
    400  1.11       chs tv_putc_ul(struct ite_softc *ip, int ch, char *p)
    401   1.1       oki {
    402   1.1       oki 	short fh, hi;
    403  1.18   tsutsui 	volatile uint16_t *kf;
    404  1.18   tsutsui 	uint8_t *f;
    405   1.1       oki 
    406   1.1       oki 	hi = ip->save_char & 0x7f;
    407   1.1       oki 
    408  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    409  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    410   1.1       oki 		/* multibyte character */
    411  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    412  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    413   1.1       oki 		/* draw plane */
    414   1.1       oki 		for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES)
    415  1.18   tsutsui 			*(uint16_t *)p = *kf++;
    416  1.18   tsutsui 		*(uint16_t *)p = expbits(*kf++);
    417   1.1       oki 		p += ROWBYTES;
    418   1.1       oki 		for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    419  1.18   tsutsui 			*(uint16_t *)p = *kf++;
    420   1.1       oki 		return;
    421   1.1       oki 	}
    422   1.1       oki 
    423   1.1       oki 	/* singlebyte character */
    424  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    425   1.1       oki 
    426   1.1       oki 	/* draw plane */
    427   1.1       oki 	for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES)
    428   1.1       oki 		*p = *f++;
    429   1.1       oki 	*p = expbits(*f++);
    430   1.1       oki 	p += ROWBYTES;
    431   1.1       oki 	for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    432   1.1       oki 		*p = *f++;
    433   1.1       oki }
    434   1.1       oki 
    435  1.18   tsutsui static void
    436  1.11       chs tv_putc_bd_in(struct ite_softc *ip, int ch, char *p)
    437   1.1       oki {
    438   1.1       oki 	short fh, hi;
    439  1.18   tsutsui 	u_int data;
    440  1.18   tsutsui 	volatile uint16_t *kf;
    441  1.18   tsutsui 	uint8_t *f;
    442   1.1       oki 
    443   1.1       oki 	hi = ip->save_char & 0x7f;
    444   1.1       oki 
    445  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    446  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    447   1.1       oki 		/* multibyte character */
    448  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    449  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    450   1.1       oki 		/* draw plane */
    451   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    452  1.18   tsutsui 			data = *kf++;
    453  1.18   tsutsui 			*(uint16_t *)p = ~(data | (data >> 1));
    454   1.1       oki 		}
    455   1.1       oki 		return;
    456   1.1       oki 	}
    457   1.1       oki 
    458   1.1       oki 	/* singlebyte character */
    459  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    460   1.1       oki 
    461   1.1       oki 	/* draw plane */
    462   1.1       oki 	for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    463  1.18   tsutsui 		data = *f++;
    464  1.18   tsutsui 		*p = ~(data | (data >> 1));
    465   1.1       oki 	}
    466   1.1       oki }
    467   1.1       oki 
    468  1.18   tsutsui static void
    469  1.11       chs tv_putc_ul_in(struct ite_softc *ip, int ch, char *p)
    470   1.1       oki {
    471   1.1       oki 	short fh, hi;
    472  1.18   tsutsui 	volatile uint16_t *kf;
    473  1.18   tsutsui 	uint8_t *f;
    474   1.1       oki 
    475   1.1       oki 	hi = ip->save_char & 0x7f;
    476   1.1       oki 
    477  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    478  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    479   1.1       oki 		/* multibyte character */
    480  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    481  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    482   1.1       oki 		/* draw plane */
    483   1.1       oki 		for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES)
    484  1.18   tsutsui 			*(uint16_t *)p = ~*kf++;
    485  1.18   tsutsui 		*(uint16_t *)p = ~expbits(*kf++);
    486   1.1       oki 		p += ROWBYTES;
    487   1.1       oki 		for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    488  1.18   tsutsui 			*(uint16_t *)p = ~*kf++;
    489   1.1       oki 		return;
    490   1.1       oki 	}
    491   1.1       oki 
    492   1.1       oki 	/* singlebyte character */
    493  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    494   1.1       oki 
    495   1.1       oki 	/* draw plane */
    496   1.1       oki 	for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES)
    497   1.1       oki 		*p = ~*f++;
    498   1.1       oki 	*p = ~expbits(*f++);
    499   1.1       oki 	p += ROWBYTES;
    500   1.1       oki 	for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    501   1.1       oki 		*p = ~*f++;
    502   1.1       oki }
    503   1.1       oki 
    504  1.18   tsutsui static void
    505  1.11       chs tv_putc_bd_ul(struct ite_softc *ip, int ch, char *p)
    506   1.1       oki {
    507   1.1       oki 	short fh, hi;
    508  1.18   tsutsui 	u_int data;
    509  1.18   tsutsui 	volatile uint16_t *kf;
    510  1.18   tsutsui 	uint8_t *f;
    511   1.1       oki 
    512   1.1       oki 	hi = ip->save_char & 0x7f;
    513   1.1       oki 
    514  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    515  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    516   1.1       oki 		/* multibyte character */
    517  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    518  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    519   1.1       oki 		/* draw plane */
    520   1.1       oki 		for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES) {
    521  1.18   tsutsui 			data = *kf++;
    522  1.18   tsutsui 			*(uint16_t *)p = data | (data >> 1);
    523   1.1       oki 		}
    524  1.18   tsutsui 		data = *kf++;
    525  1.18   tsutsui 		*(uint16_t *)p = expbits(data | (data >> 1));
    526   1.1       oki 		p += ROWBYTES;
    527   1.1       oki 		for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    528  1.18   tsutsui 			data = *kf++;
    529  1.18   tsutsui 			*(uint16_t *)p = data | (data >> 1);
    530   1.1       oki 		}
    531   1.1       oki 		return;
    532   1.1       oki 	}
    533   1.1       oki 
    534   1.1       oki 	/* singlebyte character */
    535  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    536   1.1       oki 
    537   1.1       oki 	/* draw plane */
    538   1.1       oki 	for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES) {
    539  1.18   tsutsui 		data = *f++;
    540  1.18   tsutsui 		*p = data | (data >> 1);
    541   1.1       oki 	}
    542  1.18   tsutsui 	data = *f++;
    543  1.18   tsutsui 	*p = expbits(data | (data >> 1));
    544   1.1       oki 	p += ROWBYTES;
    545   1.1       oki 	for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    546  1.18   tsutsui 		data = *f++;
    547  1.18   tsutsui 		*p = data | (data >> 1);
    548   1.1       oki 	}
    549   1.1       oki }
    550   1.1       oki 
    551  1.18   tsutsui static void
    552  1.11       chs tv_putc_bd_ul_in(struct ite_softc *ip, int ch, char *p)
    553   1.1       oki {
    554   1.1       oki 	short fh, hi;
    555  1.18   tsutsui 	u_int data;
    556  1.18   tsutsui 	volatile uint16_t *kf;
    557  1.18   tsutsui 	uint8_t *f;
    558   1.1       oki 
    559   1.1       oki 	hi = ip->save_char & 0x7f;
    560   1.1       oki 
    561  1.18   tsutsui 	if (hi >= 0x21 && hi <= 0x7e &&
    562  1.18   tsutsui 	    (ch & 0x7f) >= 0x21 && (ch & 0x7f) <= 0x7e) {
    563   1.1       oki 		/* multibyte character */
    564  1.18   tsutsui 		kf = (volatile uint16_t *)tv_kfont[hi];
    565  1.18   tsutsui 		kf += (ch & 0x7f) * FONTHEIGHT;
    566   1.1       oki 		/* draw plane */
    567   1.1       oki 		for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES) {
    568  1.18   tsutsui 			data = *kf++;
    569  1.18   tsutsui 			*(uint16_t *)p = ~(data | (data >> 1));
    570   1.1       oki 		}
    571  1.18   tsutsui 		data = *kf++;
    572  1.18   tsutsui 		*(uint16_t *)p = ~expbits(data | (data >> 1));
    573   1.1       oki 		p += ROWBYTES;
    574   1.1       oki 		for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    575  1.18   tsutsui 			data = *kf++;
    576  1.18   tsutsui 			*(uint16_t *)p = ~(data | (data >> 1));
    577   1.1       oki 		}
    578   1.1       oki 		return;
    579   1.1       oki 	}
    580   1.1       oki 
    581   1.1       oki 	/* singlebyte character */
    582  1.18   tsutsui 	f = tv_getfont(*ip->GL, ch);
    583   1.1       oki 
    584   1.1       oki 	/* draw plane */
    585   1.1       oki 	for (fh = 0; fh < UNDERLINE; fh++, p += ROWBYTES) {
    586  1.18   tsutsui 		data = *f++;
    587  1.18   tsutsui 		*p = ~(data | (data >> 1));
    588   1.1       oki 	}
    589  1.18   tsutsui 	data = *f++;
    590  1.18   tsutsui 	*p = ~expbits(data | (data >> 1));
    591   1.1       oki 	p += ROWBYTES;
    592   1.1       oki 	for (fh++; fh < FONTHEIGHT; fh++, p += ROWBYTES) {
    593  1.18   tsutsui 		data = *f++;
    594  1.18   tsutsui 		data |= data >> 1;
    595  1.18   tsutsui 		*p = ~(data | (data >> 1));
    596   1.1       oki 	}
    597   1.1       oki }
    598   1.1       oki 
    599   1.1       oki /*
    600   1.1       oki  * draw/erase/move cursor
    601   1.1       oki  */
    602  1.18   tsutsui static void
    603  1.11       chs tv_cursor(struct ite_softc *ip, int flag)
    604   1.1       oki {
    605  1.18   tsutsui 	uint8_t *p;
    606   1.1       oki 	short fh;
    607   1.1       oki 
    608   1.1       oki 	/* erase */
    609   1.1       oki 	switch (flag) {
    610   1.1       oki 	/*case DRAW_CURSOR:*/
    611   1.1       oki 	/*case ERASE_CURSOR:*/
    612   1.1       oki 	/*case MOVE_CURSOR:*/
    613   1.1       oki 	case START_CURSOROPT:
    614   1.1       oki 		/*
    615   1.1       oki 		 * old: ip->cursorx, ip->cursory
    616   1.1       oki 		 * new: ip->curx, ip->cury
    617   1.1       oki 		 */
    618   1.1       oki 		p = CHADDR(ip->cursory, ip->cursorx);
    619   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    620   1.1       oki 			*p = ~*p;
    621   1.1       oki 		break;
    622   1.1       oki 	}
    623   1.1       oki 
    624   1.1       oki 	/* draw */
    625   1.1       oki 	switch (flag) {
    626   1.1       oki 	/*case MOVE_CURSOR:*/
    627   1.1       oki 	case END_CURSOROPT:
    628   1.1       oki 		/*
    629   1.1       oki 		 * Use exclusive-or.
    630   1.1       oki 		 */
    631   1.1       oki 		p = CHADDR(ip->cury, ip->curx);
    632   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    633   1.1       oki 			*p = ~*p;
    634   1.1       oki 
    635   1.1       oki 		ip->cursorx = ip->curx;
    636   1.1       oki 		ip->cursory = ip->cury;
    637   1.1       oki 		break;
    638   1.1       oki 	}
    639   1.1       oki }
    640   1.1       oki 
    641   1.1       oki /*
    642   1.1       oki  * clear rectangle
    643   1.1       oki  */
    644  1.18   tsutsui static void
    645  1.11       chs tv_clear(struct ite_softc *ip, int y, int x, int height, int width)
    646   1.1       oki {
    647  1.18   tsutsui 	uint8_t *p;
    648   1.1       oki 	short fh;
    649   1.7   minoura 
    650   1.7   minoura 	/* XXX: reset scroll register on clearing whole screen */
    651   1.7   minoura 	if (y == 0 && x == 0 && height == ip->rows && width == ip->cols) {
    652   1.7   minoura 		CRTC.r10 = 0;
    653   1.7   minoura 		CRTC.r11 = tv_top * FONTHEIGHT;
    654   1.7   minoura 	}
    655   1.1       oki 
    656   1.1       oki 	CRTC.r21 = 0x01f0;
    657   1.1       oki 	while (height--) {
    658   1.1       oki 		p = CHADDR(y++, x);
    659   1.1       oki 		for (fh = 0; fh < FONTHEIGHT; fh++, p += ROWBYTES)
    660   1.9       wiz 			memset(p, 0, width);
    661   1.1       oki 	}
    662   1.1       oki 	/* crtc mode reset */
    663   1.1       oki 	CRTC.r21 = 0;
    664   1.1       oki }
    665   1.1       oki 
    666   1.1       oki /*
    667   1.1       oki  * scroll lines/columns
    668   1.1       oki  */
    669  1.18   tsutsui static void
    670  1.11       chs tv_scroll(struct ite_softc *ip, int srcy, int srcx, int count, int dir)
    671   1.1       oki {
    672   1.1       oki 	int dst, siz, pl;
    673   1.1       oki 
    674   1.1       oki 	switch (dir) {
    675   1.1       oki 	case SCROLL_UP:
    676   1.1       oki 		/*
    677   1.1       oki 		 * src: srcy
    678   1.1       oki 		 * dst: (srcy - count)
    679   1.1       oki 		 * siz: (ip->bottom_margin - sy + 1)
    680   1.1       oki 		 */
    681   1.1       oki 		dst = srcy - count;
    682   1.1       oki 		siz = ip->bottom_margin - srcy + 1;
    683   1.1       oki 		if (dst == 0 && ip->bottom_margin == ip->rows - 1) {
    684   1.1       oki 			/* special case, hardware scroll */
    685   1.1       oki 			tv_top = (tv_top + count) % PLANELINES;
    686   1.1       oki 			CRTC.r11 = tv_top * FONTHEIGHT;
    687   1.1       oki 		} else {
    688   1.1       oki 			srcy = PHYSLINE(srcy);
    689   1.1       oki 			dst = PHYSLINE(dst);
    690   1.1       oki 			txrascpy(srcy, dst, siz, 0x0f);
    691   1.1       oki 		}
    692   1.1       oki 		break;
    693   1.1       oki 
    694   1.1       oki 	case SCROLL_DOWN:
    695   1.1       oki 		/*
    696   1.1       oki 		 * src: srcy
    697   1.1       oki 		 * dst: (srcy + count)
    698   1.1       oki 		 * siz: (ip->bottom_margin - dy + 1)
    699   1.1       oki 		 */
    700   1.1       oki 		dst = srcy + count;
    701   1.1       oki 		siz = ip->bottom_margin - dst + 1;
    702   1.1       oki 		if (srcy == 0 && ip->bottom_margin == ip->rows - 1) {
    703   1.1       oki 			/* special case, hardware scroll */
    704   1.1       oki 			tv_top = (tv_top + PLANELINES - count) % PLANELINES;
    705   1.1       oki 			CRTC.r11 = tv_top * FONTHEIGHT;
    706   1.1       oki 		} else {
    707   1.1       oki 			srcy = PHYSLINE(srcy) + siz - 1;
    708   1.1       oki 			dst = PHYSLINE(dst) + siz - 1;
    709   1.1       oki 			txrascpy(srcy, dst, siz, 0x0f | 0x8000);
    710   1.1       oki 		}
    711   1.1       oki 		break;
    712   1.1       oki 
    713   1.1       oki 	case SCROLL_LEFT:
    714   1.1       oki 		for (pl = 0; pl < PLANESIZE * 4; pl += PLANESIZE) {
    715   1.1       oki 			short fh;
    716  1.18   tsutsui 			uint8_t *src = CHADDR(srcy, srcx) + pl;
    717  1.18   tsutsui 			uint8_t *dest = CHADDR(srcy, srcx - count) + pl;
    718   1.1       oki 
    719   1.1       oki 			siz = ip->cols - srcx;
    720   1.1       oki 			for (fh = 0; fh < FONTHEIGHT; fh++) {
    721  1.12        he 				memcpy(dest, src, siz);
    722   1.1       oki 				src += ROWBYTES;
    723  1.12        he 				dest += ROWBYTES;
    724   1.1       oki 			}
    725   1.1       oki 		}
    726   1.1       oki 		break;
    727   1.1       oki 
    728   1.1       oki 	case SCROLL_RIGHT:
    729   1.1       oki 		for (pl = 0; pl < PLANESIZE * 4; pl += PLANESIZE) {
    730   1.1       oki 			short fh;
    731  1.18   tsutsui 			uint8_t *src = CHADDR(srcy, srcx) + pl;
    732  1.18   tsutsui 			uint8_t *dest = CHADDR(srcy, srcx + count) + pl;
    733   1.1       oki 
    734   1.1       oki 			siz = ip->cols - (srcx + count);
    735   1.1       oki 			for (fh = 0; fh < FONTHEIGHT; fh++) {
    736  1.12        he 				memcpy(dest, src, siz);
    737   1.1       oki 				src += ROWBYTES;
    738  1.12        he 				dest += ROWBYTES;
    739   1.1       oki 			}
    740   1.1       oki 		}
    741   1.1       oki 		break;
    742   1.1       oki 	}
    743   1.1       oki }
    744