#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: if_ie_sebuf.c,v 1.18 2025/12/16 18:24:47 andvar Exp $");
#include "opt_inet.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/protosw.h>
#include <sys/socket.h>
#include <net/if.h>
#include <net/if_ether.h>
#ifdef INET
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#include <netinet/if_inarp.h>
#endif
#include <machine/autoconf.h>
#include <machine/cpu.h>
#include <machine/dvma.h>
#include <machine/idprom.h>
#include <machine/vmparam.h>
#include "i82586.h"
#include "if_iereg.h"
#include "if_ievar.h"
#include "sereg.h"
#include "sevar.h"
static void ie_sebuf_reset(struct ie_softc *);
static void ie_sebuf_attend(struct ie_softc *);
static void ie_sebuf_run(struct ie_softc *);
static void *wmemcpy(void *, const void *, size_t);
static void *wmemset(void *, int, size_t);
static int ie_sebuf_match(device_t, cfdata_t, void *);
static void ie_sebuf_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(ie_sebuf, sizeof(struct ie_softc),
ie_sebuf_match, ie_sebuf_attach, NULL, NULL);
static int
ie_sebuf_match(device_t parent, cfdata_t cf, void *args)
{
struct sebuf_attach_args *aa = args;
if (strcmp(aa->name, "ie"))
return 0;
return 1;
}
static void
ie_sebuf_attach(device_t parent, device_t self, void *args)
{
struct ie_softc *sc = device_private(self);
struct sebuf_attach_args *aa = args;
volatile struct ie_regs *regs;
int off;
sc->sc_dev = self;
sc->hard_type = IE_VME3E;
sc->reset_586 = ie_sebuf_reset;
sc->chan_attn = ie_sebuf_attend;
sc->run_586 = ie_sebuf_run;
sc->sc_memcpy = wmemcpy;
sc->sc_memset = wmemset;
sc->sc_reg = aa->regs;
regs = (struct ie_regs *)sc->sc_reg;
sc->sc_iobase = aa->buf - 0x20000;
if (aa->blen < SE_IEBUFSIZE)
panic("ie_sebuf: bad size");
sc->sc_msize = SE_IEBUFSIZE;
sc->sc_maddr = aa->buf;
(sc->sc_memset)(sc->sc_maddr, 0, sc->sc_msize);
sc->sc_msize -= 0x10000;
sc->sc_maddr = (char *)sc->sc_maddr + 0x10000;
off = IE_SCP_ADDR & 0xFFFF;
sc->scp = (volatile void *)((char *)sc->sc_maddr + off);
sc->buf_area = sc->sc_maddr;
sc->buf_area_sz = off;
regs->ie_ivec = aa->ca.ca_intvec;
isr_add_vectored(ie_intr, sc, aa->ca.ca_intpri, aa->ca.ca_intvec);
idprom_etheraddr(sc->sc_addr);
ie_attach(sc);
}
void
ie_sebuf_attend(struct ie_softc *sc)
{
volatile struct ie_regs *regs = (struct ie_regs *)sc->sc_reg;
regs->ie_csr |= IE_CSR_ATTEN;
regs->ie_csr &= ~IE_CSR_ATTEN;
}
void
ie_sebuf_reset(struct ie_softc *sc)
{
volatile struct ie_regs *regs = (struct ie_regs *)sc->sc_reg;
regs->ie_csr = IE_CSR_RESET;
delay(20);
regs->ie_csr = (IE_CSR_NOLOOP | IE_CSR_IENAB);
}
void
ie_sebuf_run(struct ie_softc *sc)
{
}
static void *
wmemset(void *vb, int val, size_t l)
{
uint8_t *b = vb;
uint8_t *be = b + l;
uint16_t *sp;
if (l == 0)
return vb;
if ((uint32_t)b & 1)
*b++ = val;
if (b != be && ((uint32_t)be & 1) != 0) {
be--;
*be = val;
}
sp = (uint16_t *)b;
while (sp != (uint16_t *)be)
*sp++ = val;
return vb;
}
static void *
wmemcpy(void *dst, const void *src, size_t l)
{
const uint8_t *b1e, *b1 = src;
uint8_t *b2 = dst;
const uint16_t *sp;
int bstore = 0;
if (l == 0)
return dst;
if ((uint32_t)b1 & 1) {
*b2++ = *b1++;
l--;
}
sp = (const uint16_t *)b1;
b1e = b1 + l;
if (l & 1)
b1e--;
bstore = (uint32_t)b2 & 1;
while (sp < (const uint16_t *)b1e) {
if (bstore) {
b2[1] = *sp & 0xff;
b2[0] = *sp >> 8;
} else
*((uint16_t *)b2) = *sp;
sp++;
b2 += 2;
}
if (l & 1)
*b2 = *b1e;
return dst;
}