#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: igsfb_ofbus.c,v 1.20 2021/01/27 03:10:21 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/kmem.h>
#include <sys/buf.h>
#include <sys/bus.h>
#include <uvm/uvm.h>
#include <machine/intr.h>
#include <machine/ofw.h>
#include <machine/pmap.h>
#include <dev/isa/isavar.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/wscons/wsconsio.h>
#include <dev/rasops/rasops.h>
#include <dev/wscons/wsdisplay_vconsvar.h>
#include <dev/ofw/openfirm.h>
#include <dev/ic/igsfbreg.h>
#include <dev/ic/igsfbvar.h>
#include <shark/ofw/igsfb_ofbusvar.h>
static int igsfb_ofbus_is_console(int);
static int igsfb_ofbus_console = 0;
static int igsfb_ofbus_phandle = 0;
static int igsfb_ofbus_match(device_t, cfdata_t, void *);
static void igsfb_ofbus_attach(device_t, device_t, void *);
static int igsfb_setup_dc(struct igsfb_devconfig *);
static paddr_t igsfb_ofbus_mmap(void *, void *, off_t, int);
CFATTACH_DECL_NEW(igsfb_ofbus, sizeof(struct igsfb_softc),
igsfb_ofbus_match, igsfb_ofbus_attach, NULL, NULL);
static const struct device_compatible_entry compat_data[] = {
{ .compat = "igs,cyperpro2010" },
DEVICE_COMPAT_EOL
};
vaddr_t igsfb_mem_vaddr = 0, igsfb_mmio_vaddr = 0;
paddr_t igsfb_mem_paddr;
extern paddr_t isa_io_physaddr;
struct bus_space igsfb_memt, igsfb_iot;
#if (NIGSFB_OFBUS > 0) || (NVGA_OFBUS > 0)
extern int console_ihandle;
#endif
int
igsfb_ofbus_cnattach(bus_space_tag_t iot, bus_space_tag_t memt)
{
struct igsfb_devconfig *dc;
int ret;
int chosen_phandle, igs_node;
int stdout_ihandle, stdout_phandle;
uint32_t regs[16];
char mode_buffer[64];
stdout_phandle = 0;
igs_node = OF_finddevice("/vlbus/display");
if (igs_node == -1)
return ENXIO;
if (!of_compatible_match(igs_node, compat_data))
return ENXIO;
if (OF_getprop(igs_node, "reg", regs, sizeof(regs)) <= 0)
return ENXIO;
igsfb_mem_paddr = be32toh(regs[13]);
igsfb_mem_vaddr = ofw_map(igsfb_mem_paddr, 0x00400000, L2_B);
igsfb_mmio_vaddr = ofw_map(igsfb_mem_paddr + IGS_MEM_MMIO_SELECT,
0x00100000, 0);
memcpy(&igsfb_memt, memt, sizeof(struct bus_space));
igsfb_memt.bs_cookie = (void *)igsfb_mem_vaddr;
memcpy(&igsfb_iot, memt, sizeof(struct bus_space));
igsfb_iot.bs_cookie = (void *)igsfb_mmio_vaddr;
if ((chosen_phandle = OF_finddevice("/chosen")) == -1 ||
OF_getprop(chosen_phandle, "stdout", &stdout_ihandle,
sizeof(stdout_ihandle)) != sizeof(stdout_ihandle)) {
return ENXIO;
}
stdout_ihandle = of_decode_int((void *)&stdout_ihandle);
stdout_phandle = OF_instance_to_package(stdout_ihandle);
if (stdout_phandle != igs_node) {
const int handle = OF_open("/vlbus/display");
if (handle != -1)
OF_close(handle);
return ENXIO;
}
dc = &igsfb_console_dc;
ret = igsfb_setup_dc(dc);
if (ret)
return ret;
if (of_get_mode_string(mode_buffer, sizeof(mode_buffer))) {
strcpy(dc->dc_modestring, mode_buffer);
}
ret = igsfb_cnattach_subr(dc);
if (ret)
return ret;
igsfb_ofbus_console = 1;
igsfb_ofbus_phandle = stdout_phandle;
#if (NIGSFB_OFBUS > 0) || (NVGA_OFBUS > 0)
console_ihandle = stdout_ihandle;
#endif
return 0;
}
static int
igsfb_setup_dc(struct igsfb_devconfig *dc)
{
int ret;
dc->dc_id = 0x2010;
dc->dc_memt = &igsfb_memt;
dc->dc_memaddr = 0;
dc->dc_memsz= 0x00400000;
dc->dc_memflags = 0;
dc->dc_iot = &igsfb_iot;
dc->dc_iobase = 0;
dc->dc_ioflags = 0;
dc->dc_mmap = igsfb_ofbus_mmap;
if (bus_space_map(dc->dc_iot,
dc->dc_iobase + IGS_REG_BASE, IGS_REG_SIZE,
dc->dc_ioflags,
&dc->dc_ioh) != 0)
{
printf("unable to map I/O registers\n");
return 1;
}
ret = igsfb_enable(dc->dc_iot, dc->dc_iobase, dc->dc_ioflags);
if (ret)
return ret;
return 0;
}
static int
igsfb_ofbus_is_console(int phandle)
{
return igsfb_ofbus_console && (phandle == igsfb_ofbus_phandle);
}
static int
igsfb_ofbus_match(device_t parent, cfdata_t match, void *aux)
{
struct ofbus_attach_args *oba = aux;
return of_compatible_match(oba->oba_phandle, compat_data) * 10;
}
static void
igsfb_ofbus_attach(device_t parent, device_t self, void *aux)
{
struct igsfb_softc *sc = device_private(self);
struct ofbus_attach_args *oba = aux;
uint32_t regs[16];
int isconsole, ret;
sc->sc_dev = self;
if (igsfb_ofbus_is_console(oba->oba_phandle)) {
isconsole = 1;
sc->sc_dc = &igsfb_console_dc;
} else {
isconsole = 0;
sc->sc_dc = kmem_zalloc(sizeof(struct igsfb_devconfig),
KM_SLEEP);
if (OF_getprop(oba->oba_phandle, "reg",
regs, sizeof(regs)) <= 0)
{
printf(": unable to read 'reg' property\n");
return;
}
ret = igsfb_setup_dc(sc->sc_dc);
if (ret)
return;
}
printf(": IGS CyberPro 2010 at 0x%08x\n", (uint32_t)igsfb_mem_paddr);
igsfb_attach_subr(sc, isconsole);
}
static paddr_t
igsfb_ofbus_mmap(void *v, void *vs, off_t offset, int prot)
{
#ifdef PCI_MAGIC_IO_RANGE
if ((offset >= PCI_MAGIC_IO_RANGE) &&
(offset < (PCI_MAGIC_IO_RANGE + 0x10000))) {
paddr_t pa;
pa = isa_io_physaddr + offset - PCI_MAGIC_IO_RANGE;
return arm_btop(pa);
}
#endif
if ((offset >= igsfb_mem_paddr) &&
(offset < (igsfb_mem_paddr + 0x00800000))) {
return (arm_btop(offset) | ARM32_MMAP_WRITECOMBINE);
}
if ((offset >= (igsfb_mem_paddr + 0x00800000)) &&
(offset < (igsfb_mem_paddr + 0x01000000)))
return arm_btop(offset);
return -1;
}