Home | History | Annotate | Line # | Download | only in tc
sfb.c revision 1.18
      1  1.18  nisimura /* $NetBSD: sfb.c,v 1.18 1999/06/25 03:33:20 nisimura Exp $ */
      2   1.2  nisimura 
      3   1.2  nisimura /*
      4  1.16  nisimura  * Copyright (c) 1998, 1999 Tohru Nishimura.  All rights reserved.
      5   1.2  nisimura  *
      6   1.2  nisimura  * Redistribution and use in source and binary forms, with or without
      7   1.2  nisimura  * modification, are permitted provided that the following conditions
      8   1.2  nisimura  * are met:
      9   1.2  nisimura  * 1. Redistributions of source code must retain the above copyright
     10   1.2  nisimura  *    notice, this list of conditions and the following disclaimer.
     11   1.2  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.2  nisimura  *    notice, this list of conditions and the following disclaimer in the
     13   1.2  nisimura  *    documentation and/or other materials provided with the distribution.
     14   1.2  nisimura  * 3. All advertising materials mentioning features or use of this software
     15   1.2  nisimura  *    must display the following acknowledgement:
     16   1.2  nisimura  *      This product includes software developed by Tohru Nishimura
     17   1.2  nisimura  *	for the NetBSD Project.
     18   1.2  nisimura  * 4. The name of the author may not be used to endorse or promote products
     19   1.2  nisimura  *    derived from this software without specific prior written permission
     20   1.2  nisimura  *
     21   1.2  nisimura  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22   1.2  nisimura  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23   1.2  nisimura  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24   1.2  nisimura  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25   1.2  nisimura  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26   1.2  nisimura  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27   1.2  nisimura  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28   1.2  nisimura  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29   1.2  nisimura  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30   1.2  nisimura  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31   1.2  nisimura  */
     32   1.1  nisimura 
     33   1.1  nisimura #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
     34   1.1  nisimura 
     35  1.18  nisimura __KERNEL_RCSID(0, "$NetBSD: sfb.c,v 1.18 1999/06/25 03:33:20 nisimura Exp $");
     36   1.1  nisimura 
     37   1.1  nisimura #include <sys/param.h>
     38   1.1  nisimura #include <sys/systm.h>
     39   1.1  nisimura #include <sys/kernel.h>
     40   1.1  nisimura #include <sys/device.h>
     41   1.1  nisimura #include <sys/malloc.h>
     42   1.1  nisimura #include <sys/buf.h>
     43   1.1  nisimura #include <sys/ioctl.h>
     44   1.1  nisimura #include <vm/vm.h>
     45   1.1  nisimura 
     46   1.1  nisimura #include <machine/bus.h>
     47   1.1  nisimura #include <machine/intr.h>
     48   1.1  nisimura 
     49   1.1  nisimura #include <dev/rcons/raster.h>
     50   1.1  nisimura #include <dev/wscons/wsconsio.h>
     51   1.1  nisimura #include <dev/wscons/wscons_raster.h>
     52   1.1  nisimura #include <dev/wscons/wsdisplayvar.h>
     53   1.1  nisimura 
     54   1.1  nisimura #include <dev/tc/tcvar.h>
     55   1.1  nisimura #include <dev/ic/bt459reg.h>
     56   1.4  drochner #include <dev/tc/sfbreg.h>
     57   1.1  nisimura 
     58   1.1  nisimura #include <uvm/uvm_extern.h>
     59   1.1  nisimura 
     60   1.8   thorpej #if defined(pmax)
     61   1.1  nisimura #define	machine_btop(x) mips_btop(x)
     62   1.1  nisimura #define	MACHINE_KSEG0_TO_PHYS(x) MIPS_KSEG1_TO_PHYS(x)
     63   1.1  nisimura #endif
     64   1.1  nisimura 
     65   1.1  nisimura #if defined(__alpha__) || defined(alpha)
     66   1.1  nisimura #define machine_btop(x) alpha_btop(x)
     67   1.1  nisimura #define MACHINE_KSEG0_TO_PHYS(x) ALPHA_K0SEG_TO_PHYS(x)
     68   1.1  nisimura #endif
     69   1.1  nisimura 
     70   1.1  nisimura /*
     71   1.1  nisimura  * N.B., Bt459 registers are 8bit width.  Some of TC framebuffers have
     72   1.3  nisimura  * obscure register layout such as 2nd and 3rd Bt459 registers are
     73   1.3  nisimura  * adjacent each other in a word, i.e.,
     74   1.1  nisimura  *	struct bt459triplet {
     75   1.1  nisimura  * 		struct {
     76   1.1  nisimura  *			u_int8_t u0;
     77   1.1  nisimura  *			u_int8_t u1;
     78   1.1  nisimura  *			u_int8_t u2;
     79   1.1  nisimura  *			unsigned :8;
     80   1.1  nisimura  *		} bt_lo;
     81  1.17  nisimura  *		struct {
     82  1.17  nisimura  *
     83   1.1  nisimura  * Although HX has single Bt459, 32bit R/W can be done w/o any trouble.
     84  1.16  nisimura  *	struct bt459reg {
     85  1.16  nisimura  *		   u_int32_t	   bt_lo;
     86  1.16  nisimura  *		   u_int32_t	   bt_hi;
     87  1.16  nisimura  *		   u_int32_t	   bt_reg;
     88  1.16  nisimura  *		   u_int32_t	   bt_cmap;
     89  1.16  nisimura  *	};
     90  1.16  nisimura  *
     91   1.1  nisimura  */
     92   1.2  nisimura 
     93  1.18  nisimura /* Bt459 hardware registers */
     94  1.16  nisimura #define bt_lo	0
     95  1.16  nisimura #define bt_hi	1
     96  1.16  nisimura #define bt_reg	2
     97  1.16  nisimura #define bt_cmap 3
     98  1.16  nisimura 
     99  1.16  nisimura #define REG(base, index)	*((u_int32_t *)(base) + (index))
    100  1.16  nisimura #define SELECT(vdac, regno) do {			\
    101  1.16  nisimura 	REG(vdac, bt_lo) = ((regno) & 0x00ff);		\
    102  1.16  nisimura 	REG(vdac, bt_hi) = ((regno) & 0x0f00) >> 8;	\
    103  1.16  nisimura 	tc_wmb();					\
    104  1.16  nisimura    } while (0)
    105   1.1  nisimura 
    106   1.1  nisimura struct fb_devconfig {
    107   1.1  nisimura 	vaddr_t dc_vaddr;		/* memory space virtual base address */
    108   1.1  nisimura 	paddr_t dc_paddr;		/* memory space physical base address */
    109   1.1  nisimura 	vsize_t dc_size;		/* size of slot memory */
    110   1.1  nisimura 	int	dc_wid;			/* width of frame buffer */
    111   1.1  nisimura 	int	dc_ht;			/* height of frame buffer */
    112   1.1  nisimura 	int	dc_depth;		/* depth, bits per pixel */
    113   1.1  nisimura 	int	dc_rowbytes;		/* bytes in a FB scan line */
    114   1.1  nisimura 	vaddr_t	dc_videobase;		/* base of flat frame buffer */
    115   1.1  nisimura 	struct raster	dc_raster;	/* raster description */
    116   1.1  nisimura 	struct rcons	dc_rcons;	/* raster blitter control info */
    117   1.1  nisimura 	int	    dc_blanked;		/* currently has video disabled */
    118   1.1  nisimura };
    119   1.1  nisimura 
    120  1.15  nisimura struct hwcmap256 {
    121   1.1  nisimura #define	CMAP_SIZE	256	/* 256 R/G/B entries */
    122   1.1  nisimura 	u_int8_t r[CMAP_SIZE];
    123   1.1  nisimura 	u_int8_t g[CMAP_SIZE];
    124   1.1  nisimura 	u_int8_t b[CMAP_SIZE];
    125   1.1  nisimura };
    126   1.1  nisimura 
    127  1.15  nisimura struct hwcursor64 {
    128   1.1  nisimura 	struct wsdisplay_curpos cc_pos;
    129   1.1  nisimura 	struct wsdisplay_curpos cc_hot;
    130   1.1  nisimura 	struct wsdisplay_curpos cc_size;
    131  1.15  nisimura 	struct wsdisplay_curpos cc_magic;
    132   1.1  nisimura #define	CURSOR_MAX_SIZE	64
    133   1.1  nisimura 	u_int8_t cc_color[6];
    134   1.1  nisimura 	u_int64_t cc_image[64 + 64];
    135   1.1  nisimura };
    136   1.1  nisimura 
    137   1.1  nisimura struct sfb_softc {
    138   1.1  nisimura 	struct device sc_dev;
    139   1.1  nisimura 	struct fb_devconfig *sc_dc;	/* device configuration */
    140  1.15  nisimura 	struct hwcmap256 sc_cmap;	/* software copy of colormap */
    141  1.15  nisimura 	struct hwcursor64 sc_cursor;	/* software copy of cursor */
    142   1.1  nisimura 	int sc_curenb;			/* cursor sprite enabled */
    143   1.1  nisimura 	int sc_changed;			/* need update of colormap */
    144   1.1  nisimura #define	DATA_ENB_CHANGED	0x01	/* cursor enable changed */
    145   1.1  nisimura #define	DATA_CURCMAP_CHANGED	0x02	/* cursor colormap changed */
    146   1.1  nisimura #define	DATA_CURSHAPE_CHANGED	0x04	/* cursor size, image, mask changed */
    147   1.1  nisimura #define	DATA_CMAP_CHANGED	0x08	/* colormap changed */
    148   1.1  nisimura #define	DATA_ALL_CHANGED	0x0f
    149   1.1  nisimura 	int nscreens;
    150  1.15  nisimura };
    151  1.15  nisimura 
    152   1.3  nisimura #define	HX_MAGIC_X 368
    153   1.3  nisimura #define	HX_MAGIC_Y 38
    154   1.1  nisimura 
    155   1.1  nisimura int  sfbmatch __P((struct device *, struct cfdata *, void *));
    156   1.1  nisimura void sfbattach __P((struct device *, struct device *, void *));
    157   1.1  nisimura 
    158   1.1  nisimura struct cfattach sfb_ca = {
    159   1.1  nisimura 	sizeof(struct sfb_softc), sfbmatch, sfbattach,
    160   1.1  nisimura };
    161   1.1  nisimura 
    162   1.1  nisimura void sfb_getdevconfig __P((tc_addr_t, struct fb_devconfig *));
    163   1.1  nisimura struct fb_devconfig sfb_console_dc;
    164   1.1  nisimura tc_addr_t sfb_consaddr;
    165   1.1  nisimura 
    166  1.10  nisimura void	sfb_cursor __P((void *, int, int, int));
    167  1.10  nisimura int	sfb_mapchar __P((void *, int, unsigned int *));
    168  1.10  nisimura void	sfb_putchar __P((void *, int, int, u_int, long));
    169  1.10  nisimura void	sfb_copycols __P((void *, int, int, int, int));
    170  1.10  nisimura void	sfb_erasecols __P((void *, int, int, int, long));
    171  1.10  nisimura void	sfb_copyrows __P((void *, int, int, int));
    172  1.10  nisimura void	sfb_eraserows __P((void *, int, int, long));
    173  1.10  nisimura int	sfb_alloc_attr __P((void *, int, int, int, long *));
    174  1.10  nisimura #define	rcons_alloc_attr sfb_alloc_attr
    175  1.10  nisimura 
    176  1.10  nisimura struct wsdisplay_emulops sfb_emulops = {
    177  1.10  nisimura 	sfb_cursor,			/* could use hardware cursor; punt */
    178  1.10  nisimura 	sfb_mapchar,
    179  1.10  nisimura 	sfb_putchar,
    180  1.10  nisimura 	sfb_copycols,
    181  1.10  nisimura 	sfb_erasecols,
    182  1.10  nisimura 	sfb_copyrows,
    183  1.10  nisimura 	sfb_eraserows,
    184  1.10  nisimura 	sfb_alloc_attr
    185  1.10  nisimura };
    186   1.1  nisimura 
    187   1.1  nisimura struct wsscreen_descr sfb_stdscreen = {
    188   1.1  nisimura 	"std", 0, 0,
    189   1.1  nisimura 	&sfb_emulops,
    190   1.1  nisimura 	0, 0,
    191   1.1  nisimura 	0
    192   1.1  nisimura };
    193   1.1  nisimura 
    194   1.1  nisimura const struct wsscreen_descr *_sfb_scrlist[] = {
    195   1.1  nisimura 	&sfb_stdscreen,
    196   1.1  nisimura };
    197   1.1  nisimura 
    198   1.1  nisimura struct wsscreen_list sfb_screenlist = {
    199   1.1  nisimura 	sizeof(_sfb_scrlist) / sizeof(struct wsscreen_descr *), _sfb_scrlist
    200   1.1  nisimura };
    201   1.1  nisimura 
    202   1.1  nisimura int	sfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
    203   1.1  nisimura int	sfbmmap __P((void *, off_t, int));
    204   1.1  nisimura 
    205   1.1  nisimura int	sfb_alloc_screen __P((void *, const struct wsscreen_descr *,
    206   1.1  nisimura 				      void **, int *, int *, long *));
    207   1.1  nisimura void	sfb_free_screen __P((void *, void *));
    208   1.1  nisimura void	sfb_show_screen __P((void *, void *));
    209   1.1  nisimura 
    210   1.1  nisimura struct wsdisplay_accessops sfb_accessops = {
    211   1.1  nisimura 	sfbioctl,
    212   1.1  nisimura 	sfbmmap,
    213   1.1  nisimura 	sfb_alloc_screen,
    214   1.1  nisimura 	sfb_free_screen,
    215   1.1  nisimura 	sfb_show_screen,
    216   1.7  drochner 	0 /* load_font */
    217   1.1  nisimura };
    218   1.1  nisimura 
    219   1.1  nisimura int  sfb_cnattach __P((tc_addr_t));
    220   1.1  nisimura int  sfbintr __P((void *));
    221   1.1  nisimura void sfbinit __P((struct fb_devconfig *));
    222   1.1  nisimura 
    223   1.1  nisimura static int  get_cmap __P((struct sfb_softc *, struct wsdisplay_cmap *));
    224   1.1  nisimura static int  set_cmap __P((struct sfb_softc *, struct wsdisplay_cmap *));
    225   1.1  nisimura static int  set_cursor __P((struct sfb_softc *, struct wsdisplay_cursor *));
    226   1.1  nisimura static int  get_cursor __P((struct sfb_softc *, struct wsdisplay_cursor *));
    227   1.1  nisimura static void set_curpos __P((struct sfb_softc *, struct wsdisplay_curpos *));
    228   1.1  nisimura static void bt459_set_curpos __P((struct sfb_softc *));
    229   1.1  nisimura 
    230   1.1  nisimura 
    231   1.3  nisimura /*
    232   1.3  nisimura  * Compose 2 bit/pixel cursor image.  Bit order will be reversed.
    233   1.3  nisimura  *   M M M M I I I I		M I M I M I M I
    234   1.3  nisimura  *	[ before ]		   [ after ]
    235   1.3  nisimura  *   3 2 1 0 3 2 1 0		0 0 1 1 2 2 3 3
    236   1.3  nisimura  *   7 6 5 4 7 6 5 4		4 4 5 5 6 6 7 7
    237   1.3  nisimura  */
    238   1.3  nisimura const static u_int8_t shuffle[256] = {
    239   1.3  nisimura 	0x00, 0x40, 0x10, 0x50, 0x04, 0x44, 0x14, 0x54,
    240   1.3  nisimura 	0x01, 0x41, 0x11, 0x51, 0x05, 0x45, 0x15, 0x55,
    241   1.3  nisimura 	0x80, 0xc0, 0x90, 0xd0, 0x84, 0xc4, 0x94, 0xd4,
    242   1.3  nisimura 	0x81, 0xc1, 0x91, 0xd1, 0x85, 0xc5, 0x95, 0xd5,
    243   1.3  nisimura 	0x20, 0x60, 0x30, 0x70, 0x24, 0x64, 0x34, 0x74,
    244   1.3  nisimura 	0x21, 0x61, 0x31, 0x71, 0x25, 0x65, 0x35, 0x75,
    245   1.3  nisimura 	0xa0, 0xe0, 0xb0, 0xf0, 0xa4, 0xe4, 0xb4, 0xf4,
    246   1.3  nisimura 	0xa1, 0xe1, 0xb1, 0xf1, 0xa5, 0xe5, 0xb5, 0xf5,
    247   1.3  nisimura 	0x08, 0x48, 0x18, 0x58, 0x0c, 0x4c, 0x1c, 0x5c,
    248   1.3  nisimura 	0x09, 0x49, 0x19, 0x59, 0x0d, 0x4d, 0x1d, 0x5d,
    249   1.3  nisimura 	0x88, 0xc8, 0x98, 0xd8, 0x8c, 0xcc, 0x9c, 0xdc,
    250   1.3  nisimura 	0x89, 0xc9, 0x99, 0xd9, 0x8d, 0xcd, 0x9d, 0xdd,
    251   1.3  nisimura 	0x28, 0x68, 0x38, 0x78, 0x2c, 0x6c, 0x3c, 0x7c,
    252   1.3  nisimura 	0x29, 0x69, 0x39, 0x79, 0x2d, 0x6d, 0x3d, 0x7d,
    253   1.3  nisimura 	0xa8, 0xe8, 0xb8, 0xf8, 0xac, 0xec, 0xbc, 0xfc,
    254   1.3  nisimura 	0xa9, 0xe9, 0xb9, 0xf9, 0xad, 0xed, 0xbd, 0xfd,
    255   1.3  nisimura 	0x02, 0x42, 0x12, 0x52, 0x06, 0x46, 0x16, 0x56,
    256   1.3  nisimura 	0x03, 0x43, 0x13, 0x53, 0x07, 0x47, 0x17, 0x57,
    257   1.3  nisimura 	0x82, 0xc2, 0x92, 0xd2, 0x86, 0xc6, 0x96, 0xd6,
    258   1.3  nisimura 	0x83, 0xc3, 0x93, 0xd3, 0x87, 0xc7, 0x97, 0xd7,
    259   1.3  nisimura 	0x22, 0x62, 0x32, 0x72, 0x26, 0x66, 0x36, 0x76,
    260   1.3  nisimura 	0x23, 0x63, 0x33, 0x73, 0x27, 0x67, 0x37, 0x77,
    261   1.3  nisimura 	0xa2, 0xe2, 0xb2, 0xf2, 0xa6, 0xe6, 0xb6, 0xf6,
    262   1.3  nisimura 	0xa3, 0xe3, 0xb3, 0xf3, 0xa7, 0xe7, 0xb7, 0xf7,
    263   1.3  nisimura 	0x0a, 0x4a, 0x1a, 0x5a, 0x0e, 0x4e, 0x1e, 0x5e,
    264   1.3  nisimura 	0x0b, 0x4b, 0x1b, 0x5b, 0x0f, 0x4f, 0x1f, 0x5f,
    265   1.3  nisimura 	0x8a, 0xca, 0x9a, 0xda, 0x8e, 0xce, 0x9e, 0xde,
    266   1.3  nisimura 	0x8b, 0xcb, 0x9b, 0xdb, 0x8f, 0xcf, 0x9f, 0xdf,
    267   1.3  nisimura 	0x2a, 0x6a, 0x3a, 0x7a, 0x2e, 0x6e, 0x3e, 0x7e,
    268   1.3  nisimura 	0x2b, 0x6b, 0x3b, 0x7b, 0x2f, 0x6f, 0x3f, 0x7f,
    269   1.3  nisimura 	0xaa, 0xea, 0xba, 0xfa, 0xae, 0xee, 0xbe, 0xfe,
    270   1.3  nisimura 	0xab, 0xeb, 0xbb, 0xfb, 0xaf, 0xef, 0xbf, 0xff,
    271   1.3  nisimura };
    272   1.3  nisimura 
    273   1.1  nisimura int
    274   1.1  nisimura sfbmatch(parent, match, aux)
    275   1.1  nisimura 	struct device *parent;
    276   1.1  nisimura 	struct cfdata *match;
    277   1.1  nisimura 	void *aux;
    278   1.1  nisimura {
    279   1.1  nisimura 	struct tc_attach_args *ta = aux;
    280   1.1  nisimura 
    281   1.1  nisimura 	if (strncmp("PMAGB-BA", ta->ta_modname, TC_ROM_LLEN) != 0)
    282   1.1  nisimura 		return (0);
    283   1.1  nisimura 
    284   1.1  nisimura 	return (1);
    285   1.1  nisimura }
    286   1.1  nisimura 
    287   1.1  nisimura void
    288   1.1  nisimura sfb_getdevconfig(dense_addr, dc)
    289   1.1  nisimura 	tc_addr_t dense_addr;
    290   1.1  nisimura 	struct fb_devconfig *dc;
    291   1.1  nisimura {
    292   1.1  nisimura 	struct raster *rap;
    293   1.1  nisimura 	struct rcons *rcp;
    294   1.1  nisimura 	caddr_t sfbasic;
    295   1.1  nisimura 	int i, hsetup, vsetup, vbase;
    296   1.1  nisimura 
    297   1.1  nisimura 	dc->dc_vaddr = dense_addr;
    298   1.1  nisimura 	dc->dc_paddr = MACHINE_KSEG0_TO_PHYS(dc->dc_vaddr);
    299   1.1  nisimura 
    300   1.1  nisimura 	sfbasic = (caddr_t)(dc->dc_vaddr + SFB_ASIC_OFFSET);
    301   1.1  nisimura 	hsetup = *(u_int32_t *)(sfbasic + SFB_ASIC_VIDEO_HSETUP);
    302   1.1  nisimura 	vsetup = *(u_int32_t *)(sfbasic + SFB_ASIC_VIDEO_VSETUP);
    303   1.1  nisimura 	vbase  = *(u_int32_t *)(sfbasic + SFB_ASIC_VIDEO_BASE) & 0x1ff;
    304   1.1  nisimura 
    305   1.1  nisimura 	dc->dc_wid = (hsetup & 0x1ff) << 2;
    306   1.1  nisimura 	dc->dc_ht = (vsetup & 0x7ff);
    307   1.1  nisimura 	dc->dc_depth = 8;
    308   1.1  nisimura 	dc->dc_rowbytes = dc->dc_wid * (dc->dc_depth / 8);
    309   1.1  nisimura 	dc->dc_videobase = dc->dc_vaddr + SFB_FB_OFFSET + vbase * 4096;
    310   1.1  nisimura 	dc->dc_blanked = 0;
    311   1.1  nisimura 
    312   1.1  nisimura 	/* initialize colormap and cursor resource */
    313   1.1  nisimura 	sfbinit(dc);
    314   1.1  nisimura 
    315   1.1  nisimura 	/* clear the screen */
    316   1.1  nisimura 	for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
    317   1.1  nisimura 		*(u_int32_t *)(dc->dc_videobase + i) = 0x0;
    318   1.1  nisimura 
    319   1.9  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_VIDEO_VALID) = 1;
    320   1.9  nisimura 
    321   1.1  nisimura 	/* initialize the raster */
    322   1.1  nisimura 	rap = &dc->dc_raster;
    323   1.1  nisimura 	rap->width = dc->dc_wid;
    324   1.1  nisimura 	rap->height = dc->dc_ht;
    325   1.1  nisimura 	rap->depth = dc->dc_depth;
    326   1.1  nisimura 	rap->linelongs = dc->dc_rowbytes / sizeof(u_int32_t);
    327   1.1  nisimura 	rap->pixels = (u_int32_t *)dc->dc_videobase;
    328  1.10  nisimura 	rap->data = sfbasic;
    329   1.1  nisimura 
    330   1.1  nisimura 	/* initialize the raster console blitter */
    331   1.1  nisimura 	rcp = &dc->dc_rcons;
    332   1.1  nisimura 	rcp->rc_sp = rap;
    333   1.1  nisimura 	rcp->rc_crow = rcp->rc_ccol = -1;
    334   1.1  nisimura 	rcp->rc_crowp = &rcp->rc_crow;
    335   1.1  nisimura 	rcp->rc_ccolp = &rcp->rc_ccol;
    336   1.1  nisimura 	rcons_init(rcp, 34, 80);
    337   1.1  nisimura 
    338   1.1  nisimura 	sfb_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
    339   1.1  nisimura 	sfb_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
    340   1.1  nisimura }
    341   1.1  nisimura 
    342   1.1  nisimura void
    343   1.1  nisimura sfbattach(parent, self, aux)
    344   1.1  nisimura 	struct device *parent, *self;
    345   1.1  nisimura 	void *aux;
    346   1.1  nisimura {
    347   1.1  nisimura 	struct sfb_softc *sc = (struct sfb_softc *)self;
    348   1.1  nisimura 	struct tc_attach_args *ta = aux;
    349   1.1  nisimura 	struct wsemuldisplaydev_attach_args waa;
    350  1.15  nisimura 	struct hwcmap256 *cm;
    351   1.1  nisimura 	caddr_t sfbasic;
    352  1.15  nisimura 	int console;
    353   1.1  nisimura 
    354   1.1  nisimura 	console = (ta->ta_addr == sfb_consaddr);
    355   1.1  nisimura 	if (console) {
    356   1.1  nisimura 		sc->sc_dc = &sfb_console_dc;
    357   1.1  nisimura 		sc->nscreens = 1;
    358   1.1  nisimura 	}
    359   1.1  nisimura 	else {
    360   1.1  nisimura 		sc->sc_dc = (struct fb_devconfig *)
    361   1.1  nisimura 		    malloc(sizeof(struct fb_devconfig), M_DEVBUF, M_WAITOK);
    362   1.1  nisimura 		sfb_getdevconfig(ta->ta_addr, sc->sc_dc);
    363   1.1  nisimura 	}
    364   1.1  nisimura 	printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
    365   1.1  nisimura 	    sc->sc_dc->dc_depth);
    366   1.1  nisimura 
    367   1.1  nisimura 	cm = &sc->sc_cmap;
    368  1.15  nisimura 	memset(cm, 255, sizeof(struct hwcmap256));	/* XXX */
    369  1.15  nisimura 	cm->r[0] = cm->g[0] = cm->b[0] = 0;		/* XXX */
    370  1.15  nisimura 
    371  1.15  nisimura 	sc->sc_cursor.cc_magic.x = HX_MAGIC_X;
    372  1.15  nisimura 	sc->sc_cursor.cc_magic.y = HX_MAGIC_Y;
    373   1.1  nisimura 
    374   1.1  nisimura         tc_intr_establish(parent, ta->ta_cookie, TC_IPL_TTY, sfbintr, sc);
    375   1.1  nisimura 
    376   1.1  nisimura 	sfbasic = (caddr_t)(sc->sc_dc->dc_vaddr + SFB_ASIC_OFFSET);
    377   1.1  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_CLEAR_INTR) = 0;
    378   1.1  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_ENABLE_INTR) = 1;
    379   1.1  nisimura 
    380   1.1  nisimura 	waa.console = console;
    381   1.1  nisimura 	waa.scrdata = &sfb_screenlist;
    382   1.1  nisimura 	waa.accessops = &sfb_accessops;
    383   1.1  nisimura 	waa.accesscookie = sc;
    384   1.1  nisimura 
    385   1.1  nisimura 	config_found(self, &waa, wsemuldisplaydevprint);
    386   1.1  nisimura }
    387   1.1  nisimura 
    388   1.1  nisimura int
    389   1.1  nisimura sfbioctl(v, cmd, data, flag, p)
    390   1.1  nisimura 	void *v;
    391   1.1  nisimura 	u_long cmd;
    392   1.1  nisimura 	caddr_t data;
    393   1.1  nisimura 	int flag;
    394   1.1  nisimura 	struct proc *p;
    395   1.1  nisimura {
    396   1.1  nisimura 	struct sfb_softc *sc = v;
    397   1.1  nisimura 	struct fb_devconfig *dc = sc->sc_dc;
    398   1.1  nisimura 	int turnoff;
    399   1.1  nisimura 
    400   1.1  nisimura 	switch (cmd) {
    401   1.1  nisimura 	case WSDISPLAYIO_GTYPE:
    402   1.1  nisimura 		*(u_int *)data = WSDISPLAY_TYPE_SFB;
    403   1.1  nisimura 		return (0);
    404   1.1  nisimura 
    405   1.1  nisimura 	case WSDISPLAYIO_GINFO:
    406   1.1  nisimura #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    407   1.1  nisimura 		wsd_fbip->height = sc->sc_dc->dc_ht;
    408   1.1  nisimura 		wsd_fbip->width = sc->sc_dc->dc_wid;
    409   1.1  nisimura 		wsd_fbip->depth = sc->sc_dc->dc_depth;
    410   1.1  nisimura 		wsd_fbip->cmsize = CMAP_SIZE;
    411   1.1  nisimura #undef fbt
    412   1.1  nisimura 		return (0);
    413   1.1  nisimura 
    414   1.1  nisimura 	case WSDISPLAYIO_GETCMAP:
    415   1.1  nisimura 		return get_cmap(sc, (struct wsdisplay_cmap *)data);
    416   1.1  nisimura 
    417   1.1  nisimura 	case WSDISPLAYIO_PUTCMAP:
    418   1.1  nisimura 		return set_cmap(sc, (struct wsdisplay_cmap *)data);
    419   1.1  nisimura 
    420   1.1  nisimura 	case WSDISPLAYIO_SVIDEO:
    421   1.1  nisimura 		turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
    422   1.1  nisimura 		if ((dc->dc_blanked == 0) ^ turnoff) {
    423   1.1  nisimura 			dc->dc_blanked = turnoff;
    424  1.18  nisimura #if 0 /* XXX later XXX */
    425  1.18  nisimura 		To turn off, assign value 0 in ASIC_VIDEO_VALID register.
    426  1.18  nisimura #endif	/* XXX XXX XXX */
    427   1.1  nisimura 		}
    428   1.1  nisimura 		return (0);
    429   1.1  nisimura 
    430   1.1  nisimura 	case WSDISPLAYIO_GVIDEO:
    431   1.1  nisimura 		*(u_int *)data = dc->dc_blanked ?
    432   1.1  nisimura 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
    433   1.1  nisimura 		return (0);
    434   1.1  nisimura 
    435   1.1  nisimura 	case WSDISPLAYIO_GCURPOS:
    436   1.1  nisimura 		*(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
    437   1.1  nisimura 		return (0);
    438   1.1  nisimura 
    439   1.1  nisimura 	case WSDISPLAYIO_SCURPOS:
    440   1.1  nisimura 		set_curpos(sc, (struct wsdisplay_curpos *)data);
    441   1.1  nisimura 		bt459_set_curpos(sc);
    442   1.1  nisimura 		return (0);
    443   1.1  nisimura 
    444   1.1  nisimura 	case WSDISPLAYIO_GCURMAX:
    445   1.1  nisimura 		((struct wsdisplay_curpos *)data)->x =
    446   1.1  nisimura 		((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
    447   1.1  nisimura 		return (0);
    448   1.1  nisimura 
    449   1.1  nisimura 	case WSDISPLAYIO_GCURSOR:
    450   1.1  nisimura 		return get_cursor(sc, (struct wsdisplay_cursor *)data);
    451   1.1  nisimura 
    452   1.1  nisimura 	case WSDISPLAYIO_SCURSOR:
    453   1.1  nisimura 		return set_cursor(sc, (struct wsdisplay_cursor *)data);
    454   1.1  nisimura 	}
    455   1.1  nisimura 	return ENOTTY;
    456   1.1  nisimura }
    457   1.1  nisimura 
    458   1.1  nisimura int
    459   1.1  nisimura sfbmmap(v, offset, prot)
    460   1.1  nisimura 	void *v;
    461   1.1  nisimura 	off_t offset;
    462   1.1  nisimura 	int prot;
    463   1.1  nisimura {
    464   1.1  nisimura 	struct sfb_softc *sc = v;
    465   1.1  nisimura 
    466  1.10  nisimura 	if (offset >= SFB_SIZE || offset < 0)
    467   1.1  nisimura 		return (-1);
    468   1.1  nisimura 	return machine_btop(sc->sc_dc->dc_paddr + offset);
    469   1.1  nisimura }
    470   1.1  nisimura 
    471   1.1  nisimura int
    472   1.1  nisimura sfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
    473   1.1  nisimura 	void *v;
    474   1.1  nisimura 	const struct wsscreen_descr *type;
    475   1.1  nisimura 	void **cookiep;
    476   1.1  nisimura 	int *curxp, *curyp;
    477   1.1  nisimura 	long *attrp;
    478   1.1  nisimura {
    479   1.1  nisimura 	struct sfb_softc *sc = v;
    480   1.1  nisimura 	long defattr;
    481   1.1  nisimura 
    482   1.1  nisimura 	if (sc->nscreens > 0)
    483   1.1  nisimura 		return (ENOMEM);
    484   1.1  nisimura 
    485   1.1  nisimura 	*cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
    486   1.1  nisimura 	*curxp = 0;
    487   1.1  nisimura 	*curyp = 0;
    488   1.1  nisimura 	rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
    489   1.1  nisimura 	*attrp = defattr;
    490   1.1  nisimura 	sc->nscreens++;
    491   1.1  nisimura 	return (0);
    492   1.1  nisimura }
    493   1.1  nisimura 
    494   1.1  nisimura void
    495   1.1  nisimura sfb_free_screen(v, cookie)
    496   1.1  nisimura 	void *v;
    497   1.1  nisimura 	void *cookie;
    498   1.1  nisimura {
    499   1.1  nisimura 	struct sfb_softc *sc = v;
    500   1.1  nisimura 
    501   1.1  nisimura 	if (sc->sc_dc == &sfb_console_dc)
    502   1.1  nisimura 		panic("sfb_free_screen: console");
    503   1.1  nisimura 
    504   1.1  nisimura 	sc->nscreens--;
    505   1.1  nisimura }
    506   1.1  nisimura 
    507   1.1  nisimura void
    508   1.1  nisimura sfb_show_screen(v, cookie)
    509   1.1  nisimura 	void *v;
    510   1.1  nisimura 	void *cookie;
    511   1.1  nisimura {
    512   1.1  nisimura }
    513   1.1  nisimura 
    514   1.1  nisimura int
    515   1.1  nisimura sfb_cnattach(addr)
    516   1.1  nisimura         tc_addr_t addr;
    517   1.1  nisimura {
    518   1.1  nisimura         struct fb_devconfig *dcp = &sfb_console_dc;
    519   1.1  nisimura         long defattr;
    520   1.1  nisimura 
    521   1.1  nisimura         sfb_getdevconfig(addr, dcp);
    522   1.1  nisimura 
    523   1.1  nisimura         rcons_alloc_attr(&dcp->dc_rcons, 0, 0, 0, &defattr);
    524   1.1  nisimura 
    525   1.1  nisimura         wsdisplay_cnattach(&sfb_stdscreen, &dcp->dc_rcons,
    526   1.1  nisimura                            0, 0, defattr);
    527   1.1  nisimura         sfb_consaddr = addr;
    528   1.1  nisimura         return(0);
    529   1.1  nisimura }
    530   1.1  nisimura 
    531   1.1  nisimura int
    532   1.1  nisimura sfbintr(arg)
    533   1.1  nisimura 	void *arg;
    534   1.1  nisimura {
    535   1.1  nisimura 	struct sfb_softc *sc = arg;
    536   1.1  nisimura 	caddr_t sfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
    537   1.1  nisimura 	caddr_t sfbasic = sfbbase + SFB_ASIC_OFFSET;
    538  1.16  nisimura 	caddr_t vdac;
    539   1.1  nisimura 	int v;
    540   1.1  nisimura 
    541   1.1  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_CLEAR_INTR) = 0;
    542   1.1  nisimura 	/* *(u_int32_t *)(sfbasic + SFB_ASIC_ENABLE_INTR) = 1; */
    543   1.1  nisimura 
    544   1.1  nisimura 	if (sc->sc_changed == 0)
    545   1.1  nisimura 		return (1);
    546   1.1  nisimura 
    547   1.1  nisimura 	vdac = (void *)(sfbbase + SFB_RAMDAC_OFFSET);
    548   1.1  nisimura 	v = sc->sc_changed;
    549   1.1  nisimura 	sc->sc_changed = 0;
    550   1.1  nisimura 
    551   1.1  nisimura 	if (v & DATA_ENB_CHANGED) {
    552  1.16  nisimura 		SELECT(vdac, BT459_REG_CCR);
    553  1.16  nisimura 		REG(vdac, bt_reg) = (sc->sc_curenb) ? 0xc0 : 0x00;
    554   1.1  nisimura 	}
    555   1.1  nisimura 	if (v & DATA_CURCMAP_CHANGED) {
    556   1.1  nisimura 		u_int8_t *cp = sc->sc_cursor.cc_color;
    557   1.1  nisimura 
    558  1.16  nisimura 		SELECT(vdac, BT459_REG_CCOLOR_2);
    559  1.16  nisimura 		REG(vdac, bt_reg) = cp[1];	tc_wmb();
    560  1.16  nisimura 		REG(vdac, bt_reg) = cp[3];	tc_wmb();
    561  1.16  nisimura 		REG(vdac, bt_reg) = cp[5];	tc_wmb();
    562  1.16  nisimura 
    563  1.16  nisimura 		REG(vdac, bt_reg) = cp[0];	tc_wmb();
    564  1.16  nisimura 		REG(vdac, bt_reg) = cp[2];	tc_wmb();
    565  1.16  nisimura 		REG(vdac, bt_reg) = cp[4];	tc_wmb();
    566   1.1  nisimura 	}
    567   1.1  nisimura 	if (v & DATA_CURSHAPE_CHANGED) {
    568   1.3  nisimura 		u_int8_t *ip, *mp, img, msk;
    569   1.3  nisimura 		u_int8_t u;
    570   1.3  nisimura 		int bcnt;
    571   1.3  nisimura 
    572   1.3  nisimura 		ip = (u_int8_t *)sc->sc_cursor.cc_image;
    573   1.3  nisimura 		mp = (u_int8_t *)(sc->sc_cursor.cc_image + CURSOR_MAX_SIZE);
    574   1.3  nisimura 
    575   1.3  nisimura 		bcnt = 0;
    576  1.16  nisimura 		SELECT(vdac, BT459_REG_CRAM_BASE+0);
    577   1.3  nisimura 		/* 64 pixel scan line is consisted with 16 byte cursor ram */
    578   1.3  nisimura 		while (bcnt < sc->sc_cursor.cc_size.y * 16) {
    579   1.3  nisimura 			/* pad right half 32 pixel when smaller than 33 */
    580   1.3  nisimura 			if ((bcnt & 0x8) && sc->sc_cursor.cc_size.x < 33) {
    581  1.16  nisimura 				REG(vdac, bt_reg) = 0; tc_wmb();
    582  1.16  nisimura 				REG(vdac, bt_reg) = 0; tc_wmb();
    583   1.3  nisimura 			}
    584   1.3  nisimura 			else {
    585   1.3  nisimura 				img = *ip++;
    586   1.3  nisimura 				msk = *mp++;
    587   1.3  nisimura 				img &= msk;	/* cookie off image */
    588   1.3  nisimura 				u = (msk & 0x0f) << 4 | (img & 0x0f);
    589  1.16  nisimura 				REG(vdac, bt_reg) = shuffle[u];	tc_wmb();
    590   1.3  nisimura 				u = (msk & 0xf0) | (img & 0xf0) >> 4;
    591  1.16  nisimura 				REG(vdac, bt_reg) = shuffle[u];	tc_wmb();
    592   1.3  nisimura 			}
    593   1.3  nisimura 			bcnt += 2;
    594   1.3  nisimura 		}
    595   1.3  nisimura 		/* pad unoccupied scan lines */
    596   1.3  nisimura 		while (bcnt < CURSOR_MAX_SIZE * 16) {
    597  1.16  nisimura 			REG(vdac, bt_reg) = 0; tc_wmb();
    598  1.16  nisimura 			REG(vdac, bt_reg) = 0; tc_wmb();
    599   1.3  nisimura 			bcnt += 2;
    600   1.1  nisimura 		}
    601   1.1  nisimura 	}
    602   1.1  nisimura 	if (v & DATA_CMAP_CHANGED) {
    603  1.15  nisimura 		struct hwcmap256 *cm = &sc->sc_cmap;
    604   1.1  nisimura 		int index;
    605   1.1  nisimura 
    606  1.16  nisimura 		SELECT(vdac, 0);
    607   1.1  nisimura 		for (index = 0; index < CMAP_SIZE; index++) {
    608  1.16  nisimura 			REG(vdac, bt_cmap) = cm->r[index];	tc_wmb();
    609  1.16  nisimura 			REG(vdac, bt_cmap) = cm->g[index];	tc_wmb();
    610  1.16  nisimura 			REG(vdac, bt_cmap) = cm->b[index];	tc_wmb();
    611   1.1  nisimura 		}
    612   1.1  nisimura 	}
    613   1.1  nisimura 	return (1);
    614   1.1  nisimura }
    615   1.1  nisimura 
    616   1.1  nisimura void
    617   1.1  nisimura sfbinit(dc)
    618   1.1  nisimura 	struct fb_devconfig *dc;
    619   1.1  nisimura {
    620   1.1  nisimura 	caddr_t sfbasic = (caddr_t)(dc->dc_vaddr + SFB_ASIC_OFFSET);
    621  1.16  nisimura 	caddr_t vdac = (void *)(dc->dc_vaddr + SFB_RAMDAC_OFFSET);
    622   1.1  nisimura 	int i;
    623   1.1  nisimura 
    624   1.9  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_VIDEO_VALID) = 0;
    625   1.1  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_PLANEMASK) = ~0;
    626   1.1  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_PIXELMASK) = ~0;
    627   1.9  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_MODE) = 0;
    628  1.10  nisimura 	*(u_int32_t *)(sfbasic + SFB_ASIC_ROP) = 3;
    629   1.1  nisimura 
    630   1.1  nisimura 	*(u_int32_t *)(sfbasic + 0x180000) = 0; /* Bt459 reset */
    631   1.1  nisimura 
    632  1.16  nisimura 	SELECT(vdac, BT459_REG_COMMAND_0);
    633  1.16  nisimura 	REG(vdac, bt_reg) = 0x40; /* CMD0 */	tc_wmb();
    634  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;  /* CMD1 */	tc_wmb();
    635  1.16  nisimura 	REG(vdac, bt_reg) = 0xc0; /* CMD2 */	tc_wmb();
    636  1.16  nisimura 	REG(vdac, bt_reg) = 0xff; /* PRM */	tc_wmb();
    637  1.16  nisimura 	REG(vdac, bt_reg) = 0;    /* 205 */	tc_wmb();
    638  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;  /* PBM */	tc_wmb();
    639  1.16  nisimura 	REG(vdac, bt_reg) = 0;    /* 207 */	tc_wmb();
    640  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;  /* ORM */	tc_wmb();
    641  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;  /* OBM */	tc_wmb();
    642  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;  /* ILV */	tc_wmb();
    643  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;  /* TEST */	tc_wmb();
    644  1.16  nisimura 
    645  1.16  nisimura 	SELECT(vdac, BT459_REG_CCR);
    646  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    647  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    648  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    649  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    650  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    651  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    652  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    653  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    654  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    655  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    656  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    657  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    658  1.16  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    659   1.3  nisimura 
    660   1.3  nisimura 	/* build sane colormap */
    661  1.16  nisimura 	SELECT(vdac, 0);
    662  1.16  nisimura 	REG(vdac, bt_cmap) = 0;	tc_wmb();
    663  1.16  nisimura 	REG(vdac, bt_cmap) = 0;	tc_wmb();
    664  1.16  nisimura 	REG(vdac, bt_cmap) = 0;	tc_wmb();
    665   1.3  nisimura 	for (i = 1; i < CMAP_SIZE; i++) {
    666  1.16  nisimura 		REG(vdac, bt_cmap) = 0xff;	tc_wmb();
    667  1.16  nisimura 		REG(vdac, bt_cmap) = 0xff;	tc_wmb();
    668  1.16  nisimura 		REG(vdac, bt_cmap) = 0xff;	tc_wmb();
    669   1.3  nisimura 	}
    670   1.3  nisimura 
    671   1.3  nisimura 	/* clear out cursor image */
    672  1.16  nisimura 	SELECT(vdac, BT459_REG_CRAM_BASE);
    673   1.3  nisimura 	for (i = 0; i < 1024; i++)
    674  1.16  nisimura 		REG(vdac, bt_reg) = 0xff;	tc_wmb();
    675   1.3  nisimura 
    676   1.3  nisimura 	/*
    677   1.3  nisimura 	 * 2 bit/pixel cursor.  Assign MSB for cursor mask and LSB for
    678   1.3  nisimura 	 * cursor image.  CCOLOR_2 for mask color, while CCOLOR_3 for
    679   1.3  nisimura 	 * image color.  CCOLOR_1 will be never used.
    680   1.3  nisimura 	 */
    681  1.16  nisimura 	SELECT(vdac, BT459_REG_CCOLOR_1);
    682  1.16  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    683  1.16  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    684  1.16  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    685  1.16  nisimura 
    686  1.16  nisimura 	REG(vdac, bt_reg) = 0;	tc_wmb();
    687  1.16  nisimura 	REG(vdac, bt_reg) = 0;	tc_wmb();
    688  1.16  nisimura 	REG(vdac, bt_reg) = 0;	tc_wmb();
    689  1.16  nisimura 
    690  1.16  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    691  1.16  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    692  1.16  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    693   1.1  nisimura }
    694   1.1  nisimura 
    695   1.1  nisimura static int
    696   1.1  nisimura get_cmap(sc, p)
    697   1.1  nisimura 	struct sfb_softc *sc;
    698   1.1  nisimura 	struct wsdisplay_cmap *p;
    699   1.1  nisimura {
    700   1.1  nisimura 	u_int index = p->index, count = p->count;
    701   1.1  nisimura 
    702   1.1  nisimura 	if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
    703   1.1  nisimura 		return (EINVAL);
    704   1.1  nisimura 
    705  1.13       mrg 	if (!uvm_useracc(p->red, count, B_WRITE) ||
    706  1.13       mrg 	    !uvm_useracc(p->green, count, B_WRITE) ||
    707  1.13       mrg 	    !uvm_useracc(p->blue, count, B_WRITE))
    708   1.1  nisimura 		return (EFAULT);
    709   1.1  nisimura 
    710   1.1  nisimura 	copyout(&sc->sc_cmap.r[index], p->red, count);
    711   1.1  nisimura 	copyout(&sc->sc_cmap.g[index], p->green, count);
    712   1.1  nisimura 	copyout(&sc->sc_cmap.b[index], p->blue, count);
    713   1.1  nisimura 
    714   1.1  nisimura 	return (0);
    715   1.1  nisimura }
    716   1.1  nisimura 
    717   1.1  nisimura static int
    718   1.1  nisimura set_cmap(sc, p)
    719   1.1  nisimura 	struct sfb_softc *sc;
    720   1.1  nisimura 	struct wsdisplay_cmap *p;
    721   1.1  nisimura {
    722   1.1  nisimura 	u_int index = p->index, count = p->count;
    723   1.1  nisimura 
    724   1.1  nisimura 	if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
    725   1.1  nisimura 		return (EINVAL);
    726   1.1  nisimura 
    727  1.13       mrg 	if (!uvm_useracc(p->red, count, B_READ) ||
    728  1.13       mrg 	    !uvm_useracc(p->green, count, B_READ) ||
    729  1.13       mrg 	    !uvm_useracc(p->blue, count, B_READ))
    730   1.1  nisimura 		return (EFAULT);
    731   1.1  nisimura 
    732   1.1  nisimura 	copyin(p->red, &sc->sc_cmap.r[index], count);
    733   1.1  nisimura 	copyin(p->green, &sc->sc_cmap.g[index], count);
    734   1.1  nisimura 	copyin(p->blue, &sc->sc_cmap.b[index], count);
    735   1.1  nisimura 
    736   1.1  nisimura 	sc->sc_changed |= DATA_CMAP_CHANGED;
    737   1.1  nisimura 
    738   1.1  nisimura 	return (0);
    739   1.1  nisimura }
    740   1.1  nisimura 
    741   1.3  nisimura 
    742   1.1  nisimura static int
    743   1.1  nisimura set_cursor(sc, p)
    744   1.1  nisimura 	struct sfb_softc *sc;
    745   1.1  nisimura 	struct wsdisplay_cursor *p;
    746   1.1  nisimura {
    747   1.1  nisimura #define	cc (&sc->sc_cursor)
    748   1.5  nisimura 	int v, index, count, icount;
    749   1.1  nisimura 
    750   1.1  nisimura 	v = p->which;
    751   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    752   1.1  nisimura 		index = p->cmap.index;
    753   1.1  nisimura 		count = p->cmap.count;
    754   1.1  nisimura 		if (index >= 2 || (index + count) > 2)
    755   1.1  nisimura 			return (EINVAL);
    756  1.13       mrg 		if (!uvm_useracc(p->cmap.red, count, B_READ) ||
    757  1.13       mrg 		    !uvm_useracc(p->cmap.green, count, B_READ) ||
    758  1.13       mrg 		    !uvm_useracc(p->cmap.blue, count, B_READ))
    759   1.1  nisimura 			return (EFAULT);
    760   1.1  nisimura 	}
    761   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    762   1.1  nisimura 		if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
    763   1.1  nisimura 			return (EINVAL);
    764   1.5  nisimura 		icount = ((p->size.x < 33) ? 4 : 8) * p->size.y;
    765  1.13       mrg 		if (!uvm_useracc(p->image, icount, B_READ) ||
    766  1.13       mrg 		    !uvm_useracc(p->mask, icount, B_READ))
    767   1.1  nisimura 			return (EFAULT);
    768   1.1  nisimura 	}
    769   1.1  nisimura 	if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOCUR)) {
    770   1.1  nisimura 		if (v & WSDISPLAY_CURSOR_DOCUR)
    771   1.1  nisimura 			cc->cc_hot = p->hot;
    772   1.1  nisimura 		if (v & WSDISPLAY_CURSOR_DOPOS)
    773   1.1  nisimura 			set_curpos(sc, &p->pos);
    774   1.1  nisimura 		bt459_set_curpos(sc);
    775   1.1  nisimura 	}
    776   1.1  nisimura 
    777   1.1  nisimura 	sc->sc_changed = 0;
    778   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR) {
    779   1.1  nisimura 		sc->sc_curenb = p->enable;
    780   1.1  nisimura 		sc->sc_changed |= DATA_ENB_CHANGED;
    781   1.1  nisimura 	}
    782   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    783   1.1  nisimura 		copyin(p->cmap.red, &cc->cc_color[index], count);
    784   1.1  nisimura 		copyin(p->cmap.green, &cc->cc_color[index + 2], count);
    785   1.1  nisimura 		copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
    786   1.1  nisimura 		sc->sc_changed |= DATA_CURCMAP_CHANGED;
    787   1.1  nisimura 	}
    788   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    789   1.1  nisimura 		cc->cc_size = p->size;
    790   1.1  nisimura 		memset(cc->cc_image, 0, sizeof cc->cc_image);
    791   1.5  nisimura 		copyin(p->image, cc->cc_image, icount);
    792   1.5  nisimura 		copyin(p->mask, cc->cc_image+CURSOR_MAX_SIZE, icount);
    793   1.1  nisimura 		sc->sc_changed |= DATA_CURSHAPE_CHANGED;
    794   1.1  nisimura 	}
    795   1.1  nisimura 
    796   1.1  nisimura 	return (0);
    797   1.1  nisimura #undef cc
    798   1.1  nisimura }
    799   1.1  nisimura 
    800   1.1  nisimura static int
    801   1.1  nisimura get_cursor(sc, p)
    802   1.1  nisimura 	struct sfb_softc *sc;
    803   1.1  nisimura 	struct wsdisplay_cursor *p;
    804   1.1  nisimura {
    805   1.1  nisimura 	return (ENOTTY); /* XXX */
    806   1.1  nisimura }
    807   1.1  nisimura 
    808   1.1  nisimura static void
    809   1.1  nisimura set_curpos(sc, curpos)
    810   1.1  nisimura 	struct sfb_softc *sc;
    811   1.1  nisimura 	struct wsdisplay_curpos *curpos;
    812   1.1  nisimura {
    813   1.1  nisimura 	struct fb_devconfig *dc = sc->sc_dc;
    814   1.1  nisimura 	int x = curpos->x, y = curpos->y;
    815   1.1  nisimura 
    816   1.1  nisimura 	if (y < 0)
    817   1.1  nisimura 		y = 0;
    818   1.3  nisimura 	else if (y > dc->dc_ht)
    819   1.3  nisimura 		y = dc->dc_ht;
    820   1.1  nisimura 	if (x < 0)
    821   1.1  nisimura 		x = 0;
    822   1.3  nisimura 	else if (x > dc->dc_wid)
    823   1.3  nisimura 		x = dc->dc_wid;
    824   1.1  nisimura 	sc->sc_cursor.cc_pos.x = x;
    825   1.1  nisimura 	sc->sc_cursor.cc_pos.y = y;
    826   1.1  nisimura }
    827   1.1  nisimura 
    828   1.1  nisimura static void
    829   1.1  nisimura bt459_set_curpos(sc)
    830   1.1  nisimura 	struct sfb_softc *sc;
    831   1.1  nisimura {
    832   1.1  nisimura 	caddr_t sfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
    833  1.16  nisimura 	caddr_t vdac = (void *)(sfbbase + SFB_RAMDAC_OFFSET);
    834   1.3  nisimura 	int x, y, s;
    835   1.1  nisimura 
    836   1.3  nisimura 	x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
    837   1.3  nisimura 	y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
    838  1.15  nisimura 
    839  1.15  nisimura 	x += sc->sc_cursor.cc_magic.x;
    840  1.15  nisimura 	y += sc->sc_cursor.cc_magic.y;
    841   1.1  nisimura 
    842   1.1  nisimura 	s = spltty();
    843   1.1  nisimura 
    844  1.16  nisimura 	SELECT(vdac, BT459_REG_CURSOR_X_LOW);
    845  1.16  nisimura 	REG(vdac, bt_reg) = x;		tc_wmb();
    846  1.16  nisimura 	REG(vdac, bt_reg) = x >> 8;	tc_wmb();
    847  1.16  nisimura 	REG(vdac, bt_reg) = y;		tc_wmb();
    848  1.16  nisimura 	REG(vdac, bt_reg) = y >> 8;	tc_wmb();
    849   1.1  nisimura 
    850   1.1  nisimura 	splx(s);
    851   1.1  nisimura }
    852  1.10  nisimura 
    853  1.10  nisimura #define	MODE_SIMPLE		0
    854  1.10  nisimura #define	MODE_OPAQUESTIPPLE	1
    855  1.10  nisimura #define	MODE_OPAQUELINE		2
    856  1.10  nisimura #define	MODE_TRANSPARENTSTIPPLE	5
    857  1.10  nisimura #define	MODE_TRANSPARENTLINE	6
    858  1.10  nisimura #define	MODE_COPY		7
    859  1.10  nisimura 
    860  1.10  nisimura #define	SFBALIGNMASK		0x7
    861  1.10  nisimura #define	SFBSTIPPLEALL1		0xffffffff
    862  1.10  nisimura #define	SFBSTIPPLEBITS		32
    863  1.10  nisimura #define	SFBSTIPPLEBITMASK	0x1f
    864  1.10  nisimura #define	SFBSTIPPLEBYTESDONE	32
    865  1.10  nisimura 
    866  1.10  nisimura /*
    867  1.10  nisimura  * Paint (or unpaint) the cursor.
    868  1.10  nisimura  */
    869  1.10  nisimura void
    870  1.10  nisimura sfb_cursor(id, on, row, col)
    871  1.10  nisimura 	void *id;
    872  1.10  nisimura 	int on, row, col;
    873  1.10  nisimura {
    874  1.10  nisimura 	struct rcons *rc = id;
    875  1.10  nisimura 	int x, y;
    876  1.10  nisimura 
    877  1.10  nisimura 	/* turn the cursor off */
    878  1.10  nisimura 	if (!on) {
    879  1.10  nisimura 		/* make sure it's on */
    880  1.10  nisimura 		if ((rc->rc_bits & RC_CURSOR) == 0)
    881  1.10  nisimura 			return;
    882  1.10  nisimura 
    883  1.10  nisimura 		row = *rc->rc_crowp;
    884  1.10  nisimura 		col = *rc->rc_ccolp;
    885  1.10  nisimura 	} else {
    886  1.10  nisimura 		/* unpaint the old copy. */
    887  1.10  nisimura 		*rc->rc_crowp = row;
    888  1.10  nisimura 		*rc->rc_ccolp = col;
    889  1.10  nisimura 	}
    890  1.10  nisimura 
    891  1.10  nisimura 	x = col * rc->rc_font->width + rc->rc_xorigin;
    892  1.10  nisimura 	y = row * rc->rc_font->height + rc->rc_yorigin;
    893  1.10  nisimura 
    894  1.10  nisimura 	raster_op(rc->rc_sp, x, y,
    895  1.10  nisimura 	    rc->rc_font->width, rc->rc_font->height,
    896  1.10  nisimura 	    RAS_INVERT,
    897  1.10  nisimura 	    (struct raster *) 0, 0, 0);
    898  1.10  nisimura 
    899  1.10  nisimura 	rc->rc_bits ^= RC_CURSOR;
    900  1.10  nisimura }
    901  1.10  nisimura 
    902  1.10  nisimura /*
    903  1.10  nisimura  * Actually write a string to the frame buffer.
    904  1.10  nisimura  */
    905  1.10  nisimura int
    906  1.10  nisimura sfb_mapchar(id, uni, index)
    907  1.10  nisimura 	void *id;
    908  1.10  nisimura 	int uni;
    909  1.10  nisimura 	unsigned int *index;
    910  1.10  nisimura {
    911  1.10  nisimura 	if (uni < 128) {
    912  1.10  nisimura 		*index = uni;
    913  1.10  nisimura 		return (5);
    914  1.10  nisimura 	}
    915  1.10  nisimura 	*index = ' ';
    916  1.10  nisimura 	return (0);
    917  1.10  nisimura }
    918  1.10  nisimura 
    919  1.10  nisimura /*
    920  1.10  nisimura  * Actually write a string to the frame buffer.
    921  1.10  nisimura  */
    922  1.10  nisimura void
    923  1.10  nisimura sfb_putchar(id, row, col, uc, attr)
    924  1.10  nisimura 	void *id;
    925  1.10  nisimura 	int row, col;
    926  1.10  nisimura 	u_int uc;
    927  1.10  nisimura 	long attr;
    928  1.10  nisimura {
    929  1.10  nisimura 	struct rcons *rc = id;
    930  1.10  nisimura 	int x, y, op;
    931  1.10  nisimura 	u_char help;
    932  1.10  nisimura 
    933  1.10  nisimura 	x = col * rc->rc_font->width + rc->rc_xorigin;
    934  1.10  nisimura 	y = row * rc->rc_font->height + rc->rc_font_ascent + rc->rc_yorigin;
    935  1.10  nisimura 
    936  1.10  nisimura 	op = RAS_SRC;
    937  1.10  nisimura 	if ((attr != 0) ^ ((rc->rc_bits & RC_INVERT) != 0))
    938  1.10  nisimura 		op = RAS_NOT(op);
    939  1.10  nisimura 	help = uc & 0xff;
    940  1.10  nisimura 	raster_textn(rc->rc_sp, x, y, op, rc->rc_font, &help, 1);
    941  1.10  nisimura }
    942  1.10  nisimura 
    943  1.10  nisimura /*
    944  1.16  nisimura  * Copy characters in a line.
    945  1.10  nisimura  */
    946  1.10  nisimura void
    947  1.10  nisimura sfb_copycols(id, row, srccol, dstcol, ncols)
    948  1.10  nisimura 	void *id;
    949  1.10  nisimura 	int row, srccol, dstcol, ncols;
    950  1.10  nisimura {
    951  1.10  nisimura 	struct rcons *rc = id;
    952  1.16  nisimura 	struct raster *rap = rc->rc_sp;
    953  1.16  nisimura 	caddr_t sp, dp, basex, sfb;
    954  1.16  nisimura 	int scanspan, height, width, aligns, alignd, w, y;
    955  1.16  nisimura 	u_int32_t lmasks, rmasks, lmaskd, rmaskd;
    956  1.10  nisimura 
    957  1.16  nisimura 	scanspan = rap->linelongs * 4;
    958  1.10  nisimura 	y = rc->rc_yorigin + rc->rc_font->height * row;
    959  1.16  nisimura 	basex = (caddr_t)rap->pixels + y * scanspan + rc->rc_xorigin;
    960  1.16  nisimura 	height = rc->rc_font->height;
    961  1.16  nisimura 	w = rc->rc_font->width * ncols;
    962  1.16  nisimura 
    963  1.16  nisimura 	dp = basex + rc->rc_font->width * dstcol;
    964  1.16  nisimura 	alignd = (long)dp & SFBALIGNMASK;
    965  1.16  nisimura 	dp -= alignd;
    966  1.16  nisimura 	width = w + alignd;
    967  1.16  nisimura 	lmaskd = SFBSTIPPLEALL1 << alignd;
    968  1.16  nisimura 	rmaskd = SFBSTIPPLEALL1 >> (-width & SFBSTIPPLEBITMASK);
    969  1.16  nisimura 
    970  1.16  nisimura 	sp = basex + rc->rc_font->width * srccol;
    971  1.16  nisimura 	aligns = (long)sp & SFBALIGNMASK;
    972  1.16  nisimura 	sp -= aligns;
    973  1.16  nisimura 	width = w + aligns;
    974  1.16  nisimura 	lmasks = SFBSTIPPLEALL1 << aligns;
    975  1.16  nisimura 	rmasks = SFBSTIPPLEALL1 >> (-width & SFBSTIPPLEBITMASK);
    976  1.16  nisimura 
    977  1.16  nisimura 	width += (-width & SFBSTIPPLEBITMASK);
    978  1.16  nisimura 	sfb = rap->data;
    979  1.16  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_COPY;
    980  1.16  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_PLANEMASK) = ~0;
    981  1.16  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_PIXELSHIFT) = alignd - aligns;
    982  1.16  nisimura 
    983  1.16  nisimura 	if (width <= SFBSTIPPLEBITS) {
    984  1.16  nisimura 		while (height > 0) {
    985  1.16  nisimura 			*(u_int32_t *)sp = lmasks & rmasks;
    986  1.16  nisimura 			*(u_int32_t *)dp = lmaskd & rmaskd;
    987  1.16  nisimura 			sp += scanspan;
    988  1.16  nisimura 			dp += scanspan;
    989  1.16  nisimura 			height--;
    990  1.16  nisimura 		}
    991  1.16  nisimura 	}
    992  1.16  nisimura 	/* copy forward (left-to-right) */
    993  1.17  nisimura 	else if (dstcol < srccol || srccol + ncols < dstcol) {
    994  1.16  nisimura 		caddr_t sq = sp, dq = dp;
    995  1.16  nisimura 
    996  1.16  nisimura 		w = width;
    997  1.16  nisimura 		while (height > 0) {
    998  1.16  nisimura 			*(u_int32_t *)sp = lmasks;
    999  1.16  nisimura 			*(u_int32_t *)dp = lmaskd;
   1000  1.16  nisimura 			width -= 2 * SFBSTIPPLEBITS;
   1001  1.16  nisimura 			while (width > 0) {
   1002  1.16  nisimura 				sp += SFBSTIPPLEBYTESDONE;
   1003  1.16  nisimura 				dp += SFBSTIPPLEBYTESDONE;
   1004  1.16  nisimura 				*(u_int32_t *)sp = SFBSTIPPLEALL1;
   1005  1.16  nisimura 				*(u_int32_t *)dp = SFBSTIPPLEALL1;
   1006  1.16  nisimura 				width -= SFBSTIPPLEBITS;
   1007  1.16  nisimura 			}
   1008  1.16  nisimura 			sp += SFBSTIPPLEBYTESDONE;
   1009  1.16  nisimura 			dp += SFBSTIPPLEBYTESDONE;
   1010  1.16  nisimura 			*(u_int32_t *)sp = rmasks;
   1011  1.16  nisimura 			*(u_int32_t *)dp = rmaskd;
   1012  1.16  nisimura 
   1013  1.16  nisimura 			sp = (sq += scanspan);
   1014  1.16  nisimura 			dp = (dq += scanspan);
   1015  1.16  nisimura 			width = w;
   1016  1.16  nisimura 			height--;
   1017  1.16  nisimura 		}
   1018  1.16  nisimura 	}
   1019  1.16  nisimura 	/* copy backward (right-to-left) */
   1020  1.16  nisimura 	else {
   1021  1.16  nisimura 		caddr_t sq = (sp += width), dq = (dp += width);
   1022  1.16  nisimura 
   1023  1.16  nisimura 		w = width;
   1024  1.16  nisimura 		while (height > 0) {
   1025  1.16  nisimura 			*(u_int32_t *)sp = rmasks;
   1026  1.16  nisimura 			*(u_int32_t *)dp = rmaskd;
   1027  1.16  nisimura 			width -= 2 * SFBSTIPPLEBITS;
   1028  1.16  nisimura 			while (width > 0) {
   1029  1.16  nisimura 				sp -= SFBSTIPPLEBYTESDONE;
   1030  1.16  nisimura 				dp -= SFBSTIPPLEBYTESDONE;
   1031  1.16  nisimura 				*(u_int32_t *)sp = SFBSTIPPLEALL1;
   1032  1.16  nisimura 				*(u_int32_t *)dp = SFBSTIPPLEALL1;
   1033  1.16  nisimura 				width -= SFBSTIPPLEBITS;
   1034  1.16  nisimura 			}
   1035  1.16  nisimura 			sp -= SFBSTIPPLEBYTESDONE;
   1036  1.16  nisimura 			dp -= SFBSTIPPLEBYTESDONE;
   1037  1.16  nisimura 			*(u_int32_t *)sp = lmasks;
   1038  1.16  nisimura 			*(u_int32_t *)dp = lmaskd;
   1039  1.16  nisimura 
   1040  1.16  nisimura 			sp = (sq += scanspan);
   1041  1.16  nisimura 			dp = (dq += scanspan);
   1042  1.16  nisimura 			width = w;
   1043  1.16  nisimura 			height--;
   1044  1.16  nisimura 		}
   1045  1.16  nisimura 	}
   1046  1.16  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_SIMPLE;
   1047  1.10  nisimura }
   1048  1.10  nisimura 
   1049  1.10  nisimura /*
   1050  1.16  nisimura  * Clear characters in a line.
   1051  1.10  nisimura  */
   1052  1.10  nisimura void
   1053  1.10  nisimura sfb_erasecols(id, row, startcol, ncols, fillattr)
   1054  1.10  nisimura 	void *id;
   1055  1.10  nisimura 	int row, startcol, ncols;
   1056  1.10  nisimura 	long fillattr;
   1057  1.10  nisimura {
   1058  1.10  nisimura 	struct rcons *rc = id;
   1059  1.10  nisimura 	struct raster *rap = rc->rc_sp;
   1060  1.10  nisimura 	caddr_t sfb, p;
   1061  1.10  nisimura 	int scanspan, startx, height, width, align, w, y;
   1062  1.10  nisimura 	u_int32_t lmask, rmask;
   1063  1.10  nisimura 
   1064  1.10  nisimura 	scanspan = rap->linelongs * 4;
   1065  1.10  nisimura 	y = rc->rc_yorigin + rc->rc_font->height * row;
   1066  1.10  nisimura 	startx = rc->rc_xorigin + rc->rc_font->width * startcol;
   1067  1.10  nisimura 	height = rc->rc_font->height;
   1068  1.10  nisimura 	w = rc->rc_font->width * ncols;
   1069  1.10  nisimura 
   1070  1.10  nisimura 	p = (caddr_t)rap->pixels + y * scanspan + startx;
   1071  1.10  nisimura 	align = (long)p & SFBALIGNMASK;
   1072  1.10  nisimura 	p -= align;
   1073  1.10  nisimura 	width = w + align;
   1074  1.10  nisimura 	lmask = SFBSTIPPLEALL1 << align;
   1075  1.10  nisimura 	rmask = SFBSTIPPLEALL1 >> (-width & SFBSTIPPLEBITMASK);
   1076  1.10  nisimura 	sfb = rap->data;
   1077  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_TRANSPARENTSTIPPLE;
   1078  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_PLANEMASK) = ~0;
   1079  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_FG) = 0;
   1080  1.10  nisimura 	if (width <= SFBSTIPPLEBITS) {
   1081  1.10  nisimura 		while (height > 0) {
   1082  1.10  nisimura 			*(u_int32_t *)(sfb + SFB_ASIC_ADDRESS) = (long)p;
   1083  1.10  nisimura 			*(u_int32_t *)(sfb + SFB_ASIC_START) = lmask & rmask;
   1084  1.10  nisimura 			p += scanspan;
   1085  1.10  nisimura 			height--;
   1086  1.10  nisimura 		}
   1087  1.10  nisimura 	}
   1088  1.10  nisimura 	else {
   1089  1.10  nisimura 		caddr_t q = p;
   1090  1.10  nisimura 		while (height > 0) {
   1091  1.10  nisimura 			*(u_int32_t *)p = lmask;
   1092  1.10  nisimura 			width -= 2 * SFBSTIPPLEBITS;
   1093  1.10  nisimura 			while (width > 0) {
   1094  1.10  nisimura 				p += SFBSTIPPLEBYTESDONE;
   1095  1.10  nisimura 				*(u_int32_t *)p = SFBSTIPPLEALL1;
   1096  1.10  nisimura 				width -= SFBSTIPPLEBITS;
   1097  1.10  nisimura 			}
   1098  1.10  nisimura 			p += SFBSTIPPLEBYTESDONE;
   1099  1.10  nisimura 			*(u_int32_t *)p = rmask;
   1100  1.10  nisimura 
   1101  1.10  nisimura 			p = (q += scanspan);
   1102  1.10  nisimura 			width = w + align;
   1103  1.10  nisimura 			height--;
   1104  1.10  nisimura 		}
   1105  1.10  nisimura 	}
   1106  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_SIMPLE;
   1107  1.10  nisimura }
   1108  1.10  nisimura 
   1109  1.10  nisimura /*
   1110  1.16  nisimura  * Copy lines.
   1111  1.10  nisimura  */
   1112  1.10  nisimura void
   1113  1.10  nisimura sfb_copyrows(id, srcrow, dstrow, nrows)
   1114  1.10  nisimura 	void *id;
   1115  1.10  nisimura 	int srcrow, dstrow, nrows;
   1116  1.10  nisimura {
   1117  1.10  nisimura 	struct rcons *rc = id;
   1118  1.10  nisimura 	struct raster *rap = rc->rc_sp;
   1119  1.10  nisimura 	caddr_t sfb, p;
   1120  1.10  nisimura 	int scanspan, offset, srcy, height, width, align, w;
   1121  1.10  nisimura 	u_int32_t lmask, rmask;
   1122  1.10  nisimura 
   1123  1.10  nisimura 	scanspan = rap->linelongs * 4;
   1124  1.10  nisimura 	height = rc->rc_font->height * nrows;
   1125  1.10  nisimura 	offset = (dstrow - srcrow) * scanspan * rc->rc_font->height;
   1126  1.10  nisimura 	srcy = rc->rc_yorigin + rc->rc_font->height * srcrow;
   1127  1.10  nisimura 	if (srcrow < dstrow && srcrow + nrows > dstrow) {
   1128  1.10  nisimura 		scanspan = -scanspan;
   1129  1.10  nisimura 		srcy += height;
   1130  1.10  nisimura 	}
   1131  1.10  nisimura 
   1132  1.10  nisimura 	p = (caddr_t)(rap->pixels + srcy * rap->linelongs) + rc->rc_xorigin;
   1133  1.10  nisimura 	align = (long)p & SFBALIGNMASK;
   1134  1.10  nisimura 	p -= align;
   1135  1.10  nisimura 	w = rc->rc_font->width * rc->rc_maxcol;
   1136  1.10  nisimura 	width = w + align;
   1137  1.10  nisimura 	lmask = SFBSTIPPLEALL1 << align;
   1138  1.10  nisimura 	rmask = SFBSTIPPLEALL1 >> (-width & SFBSTIPPLEBITMASK);
   1139  1.10  nisimura 	sfb = rap->data;
   1140  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_COPY;
   1141  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_PLANEMASK) = ~0;
   1142  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_PIXELSHIFT) = 0;
   1143  1.10  nisimura 	if (width <= SFBSTIPPLEBITS) {
   1144  1.10  nisimura 		/* never happens */;
   1145  1.10  nisimura 	}
   1146  1.10  nisimura 	else {
   1147  1.10  nisimura 		caddr_t q = p;
   1148  1.10  nisimura 		while (height > 0) {
   1149  1.10  nisimura 			*(u_int32_t *)p = lmask;
   1150  1.10  nisimura 			*(u_int32_t *)(p + offset) = lmask;
   1151  1.10  nisimura 			width -= 2 * SFBSTIPPLEBITS;
   1152  1.10  nisimura 			while (width > 0) {
   1153  1.10  nisimura 				p += SFBSTIPPLEBYTESDONE;
   1154  1.10  nisimura 				*(u_int32_t *)p = SFBSTIPPLEALL1;
   1155  1.10  nisimura 				*(u_int32_t *)(p + offset) = SFBSTIPPLEALL1;
   1156  1.10  nisimura 				width -= SFBSTIPPLEBITS;
   1157  1.10  nisimura 			}
   1158  1.10  nisimura 			p += SFBSTIPPLEBYTESDONE;
   1159  1.10  nisimura 			*(u_int32_t *)p = rmask;
   1160  1.10  nisimura 			*(u_int32_t *)(p + offset) = rmask;
   1161  1.10  nisimura 
   1162  1.10  nisimura 			p = (q += scanspan);
   1163  1.10  nisimura 			width = w + align;
   1164  1.10  nisimura 			height--;
   1165  1.10  nisimura 		}
   1166  1.10  nisimura 	}
   1167  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_SIMPLE;
   1168  1.10  nisimura }
   1169  1.10  nisimura 
   1170  1.10  nisimura /*
   1171  1.16  nisimura  * Erase characters in a line.
   1172  1.10  nisimura  */
   1173  1.10  nisimura void
   1174  1.10  nisimura sfb_eraserows(id, startrow, nrows, fillattr)
   1175  1.10  nisimura 	void *id;
   1176  1.10  nisimura 	int startrow, nrows;
   1177  1.10  nisimura 	long fillattr;
   1178  1.10  nisimura {
   1179  1.10  nisimura 	struct rcons *rc = id;
   1180  1.10  nisimura 	struct raster *rap = rc->rc_sp;
   1181  1.10  nisimura 	caddr_t sfb, p;
   1182  1.10  nisimura 	int scanspan, starty, height, width, align, w;
   1183  1.10  nisimura 	u_int32_t lmask, rmask;
   1184  1.10  nisimura 
   1185  1.10  nisimura 	scanspan = rap->linelongs * 4;
   1186  1.10  nisimura 	starty = rc->rc_yorigin + rc->rc_font->height * startrow;
   1187  1.10  nisimura 	height = rc->rc_font->height * nrows;
   1188  1.10  nisimura 
   1189  1.10  nisimura 	p = (caddr_t)rap->pixels + starty * scanspan + rc->rc_xorigin;
   1190  1.10  nisimura 	align = (long)p & SFBALIGNMASK;
   1191  1.10  nisimura 	p -= align;
   1192  1.10  nisimura 	w = rc->rc_font->width * rc->rc_maxcol;
   1193  1.10  nisimura 	width = w + align;
   1194  1.10  nisimura 	lmask = SFBSTIPPLEALL1 << align;
   1195  1.10  nisimura 	rmask = SFBSTIPPLEALL1 >> (-width & SFBSTIPPLEBITMASK);
   1196  1.10  nisimura 	sfb = rap->data;
   1197  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_TRANSPARENTSTIPPLE;
   1198  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_PLANEMASK) = ~0;
   1199  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_FG) = 0;
   1200  1.10  nisimura 	if (width <= SFBSTIPPLEBITS) {
   1201  1.10  nisimura 		/* never happens */;
   1202  1.10  nisimura 	}
   1203  1.10  nisimura 	else {
   1204  1.10  nisimura 		caddr_t q = p;
   1205  1.10  nisimura 		while (height > 0) {
   1206  1.10  nisimura 			*(u_int32_t *)p = lmask;
   1207  1.10  nisimura 			width -= 2 * SFBSTIPPLEBITS;
   1208  1.10  nisimura 			while (width > 0) {
   1209  1.10  nisimura 				p += SFBSTIPPLEBYTESDONE;
   1210  1.10  nisimura 				*(u_int32_t *)p = SFBSTIPPLEALL1;
   1211  1.10  nisimura 				width -= SFBSTIPPLEBITS;
   1212  1.10  nisimura 			}
   1213  1.10  nisimura 			p += SFBSTIPPLEBYTESDONE;
   1214  1.10  nisimura 			*(u_int32_t *)p = rmask;
   1215  1.10  nisimura 
   1216  1.10  nisimura 			p = (q += scanspan);
   1217  1.10  nisimura 			width = w + align;
   1218  1.10  nisimura 			height--;
   1219  1.10  nisimura 		}
   1220  1.10  nisimura 	}
   1221  1.10  nisimura 	*(u_int32_t *)(sfb + SFB_ASIC_MODE) = MODE_SIMPLE;
   1222  1.10  nisimura }
   1223  1.10  nisimura 
   1224  1.10  nisimura int
   1225  1.10  nisimura sfb_alloc_attr(id, fg, bg, flags, attrp)
   1226  1.10  nisimura 	void *id;
   1227  1.10  nisimura 	int fg, bg, flags;
   1228  1.10  nisimura 	long *attrp;
   1229  1.10  nisimura {
   1230  1.10  nisimura 	if (flags & (WSATTR_HILIT | WSATTR_BLINK |
   1231  1.10  nisimura 		     WSATTR_UNDERLINE | WSATTR_WSCOLORS))
   1232  1.10  nisimura 		return (EINVAL);
   1233  1.10  nisimura 	if (flags & WSATTR_REVERSE)
   1234  1.10  nisimura 		*attrp = 1;
   1235  1.10  nisimura 	else
   1236  1.10  nisimura 		*attrp = 0;
   1237  1.10  nisimura 	return (0);
   1238  1.10  nisimura }
   1239