494 lines
10 KiB
C
494 lines
10 KiB
C
/* $NetBSD: fb.c,v 1.24 2008/04/09 15:40:30 tsutsui Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 2000 Tsubai Masanari. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: fb.c,v 1.24 2008/04/09 15:40:30 tsutsui Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/device.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/systm.h>
|
|
|
|
#include <uvm/uvm_extern.h>
|
|
|
|
#include <machine/adrsmap.h>
|
|
|
|
#include <newsmips/dev/hbvar.h>
|
|
|
|
#include <dev/wscons/wsconsio.h>
|
|
#include <dev/wscons/wsdisplayvar.h>
|
|
#include <dev/rasops/rasops.h>
|
|
|
|
struct fb_devconfig {
|
|
u_char *dc_fbbase; /* VRAM base address */
|
|
struct rasops_info dc_ri;
|
|
};
|
|
|
|
struct fb_softc {
|
|
device_t sc_dev;
|
|
struct fb_devconfig *sc_dc;
|
|
int sc_nscreens;
|
|
};
|
|
|
|
int fb_match(device_t, cfdata_t, void *);
|
|
void fb_attach(device_t, device_t, void *);
|
|
|
|
int fb_common_init(struct fb_devconfig *);
|
|
int fb_is_console(void);
|
|
|
|
int fb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
|
|
paddr_t fb_mmap(void *, void *, off_t, int);
|
|
int fb_alloc_screen(void *, const struct wsscreen_descr *, void **, int *,
|
|
int *, long *);
|
|
void fb_free_screen(void *, void *);
|
|
int fb_show_screen(void *, void *, int, void (*)(void *, int, int), void *);
|
|
|
|
void fb_cnattach(void);
|
|
|
|
static void fb253_init(void);
|
|
|
|
CFATTACH_DECL_NEW(fb, sizeof(struct fb_softc),
|
|
fb_match, fb_attach, NULL, NULL);
|
|
|
|
struct fb_devconfig fb_console_dc;
|
|
|
|
struct wsdisplay_accessops fb_accessops = {
|
|
fb_ioctl,
|
|
fb_mmap,
|
|
fb_alloc_screen,
|
|
fb_free_screen,
|
|
fb_show_screen,
|
|
NULL /* load_font */
|
|
};
|
|
|
|
struct wsscreen_descr fb_stdscreen = {
|
|
"std",
|
|
0, 0,
|
|
0,
|
|
0, 0,
|
|
WSSCREEN_REVERSE
|
|
};
|
|
|
|
const struct wsscreen_descr *fb_scrlist[] = {
|
|
&fb_stdscreen
|
|
};
|
|
|
|
struct wsscreen_list fb_screenlist = {
|
|
__arraycount(fb_scrlist), fb_scrlist
|
|
};
|
|
|
|
#define NWB253_VRAM ((uint8_t *) 0x88000000)
|
|
#define NWB253_CTLREG ((uint16_t *)0xb8ff0000)
|
|
#define NWB253_CRTREG ((uint16_t *)0xb8fe0000)
|
|
|
|
static const char *devname[8] = { "NWB-512", "NWB-518", "NWE-501" }; /* XXX ? */
|
|
|
|
int
|
|
fb_match(device_t parent, cfdata_t cf, void *aux)
|
|
{
|
|
struct hb_attach_args *ha = aux;
|
|
|
|
if (strcmp(ha->ha_name, "fb") != 0)
|
|
return 0;
|
|
|
|
if (hb_badaddr(NWB253_CTLREG, 2) || hb_badaddr(NWB253_CRTREG, 2))
|
|
return 0;
|
|
if ((*(volatile uint16_t *)NWB253_CTLREG & 7) != 4)
|
|
return 0;
|
|
|
|
return 1;
|
|
}
|
|
|
|
void
|
|
fb_attach(device_t parent, device_t self, void *aux)
|
|
{
|
|
struct fb_softc *sc = device_private(self);
|
|
struct wsemuldisplaydev_attach_args waa;
|
|
struct fb_devconfig *dc;
|
|
struct rasops_info *ri;
|
|
int console;
|
|
volatile u_short *ctlreg = NWB253_CTLREG;
|
|
int id;
|
|
|
|
sc->sc_dev = self;
|
|
|
|
console = fb_is_console();
|
|
|
|
if (console) {
|
|
dc = &fb_console_dc;
|
|
ri = &dc->dc_ri;
|
|
sc->sc_nscreens = 1;
|
|
} else {
|
|
dc = malloc(sizeof(struct fb_devconfig), M_DEVBUF,
|
|
M_WAITOK|M_ZERO);
|
|
|
|
dc->dc_fbbase = NWB253_VRAM;
|
|
fb_common_init(dc);
|
|
ri = &dc->dc_ri;
|
|
|
|
/* clear screen */
|
|
(*ri->ri_ops.eraserows)(ri, 0, ri->ri_rows, 0);
|
|
|
|
fb253_init();
|
|
}
|
|
sc->sc_dc = dc;
|
|
|
|
id = (*ctlreg >> 8) & 0xf;
|
|
aprint_normal(": %s, %d x %d, %dbpp\n", devname[id],
|
|
ri->ri_width, ri->ri_height, ri->ri_depth);
|
|
|
|
waa.console = console;
|
|
waa.scrdata = &fb_screenlist;
|
|
waa.accessops = &fb_accessops;
|
|
waa.accesscookie = sc;
|
|
|
|
config_found(self, &waa, wsemuldisplaydevprint);
|
|
}
|
|
|
|
int
|
|
fb_common_init(struct fb_devconfig *dc)
|
|
{
|
|
struct rasops_info *ri = &dc->dc_ri;
|
|
volatile uint16_t *ctlreg = NWB253_CTLREG;
|
|
int id;
|
|
int width, height, xoff, yoff, cols, rows;
|
|
|
|
id = (*ctlreg >> 8) & 0xf;
|
|
|
|
/* initialize rasops */
|
|
switch (id) {
|
|
case 0:
|
|
width = 816;
|
|
height = 1024;
|
|
break;
|
|
case 1:
|
|
case 2:
|
|
default:
|
|
width = 1024;
|
|
height = 768;
|
|
break;
|
|
}
|
|
|
|
ri->ri_width = width;
|
|
ri->ri_height = height;
|
|
ri->ri_depth = 1;
|
|
ri->ri_stride = 2048 / 8;
|
|
ri->ri_bits = dc->dc_fbbase;
|
|
ri->ri_flg = RI_FULLCLEAR;
|
|
|
|
rasops_init(ri, 24, 80);
|
|
rows = (height - 2) / ri->ri_font->fontheight;
|
|
cols = ((width - 2) / ri->ri_font->fontwidth) & ~7;
|
|
xoff = ((width - cols * ri->ri_font->fontwidth) / 2 / 8) & ~3;
|
|
yoff = (height - rows * ri->ri_font->fontheight) / 2;
|
|
rasops_reconfig(ri, rows, cols);
|
|
|
|
ri->ri_xorigin = xoff;
|
|
ri->ri_yorigin = yoff;
|
|
ri->ri_bits = dc->dc_fbbase + xoff + ri->ri_stride * yoff;
|
|
|
|
fb_stdscreen.nrows = ri->ri_rows;
|
|
fb_stdscreen.ncols = ri->ri_cols;
|
|
fb_stdscreen.textops = &ri->ri_ops;
|
|
fb_stdscreen.capabilities = ri->ri_caps;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
fb_is_console(void)
|
|
{
|
|
volatile u_int *dipsw = (void *)DIP_SWITCH;
|
|
|
|
if (*dipsw & 7) /* XXX right? */
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
fb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
|
|
{
|
|
struct fb_softc *sc = v;
|
|
struct fb_devconfig *dc = sc->sc_dc;
|
|
struct wsdisplay_fbinfo *wdf;
|
|
|
|
switch (cmd) {
|
|
case WSDISPLAYIO_GTYPE:
|
|
*(int *)data = WSDISPLAY_TYPE_UNKNOWN; /* XXX */
|
|
return 0;
|
|
|
|
case WSDISPLAYIO_GINFO:
|
|
wdf = (void *)data;
|
|
wdf->height = dc->dc_ri.ri_height;
|
|
wdf->width = dc->dc_ri.ri_width;
|
|
wdf->depth = dc->dc_ri.ri_depth;
|
|
wdf->cmsize = 2;
|
|
return 0;
|
|
|
|
case WSDISPLAYIO_SVIDEO:
|
|
if (*(int *)data == WSDISPLAYIO_VIDEO_OFF) {
|
|
volatile u_short *ctlreg = NWB253_CTLREG;
|
|
*ctlreg = 0; /* stop crtc */
|
|
} else
|
|
fb253_init();
|
|
return 0;
|
|
|
|
case WSDISPLAYIO_GETCMAP:
|
|
case WSDISPLAYIO_PUTCMAP:
|
|
break;
|
|
}
|
|
return EPASSTHROUGH;
|
|
}
|
|
|
|
paddr_t
|
|
fb_mmap(void *v, void *vs, off_t offset, int prot)
|
|
{
|
|
struct fb_softc *sc = v;
|
|
struct fb_devconfig *dc = sc->sc_dc;
|
|
|
|
if (offset >= 2048 * 2048 / 8 || offset < 0)
|
|
return -1;
|
|
|
|
return mips_btop((int)dc->dc_fbbase + offset);
|
|
}
|
|
|
|
int
|
|
fb_alloc_screen(void *v, const struct wsscreen_descr *scrdesc, void **cookiep,
|
|
int *ccolp, int *crowp, long *attrp)
|
|
{
|
|
struct fb_softc *sc = v;
|
|
struct rasops_info *ri = &sc->sc_dc->dc_ri;
|
|
long defattr;
|
|
|
|
if (sc->sc_nscreens > 0)
|
|
return ENOMEM;
|
|
|
|
*cookiep = ri;
|
|
*ccolp = *crowp = 0;
|
|
(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
|
|
*attrp = defattr;
|
|
sc->sc_nscreens++;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
fb_free_screen(void *v, void *cookie)
|
|
{
|
|
struct fb_softc *sc = v;
|
|
|
|
if (sc->sc_dc == &fb_console_dc)
|
|
panic("%s: console", __func__);
|
|
|
|
sc->sc_nscreens--;
|
|
}
|
|
|
|
int
|
|
fb_show_screen(void *v, void *cookie, int waitok, void (*cb)(void *, int, int),
|
|
void *cbarg)
|
|
{
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
fb_cnattach(void)
|
|
{
|
|
struct fb_devconfig *dc = &fb_console_dc;
|
|
struct rasops_info *ri = &dc->dc_ri;
|
|
long defattr;
|
|
|
|
if (!fb_is_console())
|
|
return;
|
|
|
|
dc->dc_fbbase = NWB253_VRAM;
|
|
fb_common_init(dc);
|
|
|
|
(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
|
|
wsdisplay_cnattach(&fb_stdscreen, ri, 0, ri->ri_rows - 1, defattr);
|
|
}
|
|
|
|
static const uint8_t
|
|
nwp512_data1[] = {
|
|
0x00, 0x44,
|
|
0x01, 0x33,
|
|
0x02, 0x3c,
|
|
0x03, 0x38,
|
|
0x04, 0x84,
|
|
0x05, 0x03,
|
|
0x06, 0x80,
|
|
0x07, 0x80,
|
|
0x08, 0x10,
|
|
0x09, 0x07,
|
|
0x0a, 0x20,
|
|
0x0c, 0x00,
|
|
0x0d, 0x00,
|
|
0x1b, 0x03
|
|
};
|
|
|
|
static const uint8_t
|
|
nwp512_data2[] = {
|
|
0x1e, 0x08,
|
|
0x20, 0x08,
|
|
0x21, 0x0d
|
|
};
|
|
|
|
static const uint8_t
|
|
nwp518_data1[] = {
|
|
0x00, 0x52,
|
|
0x01, 0x40,
|
|
0x02, 0x4a,
|
|
0x03, 0x49,
|
|
0x04, 0x63,
|
|
0x05, 0x02,
|
|
0x06, 0x60,
|
|
0x07, 0x60,
|
|
0x08, 0x10,
|
|
0x09, 0x07,
|
|
0x0a, 0x20,
|
|
0x0c, 0x00,
|
|
0x0d, 0x00,
|
|
0x1b, 0x04
|
|
};
|
|
|
|
static const uint8_t
|
|
nwp518_data2[] = {
|
|
0x1e, 0x08,
|
|
0x20, 0x00,
|
|
0x21, 0x00
|
|
};
|
|
|
|
static const uint8_t
|
|
nwe501_data1[] = {
|
|
0x00, 0x4b,
|
|
0x01, 0x40,
|
|
0x02, 0x4a,
|
|
0x03, 0x43,
|
|
0x04, 0x64,
|
|
0x05, 0x02,
|
|
0x06, 0x60,
|
|
0x07, 0x60,
|
|
0x08, 0x10,
|
|
0x09, 0x07,
|
|
0x0a, 0x20,
|
|
0x0c, 0x00,
|
|
0x0d, 0x00,
|
|
0x1b, 0x04
|
|
};
|
|
|
|
static const uint8_t
|
|
nwe501_data2[] = {
|
|
0x1e, 0x08,
|
|
0x20, 0x00,
|
|
0x21, 0x00
|
|
};
|
|
|
|
static const uint8_t
|
|
*crtc_data[3][2] = {
|
|
{ nwp512_data1, nwp512_data2 },
|
|
{ nwp518_data1, nwp518_data2 },
|
|
{ nwe501_data1, nwe501_data2 }
|
|
};
|
|
|
|
static void
|
|
fb253_init(void)
|
|
{
|
|
volatile uint16_t *ctlreg = NWB253_CTLREG;
|
|
volatile uint16_t *crtreg = NWB253_CRTREG;
|
|
int id = (*ctlreg >> 8) & 0xf;
|
|
const uint8_t *p;
|
|
int i;
|
|
|
|
*ctlreg = 0; /* stop crtc */
|
|
delay(10);
|
|
|
|
/* initialize crtc without R3{0,1,2} */
|
|
p = crtc_data[id][0];
|
|
for (i = 0; i < 28; i++) {
|
|
*crtreg++ = *p++;
|
|
delay(10);
|
|
}
|
|
|
|
*ctlreg = 0x02; /* start crtc */
|
|
delay(10);
|
|
|
|
/* set crtc control reg */
|
|
p = crtc_data[id][1];
|
|
for (i = 0; i < 6; i++) {
|
|
*crtreg++ = *p++;
|
|
delay(10);
|
|
}
|
|
}
|
|
|
|
#if 0
|
|
static struct wsdisplay_font newsrom8x16;
|
|
static struct wsdisplay_font newsrom12x24;
|
|
static char fontarea16[96][32];
|
|
static char fontarea24[96][96];
|
|
|
|
void
|
|
initfont(struct rasops_info *ri)
|
|
{
|
|
int c, x;
|
|
|
|
for (c = 0; c < 96; c++) {
|
|
x = ((c & 0x1f) | ((c & 0xe0) << 2)) << 7;
|
|
memcpy(fontarea16 + c, (char *)0xb8e00000 + x + 96, 32);
|
|
memcpy(fontarea24 + c, (char *)0xb8e00000 + x, 96);
|
|
}
|
|
|
|
newsrom8x16.name = "rom8x16";
|
|
newsrom8x16.firstchar = 32;
|
|
newsrom8x16.numchars = 96;
|
|
newsrom8x16.encoding = WSDISPLAY_FONTENC_ISO;
|
|
newsrom8x16.fontwidth = 8;
|
|
newsrom8x16.fontheight = 16;
|
|
newsrom8x16.stride = 2;
|
|
newsrom8x16.bitorder = WSDISPLAY_FONTORDER_L2R;
|
|
newsrom8x16.byteorder = WSDISPLAY_FONTORDER_L2R;
|
|
newsrom8x16.data = fontarea16;
|
|
|
|
newsrom12x24.name = "rom12x24";
|
|
newsrom12x24.firstchar = 32;
|
|
newsrom12x24.numchars = 96;
|
|
newsrom12x24.encoding = WSDISPLAY_FONTENC_ISO;
|
|
newsrom12x24.fontwidth = 12;
|
|
newsrom12x24.fontheight = 24;
|
|
newsrom12x24.stride = 4;
|
|
newsrom12x24.bitorder = WSDISPLAY_FONTORDER_L2R;
|
|
newsrom12x24.byteorder = WSDISPLAY_FONTORDER_L2R;
|
|
newsrom12x24.data = fontarea24;
|
|
|
|
ri->ri_font = &newsrom8x16;
|
|
ri->ri_font = &newsrom12x24;
|
|
ri->ri_wsfcookie = -1; /* not using wsfont */
|
|
}
|
|
#endif
|