Home | History | Annotate | Line # | Download | only in dev
fb.c revision 1.24
      1  1.24   tsutsui /*	$NetBSD: fb.c,v 1.24 2008/04/09 15:40:30 tsutsui Exp $	*/
      2   1.5    tsubai 
      3   1.5    tsubai /*-
      4   1.5    tsubai  * Copyright (c) 2000 Tsubai Masanari.  All rights reserved.
      5   1.1    tsubai  *
      6   1.1    tsubai  * Redistribution and use in source and binary forms, with or without
      7   1.1    tsubai  * modification, are permitted provided that the following conditions
      8   1.1    tsubai  * are met:
      9   1.1    tsubai  * 1. Redistributions of source code must retain the above copyright
     10   1.1    tsubai  *    notice, this list of conditions and the following disclaimer.
     11   1.1    tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1    tsubai  *    notice, this list of conditions and the following disclaimer in the
     13   1.1    tsubai  *    documentation and/or other materials provided with the distribution.
     14   1.5    tsubai  * 3. The name of the author may not be used to endorse or promote products
     15   1.5    tsubai  *    derived from this software without specific prior written permission.
     16   1.1    tsubai  *
     17   1.5    tsubai  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     18   1.5    tsubai  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     19   1.5    tsubai  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     20   1.5    tsubai  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     21   1.5    tsubai  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     22   1.5    tsubai  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     23   1.5    tsubai  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     24   1.5    tsubai  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     25   1.5    tsubai  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     26   1.5    tsubai  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     27   1.1    tsubai  */
     28  1.17     lukem 
     29  1.17     lukem #include <sys/cdefs.h>
     30  1.24   tsutsui __KERNEL_RCSID(0, "$NetBSD: fb.c,v 1.24 2008/04/09 15:40:30 tsutsui Exp $");
     31   1.1    tsubai 
     32   1.1    tsubai #include <sys/param.h>
     33   1.1    tsubai #include <sys/device.h>
     34   1.5    tsubai #include <sys/ioctl.h>
     35   1.5    tsubai #include <sys/malloc.h>
     36   1.1    tsubai #include <sys/systm.h>
     37   1.1    tsubai 
     38   1.5    tsubai #include <uvm/uvm_extern.h>
     39   1.5    tsubai 
     40   1.5    tsubai #include <machine/adrsmap.h>
     41  1.16   tsutsui 
     42  1.16   tsutsui #include <newsmips/dev/hbvar.h>
     43   1.1    tsubai 
     44   1.5    tsubai #include <dev/wscons/wsconsio.h>
     45   1.5    tsubai #include <dev/wscons/wsdisplayvar.h>
     46   1.5    tsubai #include <dev/rasops/rasops.h>
     47   1.5    tsubai 
     48   1.5    tsubai struct fb_devconfig {
     49   1.5    tsubai 	u_char *dc_fbbase;		/* VRAM base address */
     50   1.5    tsubai 	struct rasops_info dc_ri;
     51   1.5    tsubai };
     52   1.1    tsubai 
     53   1.1    tsubai struct fb_softc {
     54  1.24   tsutsui 	device_t sc_dev;
     55   1.5    tsubai 	struct fb_devconfig *sc_dc;
     56   1.5    tsubai 	int sc_nscreens;
     57   1.1    tsubai };
     58   1.1    tsubai 
     59  1.24   tsutsui int fb_match(device_t, cfdata_t, void *);
     60  1.24   tsutsui void fb_attach(device_t, device_t, void *);
     61   1.5    tsubai 
     62   1.5    tsubai int fb_common_init(struct fb_devconfig *);
     63   1.5    tsubai int fb_is_console(void);
     64   1.5    tsubai 
     65  1.23  christos int fb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     66  1.22      jmmv paddr_t fb_mmap(void *, void *, off_t, int);
     67   1.5    tsubai int fb_alloc_screen(void *, const struct wsscreen_descr *, void **, int *,
     68  1.19   tsutsui     int *, long *);
     69   1.5    tsubai void fb_free_screen(void *, void *);
     70   1.5    tsubai int fb_show_screen(void *, void *, int, void (*)(void *, int, int), void *);
     71   1.5    tsubai 
     72   1.5    tsubai void fb_cnattach(void);
     73   1.5    tsubai 
     74   1.9      matt static void fb253_init(void);
     75   1.1    tsubai 
     76  1.24   tsutsui CFATTACH_DECL_NEW(fb, sizeof(struct fb_softc),
     77  1.14   thorpej     fb_match, fb_attach, NULL, NULL);
     78   1.5    tsubai 
     79   1.5    tsubai struct fb_devconfig fb_console_dc;
     80   1.5    tsubai 
     81   1.5    tsubai struct wsdisplay_accessops fb_accessops = {
     82   1.5    tsubai 	fb_ioctl,
     83   1.5    tsubai 	fb_mmap,
     84   1.5    tsubai 	fb_alloc_screen,
     85   1.5    tsubai 	fb_free_screen,
     86   1.5    tsubai 	fb_show_screen,
     87   1.5    tsubai 	NULL	/* load_font */
     88   1.5    tsubai };
     89   1.5    tsubai 
     90   1.5    tsubai struct wsscreen_descr fb_stdscreen = {
     91   1.5    tsubai 	"std",
     92   1.5    tsubai 	0, 0,
     93   1.5    tsubai 	0,
     94   1.5    tsubai 	0, 0,
     95   1.5    tsubai 	WSSCREEN_REVERSE
     96   1.1    tsubai };
     97   1.1    tsubai 
     98   1.5    tsubai const struct wsscreen_descr *fb_scrlist[] = {
     99   1.5    tsubai 	&fb_stdscreen
    100   1.5    tsubai };
    101   1.5    tsubai 
    102   1.5    tsubai struct wsscreen_list fb_screenlist = {
    103  1.24   tsutsui 	__arraycount(fb_scrlist), fb_scrlist
    104   1.5    tsubai };
    105   1.1    tsubai 
    106  1.24   tsutsui #define NWB253_VRAM   ((uint8_t *) 0x88000000)
    107  1.24   tsutsui #define NWB253_CTLREG ((uint16_t *)0xb8ff0000)
    108  1.24   tsutsui #define NWB253_CRTREG ((uint16_t *)0xb8fe0000)
    109   1.1    tsubai 
    110  1.20   tsutsui static const char *devname[8] = { "NWB-512", "NWB-518", "NWE-501" }; /* XXX ? */
    111   1.5    tsubai 
    112   1.5    tsubai int
    113  1.24   tsutsui fb_match(device_t parent, cfdata_t cf, void *aux)
    114   1.1    tsubai {
    115  1.16   tsutsui 	struct hb_attach_args *ha = aux;
    116   1.1    tsubai 
    117  1.16   tsutsui 	if (strcmp(ha->ha_name, "fb") != 0)
    118   1.1    tsubai 		return 0;
    119   1.1    tsubai 
    120  1.16   tsutsui 	if (hb_badaddr(NWB253_CTLREG, 2) || hb_badaddr(NWB253_CRTREG, 2))
    121   1.5    tsubai 		return 0;
    122  1.24   tsutsui 	if ((*(volatile uint16_t *)NWB253_CTLREG & 7) != 4)
    123   1.1    tsubai 		return 0;
    124   1.1    tsubai 
    125   1.1    tsubai 	return 1;
    126   1.1    tsubai }
    127   1.1    tsubai 
    128   1.5    tsubai void
    129  1.24   tsutsui fb_attach(device_t parent, device_t self, void *aux)
    130   1.1    tsubai {
    131  1.24   tsutsui 	struct fb_softc *sc = device_private(self);
    132   1.5    tsubai 	struct wsemuldisplaydev_attach_args waa;
    133   1.5    tsubai 	struct fb_devconfig *dc;
    134   1.5    tsubai 	struct rasops_info *ri;
    135   1.5    tsubai 	int console;
    136   1.5    tsubai 	volatile u_short *ctlreg = NWB253_CTLREG;
    137   1.5    tsubai 	int id;
    138   1.5    tsubai 
    139  1.24   tsutsui 	sc->sc_dev = self;
    140  1.24   tsutsui 
    141   1.5    tsubai 	console = fb_is_console();
    142   1.5    tsubai 
    143   1.5    tsubai 	if (console) {
    144   1.5    tsubai 		dc = &fb_console_dc;
    145   1.5    tsubai 		ri = &dc->dc_ri;
    146   1.5    tsubai 		sc->sc_nscreens = 1;
    147   1.5    tsubai 	} else {
    148  1.19   tsutsui 		dc = malloc(sizeof(struct fb_devconfig), M_DEVBUF,
    149  1.19   tsutsui 		    M_WAITOK|M_ZERO);
    150   1.5    tsubai 
    151   1.5    tsubai 		dc->dc_fbbase = NWB253_VRAM;
    152   1.5    tsubai 		fb_common_init(dc);
    153   1.5    tsubai 		ri = &dc->dc_ri;
    154   1.5    tsubai 
    155   1.5    tsubai 		/* clear screen */
    156   1.5    tsubai 		(*ri->ri_ops.eraserows)(ri, 0, ri->ri_rows, 0);
    157   1.5    tsubai 
    158   1.8    tsubai 		fb253_init();
    159   1.5    tsubai 	}
    160   1.5    tsubai 	sc->sc_dc = dc;
    161   1.5    tsubai 
    162   1.5    tsubai 	id = (*ctlreg >> 8) & 0xf;
    163  1.24   tsutsui 	aprint_normal(": %s, %d x %d, %dbpp\n", devname[id],
    164   1.5    tsubai 	    ri->ri_width, ri->ri_height, ri->ri_depth);
    165   1.5    tsubai 
    166   1.5    tsubai 	waa.console = console;
    167   1.5    tsubai 	waa.scrdata = &fb_screenlist;
    168   1.5    tsubai 	waa.accessops = &fb_accessops;
    169   1.5    tsubai 	waa.accesscookie = sc;
    170   1.1    tsubai 
    171   1.5    tsubai 	config_found(self, &waa, wsemuldisplaydevprint);
    172   1.1    tsubai }
    173   1.1    tsubai 
    174   1.1    tsubai int
    175  1.19   tsutsui fb_common_init(struct fb_devconfig *dc)
    176   1.1    tsubai {
    177   1.5    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    178  1.24   tsutsui 	volatile uint16_t *ctlreg = NWB253_CTLREG;
    179   1.5    tsubai 	int id;
    180   1.5    tsubai 	int width, height, xoff, yoff, cols, rows;
    181   1.5    tsubai 
    182   1.5    tsubai 	id = (*ctlreg >> 8) & 0xf;
    183   1.5    tsubai 
    184   1.5    tsubai 	/* initialize rasops */
    185   1.5    tsubai 	switch (id) {
    186   1.5    tsubai 	case 0:
    187   1.5    tsubai 		width = 816;
    188   1.5    tsubai 		height = 1024;
    189   1.5    tsubai 		break;
    190   1.5    tsubai 	case 1:
    191   1.5    tsubai 	case 2:
    192  1.18       dsl 	default:
    193   1.5    tsubai 		width = 1024;
    194   1.5    tsubai 		height = 768;
    195   1.5    tsubai 		break;
    196   1.1    tsubai 	}
    197   1.1    tsubai 
    198   1.5    tsubai 	ri->ri_width = width;
    199   1.5    tsubai 	ri->ri_height = height;
    200   1.5    tsubai 	ri->ri_depth = 1;
    201   1.5    tsubai 	ri->ri_stride = 2048 / 8;
    202   1.5    tsubai 	ri->ri_bits = dc->dc_fbbase;
    203   1.5    tsubai 	ri->ri_flg = RI_FULLCLEAR;
    204   1.5    tsubai 
    205   1.5    tsubai 	rasops_init(ri, 24, 80);
    206   1.5    tsubai 	rows = (height - 2) / ri->ri_font->fontheight;
    207   1.5    tsubai 	cols = ((width - 2) / ri->ri_font->fontwidth) & ~7;
    208   1.5    tsubai 	xoff = ((width - cols * ri->ri_font->fontwidth) / 2 / 8) & ~3;
    209   1.5    tsubai 	yoff = (height - rows * ri->ri_font->fontheight) / 2;
    210   1.5    tsubai 	rasops_reconfig(ri, rows, cols);
    211  1.15   tsutsui 
    212   1.5    tsubai 	ri->ri_xorigin = xoff;
    213   1.5    tsubai 	ri->ri_yorigin = yoff;
    214   1.5    tsubai 	ri->ri_bits = dc->dc_fbbase + xoff + ri->ri_stride * yoff;
    215  1.15   tsutsui 
    216   1.5    tsubai 	fb_stdscreen.nrows = ri->ri_rows;
    217   1.5    tsubai 	fb_stdscreen.ncols = ri->ri_cols;
    218   1.5    tsubai 	fb_stdscreen.textops = &ri->ri_ops;
    219   1.5    tsubai 	fb_stdscreen.capabilities = ri->ri_caps;
    220   1.1    tsubai 
    221   1.1    tsubai 	return 0;
    222   1.1    tsubai }
    223   1.1    tsubai 
    224   1.1    tsubai int
    225  1.19   tsutsui fb_is_console(void)
    226   1.1    tsubai {
    227   1.5    tsubai 	volatile u_int *dipsw = (void *)DIP_SWITCH;
    228   1.1    tsubai 
    229   1.5    tsubai 	if (*dipsw & 7)					/* XXX right? */
    230   1.5    tsubai 		return 1;
    231   1.1    tsubai 
    232   1.1    tsubai 	return 0;
    233   1.1    tsubai }
    234   1.1    tsubai 
    235   1.1    tsubai int
    236  1.23  christos fb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
    237   1.1    tsubai {
    238   1.5    tsubai 	struct fb_softc *sc = v;
    239   1.5    tsubai 	struct fb_devconfig *dc = sc->sc_dc;
    240   1.5    tsubai 	struct wsdisplay_fbinfo *wdf;
    241   1.1    tsubai 
    242   1.5    tsubai 	switch (cmd) {
    243   1.5    tsubai 	case WSDISPLAYIO_GTYPE:
    244   1.5    tsubai 		*(int *)data = WSDISPLAY_TYPE_UNKNOWN;	/* XXX */
    245   1.5    tsubai 		return 0;
    246   1.1    tsubai 
    247   1.5    tsubai 	case WSDISPLAYIO_GINFO:
    248   1.5    tsubai 		wdf = (void *)data;
    249   1.5    tsubai 		wdf->height = dc->dc_ri.ri_height;
    250   1.5    tsubai 		wdf->width = dc->dc_ri.ri_width;
    251   1.5    tsubai 		wdf->depth = dc->dc_ri.ri_depth;
    252   1.5    tsubai 		wdf->cmsize = 2;
    253   1.5    tsubai 		return 0;
    254   1.1    tsubai 
    255   1.5    tsubai 	case WSDISPLAYIO_SVIDEO:
    256   1.5    tsubai 		if (*(int *)data == WSDISPLAYIO_VIDEO_OFF) {
    257   1.5    tsubai 			volatile u_short *ctlreg = NWB253_CTLREG;
    258   1.5    tsubai 			*ctlreg = 0;			/* stop crtc */
    259   1.8    tsubai 		} else
    260   1.8    tsubai 			fb253_init();
    261   1.5    tsubai 		return 0;
    262   1.1    tsubai 
    263   1.5    tsubai 	case WSDISPLAYIO_GETCMAP:
    264   1.5    tsubai 	case WSDISPLAYIO_PUTCMAP:
    265  1.11   thorpej 		break;
    266   1.1    tsubai 	}
    267  1.10    atatat 	return EPASSTHROUGH;
    268   1.1    tsubai }
    269   1.1    tsubai 
    270   1.4    simonb paddr_t
    271  1.22      jmmv fb_mmap(void *v, void *vs, off_t offset, int prot)
    272   1.1    tsubai {
    273   1.5    tsubai 	struct fb_softc *sc = v;
    274   1.5    tsubai 	struct fb_devconfig *dc = sc->sc_dc;
    275   1.1    tsubai 
    276   1.6    tsubai 	if (offset >= 2048 * 2048 / 8 || offset < 0)
    277   1.1    tsubai 		return -1;
    278   1.1    tsubai 
    279   1.5    tsubai 	return mips_btop((int)dc->dc_fbbase + offset);
    280   1.5    tsubai }
    281   1.1    tsubai 
    282   1.5    tsubai int
    283  1.19   tsutsui fb_alloc_screen(void *v, const struct wsscreen_descr *scrdesc, void **cookiep,
    284  1.19   tsutsui     int *ccolp, int *crowp, long *attrp)
    285   1.5    tsubai {
    286   1.5    tsubai 	struct fb_softc *sc = v;
    287   1.5    tsubai 	struct rasops_info *ri = &sc->sc_dc->dc_ri;
    288   1.5    tsubai 	long defattr;
    289   1.5    tsubai 
    290   1.5    tsubai 	if (sc->sc_nscreens > 0)
    291   1.5    tsubai 		return ENOMEM;
    292   1.5    tsubai 
    293   1.5    tsubai 	*cookiep = ri;
    294   1.5    tsubai 	*ccolp = *crowp = 0;
    295  1.12  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    296   1.5    tsubai 	*attrp = defattr;
    297   1.5    tsubai 	sc->sc_nscreens++;
    298   1.1    tsubai 
    299   1.5    tsubai 	return 0;
    300   1.1    tsubai }
    301   1.1    tsubai 
    302   1.5    tsubai void
    303  1.19   tsutsui fb_free_screen(void *v, void *cookie)
    304   1.1    tsubai {
    305   1.5    tsubai 	struct fb_softc *sc = v;
    306   1.5    tsubai 
    307   1.5    tsubai 	if (sc->sc_dc == &fb_console_dc)
    308  1.24   tsutsui 		panic("%s: console", __func__);
    309   1.5    tsubai 
    310   1.5    tsubai 	sc->sc_nscreens--;
    311   1.1    tsubai }
    312   1.1    tsubai 
    313   1.5    tsubai int
    314  1.19   tsutsui fb_show_screen(void *v, void *cookie, int waitok, void (*cb)(void *, int, int),
    315  1.19   tsutsui     void *cbarg)
    316   1.1    tsubai {
    317  1.19   tsutsui 
    318   1.5    tsubai 	return 0;
    319   1.1    tsubai }
    320   1.1    tsubai 
    321   1.5    tsubai void
    322  1.19   tsutsui fb_cnattach(void)
    323   1.1    tsubai {
    324   1.5    tsubai 	struct fb_devconfig *dc = &fb_console_dc;
    325   1.5    tsubai 	struct rasops_info *ri = &dc->dc_ri;
    326   1.5    tsubai 	long defattr;
    327   1.5    tsubai 
    328   1.5    tsubai 	if (!fb_is_console())
    329   1.5    tsubai 		return;
    330   1.5    tsubai 
    331   1.5    tsubai 	dc->dc_fbbase = NWB253_VRAM;
    332   1.5    tsubai 	fb_common_init(dc);
    333   1.5    tsubai 
    334  1.12  junyoung 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    335   1.5    tsubai 	wsdisplay_cnattach(&fb_stdscreen, ri, 0, ri->ri_rows - 1, defattr);
    336   1.5    tsubai }
    337   1.5    tsubai 
    338  1.19   tsutsui static const uint8_t
    339   1.5    tsubai nwp512_data1[] = {
    340   1.5    tsubai 	0x00, 0x44,
    341   1.5    tsubai 	0x01, 0x33,
    342   1.5    tsubai 	0x02, 0x3c,
    343   1.5    tsubai 	0x03, 0x38,
    344   1.5    tsubai 	0x04, 0x84,
    345   1.5    tsubai 	0x05, 0x03,
    346   1.5    tsubai 	0x06, 0x80,
    347   1.5    tsubai 	0x07, 0x80,
    348   1.5    tsubai 	0x08, 0x10,
    349   1.5    tsubai 	0x09, 0x07,
    350   1.5    tsubai 	0x0a, 0x20,
    351   1.5    tsubai 	0x0c, 0x00,
    352   1.5    tsubai 	0x0d, 0x00,
    353   1.5    tsubai 	0x1b, 0x03
    354   1.5    tsubai };
    355   1.1    tsubai 
    356  1.19   tsutsui static const uint8_t
    357   1.5    tsubai nwp512_data2[] = {
    358   1.5    tsubai 	0x1e, 0x08,
    359   1.5    tsubai 	0x20, 0x08,
    360   1.5    tsubai 	0x21, 0x0d
    361   1.5    tsubai };
    362   1.1    tsubai 
    363  1.19   tsutsui static const uint8_t
    364   1.5    tsubai nwp518_data1[] = {
    365   1.5    tsubai 	0x00, 0x52,
    366   1.5    tsubai 	0x01, 0x40,
    367   1.5    tsubai 	0x02, 0x4a,
    368   1.5    tsubai 	0x03, 0x49,
    369   1.5    tsubai 	0x04, 0x63,
    370   1.5    tsubai 	0x05, 0x02,
    371   1.5    tsubai 	0x06, 0x60,
    372   1.5    tsubai 	0x07, 0x60,
    373   1.5    tsubai 	0x08, 0x10,
    374   1.5    tsubai 	0x09, 0x07,
    375   1.5    tsubai 	0x0a, 0x20,
    376   1.5    tsubai 	0x0c, 0x00,
    377   1.5    tsubai 	0x0d, 0x00,
    378   1.5    tsubai 	0x1b, 0x04
    379   1.5    tsubai };
    380   1.1    tsubai 
    381  1.19   tsutsui static const uint8_t
    382   1.5    tsubai nwp518_data2[] = {
    383   1.5    tsubai 	0x1e, 0x08,
    384   1.5    tsubai 	0x20, 0x00,
    385   1.5    tsubai 	0x21, 0x00
    386   1.5    tsubai };
    387   1.1    tsubai 
    388  1.19   tsutsui static const uint8_t
    389   1.5    tsubai nwe501_data1[] = {
    390   1.5    tsubai 	0x00, 0x4b,
    391   1.5    tsubai 	0x01, 0x40,
    392   1.5    tsubai 	0x02, 0x4a,
    393   1.5    tsubai 	0x03, 0x43,
    394   1.5    tsubai 	0x04, 0x64,
    395   1.5    tsubai 	0x05, 0x02,
    396   1.5    tsubai 	0x06, 0x60,
    397   1.5    tsubai 	0x07, 0x60,
    398   1.5    tsubai 	0x08, 0x10,
    399   1.5    tsubai 	0x09, 0x07,
    400   1.5    tsubai 	0x0a, 0x20,
    401   1.5    tsubai 	0x0c, 0x00,
    402   1.5    tsubai 	0x0d, 0x00,
    403   1.5    tsubai 	0x1b, 0x04
    404   1.5    tsubai };
    405   1.1    tsubai 
    406  1.19   tsutsui static const uint8_t
    407   1.5    tsubai nwe501_data2[] = {
    408   1.5    tsubai 	0x1e, 0x08,
    409   1.5    tsubai 	0x20, 0x00,
    410   1.5    tsubai 	0x21, 0x00
    411   1.5    tsubai };
    412   1.1    tsubai 
    413  1.19   tsutsui static const uint8_t
    414   1.5    tsubai *crtc_data[3][2] = {
    415   1.5    tsubai 	{ nwp512_data1, nwp512_data2 },
    416   1.5    tsubai 	{ nwp518_data1, nwp518_data2 },
    417   1.5    tsubai 	{ nwe501_data1, nwe501_data2 }
    418   1.5    tsubai };
    419   1.1    tsubai 
    420   1.1    tsubai static void
    421   1.9      matt fb253_init(void)
    422   1.1    tsubai {
    423  1.24   tsutsui 	volatile uint16_t *ctlreg = NWB253_CTLREG;
    424  1.24   tsutsui 	volatile uint16_t *crtreg = NWB253_CRTREG;
    425   1.8    tsubai 	int id = (*ctlreg >> 8) & 0xf;
    426  1.19   tsutsui 	const uint8_t *p;
    427   1.5    tsubai 	int i;
    428   1.5    tsubai 
    429   1.5    tsubai 	*ctlreg = 0;			/* stop crtc */
    430   1.5    tsubai 	delay(10);
    431   1.5    tsubai 
    432   1.5    tsubai 	/* initialize crtc without R3{0,1,2} */
    433   1.5    tsubai 	p = crtc_data[id][0];
    434   1.5    tsubai 	for (i = 0; i < 28; i++) {
    435   1.5    tsubai 		*crtreg++ = *p++;
    436   1.5    tsubai 		delay(10);
    437   1.5    tsubai 	}
    438   1.5    tsubai 
    439   1.5    tsubai 	*ctlreg = 0x02;			/* start crtc */
    440   1.5    tsubai 	delay(10);
    441   1.5    tsubai 
    442   1.5    tsubai 	/* set crtc control reg */
    443   1.5    tsubai 	p = crtc_data[id][1];
    444   1.5    tsubai 	for (i = 0; i < 6; i++) {
    445   1.5    tsubai 		*crtreg++ = *p++;
    446   1.5    tsubai 		delay(10);
    447   1.5    tsubai 	}
    448   1.5    tsubai }
    449   1.5    tsubai 
    450   1.5    tsubai #if 0
    451   1.5    tsubai static struct wsdisplay_font newsrom8x16;
    452   1.5    tsubai static struct wsdisplay_font newsrom12x24;
    453   1.5    tsubai static char fontarea16[96][32];
    454   1.5    tsubai static char fontarea24[96][96];
    455   1.5    tsubai 
    456   1.5    tsubai void
    457  1.19   tsutsui initfont(struct rasops_info *ri)
    458   1.5    tsubai {
    459   1.5    tsubai 	int c, x;
    460   1.5    tsubai 
    461   1.5    tsubai 	for (c = 0; c < 96; c++) {
    462   1.5    tsubai 		x = ((c & 0x1f) | ((c & 0xe0) << 2)) << 7;
    463  1.19   tsutsui 		memcpy(fontarea16 + c, (char *)0xb8e00000 + x + 96, 32);
    464  1.19   tsutsui 		memcpy(fontarea24 + c, (char *)0xb8e00000 + x, 96);
    465   1.5    tsubai 	}
    466   1.5    tsubai 
    467   1.5    tsubai 	newsrom8x16.name = "rom8x16";
    468   1.5    tsubai 	newsrom8x16.firstchar = 32;
    469   1.5    tsubai 	newsrom8x16.numchars = 96;
    470   1.5    tsubai 	newsrom8x16.encoding = WSDISPLAY_FONTENC_ISO;
    471   1.5    tsubai 	newsrom8x16.fontwidth = 8;
    472   1.5    tsubai 	newsrom8x16.fontheight = 16;
    473   1.5    tsubai 	newsrom8x16.stride = 2;
    474   1.5    tsubai 	newsrom8x16.bitorder = WSDISPLAY_FONTORDER_L2R;
    475   1.5    tsubai 	newsrom8x16.byteorder = WSDISPLAY_FONTORDER_L2R;
    476   1.5    tsubai 	newsrom8x16.data = fontarea16;
    477   1.5    tsubai 
    478   1.5    tsubai 	newsrom12x24.name = "rom12x24";
    479   1.5    tsubai 	newsrom12x24.firstchar = 32;
    480   1.5    tsubai 	newsrom12x24.numchars = 96;
    481   1.5    tsubai 	newsrom12x24.encoding = WSDISPLAY_FONTENC_ISO;
    482   1.5    tsubai 	newsrom12x24.fontwidth = 12;
    483   1.5    tsubai 	newsrom12x24.fontheight = 24;
    484   1.5    tsubai 	newsrom12x24.stride = 4;
    485   1.5    tsubai 	newsrom12x24.bitorder = WSDISPLAY_FONTORDER_L2R;
    486   1.5    tsubai 	newsrom12x24.byteorder = WSDISPLAY_FONTORDER_L2R;
    487   1.5    tsubai 	newsrom12x24.data = fontarea24;
    488   1.5    tsubai 
    489   1.5    tsubai 	ri->ri_font = &newsrom8x16;
    490   1.5    tsubai 	ri->ri_font = &newsrom12x24;
    491   1.5    tsubai 	ri->ri_wsfcookie = -1;		/* not using wsfont */
    492   1.1    tsubai }
    493   1.5    tsubai #endif
    494