Home | History | Annotate | Line # | Download | only in dev
      1 /*	$NetBSD: pvr.c,v 1.39 2021/08/07 16:18:47 thorpej Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2001 Marcus Comstedt.
      5  * Copyright (c) 2001 Jason R. Thorpe.
      6  * All rights reserved.
      7  *
      8  * Redistribution and use in source and binary forms, with or without
      9  * modification, are permitted provided that the following conditions
     10  * are met:
     11  * 1. Redistributions of source code must retain the above copyright
     12  *    notice, this list of conditions and the following disclaimer.
     13  * 2. Redistributions in binary form must reproduce the above copyright
     14  *    notice, this list of conditions and the following disclaimer in the
     15  *    documentation and/or other materials provided with the distribution.
     16  * 3. All advertising materials mentioning features or use of this software
     17  *    must display the following acknowledgement:
     18  *	This product includes software developed by Marcus Comstedt.
     19  * 4. Neither the name of The NetBSD Foundation nor the names of its
     20  *    contributors may be used to endorse or promote products derived
     21  *    from this software without specific prior written permission.
     22  *
     23  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     24  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     25  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     26  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     27  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     28  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     29  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     30  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     31  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     32  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     33  * POSSIBILITY OF SUCH DAMAGE.
     34  */
     35 
     36 #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
     37 
     38 __KERNEL_RCSID(0, "$NetBSD: pvr.c,v 1.39 2021/08/07 16:18:47 thorpej Exp $");
     39 
     40 #include <sys/param.h>
     41 #include <sys/systm.h>
     42 #include <sys/kernel.h>
     43 #include <sys/device.h>
     44 #include <sys/malloc.h>
     45 #include <sys/buf.h>
     46 #include <sys/ioctl.h>
     47 #include <sys/bus.h>
     48 
     49 #include <machine/vmparam.h>
     50 #include <machine/cpu.h>
     51 
     52 #include <dev/cons.h>
     53 
     54 #include <dev/wscons/wsconsio.h>
     55 #include <dev/wscons/wsdisplayvar.h>
     56 
     57 #include <dev/wscons/wscons_callbacks.h>
     58 
     59 #include <dev/rasops/rasops.h>
     60 #include <dev/wsfont/wsfont.h>
     61 
     62 #include <dreamcast/dev/pvrvar.h>
     63 #include <dreamcast/dev/maple/mkbdvar.h>
     64 
     65 #include "mkbd.h"
     66 
     67 #define	PVRREG_FBSTART		0x05000000
     68 #define	PVRREG_REGSTART		0x005f8000
     69 
     70 #define	PVRREG_BRDCOLR		0x40
     71 #define	BRDCOLR_BLUE(x)		((x) << 0)
     72 #define	BRDCOLR_GREEN(x)	((x) << 8)
     73 #define	BRDCOLR_RED(x)		((x) << 16)
     74 
     75 #define	PVRREG_DIWMODE		0x44
     76 #define	DIWMODE_DE		(1U << 0)	/* display enable */
     77 #define	DIWMODE_SD		(1U << 1)	/* scan double enable */
     78 #define	DIWMODE_COL(x)		((x) << 2)
     79 #define	DIWMODE_COL_RGB555	DIWMODE_COL(0)	/* RGB555, 16-bit */
     80 #define	DIWMODE_COL_RGB565	DIWMODE_COL(1)	/* RGB565, 16-bit */
     81 #define	DIWMODE_COL_RGB888	DIWMODE_COL(2)	/* RGB888, 24-bit */
     82 #define	DIWMODE_COL_ARGB888	DIWMODE_COL(3)	/* RGB888, 32-bit */
     83 #define	DIWMODE_C		(1U << 23)	/* 2x clock enable (VGA) */
     84 
     85 #define	PVRREG_DIWADDRL		0x50
     86 
     87 #define	PVRREG_DIWADDRS		0x54
     88 
     89 #define	PVRREG_DIWSIZE		0x5c
     90 #define	DIWSIZE_DPL(x)		((x) << 0)	/* pixel data per line */
     91 #define	DIWSIZE_LPF(x)		((x) << 10)	/* lines per field */
     92 #define	DIWSIZE_MODULO(x)	((x) << 20)	/* words to skip + 1 */
     93 
     94 #define	PVRREG_RASEVTPOS	0xcc
     95 #define	RASEVTPOS_BOTTOM(x)	((x) << 0)
     96 #define	RASEVTPOS_TOP(x)	((x) << 16)
     97 
     98 #define	PVRREG_SYNCCONF		0xd0
     99 #define	SYNCCONF_VP		(1U << 0)	/* V-sync polarity */
    100 #define	SYNCCONF_HP		(1U << 1)	/* H-sync polarity */
    101 #define	SYNCCONF_I		(1U << 4)	/* interlace */
    102 #define	SYNCCONF_BC(x)		(1U << 6)	/* broadcast standard */
    103 #define	SYNCCONF_VO		(1U << 8)	/* video output enable */
    104 
    105 #define	PVRREG_BRDHORZ		0xd4
    106 #define	BRDHORZ_STOP(x)		((x) << 0)
    107 #define	BRDHORZ_START(x)	((x) << 16)
    108 
    109 #define	PVRREG_SYNCSIZE		0xd8
    110 #define	SYNCSIZE_H(x)		((x) << 0)
    111 #define	SYNCSIZE_V(x)		((x) << 16)
    112 
    113 #define	PVRREG_BRDVERT		0xdc
    114 #define	BRDVERT_STOP(x)		((x) << 0)
    115 #define	BRDVERT_START(x)	((x) << 16)
    116 
    117 #define	PVRREG_DIWCONF		0xe8
    118 #define	DIWCONF_LR		(1U << 8)	/* low-res */
    119 #define	DIWCONF_MAGIC		(22 << 16)
    120 
    121 #define	PVRREG_DIWHSTRT		0xec
    122 
    123 #define	PVRREG_DIWVSTRT		0xf0
    124 #define	DIWVSTRT_V1(x)		((x) << 0)
    125 #define	DIWVSTRT_V2(x)		((x) << 16)
    126 
    127 #define	PVR_REG_READ(dc, reg)						\
    128 	((volatile uint32_t *)(dc)->dc_regvaddr)[(reg) >> 2]
    129 #define	PVR_REG_WRITE(dc, reg, val)					\
    130 	((volatile uint32_t *)(dc)->dc_regvaddr)[(reg) >> 2] = (val)
    131 
    132 struct fb_devconfig {
    133 	vaddr_t dc_vaddr;		/* framebuffer virtual address */
    134 	vaddr_t dc_paddr;		/* framebuffer physical address */
    135 	vaddr_t dc_regvaddr;		/* registers virtual address */
    136 	vaddr_t dc_regpaddr;		/* registers physical address */
    137 	int	dc_wid;			/* width of frame buffer */
    138 	int	dc_ht;			/* height of frame buffer */
    139 	int	dc_depth;		/* depth, bits per pixel */
    140 	int	dc_rowbytes;		/* bytes in a FB scan line */
    141 	vaddr_t	dc_videobase;		/* base of flat frame buffer */
    142 	int	dc_blanked;		/* currently has video disabled */
    143 	int	dc_dispflags;		/* display flags */
    144 	int	dc_tvsystem;		/* TV broadcast system */
    145 
    146 	struct rasops_info dc_rinfo;
    147 
    148 	char dc_wsscrname[32];
    149 	struct wsscreen_descr dc_wsscrdescr;
    150 };
    151 
    152 #define	PVR_RGBMODE	0x01		/* RGB or composite */
    153 #define	PVR_VGAMODE	0x02		/* VGA */
    154 
    155 struct pvr_softc {
    156 	device_t sc_dev;
    157 	struct fb_devconfig *sc_dc;	/* device configuration */
    158 	int sc_nscreens;
    159 	const struct wsscreen_descr *sc_scrdescs[1];
    160 	struct wsscreen_list sc_scrlist;
    161 };
    162 
    163 static int	pvr_match(device_t, cfdata_t, void *);
    164 static void	pvr_attach(device_t, device_t, void *);
    165 
    166 CFATTACH_DECL_NEW(pvr, sizeof(struct pvr_softc),
    167     pvr_match, pvr_attach, NULL, NULL);
    168 
    169 static void	pvr_getdevconfig(struct fb_devconfig *);
    170 
    171 static struct fb_devconfig pvr_console_dc;
    172 
    173 static int	pvrioctl(void *, void *, u_long, void *, int, struct lwp *);
    174 static paddr_t	pvrmmap(void *, void *, off_t, int);
    175 
    176 static int	pvr_alloc_screen(void *, const struct wsscreen_descr *,
    177 		    void **, int *, int *, long *);
    178 static void	pvr_free_screen(void *, void *);
    179 static int	pvr_show_screen(void *, void *, int,
    180 		    void (*)(void *, int, int), void *);
    181 
    182 static const struct wsdisplay_accessops pvr_accessops = {
    183 	pvrioctl,
    184 	pvrmmap,
    185 	pvr_alloc_screen,
    186 	pvr_free_screen,
    187 	pvr_show_screen,
    188 	NULL, /* load_font */
    189 };
    190 
    191 static void	pvrinit(struct fb_devconfig *);
    192 
    193 int	pvr_is_console;
    194 
    195 int
    196 pvr_match(device_t parent, cfdata_t cf, void *aux)
    197 {
    198 
    199 	return 1;
    200 }
    201 
    202 void
    203 pvr_getdevconfig(struct fb_devconfig *dc)
    204 {
    205 	int i, cookie;
    206 
    207 	dc->dc_paddr = PVRREG_FBSTART;
    208 	dc->dc_vaddr = SH3_PHYS_TO_P2SEG(dc->dc_paddr);
    209 
    210 	dc->dc_regpaddr = PVRREG_REGSTART;
    211 	dc->dc_regvaddr = SH3_PHYS_TO_P2SEG(dc->dc_regpaddr);
    212 
    213 	dc->dc_wid = 640;
    214 	dc->dc_ht = 480;
    215 	dc->dc_depth = 16;
    216 	dc->dc_rowbytes = dc->dc_wid * (dc->dc_depth / 8);
    217 	dc->dc_videobase = dc->dc_vaddr;
    218 	dc->dc_blanked = 0;
    219 	dc->dc_dispflags = 0;
    220 
    221 	/* Clear the screen. */
    222 	for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(uint32_t))
    223 		*(uint32_t *)(dc->dc_videobase + i) = 0x0;
    224 
    225 	/* Initialize the device. */
    226 	pvrinit(dc);
    227 
    228 	dc->dc_rinfo.ri_flg = 0;
    229 	if (dc == &pvr_console_dc)
    230 		dc->dc_rinfo.ri_flg |= RI_NO_AUTO;
    231 	dc->dc_rinfo.ri_depth = dc->dc_depth;
    232 	dc->dc_rinfo.ri_bits = (void *) dc->dc_videobase;
    233 	dc->dc_rinfo.ri_width = dc->dc_wid;
    234 	dc->dc_rinfo.ri_height = dc->dc_ht;
    235 	dc->dc_rinfo.ri_stride = dc->dc_rowbytes;
    236 
    237 	wsfont_init();
    238 	/* prefer 8 pixel wide font */
    239 	cookie = wsfont_find(NULL, 8, 0, 0, WSDISPLAY_FONTORDER_L2R,
    240 	    WSDISPLAY_FONTORDER_L2R, WSFONT_FIND_BITMAP);
    241 	if (cookie <= 0)
    242 		cookie = wsfont_find(NULL, 0, 0, 0, WSDISPLAY_FONTORDER_L2R,
    243 		    WSDISPLAY_FONTORDER_L2R, WSFONT_FIND_BITMAP);
    244 	if (cookie <= 0) {
    245 		printf("pvr: font table is empty\n");
    246 		return;
    247 	}
    248 
    249 	if (wsfont_lock(cookie, &dc->dc_rinfo.ri_font)) {
    250 		printf("pvr: unable to lock font\n");
    251 		return;
    252 	}
    253 	dc->dc_rinfo.ri_wsfcookie = cookie;
    254 
    255 	rasops_init(&dc->dc_rinfo, 500, 500);
    256 
    257 	dc->dc_wsscrdescr.name = dc->dc_wsscrname;
    258 	dc->dc_wsscrdescr.ncols = dc->dc_rinfo.ri_cols;
    259 	dc->dc_wsscrdescr.nrows = dc->dc_rinfo.ri_rows;
    260 	dc->dc_wsscrdescr.textops = &dc->dc_rinfo.ri_ops;
    261 	dc->dc_wsscrdescr.capabilities = dc->dc_rinfo.ri_caps;
    262 
    263 	snprintf(dc->dc_wsscrname, sizeof(dc->dc_wsscrname), "%dx%d",
    264 	    dc->dc_wsscrdescr.ncols, dc->dc_wsscrdescr.nrows);
    265 }
    266 
    267 void
    268 pvr_attach(device_t parent, device_t self, void *aux)
    269 {
    270 	struct pvr_softc *sc = device_private(self);
    271 	struct wsemuldisplaydev_attach_args waa;
    272 	int console;
    273 	static const char *tvsystem_name[4] =
    274 		{ "NTSC", "PAL", "PAL-M", "PAL-N" };
    275 
    276 	sc->sc_dev = self;
    277 	console = pvr_is_console;
    278 	if (console) {
    279 		sc->sc_dc = &pvr_console_dc;
    280 		sc->sc_dc->dc_rinfo.ri_flg &= ~RI_NO_AUTO;
    281 		sc->sc_nscreens = 1;
    282 	} else {
    283 		sc->sc_dc = malloc(sizeof(struct fb_devconfig), M_DEVBUF,
    284 		    M_WAITOK | M_ZERO);
    285 		pvr_getdevconfig(sc->sc_dc);
    286 	}
    287 	printf(": %d x %d, %dbpp, %s, %s\n", sc->sc_dc->dc_wid,
    288 	    sc->sc_dc->dc_ht, sc->sc_dc->dc_depth,
    289 	    (sc->sc_dc->dc_dispflags & PVR_VGAMODE) ? "VGA" :
    290 	       tvsystem_name[sc->sc_dc->dc_tvsystem],
    291 	    (sc->sc_dc->dc_dispflags & PVR_RGBMODE) ? "RGB" : "composite");
    292 
    293 	/* XXX Colormap initialization? */
    294 
    295 	sc->sc_scrdescs[0] = &sc->sc_dc->dc_wsscrdescr;
    296 	sc->sc_scrlist.nscreens = 1;
    297 	sc->sc_scrlist.screens = sc->sc_scrdescs;
    298 
    299 	waa.console = console;
    300 	waa.scrdata = &sc->sc_scrlist;
    301 	waa.accessops = &pvr_accessops;
    302 	waa.accesscookie = sc;
    303 
    304 	(void) config_found(self, &waa, wsemuldisplaydevprint, CFARGS_NONE);
    305 }
    306 
    307 int
    308 pvrioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
    309 {
    310 	struct pvr_softc *sc = v;
    311 	struct fb_devconfig *dc = sc->sc_dc;
    312 
    313 	switch (cmd) {
    314 	case WSDISPLAYIO_GTYPE:
    315 		*(u_int *)data = WSDISPLAY_TYPE_DCPVR;
    316 		return 0;
    317 
    318 	case WSDISPLAYIO_GINFO:
    319 #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    320 		wsd_fbip->height = sc->sc_dc->dc_ht;
    321 		wsd_fbip->width = sc->sc_dc->dc_wid;
    322 		wsd_fbip->depth = sc->sc_dc->dc_depth;
    323 		wsd_fbip->cmsize = 0;	/* XXX Colormap */
    324 #undef wsd_fbip
    325 		return 0;
    326 
    327 	case WSDISPLAYIO_LINEBYTES:
    328 		*(u_int *)data = sc->sc_dc->dc_rinfo.ri_stride;
    329 		return 0;
    330 
    331 	case WSDISPLAYIO_GETCMAP:
    332 	case WSDISPLAYIO_PUTCMAP:
    333 		return EPASSTHROUGH;	/* XXX Colormap */
    334 
    335 	case WSDISPLAYIO_SVIDEO:
    336 		switch (*(u_int *)data) {
    337 		case WSDISPLAYIO_VIDEO_OFF:
    338 			if (!dc->dc_blanked) {
    339 				dc->dc_blanked = 1;
    340 				PVR_REG_WRITE(dc, PVRREG_DIWMODE,
    341 				    PVR_REG_READ(dc, PVRREG_DIWMODE) &
    342 				    ~DIWMODE_DE);
    343 			}
    344 			break;
    345 		case WSDISPLAYIO_VIDEO_ON:
    346 			if (dc->dc_blanked) {
    347 				dc->dc_blanked = 0;
    348 				PVR_REG_WRITE(dc, PVRREG_DIWMODE,
    349 				    PVR_REG_READ(dc, PVRREG_DIWMODE) |
    350 				    DIWMODE_DE);
    351 			}
    352 			break;
    353 		default:
    354 			return EPASSTHROUGH;	/* XXX */
    355 		}
    356 		return 0;
    357 
    358 	case WSDISPLAYIO_GVIDEO:
    359 		*(u_int *)data = dc->dc_blanked ?
    360 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
    361 		return 0;
    362 
    363 	case WSDISPLAYIO_GCURPOS:
    364 	case WSDISPLAYIO_SCURPOS:
    365 	case WSDISPLAYIO_GCURMAX:
    366 	case WSDISPLAYIO_GCURSOR:
    367 	case WSDISPLAYIO_SCURSOR:
    368 		return EPASSTHROUGH;	/* XXX */
    369 	}
    370 
    371 	return EPASSTHROUGH;
    372 }
    373 
    374 paddr_t
    375 pvrmmap(void *v, void *vs, off_t offset, int prot)
    376 {
    377 
    378 	/*
    379 	 * XXX This should be easy to support -- just need to define
    380 	 * XXX offsets for the control regs, etc.
    381 	 */
    382 
    383 	struct pvr_softc *sc = v;
    384 	struct fb_devconfig *dc = sc->sc_dc;
    385 	paddr_t addr;
    386 
    387 	if (offset >= 0 &&
    388 	    offset < sh3_round_page(dc->dc_rowbytes * dc->dc_ht))
    389 		addr = sh3_btop(dc->dc_paddr + offset);
    390 	else
    391 		addr = (-1);	/* XXX bogus */
    392 
    393 	return addr;
    394 }
    395 
    396 int
    397 pvr_alloc_screen(void *v, const struct wsscreen_descr *type,
    398     void **cookiep, int *curxp, int *curyp, long *attrp)
    399 {
    400 	struct pvr_softc *sc = v;
    401 	long defattr;
    402 
    403 	if (sc->sc_nscreens > 0)
    404 		return ENOMEM;
    405 
    406 	*cookiep = &sc->sc_dc->dc_rinfo; /* one and only for now */
    407 	*curxp = 0;
    408 	*curyp = 0;
    409 	(*sc->sc_dc->dc_rinfo.ri_ops.allocattr)(&sc->sc_dc->dc_rinfo, 0, 0, 0,
    410 	    &defattr);
    411 	*attrp = defattr;
    412 	sc->sc_nscreens++;
    413 	return 0;
    414 }
    415 
    416 void
    417 pvr_free_screen(void *v, void *cookie)
    418 {
    419 	struct pvr_softc *sc = v;
    420 
    421 	if (sc->sc_dc == &pvr_console_dc)
    422 		panic("pvr_free_screen: console");
    423 
    424 	sc->sc_nscreens--;
    425 }
    426 
    427 int
    428 pvr_show_screen(void *v, void *cookie, int waitok,
    429     void (*cb)(void *, int, int), void *cbarg)
    430 {
    431 
    432 	return 0;
    433 }
    434 
    435 static void
    436 pvr_check_cable(struct fb_devconfig *dc)
    437 {
    438 	volatile uint32_t *porta =
    439 	    (volatile uint32_t *)0xff80002c;
    440 	uint16_t v;
    441 
    442 	/* PORT8 and PORT9 is input */
    443 	*porta = (*porta & ~0xf0000) | 0xa0000;
    444 
    445 	/* Read PORT8 and PORT9 */
    446 	v = ((*(volatile uint16_t *)(porta + 1)) >> 8) & 3;
    447 
    448 	if ((v & 2) == 0)
    449 		dc->dc_dispflags |= PVR_VGAMODE|PVR_RGBMODE;
    450 	else if ((v & 1) == 0)
    451 		dc->dc_dispflags |= PVR_RGBMODE;
    452 }
    453 
    454 static void
    455 pvr_check_tvsys(struct fb_devconfig *dc)
    456 {
    457 
    458 	/* XXX should use flashmem device when one exists */
    459 	dc->dc_tvsystem = (*(volatile uint8_t *)0xa021a004) & 3;
    460 }
    461 
    462 void
    463 pvrinit(struct fb_devconfig *dc)
    464 {
    465 	int display_lines_per_field;
    466 	int v_absolute_size;
    467 	int h_absolute_size;
    468 	int vborder_start, vborder_stop;
    469 	int hborder_start, hborder_stop;
    470 	int modulo = 1, voffset, hoffset;
    471 
    472 	pvr_check_cable(dc);
    473 	pvr_check_tvsys(dc);
    474 
    475 	PVR_REG_WRITE(dc, 8, 0);		/* reset */
    476 	PVR_REG_WRITE(dc, PVRREG_BRDCOLR, 0);	/* black border */
    477 
    478 	if (dc->dc_dispflags & PVR_VGAMODE) {
    479 		v_absolute_size = 524;
    480 		h_absolute_size = 857;
    481 
    482 		display_lines_per_field = 480;
    483 		hoffset = 164;
    484 		voffset = 36;
    485 
    486 		hborder_start = 126;
    487 		hborder_stop = 837;
    488 
    489 		vborder_start = 40;
    490 		vborder_stop = 444;		/* XXX */
    491 
    492 		/* 31kHz, RGB565 */
    493 		PVR_REG_WRITE(dc, PVRREG_DIWMODE,
    494 		    DIWMODE_C | DIWMODE_COL_RGB565);
    495 
    496 		/* video output */
    497 		PVR_REG_WRITE(dc, PVRREG_SYNCCONF, SYNCCONF_VO);
    498 	} else {
    499 		if (dc->dc_tvsystem & 1) {
    500 			/* 50 Hz PAL */
    501 			v_absolute_size = 624;
    502 			h_absolute_size = 863;
    503 
    504 			display_lines_per_field = 240;
    505 			hoffset = 174;
    506 			voffset = 18;
    507 
    508 			hborder_start = 116;
    509 			hborder_stop = 843;
    510 
    511 			vborder_start = 44;
    512 			vborder_stop = 536;	/* XXX */
    513 		} else {
    514 			/* 60 Hz NTSC */
    515 			v_absolute_size = 524;
    516 			h_absolute_size = 857;
    517 
    518 			display_lines_per_field = 240;
    519 			hoffset = 170;
    520 			voffset = 28;
    521 
    522 			hborder_start = 126;
    523 			hborder_stop = 837;
    524 
    525 			vborder_start = 18;
    526 			vborder_stop = 506;	/* XXX */
    527 		}
    528 
    529 		modulo += 640 * 2 / 4;	/* interlace -> skip every other line */
    530 
    531 		/* 15kHz, RGB565 */
    532 		PVR_REG_WRITE(dc, PVRREG_DIWMODE,
    533 		    DIWMODE_COL_RGB565);
    534 
    535 		/* video output, PAL/NTSC, interlace */
    536 		PVR_REG_WRITE(dc, PVRREG_SYNCCONF,
    537 		    SYNCCONF_VO | SYNCCONF_I | SYNCCONF_BC(dc->dc_tvsystem));
    538 	}
    539 
    540 	/* video base address, long field */
    541 	PVR_REG_WRITE(dc, PVRREG_DIWADDRL, 0);
    542 
    543 	/* video base address, short field */
    544 	PVR_REG_WRITE(dc, PVRREG_DIWADDRS, 640 * 2);
    545 
    546 	/* video size */
    547 	PVR_REG_WRITE(dc, PVRREG_DIWSIZE, DIWSIZE_MODULO(modulo) |
    548 	    DIWSIZE_LPF(display_lines_per_field - 1) |
    549 	    DIWSIZE_DPL(640 * 2 / 4 - 1));
    550 
    551 	PVR_REG_WRITE(dc, PVRREG_DIWVSTRT,		/* V start */
    552 	    DIWVSTRT_V1(voffset) | DIWVSTRT_V2(voffset));
    553 	PVR_REG_WRITE(dc, PVRREG_BRDVERT,		/* V border */
    554 	    BRDVERT_START(vborder_start) | BRDVERT_STOP(vborder_stop));
    555 	PVR_REG_WRITE(dc, PVRREG_DIWHSTRT, hoffset);	/* H start */
    556 	PVR_REG_WRITE(dc, PVRREG_SYNCSIZE,		/* HV counter */
    557 	    SYNCSIZE_V(v_absolute_size) | SYNCSIZE_H(h_absolute_size));
    558 	PVR_REG_WRITE(dc, PVRREG_BRDHORZ,		/* H border */
    559 	    BRDHORZ_START(hborder_start) | BRDHORZ_STOP(hborder_stop));
    560 	PVR_REG_WRITE(dc, PVRREG_DIWCONF, DIWCONF_MAGIC);
    561 
    562 	/* RGB / composite */
    563 	*(volatile uint32_t *)
    564 	    SH3_PHYS_TO_P2SEG(0x00702c00) =
    565 	    ((dc->dc_dispflags & PVR_RGBMODE) ? 0 : 3) << 8;
    566 
    567 	/* display on */
    568 	PVR_REG_WRITE(dc, PVRREG_DIWMODE,
    569 	    PVR_REG_READ(dc, PVRREG_DIWMODE) | DIWMODE_DE);
    570 }
    571 
    572 /* Console support. */
    573 
    574 void
    575 pvrcninit(struct consdev *cndev)
    576 {
    577 	struct fb_devconfig *dcp = &pvr_console_dc;
    578 	long defattr;
    579 
    580 	pvr_getdevconfig(dcp);
    581 	(*dcp->dc_rinfo.ri_ops.allocattr)(&dcp->dc_rinfo, 0, 0, 0, &defattr);
    582 	wsdisplay_cnattach(&dcp->dc_wsscrdescr, &dcp->dc_rinfo, 0, 0, defattr);
    583 
    584 	pvr_is_console = 1;
    585 
    586 	cn_tab->cn_pri = CN_INTERNAL;
    587 
    588 #if NMKBD > 0
    589 	mkbd_cnattach();	/* connect keyboard and screen together */
    590 #endif
    591 }
    592 
    593 void
    594 pvrcnprobe(struct consdev *cndev)
    595 {
    596 #if NWSDISPLAY > 0
    597 	int maj, unit;
    598 	extern const struct cdevsw wsdisplay_cdevsw;
    599 #endif
    600 	cndev->cn_dev = NODEV;
    601 	cndev->cn_pri = CN_NORMAL;
    602 
    603 #if NWSDISPLAY > 0
    604 	unit = 0;
    605 	maj = cdevsw_lookup_major(&wsdisplay_cdevsw);
    606 	if (maj != -1) {
    607 		cndev->cn_pri = CN_INTERNAL;
    608 		cndev->cn_dev = makedev(maj, unit);
    609 	}
    610 #endif
    611 }
    612