Home | History | Annotate | Line # | Download | only in dev
lunafb.c revision 1.26.2.2
      1  1.26.2.1       tls /* $NetBSD: lunafb.c,v 1.26.2.2 2017/12/03 11:36:23 jdolecek Exp $ */
      2       1.1  nisimura 
      3       1.1  nisimura /*-
      4       1.1  nisimura  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5       1.1  nisimura  * All rights reserved.
      6       1.1  nisimura  *
      7       1.1  nisimura  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1  nisimura  * by Tohru Nishimura.
      9       1.1  nisimura  *
     10       1.1  nisimura  * Redistribution and use in source and binary forms, with or without
     11       1.1  nisimura  * modification, are permitted provided that the following conditions
     12       1.1  nisimura  * are met:
     13       1.1  nisimura  * 1. Redistributions of source code must retain the above copyright
     14       1.1  nisimura  *    notice, this list of conditions and the following disclaimer.
     15       1.1  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  nisimura  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  nisimura  *    documentation and/or other materials provided with the distribution.
     18       1.1  nisimura  *
     19       1.1  nisimura  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20       1.1  nisimura  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21       1.1  nisimura  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22       1.1  nisimura  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23       1.1  nisimura  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24       1.1  nisimura  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25       1.1  nisimura  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26       1.1  nisimura  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27       1.1  nisimura  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28       1.1  nisimura  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29       1.1  nisimura  * POSSIBILITY OF SUCH DAMAGE.
     30       1.1  nisimura  */
     31       1.1  nisimura 
     32       1.1  nisimura #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
     33       1.1  nisimura 
     34  1.26.2.1       tls __KERNEL_RCSID(0, "$NetBSD: lunafb.c,v 1.26.2.2 2017/12/03 11:36:23 jdolecek Exp $");
     35       1.1  nisimura 
     36       1.1  nisimura #include <sys/param.h>
     37       1.1  nisimura #include <sys/systm.h>
     38       1.1  nisimura #include <sys/conf.h>
     39       1.1  nisimura #include <sys/device.h>
     40       1.1  nisimura #include <sys/ioctl.h>
     41  1.26.2.1       tls #include <sys/kmem.h>
     42       1.1  nisimura #include <sys/mman.h>
     43       1.1  nisimura #include <sys/proc.h>
     44       1.1  nisimura #include <sys/tty.h>
     45       1.1  nisimura #include <sys/errno.h>
     46       1.1  nisimura #include <sys/buf.h>
     47       1.6       mrg 
     48       1.1  nisimura #include <uvm/uvm_extern.h>
     49       1.1  nisimura 
     50       1.1  nisimura #include <dev/wscons/wsconsio.h>
     51       1.1  nisimura #include <dev/wscons/wsdisplayvar.h>
     52      1.26   tsutsui #include <dev/rasops/rasops.h>
     53       1.1  nisimura 
     54       1.1  nisimura #include <machine/cpu.h>
     55       1.1  nisimura #include <machine/autoconf.h>
     56       1.1  nisimura 
     57      1.26   tsutsui #include <arch/luna68k/dev/omrasopsvar.h>
     58      1.26   tsutsui 
     59      1.24   tsutsui #include "ioconf.h"
     60      1.24   tsutsui 
     61       1.1  nisimura struct bt454 {
     62      1.25   tsutsui 	volatile uint8_t bt_addr;	/* map address register */
     63      1.25   tsutsui 	volatile uint8_t bt_cmap;	/* colormap data register */
     64       1.1  nisimura };
     65       1.1  nisimura 
     66       1.1  nisimura struct bt458 {
     67      1.25   tsutsui 	volatile uint8_t bt_addr;	/* map address register */
     68      1.25   tsutsui 	uint8_t          pad0[3];
     69      1.25   tsutsui 	volatile uint8_t bt_cmap;	/* colormap data register */
     70      1.25   tsutsui 	uint8_t          pad1[3];
     71      1.25   tsutsui 	volatile uint8_t bt_ctrl;	/* control register */
     72      1.25   tsutsui 	uint8_t          pad2[3];
     73      1.25   tsutsui 	volatile uint8_t bt_omap;	/* overlay (cursor) map register */
     74      1.25   tsutsui 	uint8_t          pad3[3];
     75       1.1  nisimura };
     76       1.1  nisimura 
     77       1.1  nisimura #define	OMFB_RFCNT	0xB1000000	/* video h-origin/v-origin */
     78       1.1  nisimura #define	OMFB_RAMDAC	0xC1100000	/* Bt454/Bt458 RAMDAC */
     79  1.26.2.2  jdolecek 
     80      1.11   thorpej #define	OMFB_SIZE	(0xB1300000 - 0xB1080000 + PAGE_SIZE)
     81       1.1  nisimura 
     82  1.26.2.1       tls struct hwcmap {
     83  1.26.2.1       tls #define CMAP_SIZE 256
     84  1.26.2.1       tls 	uint8_t r[CMAP_SIZE];
     85  1.26.2.1       tls 	uint8_t g[CMAP_SIZE];
     86  1.26.2.1       tls 	uint8_t b[CMAP_SIZE];
     87  1.26.2.1       tls };
     88  1.26.2.1       tls 
     89  1.26.2.1       tls static const struct {
     90  1.26.2.1       tls 	uint8_t r;
     91  1.26.2.1       tls 	uint8_t g;
     92  1.26.2.1       tls 	uint8_t b;
     93  1.26.2.1       tls } ansicmap[16] = {
     94  1.26.2.1       tls 	{    0,    0,    0},
     95  1.26.2.1       tls 	{ 0x80,    0,    0},
     96  1.26.2.1       tls 	{    0, 0x80,    0},
     97  1.26.2.1       tls 	{ 0x80, 0x80,    0},
     98  1.26.2.1       tls 	{    0,    0, 0x80},
     99  1.26.2.1       tls 	{ 0x80,    0, 0x80},
    100  1.26.2.1       tls 	{    0, 0x80, 0x80},
    101  1.26.2.1       tls 	{ 0xc0, 0xc0, 0xc0},
    102  1.26.2.1       tls 	{ 0x80, 0x80, 0x80},
    103  1.26.2.1       tls 	{ 0xff,    0,    0},
    104  1.26.2.1       tls 	{    0, 0xff,    0},
    105  1.26.2.1       tls 	{ 0xff, 0xff,    0},
    106  1.26.2.1       tls 	{    0,    0, 0xff},
    107  1.26.2.1       tls 	{ 0xff,    0, 0xff},
    108  1.26.2.1       tls 	{    0, 0xff, 0xff},
    109  1.26.2.1       tls 	{ 0xff, 0xff, 0xff},
    110  1.26.2.1       tls };
    111  1.26.2.1       tls 
    112       1.1  nisimura struct om_hwdevconfig {
    113       1.1  nisimura 	int	dc_wid;			/* width of frame buffer */
    114       1.1  nisimura 	int	dc_ht;			/* height of frame buffer */
    115       1.1  nisimura 	int	dc_depth;		/* depth, bits per pixel */
    116       1.1  nisimura 	int	dc_rowbytes;		/* bytes in a FB scan line */
    117       1.1  nisimura 	int	dc_cmsize;		/* colormap size */
    118  1.26.2.1       tls 	struct hwcmap dc_cmap;		/* software copy of colormap */
    119       1.1  nisimura 	vaddr_t	dc_videobase;		/* base of flat frame buffer */
    120      1.26   tsutsui 	struct rasops_info dc_ri;	/* raster blitter variables */
    121       1.1  nisimura };
    122       1.1  nisimura 
    123       1.1  nisimura struct omfb_softc {
    124      1.24   tsutsui 	device_t sc_dev;		/* base device */
    125       1.1  nisimura 	struct om_hwdevconfig *sc_dc;	/* device configuration */
    126  1.26.2.1       tls 	int sc_nscreens;
    127  1.26.2.1       tls 	int sc_mode;
    128       1.1  nisimura };
    129       1.1  nisimura 
    130      1.17       dsl static int  omgetcmap(struct omfb_softc *, struct wsdisplay_cmap *);
    131      1.17       dsl static int  omsetcmap(struct omfb_softc *, struct wsdisplay_cmap *);
    132       1.1  nisimura 
    133       1.1  nisimura static struct om_hwdevconfig omfb_console_dc;
    134  1.26.2.1       tls static void omfb_resetcmap(struct om_hwdevconfig *);
    135      1.17       dsl static void omfb_getdevconfig(paddr_t, struct om_hwdevconfig *);
    136       1.1  nisimura 
    137       1.1  nisimura static struct wsscreen_descr omfb_stdscreen = {
    138      1.26   tsutsui 	.name = "std"
    139       1.1  nisimura };
    140       1.1  nisimura 
    141       1.1  nisimura static const struct wsscreen_descr *_omfb_scrlist[] = {
    142       1.1  nisimura 	&omfb_stdscreen,
    143       1.1  nisimura };
    144       1.1  nisimura 
    145       1.1  nisimura static const struct wsscreen_list omfb_screenlist = {
    146       1.1  nisimura 	sizeof(_omfb_scrlist) / sizeof(struct wsscreen_descr *), _omfb_scrlist
    147       1.1  nisimura };
    148       1.1  nisimura 
    149      1.25   tsutsui static int   omfbioctl(void *, void *, u_long, void *, int, struct lwp *);
    150      1.17       dsl static paddr_t omfbmmap(void *, void *, off_t, int);
    151      1.17       dsl static int   omfb_alloc_screen(void *, const struct wsscreen_descr *,
    152      1.25   tsutsui 			       void **, int *, int *, long *);
    153      1.17       dsl static void  omfb_free_screen(void *, void *);
    154      1.17       dsl static int   omfb_show_screen(void *, void *, int,
    155      1.25   tsutsui 			      void (*) (void *, int, int), void *);
    156       1.1  nisimura 
    157       1.1  nisimura static const struct wsdisplay_accessops omfb_accessops = {
    158  1.26.2.1       tls 	.ioctl        = omfbioctl,
    159  1.26.2.1       tls 	.mmap         = omfbmmap,
    160  1.26.2.1       tls 	.alloc_screen = omfb_alloc_screen,
    161  1.26.2.1       tls 	.free_screen  = omfb_free_screen,
    162  1.26.2.1       tls 	.show_screen  = omfb_show_screen,
    163  1.26.2.1       tls 	.load_font    = NULL,
    164  1.26.2.1       tls 	.pollc        = NULL,
    165  1.26.2.1       tls 	.scroll       = NULL
    166       1.1  nisimura };
    167       1.1  nisimura 
    168      1.24   tsutsui static int  omfbmatch(device_t, cfdata_t, void *);
    169      1.24   tsutsui static void omfbattach(device_t, device_t, void *);
    170       1.1  nisimura 
    171      1.24   tsutsui CFATTACH_DECL_NEW(fb, sizeof(struct omfb_softc),
    172      1.10   thorpej     omfbmatch, omfbattach, NULL, NULL);
    173       1.1  nisimura 
    174       1.1  nisimura extern int hwplanemask;	/* hardware planemask; retrieved at boot */
    175       1.1  nisimura 
    176       1.1  nisimura static int omfb_console;
    177      1.17       dsl int  omfb_cnattach(void);
    178       1.1  nisimura 
    179       1.1  nisimura static int
    180      1.24   tsutsui omfbmatch(device_t parent, cfdata_t cf, void *aux)
    181       1.1  nisimura {
    182       1.1  nisimura 	struct mainbus_attach_args *ma = aux;
    183       1.1  nisimura 
    184       1.1  nisimura 	if (strcmp(ma->ma_name, fb_cd.cd_name))
    185      1.25   tsutsui 		return 0;
    186       1.4  nisimura #if 0	/* XXX badaddr() bombs if no framebuffer is installed */
    187      1.15  christos 	if (badaddr((void *)ma->ma_addr, 4))
    188      1.25   tsutsui 		return 0;
    189       1.3  nisimura #else
    190       1.3  nisimura 	if (hwplanemask == 0)
    191      1.25   tsutsui 		return 0;
    192       1.3  nisimura #endif
    193      1.25   tsutsui 	return 1;
    194       1.1  nisimura }
    195       1.1  nisimura 
    196       1.1  nisimura static void
    197      1.24   tsutsui omfbattach(device_t parent, device_t self, void *args)
    198       1.1  nisimura {
    199      1.24   tsutsui 	struct omfb_softc *sc = device_private(self);
    200       1.1  nisimura 	struct wsemuldisplaydev_attach_args waa;
    201       1.1  nisimura 
    202      1.24   tsutsui 	sc->sc_dev = self;
    203      1.24   tsutsui 
    204       1.1  nisimura 	if (omfb_console) {
    205       1.1  nisimura 		sc->sc_dc = &omfb_console_dc;
    206  1.26.2.1       tls 		sc->sc_nscreens = 1;
    207      1.25   tsutsui 	} else {
    208  1.26.2.1       tls 		sc->sc_dc = kmem_zalloc(sizeof(struct om_hwdevconfig),
    209  1.26.2.1       tls 		    KM_SLEEP);
    210       1.1  nisimura 		omfb_getdevconfig(OMFB_FB_WADDR, sc->sc_dc);
    211       1.1  nisimura 	}
    212      1.24   tsutsui 	aprint_normal(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
    213       1.1  nisimura 	    sc->sc_dc->dc_depth);
    214       1.1  nisimura 
    215  1.26.2.1       tls 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    216       1.1  nisimura 	waa.console = omfb_console;
    217       1.1  nisimura 	waa.scrdata = &omfb_screenlist;
    218       1.1  nisimura 	waa.accessops = &omfb_accessops;
    219       1.1  nisimura 	waa.accesscookie = sc;
    220       1.1  nisimura 
    221       1.1  nisimura 	config_found(self, &waa, wsemuldisplaydevprint);
    222       1.1  nisimura }
    223       1.1  nisimura 
    224       1.1  nisimura /* EXPORT */ int
    225      1.21    cegger omfb_cnattach(void)
    226       1.1  nisimura {
    227       1.1  nisimura 	struct om_hwdevconfig *dc = &omfb_console_dc;
    228      1.26   tsutsui 	struct rasops_info *ri = &dc->dc_ri;
    229       1.1  nisimura 	long defattr;
    230       1.1  nisimura 
    231       1.1  nisimura 	omfb_getdevconfig(OMFB_FB_WADDR, dc);
    232      1.26   tsutsui 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    233      1.26   tsutsui 	wsdisplay_cnattach(&omfb_stdscreen, ri, 0, 0, defattr);
    234       1.1  nisimura 	omfb_console = 1;
    235      1.25   tsutsui 	return 0;
    236       1.1  nisimura }
    237       1.1  nisimura 
    238       1.1  nisimura static int
    239      1.18       dsl omfbioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
    240       1.1  nisimura {
    241       1.1  nisimura 	struct omfb_softc *sc = v;
    242       1.1  nisimura 	struct om_hwdevconfig *dc = sc->sc_dc;
    243  1.26.2.1       tls 	int new_mode;
    244       1.1  nisimura 
    245       1.1  nisimura 	switch (cmd) {
    246       1.1  nisimura 	case WSDISPLAYIO_GTYPE:
    247      1.23   tsutsui 		*(u_int *)data = WSDISPLAY_TYPE_LUNA;
    248      1.25   tsutsui 		return 0;
    249       1.1  nisimura 
    250       1.1  nisimura 	case WSDISPLAYIO_GINFO:
    251       1.1  nisimura #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    252       1.1  nisimura 		wsd_fbip->height = dc->dc_ht;
    253       1.1  nisimura 		wsd_fbip->width = dc->dc_wid;
    254       1.1  nisimura 		wsd_fbip->depth = dc->dc_depth;
    255       1.1  nisimura 		wsd_fbip->cmsize = dc->dc_cmsize;
    256       1.1  nisimura #undef fbt
    257      1.25   tsutsui 		return 0;
    258       1.1  nisimura 
    259      1.22   tsutsui 	case WSDISPLAYIO_LINEBYTES:
    260      1.22   tsutsui 		*(u_int *)data = dc->dc_rowbytes;
    261      1.22   tsutsui 		return 0;
    262      1.22   tsutsui 
    263       1.1  nisimura 	case WSDISPLAYIO_GETCMAP:
    264       1.1  nisimura 		return omgetcmap(sc, (struct wsdisplay_cmap *)data);
    265       1.1  nisimura 
    266       1.1  nisimura 	case WSDISPLAYIO_PUTCMAP:
    267       1.1  nisimura 		return omsetcmap(sc, (struct wsdisplay_cmap *)data);
    268       1.1  nisimura 
    269  1.26.2.1       tls 	case WSDISPLAYIO_SMODE:
    270  1.26.2.1       tls 		new_mode = *(int *)data;
    271  1.26.2.1       tls 		if (new_mode != sc->sc_mode) {
    272  1.26.2.1       tls 			sc->sc_mode = new_mode;
    273  1.26.2.1       tls 			if (new_mode == WSDISPLAYIO_MODE_EMUL)
    274  1.26.2.1       tls 				omfb_resetcmap(dc);
    275  1.26.2.1       tls 		}
    276  1.26.2.1       tls 		return 0;
    277  1.26.2.1       tls 
    278       1.1  nisimura 	case WSDISPLAYIO_SVIDEO:
    279       1.1  nisimura 	case WSDISPLAYIO_GVIDEO:
    280       1.1  nisimura 	case WSDISPLAYIO_GCURPOS:
    281       1.1  nisimura 	case WSDISPLAYIO_SCURPOS:
    282       1.1  nisimura 	case WSDISPLAYIO_GCURMAX:
    283       1.1  nisimura 	case WSDISPLAYIO_GCURSOR:
    284       1.1  nisimura 	case WSDISPLAYIO_SCURSOR:
    285       1.1  nisimura 		break;
    286       1.1  nisimura 	}
    287      1.25   tsutsui 	return EPASSTHROUGH;
    288       1.1  nisimura }
    289       1.1  nisimura 
    290       1.1  nisimura /*
    291       1.1  nisimura  * Return the address that would map the given device at the given
    292       1.1  nisimura  * offset, allowing for the given protection, or return -1 for error.
    293       1.1  nisimura  */
    294       1.5    simonb static paddr_t
    295      1.18       dsl omfbmmap(void *v, void *vs, off_t offset, int prot)
    296       1.1  nisimura {
    297       1.1  nisimura 	struct omfb_softc *sc = v;
    298      1.22   tsutsui 	struct om_hwdevconfig *dc = sc->sc_dc;
    299      1.22   tsutsui 	paddr_t cookie = -1;
    300       1.1  nisimura 
    301  1.26.2.1       tls 	switch (sc->sc_mode) {
    302  1.26.2.1       tls #if 0
    303  1.26.2.1       tls 	case WSDISPLAYIO_MODE_MAPPED:
    304  1.26.2.1       tls 		if (offset >= 0 && offset < OMFB_SIZE)
    305  1.26.2.1       tls 			cookie = m68k_btop(m68k_trunc_page(dc->dc_videobase) +
    306  1.26.2.1       tls 			    offset);
    307  1.26.2.1       tls 		break;
    308      1.22   tsutsui #endif
    309  1.26.2.1       tls 	case WSDISPLAYIO_MODE_DUMBFB:
    310  1.26.2.1       tls 		if (offset >= 0 &&
    311  1.26.2.1       tls 		    offset < dc->dc_rowbytes * dc->dc_ht * dc->dc_depth)
    312  1.26.2.1       tls 			cookie = m68k_btop(m68k_trunc_page(OMFB_FB_RADDR) +
    313  1.26.2.1       tls 			    offset);
    314  1.26.2.1       tls 		break;
    315  1.26.2.1       tls 	}
    316      1.22   tsutsui 
    317      1.22   tsutsui 	return cookie;
    318       1.1  nisimura }
    319       1.1  nisimura 
    320       1.1  nisimura static int
    321      1.18       dsl omgetcmap(struct omfb_softc *sc, struct wsdisplay_cmap *p)
    322       1.1  nisimura {
    323       1.1  nisimura 	u_int index = p->index, count = p->count;
    324      1.12       chs 	int cmsize, error;
    325       1.1  nisimura 
    326       1.1  nisimura 	cmsize = sc->sc_dc->dc_cmsize;
    327       1.9    itojun 	if (index >= cmsize || count > cmsize - index)
    328      1.25   tsutsui 		return EINVAL;
    329       1.1  nisimura 
    330  1.26.2.1       tls 	error = copyout(&sc->sc_dc->dc_cmap.r[index], p->red, count);
    331      1.12       chs 	if (error)
    332      1.12       chs 		return error;
    333  1.26.2.1       tls 	error = copyout(&sc->sc_dc->dc_cmap.g[index], p->green, count);
    334      1.12       chs 	if (error)
    335      1.12       chs 		return error;
    336  1.26.2.1       tls 	error = copyout(&sc->sc_dc->dc_cmap.b[index], p->blue, count);
    337      1.12       chs 	return error;
    338       1.1  nisimura }
    339       1.1  nisimura 
    340       1.1  nisimura static int
    341      1.18       dsl omsetcmap(struct omfb_softc *sc, struct wsdisplay_cmap *p)
    342       1.1  nisimura {
    343      1.12       chs 	struct hwcmap cmap;
    344       1.1  nisimura 	u_int index = p->index, count = p->count;
    345      1.12       chs 	int cmsize, i, error;
    346       1.1  nisimura 
    347       1.1  nisimura 	cmsize = sc->sc_dc->dc_cmsize;
    348       1.1  nisimura 	if (index >= cmsize || (index + count) > cmsize)
    349       1.1  nisimura 		return (EINVAL);
    350       1.1  nisimura 
    351      1.12       chs 	error = copyin(p->red, &cmap.r[index], count);
    352      1.12       chs 	if (error)
    353      1.12       chs 		return error;
    354      1.12       chs 	error = copyin(p->green, &cmap.g[index], count);
    355      1.12       chs 	if (error)
    356      1.12       chs 		return error;
    357      1.12       chs 	error = copyin(p->blue, &cmap.b[index], count);
    358      1.12       chs 	if (error)
    359      1.12       chs 		return error;
    360      1.12       chs 
    361  1.26.2.1       tls 	memcpy(&sc->sc_dc->dc_cmap.r[index], &cmap.r[index], count);
    362  1.26.2.1       tls 	memcpy(&sc->sc_dc->dc_cmap.g[index], &cmap.g[index], count);
    363  1.26.2.1       tls 	memcpy(&sc->sc_dc->dc_cmap.b[index], &cmap.b[index], count);
    364       1.1  nisimura 	if (hwplanemask == 0x0f) {
    365       1.1  nisimura 		struct bt454 *odac = (struct bt454 *)OMFB_RAMDAC;
    366       1.1  nisimura 		odac->bt_addr = index;
    367      1.22   tsutsui 		for (i = index; i < index + count; i++) {
    368  1.26.2.1       tls 			odac->bt_cmap = sc->sc_dc->dc_cmap.r[i];
    369  1.26.2.1       tls 			odac->bt_cmap = sc->sc_dc->dc_cmap.g[i];
    370  1.26.2.1       tls 			odac->bt_cmap = sc->sc_dc->dc_cmap.b[i];
    371       1.1  nisimura 		}
    372      1.25   tsutsui 	} else if (hwplanemask == 0xff) {
    373       1.1  nisimura 		struct bt458 *ndac = (struct bt458 *)OMFB_RAMDAC;
    374       1.1  nisimura 		ndac->bt_addr = index;
    375      1.22   tsutsui 		for (i = index; i < index + count; i++) {
    376  1.26.2.1       tls 			ndac->bt_cmap = sc->sc_dc->dc_cmap.r[i];
    377  1.26.2.1       tls 			ndac->bt_cmap = sc->sc_dc->dc_cmap.g[i];
    378  1.26.2.1       tls 			ndac->bt_cmap = sc->sc_dc->dc_cmap.b[i];
    379       1.1  nisimura 		}
    380       1.1  nisimura 	}
    381      1.25   tsutsui 	return 0;
    382       1.1  nisimura }
    383       1.1  nisimura 
    384       1.1  nisimura static void
    385  1.26.2.1       tls omfb_resetcmap(struct om_hwdevconfig *dc)
    386  1.26.2.1       tls {
    387  1.26.2.1       tls 	int i;
    388  1.26.2.1       tls 
    389  1.26.2.1       tls 	if (hwplanemask == 0x01) {
    390  1.26.2.1       tls 		struct bt454 *odac = (struct bt454 *)OMFB_RAMDAC;
    391  1.26.2.1       tls 
    392  1.26.2.1       tls 		/*
    393  1.26.2.1       tls 		 * On 1bpp framebuffer, only plane P0 has framebuffer memory
    394  1.26.2.1       tls 		 * and other planes seems pulled up, i.e. always 1.
    395  1.26.2.1       tls 		 * Set white only for a palette (P0,P1,P2,P3) = (1,1,1,1).
    396  1.26.2.1       tls 		 */
    397  1.26.2.1       tls 		odac->bt_addr = 0;
    398  1.26.2.1       tls 		for (i = 0; i < 15; i++) {
    399  1.26.2.1       tls 			odac->bt_cmap = dc->dc_cmap.r[i] = 0;
    400  1.26.2.1       tls 			odac->bt_cmap = dc->dc_cmap.g[i] = 0;
    401  1.26.2.1       tls 			odac->bt_cmap = dc->dc_cmap.b[i] = 0;
    402  1.26.2.1       tls 		}
    403  1.26.2.1       tls 		/*
    404  1.26.2.1       tls 		 * The B/W video connector is connected to IOG of Bt454,
    405  1.26.2.1       tls 		 * and IOR and IOB are unused.
    406  1.26.2.1       tls 		 */
    407  1.26.2.1       tls 		odac->bt_cmap = dc->dc_cmap.r[15] = 0;
    408  1.26.2.1       tls 		odac->bt_cmap = dc->dc_cmap.g[15] = 255;
    409  1.26.2.1       tls 		odac->bt_cmap = dc->dc_cmap.b[15] = 0;
    410  1.26.2.1       tls 	} else if (hwplanemask == 0x0f) {
    411  1.26.2.1       tls 		struct bt454 *odac = (struct bt454 *)OMFB_RAMDAC;
    412  1.26.2.1       tls 
    413  1.26.2.1       tls 		odac->bt_addr = 0;
    414  1.26.2.1       tls 		for (i = 0; i < 16; i++) {
    415  1.26.2.1       tls 			odac->bt_cmap = dc->dc_cmap.r[i] = ansicmap[i].r;
    416  1.26.2.1       tls 			odac->bt_cmap = dc->dc_cmap.g[i] = ansicmap[i].g;
    417  1.26.2.1       tls 			odac->bt_cmap = dc->dc_cmap.b[i] = ansicmap[i].b;
    418  1.26.2.1       tls 		}
    419  1.26.2.1       tls 	} else if (hwplanemask == 0xff) {
    420  1.26.2.1       tls 		struct bt458 *ndac = (struct bt458 *)OMFB_RAMDAC;
    421  1.26.2.1       tls 
    422  1.26.2.1       tls 		/*
    423  1.26.2.1       tls 		 * Initialize the Bt458.  When we write to control registers,
    424  1.26.2.1       tls 		 * the address is not incremented automatically. So we specify
    425  1.26.2.1       tls 		 * it ourselves for each control register.
    426  1.26.2.1       tls 		 */
    427  1.26.2.1       tls 		ndac->bt_addr = 0x04;
    428  1.26.2.1       tls 		ndac->bt_ctrl = 0xff; /* all planes will be read */
    429  1.26.2.1       tls 		ndac->bt_addr = 0x05;
    430  1.26.2.1       tls 		ndac->bt_ctrl = 0x00; /* all planes have non-blink */
    431  1.26.2.1       tls 		ndac->bt_addr = 0x06;
    432  1.26.2.1       tls 		ndac->bt_ctrl = 0x40; /* pallete enabled, ovly plane disabled */
    433  1.26.2.1       tls 		ndac->bt_addr = 0x07;
    434  1.26.2.1       tls 		ndac->bt_ctrl = 0x00; /* no test mode */
    435  1.26.2.1       tls 
    436  1.26.2.1       tls 		/*
    437  1.26.2.1       tls 		 * Set ANSI 16 colors.  We only supports 4bpp console right
    438  1.26.2.1       tls 		 * now, repeat 16 colors in 256 colormap.
    439  1.26.2.1       tls 		 */
    440  1.26.2.1       tls 		ndac->bt_addr = 0;
    441  1.26.2.1       tls 		for (i = 0; i < 256; i++) {
    442  1.26.2.1       tls 			ndac->bt_cmap = dc->dc_cmap.r[i] = ansicmap[i % 16].r;
    443  1.26.2.1       tls 			ndac->bt_cmap = dc->dc_cmap.g[i] = ansicmap[i % 16].g;
    444  1.26.2.1       tls 			ndac->bt_cmap = dc->dc_cmap.b[i] = ansicmap[i % 16].b;
    445  1.26.2.1       tls 		}
    446  1.26.2.1       tls 	}
    447  1.26.2.1       tls }
    448  1.26.2.1       tls 
    449  1.26.2.1       tls static void
    450      1.18       dsl omfb_getdevconfig(paddr_t paddr, struct om_hwdevconfig *dc)
    451       1.1  nisimura {
    452       1.1  nisimura 	int bpp, i;
    453      1.26   tsutsui 	struct rasops_info *ri;
    454       1.4  nisimura 	union {
    455       1.4  nisimura 		struct { short h, v; } p;
    456      1.25   tsutsui 		uint32_t u;
    457       1.4  nisimura 	} rfcnt;
    458       1.1  nisimura 
    459       1.1  nisimura 	switch (hwplanemask) {
    460       1.1  nisimura 	case 0xff:
    461       1.1  nisimura 		bpp = 8;	/* XXX check monochrome bit in DIPSW */
    462       1.1  nisimura 		break;
    463       1.1  nisimura 	default:
    464       1.1  nisimura 	case 0x0f:
    465       1.1  nisimura 		bpp = 4;	/* XXX check monochrome bit in DIPSW */
    466       1.1  nisimura 		break;
    467       1.1  nisimura 	case 1:
    468       1.1  nisimura 		bpp = 1;
    469       1.1  nisimura 		break;
    470       1.1  nisimura 	}
    471       1.2  nisimura 	dc->dc_wid = 1280;
    472       1.1  nisimura 	dc->dc_ht = 1024;
    473       1.1  nisimura 	dc->dc_depth = bpp;
    474       1.1  nisimura 	dc->dc_rowbytes = 2048 / 8;
    475       1.1  nisimura 	dc->dc_cmsize = (bpp == 1) ? 0 : 1 << bpp;
    476       1.1  nisimura 	dc->dc_videobase = paddr;
    477       1.1  nisimura 
    478  1.26.2.1       tls 	omfb_resetcmap(dc);
    479       1.1  nisimura 
    480      1.26   tsutsui 	/* adjust h/v origin on screen */
    481       1.4  nisimura 	rfcnt.p.h = 7;
    482       1.4  nisimura 	rfcnt.p.v = -27;
    483      1.22   tsutsui 	/* single write of 0x007ffe6 */
    484      1.25   tsutsui 	*(volatile uint32_t *)OMFB_RFCNT = rfcnt.u;
    485       1.1  nisimura 
    486       1.1  nisimura 	/* clear the screen */
    487      1.25   tsutsui 	*(volatile uint32_t *)OMFB_PLANEMASK = 0xff;
    488      1.25   tsutsui 	((volatile uint32_t *)OMFB_ROPFUNC)[5] = ~0;	/* ROP copy */
    489      1.26   tsutsui 	for (i = 0; i < dc->dc_ht * dc->dc_rowbytes / sizeof(uint32_t); i++)
    490      1.25   tsutsui 		*((volatile uint32_t *)dc->dc_videobase + i) = 0;
    491      1.25   tsutsui 	*(volatile uint32_t *)OMFB_PLANEMASK = 0x01;
    492       1.1  nisimura 
    493       1.1  nisimura 	/* initialize the raster */
    494      1.26   tsutsui 	ri = &dc->dc_ri;
    495      1.26   tsutsui 	ri->ri_width = dc->dc_wid;
    496      1.26   tsutsui 	ri->ri_height = dc->dc_ht;
    497      1.26   tsutsui 	ri->ri_depth = 1;       /* since planes are independently addressed */
    498      1.26   tsutsui 	ri->ri_stride = dc->dc_rowbytes;
    499      1.26   tsutsui 	ri->ri_bits = (void *)dc->dc_videobase;
    500      1.26   tsutsui 	ri->ri_flg = RI_CENTER;
    501      1.26   tsutsui 	if (dc == &omfb_console_dc)
    502      1.26   tsutsui 		ri->ri_flg |= RI_NO_AUTO;
    503      1.26   tsutsui 	ri->ri_hw = dc;
    504      1.26   tsutsui 
    505  1.26.2.1       tls 	if (bpp == 4 || bpp == 8)
    506  1.26.2.1       tls 		omrasops4_init(ri, 34, 80);
    507  1.26.2.1       tls 	else
    508  1.26.2.1       tls 		omrasops1_init(ri, 34, 80);
    509      1.26   tsutsui 
    510      1.26   tsutsui 	omfb_stdscreen.nrows = ri->ri_rows;
    511      1.26   tsutsui 	omfb_stdscreen.ncols = ri->ri_cols;
    512      1.26   tsutsui 	omfb_stdscreen.textops = &ri->ri_ops;
    513  1.26.2.1       tls 	omfb_stdscreen.capabilities = ri->ri_caps;
    514      1.26   tsutsui 	omfb_stdscreen.fontwidth = ri->ri_font->fontwidth;
    515      1.26   tsutsui 	omfb_stdscreen.fontheight = ri->ri_font->fontheight;
    516       1.1  nisimura }
    517       1.1  nisimura 
    518       1.1  nisimura static int
    519      1.25   tsutsui omfb_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
    520      1.25   tsutsui     int *curxp, int *curyp, long *attrp)
    521       1.1  nisimura {
    522       1.1  nisimura 	struct omfb_softc *sc = v;
    523      1.26   tsutsui 	struct rasops_info *ri = &sc->sc_dc->dc_ri;
    524       1.1  nisimura 
    525  1.26.2.1       tls 	if (sc->sc_nscreens > 0)
    526      1.25   tsutsui 		return ENOMEM;
    527       1.1  nisimura 
    528      1.26   tsutsui 	*cookiep = ri;
    529       1.1  nisimura 	*curxp = 0;
    530       1.1  nisimura 	*curyp = 0;
    531      1.26   tsutsui 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, attrp);
    532  1.26.2.1       tls 	sc->sc_nscreens++;
    533      1.25   tsutsui 	return 0;
    534       1.1  nisimura }
    535       1.1  nisimura 
    536       1.1  nisimura static void
    537      1.18       dsl omfb_free_screen(void *v, void *cookie)
    538       1.1  nisimura {
    539       1.1  nisimura 	struct omfb_softc *sc = v;
    540       1.1  nisimura 
    541       1.1  nisimura 	if (sc->sc_dc == &omfb_console_dc)
    542       1.1  nisimura 		panic("omfb_free_screen: console");
    543       1.1  nisimura 
    544  1.26.2.1       tls 	sc->sc_nscreens--;
    545       1.1  nisimura }
    546       1.1  nisimura 
    547       1.1  nisimura static int
    548      1.25   tsutsui omfb_show_screen(void *v, void *cookie, int waitok,
    549      1.25   tsutsui     void (*cb)(void *, int, int), void *cbarg)
    550       1.1  nisimura {
    551      1.25   tsutsui 
    552       1.1  nisimura 	return 0;
    553       1.1  nisimura }
    554