int
smfb_cnattach(bus_space_tag_t memt, bus_space_tag_t iot, pcitag_t tag,
pcireg_t id)
{
long defattr;
struct rasops_info *ri;
bus_space_handle_t fbh, mmioh;
pcireg_t bar;
int rc, is5xx;
/* filter out unrecognized devices */
switch (id) {
default:
return ENODEV;
case PCI_ID_CODE(PCI_VENDOR_SMI, PCI_PRODUCT_SMI_SM712):
is5xx = 0;
break;
case PCI_ID_CODE(PCI_VENDOR_SMI, PCI_PRODUCT_SMI_SM501):
is5xx = 1;
break;
}
smfbcn.is5xx = is5xx;
bar = pci_conf_read_early(tag, PCI_MAPREG_START);
if (PCI_MAPREG_TYPE(bar) != PCI_MAPREG_TYPE_MEM)
return EINVAL;
rc = bus_space_map(memt, PCI_MAPREG_MEM_ADDR(bar), 1 /* XXX */,
BUS_SPACE_MAP_LINEAR, &fbh);
if (rc != 0)
return rc;
if (smfbcn.is5xx) {
bar = pci_conf_read_early(tag, PCI_MAPREG_START + 0x04);
if (PCI_MAPREG_TYPE(bar) != PCI_MAPREG_TYPE_MEM)
return EINVAL;
rc = bus_space_map(memt, PCI_MAPREG_MEM_ADDR(bar), 1 /* XXX */,
BUS_SPACE_MAP_LINEAR, &mmioh);
if (rc != 0)
return rc;
} else {
mmioh = fbh;
}
rc = smfb_setup(&smfbcn, memt, fbh, memt, mmioh);
if (rc != 0)
return rc;
ri = &smfbcn.ri;
ri->ri_ops.alloc_attr(ri, 0, 0, 0, &defattr);
wsdisplay_cnattach(&smfbcn.wsd, ri, 0, 0, defattr);
return 0;
}
void
smfb_attach(struct device *parent, struct device *self, void *aux)
{
struct smfb_softc *sc = (struct smfb_softc *)self;
struct pci_attach_args *pa = (struct pci_attach_args *)aux;
struct wsemuldisplaydev_attach_args waa;
vaddr_t fbbase;
int console;
if (pci_mapreg_map(pa, PCI_MAPREG_START, PCI_MAPREG_TYPE_MEM,
BUS_SPACE_MAP_LINEAR, &sc->sc_memt, &sc->sc_memh,
NULL, NULL, 0) != 0) {
printf(": can't map frame buffer\n");
return;
}
console = smfbcn.ri.ri_hw != NULL;
if (console) {
sc->sc_fb = &smfbcn;
sc->sc_fb->sc = sc;
} else {
sc->sc_fb = &sc->sc_fb_store;
fbbase = (vaddr_t)bus_space_vaddr(sc->sc_memt, sc->sc_memh);
if (smfb_setup(sc->sc_fb, fbbase) != 0) {
printf(": can't setup frame buffer\n");
return;
}
}
printf("\n");
sc->sc_scrlist[0] = &sc->sc_fb->wsd;
sc->sc_wsl.nscreens = 1;
sc->sc_wsl.screens = (const struct wsscreen_descr **)sc->sc_scrlist;
waa.console = console;
waa.scrdata = &sc->sc_wsl;
waa.accessops = &smfb_accessops;
waa.accesscookie = sc;
waa.defaultscreens = 0;
config_found((struct device *)sc, &waa, wsemuldisplaydevprint);
}
int
smfb_cnattach()
{
long defattr;
struct rasops_info *ri;
vaddr_t fbbase;
int rc;
extern paddr_t loongson_pci_base;
/* XXX hardwired fbmem address */
fbbase = PHYS_TO_XKPHYS(loongson_pci_base + 0x14000000, CCA_NC);
rc = smfb_setup(&smfbcn, fbbase);
if (rc != 0)
return rc;
ri = &smfbcn.ri;
ri->ri_ops.alloc_attr(ri, 0, 0, 0, &defattr);
wsdisplay_cnattach(&smfbcn.wsd, ri, 0, 0, defattr);
return 0;
}
void
smfb_attach_common(struct smfb_softc *sc, int is5xx, bus_space_tag_t memt,
bus_space_handle_t memh, bus_space_tag_t mmiot, bus_space_handle_t mmioh)
{
struct wsemuldisplaydev_attach_args waa;
int console;
console = smfbcn.ri.ri_hw != NULL;
if (console) {
sc->sc_fb = &smfbcn;
sc->sc_fb->sc = sc;
} else {
sc->sc_fb = &sc->sc_fb_store;
sc->sc_fb->is5xx = is5xx;
if (smfb_setup(sc->sc_fb, memt, memh, mmiot, mmioh) != 0) {
printf(": can't setup frame buffer\n");
return;
}
}
/* XXX print resolution */
printf("\n");
sc->sc_scrlist[0] = &sc->sc_fb->wsd;
sc->sc_wsl.nscreens = 1;
sc->sc_wsl.screens = (const struct wsscreen_descr **)sc->sc_scrlist;
waa.console = console;
waa.scrdata = &sc->sc_wsl;
waa.accessops = &smfb_accessops;
waa.accesscookie = sc;
waa.defaultscreens = 0;
config_found((struct device *)sc, &waa, wsemuldisplaydevprint);
}
