#include <sys/param.h>
#include <sys/systm.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/proc.h>
#include <sys/ioctl.h>
#include <sys/bus.h>
#include <sys/cpu.h>
#include <machine/autoconf.h>
#include <hp300/dev/dioreg.h>
#include <hp300/dev/diovar.h>
#include <hp300/dev/diodevs.h>
#include <dev/cons.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/rasops/rasops.h>
#include <hp300/dev/diofbreg.h>
#include <hp300/dev/diofbvar.h>
struct gendiofb_softc {
device_t sc_dev;
struct diofb *sc_fb;
struct diofb sc_fb_store;
int sc_scode;
};
static int gendiofb_match(device_t, cfdata_t, void *);
static void gendiofb_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(gendiofb, sizeof(struct gendiofb_softc),
gendiofb_match, gendiofb_attach, NULL, NULL);
static int gendiofb_reset(struct diofb *, int, struct diofbreg *);
static int gendiofb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
static struct wsdisplay_accessops gendiofb_accessops = {
.ioctl = gendiofb_ioctl,
.mmap = diofb_mmap,
.alloc_screen = diofb_alloc_screen,
.free_screen = diofb_free_screen,
.show_screen = diofb_show_screen,
.load_font = NULL,
};
static int
gendiofb_match(device_t parent, cfdata_t cf, void *aux)
{
struct dio_attach_args *da = aux;
if (da->da_id == DIO_DEVICE_ID_FRAMEBUFFER) {
switch (da->da_secid) {
case DIO_DEVICE_SECID_A147xVGA:
case DIO_DEVICE_SECID_A1474MID:
return 1;
}
}
return 0;
}
static void
gendiofb_attach(device_t parent, device_t self, void *aux)
{
struct gendiofb_softc *sc = device_private(self);
struct dio_attach_args *da = aux;
bus_space_handle_t bsh;
struct diofbreg *fbr;
bus_size_t size;
sc->sc_dev = self;
sc->sc_scode = da->da_scode;
if (sc->sc_scode == conscode) {
fbr = (struct diofbreg *)conaddr;
sc->sc_fb = &diofb_cn;
} else {
sc->sc_fb = &sc->sc_fb_store;
size = da->da_size;
if (size > DIOII_DEVSIZE)
size = DIOII_DEVSIZE;
if (bus_space_map(da->da_bst, da->da_addr, size, 0,
&bsh)) {
aprint_error(": can't map framebuffer\n");
return;
}
fbr = bus_space_vaddr(da->da_bst, bsh);
if (gendiofb_reset(sc->sc_fb, sc->sc_scode, fbr) != 0) {
aprint_error(": failed to reset\n");
return;
}
}
diofb_end_attach(self, &gendiofb_accessops, sc->sc_fb,
sc->sc_scode == conscode, NULL);
}
static int
gendiofb_reset(struct diofb *fb, int scode, struct diofbreg *fbr)
{
int rc;
struct rasops_info *ri = &fb->ri;
if ((rc = diofb_fbinquire(fb, scode, fbr)) != 0)
return (rc);
ri->ri_depth = 8;
ri->ri_stride = (fb->fbwidth * ri->ri_depth) / 8;
ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
if (fb == &diofb_cn)
ri->ri_flg |= RI_NO_AUTO;
ri->ri_bits = fb->fbkva;
ri->ri_width = fb->dwidth;
ri->ri_height = fb->dheight;
ri->ri_hw = fb;
rasops_init(ri, 160, 160);
ri->ri_flg |= RI_FORCEMONO;
diofb_resetcmap(fb);
fb->wsd.name = fb->wsdname;
fb->wsd.ncols = ri->ri_cols;
fb->wsd.nrows = ri->ri_rows;
fb->wsd.textops = &ri->ri_ops;
fb->wsd.fontwidth = ri->ri_font->fontwidth;
fb->wsd.fontheight = ri->ri_font->fontheight;
fb->wsd.capabilities = ri->ri_caps;
strlcpy(fb->wsdname, "std", sizeof(fb->wsdname));
return 0;
}
static int
gendiofb_ioctl(void *v, void *vs, u_long cmd, void *data, int flags,
struct lwp *l)
{
struct diofb *fb = v;
struct wsdisplay_fbinfo *wdf;
switch (cmd) {
case WSDISPLAYIO_GTYPE:
*(u_int *)data = WSDISPLAY_TYPE_UNKNOWN;
return 0;
case WSDISPLAYIO_SMODE:
fb->mapmode = *(u_int *)data;
return 0;
case WSDISPLAYIO_GINFO:
wdf = (void *)data;
wdf->width = fb->ri.ri_width;
wdf->height = fb->ri.ri_height;
wdf->depth = fb->ri.ri_depth;
wdf->cmsize = 0;
return 0;
case WSDISPLAYIO_LINEBYTES:
*(u_int *)data = fb->ri.ri_stride;
return 0;
case WSDISPLAYIO_GETCMAP:
case WSDISPLAYIO_PUTCMAP:
return EPASSTHROUGH;
case WSDISPLAYIO_GVIDEO:
case WSDISPLAYIO_SVIDEO:
return EPASSTHROUGH;
}
return EPASSTHROUGH;
}
int
gendiofbcnattach(bus_space_tag_t bst, bus_addr_t addr, int scode)
{
bus_space_handle_t bsh;
void *va;
struct diofbreg *fbr;
struct diofb *fb = &diofb_cn;
bus_size_t size;
if (bus_space_map(bst, addr, PAGE_SIZE, 0, &bsh))
return 1;
va = bus_space_vaddr(bst, bsh);
fbr = va;
if (badaddr(va) ||
fbr->id != GRFHWID ||
(fbr->fbid != DIO_DEVICE_SECID_A1474MID &&
fbr->fbid != DIO_DEVICE_SECID_A147xVGA)) {
bus_space_unmap(bst, bsh, PAGE_SIZE);
return 1;
}
size = DIO_SIZE(scode, va);
if (size > DIOII_DEVSIZE)
size = DIOII_DEVSIZE;
bus_space_unmap(bst, bsh, PAGE_SIZE);
if (bus_space_map(bst, addr, size, 0, &bsh))
return 1;
va = bus_space_vaddr(bst, bsh);
conscode = scode;
conaddr = va;
gendiofb_reset(fb, conscode, (struct diofbreg *)conaddr);
diofb_cnattach(fb);
return 0;
}