#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 <hp300/dev/intiovar.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>
#include <hp300/dev/dvboxreg.h>
struct dvbox_softc {
device_t sc_dev;
struct diofb *sc_fb;
struct diofb sc_fb_store;
int sc_scode;
};
static int dvbox_dio_match(device_t, cfdata_t, void *);
static void dvbox_dio_attach(device_t, device_t, void *);
static int dvbox_intio_match(device_t, cfdata_t, void *);
static void dvbox_intio_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(dvbox_dio, sizeof(struct dvbox_softc),
dvbox_dio_match, dvbox_dio_attach, NULL, NULL);
CFATTACH_DECL_NEW(dvbox_intio, sizeof(struct dvbox_softc),
dvbox_intio_match, dvbox_intio_attach, NULL, NULL);
static int dvbox_reset(struct diofb *, int, struct diofbreg *);
static void dvbox_restore(struct diofb *);
static int dvbox_windowmove(struct diofb *, uint16_t, uint16_t, uint16_t,
uint16_t, uint16_t, uint16_t, int16_t, int16_t);
static int dvbox_ioctl(void *, void *, u_long, void *, int, struct lwp *);
static struct wsdisplay_accessops dvbox_accessops = {
.ioctl = dvbox_ioctl,
.mmap = diofb_mmap,
.alloc_screen = diofb_alloc_screen,
.free_screen = diofb_free_screen,
.show_screen = diofb_show_screen,
.load_font = NULL,
};
int
dvbox_intio_match(device_t parent, cfdata_t cf, void *aux)
{
struct intio_attach_args *ia = aux;
struct diofbreg *fbr;
if (strcmp("fb", ia->ia_modname) != 0)
return 0;
fbr = (struct diofbreg *)ia->ia_addr;
if (badaddr((void *)fbr))
return 0;
if (fbr->id == GRFHWID && fbr->fbid == GID_DAVINCI) {
return 1;
}
return 0;
}
void
dvbox_intio_attach(device_t parent, device_t self, void *aux)
{
struct dvbox_softc *sc = device_private(self);
struct intio_attach_args *ia = aux;
struct diofbreg *fbr;
sc->sc_dev = self;
fbr = (struct diofbreg *)ia->ia_addr;
sc->sc_scode = CONSCODE_INTERNAL;
if (sc->sc_scode == conscode) {
sc->sc_fb = &diofb_cn;
} else {
sc->sc_fb = &sc->sc_fb_store;
dvbox_reset(sc->sc_fb, sc->sc_scode, fbr);
}
diofb_end_attach(self, &dvbox_accessops, sc->sc_fb,
sc->sc_scode == conscode, NULL);
}
int
dvbox_dio_match(device_t parent, cfdata_t cf, void *aux)
{
struct dio_attach_args *da = aux;
if (da->da_id == DIO_DEVICE_ID_FRAMEBUFFER &&
da->da_secid == DIO_DEVICE_SECID_DAVINCI)
return 1;
return 0;
}
void
dvbox_dio_attach(device_t parent, device_t self, void *aux)
{
struct dvbox_softc *sc = device_private(self);
struct dio_attach_args *da = aux;
bus_space_handle_t bsh;
struct diofbreg *fbr;
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;
if (bus_space_map(da->da_bst, da->da_addr, da->da_size, 0,
&bsh)) {
aprint_error(": can't map framebuffer\n");
return;
}
fbr = bus_space_vaddr(da->da_bst, bsh);
if (dvbox_reset(sc->sc_fb, sc->sc_scode, fbr) != 0) {
aprint_error(": can't reset framebuffer\n");
return;
}
}
diofb_end_attach(self, &dvbox_accessops, sc->sc_fb,
sc->sc_scode == conscode, NULL);
}
int
dvbox_reset(struct diofb *fb, int scode, struct diofbreg *fbr)
{
int rc;
if ((rc = diofb_fbinquire(fb, scode, fbr)) != 0)
return rc;
fb->planes = fb->planemask = 1;
fb->bmv = dvbox_windowmove;
dvbox_restore(fb);
diofb_fbsetup(fb);
return 0;
}
void
dvbox_restore(struct diofb *fb)
{
volatile struct dvboxfb *db = (struct dvboxfb *)fb->regkva;
u_int i;
db->regs.id = 0x80;
DELAY(100);
db->regs.interrupt = 0x04;
db->en_scan = 0x01;
db->fbwen = ~0;
db->opwen = ~0;
db->fold = 0x01;
db->drive = 0x01;
db->rep_rule = DVBOX_DUALROP(RR_COPY);
db->alt_rr = DVBOX_DUALROP(RR_COPY);
db->zrr = DVBOX_DUALROP(RR_COPY);
db->fbvenp = 0xFF;
db->dispen = 0x01;
db->fbvens = 0x0;
db->fv_trig = 0x01;
DELAY(100);
db->vdrive = 0x0;
db->zconfig = 0x0;
while (db->wbusy & 0x01)
DELAY(10);
db->cmapbank = 0;
db->red0 = 0;
db->red1 = 0;
db->green0 = 0;
db->green1 = 0;
db->blue0 = 0;
db->blue1 = 0;
db->panxh = 0;
db->panxl = 0;
db->panyh = 0;
db->panyl = 0;
db->zoom = 0;
db->cdwidth = 0x50;
db->chstart = 0x52;
db->cvwidth = 0x22;
db->pz_trig = 1;
db->regs.interrupt = 0x04;
db->drive = 0x10;
db->rep_rule = DVBOX_DUALROP(RR_COPY);
db->opwen = 0x01;
db->fbwen = 0x0;
db->fold = 0x01;
db->vdrive = 0x0;
db->dispen = 0x01;
db->opvenp = 0x01;
db->opvens = 0x01;
db->ovly0p = 0x0;
db->ovly0s = 0x0;
db->ovly1p = 0x0;
db->ovly1s = 0x0;
db->fv_trig = 0x1;
DELAY(100);
db_waitbusy(db);
for (i = 0; i <= 1; i++) {
db->cmapbank = i;
db->rgb[0].red = 0x00;
db->rgb[0].green = 0x00;
db->rgb[0].blue = 0x00;
db->rgb[1].red = 0xff;
db->rgb[1].green = 0xff;
db->rgb[1].blue = 0xff;
}
db->cmapbank = 0;
db_waitbusy(db);
}
int
dvbox_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_DVBOX;
return 0;
case WSDISPLAYIO_SMODE:
fb->mapmode = *(u_int *)data;
if (fb->mapmode == WSDISPLAYIO_MODE_EMUL)
dvbox_restore(fb);
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
dvbox_windowmove(struct diofb *fb, uint16_t sx, uint16_t sy,
uint16_t dx, uint16_t dy, uint16_t cx, uint16_t cy, int16_t rop,
int16_t planemask)
{
volatile struct dvboxfb *db = (struct dvboxfb *)fb->regkva;
if (planemask != 0xff)
return EINVAL;
db_waitbusy(db);
db->rep_rule = DVBOX_DUALROP(rop);
db->source_y = sy;
db->source_x = sx;
db->dest_y = dy;
db->dest_x = dx;
db->wheight = cy;
db->wwidth = cx;
db->wmove = 1;
db_waitbusy(db);
return 0;
}
int
dvboxcnattach(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;
int 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 != GID_DAVINCI)) {
bus_space_unmap(bst, bsh, PAGE_SIZE);
return 1;
}
size = DIO_SIZE(scode, va);
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;
dvbox_reset(fb, conscode, (struct diofbreg *)conaddr);
diofb_cnattach(fb);
return 0;
}