#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: dio.c,v 1.43 2024/01/16 07:06:59 thorpej Exp $");
#define _M68K_INTR_PRIVATE
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <machine/bus.h>
#include <uvm/uvm_extern.h>
#include <machine/autoconf.h>
#include <machine/cpu.h>
#include <machine/hp300spu.h>
#include <hp300/dev/dmavar.h>
#include <hp300/dev/dioreg.h>
#include <hp300/dev/diovar.h>
#include <hp300/dev/diodevs.h>
#include <hp300/dev/diodevs_data.h>
#include "locators.h"
#define diocf_scode cf_loc[DIOCF_SCODE]
struct dio_softc {
device_t sc_dev;
struct bus_space_tag sc_tag;
};
static int dio_scodesize(struct dio_attach_args *);
static const char *dio_devinfo(struct dio_attach_args *, char *, size_t);
static int diomatch(device_t, cfdata_t, void *);
static void dioattach(device_t, device_t, void *);
static int dioprint(void *, const char *);
static int diosubmatch(device_t, cfdata_t, const int *, void *);
CFATTACH_DECL_NEW(dio, sizeof(struct dio_softc),
diomatch, dioattach, NULL, NULL);
static LIST_HEAD(, hp300_intrhand) dio_dma_users =
LIST_HEAD_INITIALIZER(dio_dma_users);
static int
diomatch(device_t parent, cfdata_t cf, void *aux)
{
static int dio_matched = 0;
if (dio_matched)
return 0;
dio_matched = 1;
return 1;
}
static void
dioattach(device_t parent, device_t self, void *aux)
{
struct dio_softc *sc = device_private(self);
struct dio_attach_args da;
bus_addr_t pa;
void *va;
bus_space_tag_t bst = &sc->sc_tag;
bus_space_handle_t bsh;
int scode, scmax, scodesize;
sc->sc_dev = self;
aprint_normal("\n");
memset(bst, 0, sizeof(struct bus_space_tag));
bst->bustype = HP300_BUS_SPACE_DIO;
scmax = DIO_SCMAX(machineid);
for (scode = 0; scode < scmax; ) {
if (DIO_INHOLE(scode)) {
scode++;
continue;
}
pa = (bus_addr_t)dio_scodetopa(scode);
if (bus_space_map(bst, pa, PAGE_SIZE, 0, &bsh)) {
aprint_error_dev(self, "can't map scode %d\n", scode);
scode++;
continue;
}
va = bus_space_vaddr(bst, bsh);
if (badaddr(va)) {
bus_space_unmap(bst, bsh, PAGE_SIZE);
scode++;
continue;
}
memset(&da, 0, sizeof(da));
da.da_bst = bst;
da.da_scode = scode;
da.da_id = DIO_ID(va);
if (DIO_ISFRAMEBUFFER(da.da_id))
da.da_secid = DIO_SECID(va);
da.da_addr = pa;
da.da_size = DIO_SIZE(scode, va);
scodesize = dio_scodesize(&da);
if (DIO_ISDIO(scode))
da.da_size *= scodesize;
da.da_ipl = DIO_IPL(va);
bus_space_unmap(bst, bsh, PAGE_SIZE);
config_found(self, &da, dioprint,
CFARGS(.submatch = diosubmatch));
scode += scodesize;
}
}
static int
diosubmatch(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
{
struct dio_attach_args *da = aux;
if (cf->diocf_scode != DIOCF_SCODE_DEFAULT &&
cf->diocf_scode != da->da_scode)
return 0;
return config_match(parent, cf, aux);
}
static int
dioprint(void *aux, const char *pnp)
{
struct dio_attach_args *da = aux;
char buf[128];
if (pnp)
aprint_normal("%s at %s",
dio_devinfo(da, buf, sizeof(buf)), pnp);
aprint_normal(" scode %d ipl %d", da->da_scode, da->da_ipl);
return UNCONF;
}
void *
dio_scodetopa(int scode)
{
u_long rval;
if (DIO_ISDIO(scode))
rval = DIO_BASE + (scode * DIO_DEVSIZE);
else if (DIO_ISDIOII(scode))
rval = DIOII_BASE + ((scode - DIOII_SCBASE) * DIOII_DEVSIZE);
else
rval = 0;
return (void *)rval;
}
static int
dio_scodesize(struct dio_attach_args *da)
{
int i;
for (i = 0; i < DIO_NDEVICES; i++) {
if (da->da_id == dio_devdatas[i].dd_id) {
if (DIO_ISFRAMEBUFFER(da->da_id)) {
if (da->da_secid == dio_devdatas[i].dd_secid) {
goto foundit;
}
} else {
foundit:
return dio_devdatas[i].dd_nscode;
}
}
}
aprint_error("WARNING: select code size unknown "
"for id = 0x%x secid = 0x%x\n",
da->da_id, da->da_secid);
return 1;
}
static const char *
dio_devinfo(struct dio_attach_args *da, char *buf, size_t buflen)
{
#ifdef DIOVERBOSE
int i;
#endif
memset(buf, 0, buflen);
#ifdef DIOVERBOSE
for (i = 0; i < DIO_NDEVICES; i++) {
if (da->da_id == dio_devdescs[i].dd_id) {
if (DIO_ISFRAMEBUFFER(da->da_id)) {
if (da->da_secid == dio_devdescs[i].dd_secid) {
goto foundit;
}
} else {
foundit:
snprintf(buf, buflen, "%s",
dio_devdescs[i].dd_desc);
return buf;
}
}
}
#endif
snprintf(buf, buflen, "device id = 0x%x secid = 0x%x",
da->da_id, da->da_secid);
return buf;
}
static void
dio_dma_users_changed(void)
{
struct hp300_intrhand *ih;
int ipl = 0;
LIST_FOREACH(ih, &dio_dma_users, ih_dio_link) {
KASSERT(ih->ih_super.ih_isrpri == ISRPRI_BIO);
if (ih->ih_super.ih_ipl > ipl) {
ipl = ih->ih_super.ih_ipl;
}
}
dmaupdateipl(ipl);
}
void *
dio_intr_establish(int (*func)(void *), void *arg, int ipl, int isrpri)
{
struct hp300_intrhand *ih;
ih = intr_establish(func, arg, ipl, isrpri);
if (ih != NULL && isrpri == ISRPRI_BIO) {
LIST_INSERT_HEAD(&dio_dma_users, ih, ih_dio_link);
dio_dma_users_changed();
}
return ih;
}
void
dio_intr_disestablish(void *arg)
{
struct hp300_intrhand *ih = arg;
int isrpri = ih->ih_super.ih_isrpri;
if (isrpri == ISRPRI_BIO) {
LIST_REMOVE(ih, ih_dio_link);
}
intr_disestablish(arg);
if (isrpri == ISRPRI_BIO) {
dio_dma_users_changed();
}
}
static uint8_t dio_bus_space_read_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t);
static void dio_bus_space_write_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t, uint8_t);
static void dio_bus_space_read_multi_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t, uint8_t *, bus_size_t);
static void dio_bus_space_write_multi_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t, const uint8_t *, bus_size_t);
static void dio_bus_space_read_region_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t, uint8_t *, bus_size_t);
static void dio_bus_space_write_region_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t, const uint8_t *, bus_size_t);
static void dio_bus_space_set_multi_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t, uint8_t, bus_size_t);
static void dio_bus_space_set_region_oddbyte_1(bus_space_tag_t,
bus_space_handle_t, bus_size_t, uint8_t, bus_size_t);
void
dio_set_bus_space_oddbyte(bus_space_tag_t bst)
{
bst->bsr1 = dio_bus_space_read_oddbyte_1;
bst->bsw1 = dio_bus_space_write_oddbyte_1;
bst->bsrm1 = dio_bus_space_read_multi_oddbyte_1;
bst->bswm1 = dio_bus_space_write_multi_oddbyte_1;
bst->bsrr1 = dio_bus_space_read_region_oddbyte_1;
bst->bswr1 = dio_bus_space_write_region_oddbyte_1;
bst->bssm1 = dio_bus_space_set_multi_oddbyte_1;
bst->bssr1 = dio_bus_space_set_region_oddbyte_1;
}
static uint8_t
dio_bus_space_read_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
bus_size_t offset)
{
return *(volatile uint8_t *)(bsh + (offset << 1) + 1);
}
static void
dio_bus_space_write_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
bus_size_t offset, uint8_t val)
{
*(volatile uint8_t *)(bsh + (offset << 1) + 1) = val;
}
static void
dio_bus_space_read_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
bus_size_t offset, uint8_t *addr, bus_size_t len)
{
__asm volatile (
" movl %0,%%a0 ;\n"
" movl %1,%%a1 ;\n"
" movl %2,%%d0 ;\n"
"1: movb %%a0@,%%a1@+ ;\n"
" subql #1,%%d0 ;\n"
" jne 1b"
:
: "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
: "%a0","%a1","%d0");
}
static void
dio_bus_space_write_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
bus_size_t offset, const uint8_t *addr, bus_size_t len)
{
__asm volatile (
" movl %0,%%a0 ;\n"
" movl %1,%%a1 ;\n"
" movl %2,%%d0 ;\n"
"1: movb %%a1@+,%%a0@ ;\n"
" subql #1,%%d0 ;\n"
" jne 1b"
:
: "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
: "%a0","%a1","%d0");
}
static void
dio_bus_space_read_region_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
bus_size_t offset, uint8_t *addr, bus_size_t len)
{
__asm volatile (
" movl %0,%%a0 ;\n"
" movl %1,%%a1 ;\n"
" movl %2,%%d0 ;\n"
"1: movb %%a0@,%%a1@+ ;\n"
" addql #2,%%a0 ;\n"
" subql #1,%%d0 ;\n"
" jne 1b"
:
: "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
: "%a0","%a1","%d0");
}
static void
dio_bus_space_write_region_oddbyte_1(bus_space_tag_t bst,
bus_space_handle_t bsh, bus_size_t offset, const uint8_t *addr,
bus_size_t len)
{
__asm volatile (
" movl %0,%%a0 ;\n"
" movl %1,%%a1 ;\n"
" movl %2,%%d0 ;\n"
"1: movb %%a1@+,%%a0@ ;\n"
" addql #2,%%a0 ;\n"
" subql #1,%%d0 ;\n"
" jne 1b"
:
: "r" (bsh + (offset << 1) + 1), "g" (addr), "g" (len)
: "%a0","%a1","%d0");
}
static void
dio_bus_space_set_multi_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
bus_size_t offset, uint8_t val, bus_size_t count)
{
__asm volatile (
" movl %0,%%a0 ;\n"
" movl %1,%%d1 ;\n"
" movl %2,%%d0 ;\n"
"1: movb %%d1,%%a0@ ;\n"
" subql #1,%%d0 ;\n"
" jne 1b"
:
: "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
: "%a0","%d0","%d1");
}
static void
dio_bus_space_set_region_oddbyte_1(bus_space_tag_t bst, bus_space_handle_t bsh,
bus_size_t offset, uint8_t val, bus_size_t count)
{
__asm volatile (
" movl %0,%%a0 ;\n"
" movl %1,%%d1 ;\n"
" movl %2,%%d0 ;\n"
"1: movb %%d1,%%a0@ ;\n"
" addql #2,%%a0 ;\n"
" subql #1,%%d0 ;\n"
" jne 1b"
:
: "r" (bsh + (offset << 1) + 1), "g" (val), "g" (count)
: "%a0","%d0","%d1");
}