NetBSD/sys/dev/ofw/ofnet.c

488 lines
10 KiB
C
Raw Normal View History

1998-07-05 04:51:04 +04:00
/* $NetBSD: ofnet.c,v 1.15 1998/07/05 00:51:22 jonathan Exp $ */
1996-09-30 20:34:14 +04:00
/*
* Copyright (C) 1995, 1996 Wolfgang Solfrank.
* Copyright (C) 1995, 1996 TooLs GmbH.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by TooLs GmbH.
* 4. The name of TooLs GmbH may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
* OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
* ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#include "ofnet.h"
1998-07-05 04:51:04 +04:00
#include "opt_inet.h"
1996-09-30 20:34:14 +04:00
#include "bpfilter.h"
#include <sys/param.h>
1998-06-11 02:58:05 +04:00
#include <sys/systm.h>
1996-09-30 20:34:14 +04:00
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/syslog.h>
#include <net/if.h>
#include <net/if_ether.h>
1996-09-30 20:34:14 +04:00
#ifdef INET
#include <netinet/in.h>
#include <netinet/if_inarp.h>
1996-09-30 20:34:14 +04:00
#endif
#if NBPFILTER > 0
#include <net/bpf.h>
#include <net/bpfdesc.h>
#endif
1996-09-30 20:34:14 +04:00
#include <dev/ofw/openfirm.h>
#if NIPKDB_OFN > 0
#include <ipkdb/ipkdb.h>
#include <machine/ipkdb.h>
1996-09-30 20:34:14 +04:00
struct cfattach ipkdb_ofn_ca = {
0, ipkdb_probe, ipkdb_attach
1996-09-30 20:34:14 +04:00
};
static struct ipkdb_if *kifp;
static struct ofnet_softc *ipkdb_of;
1996-09-30 20:34:14 +04:00
static int ipkdbprobe __P((struct cfdata *, void *));
1996-09-30 20:34:14 +04:00
#endif
struct ofnet_softc {
1996-09-30 20:34:14 +04:00
struct device sc_dev;
int sc_phandle;
int sc_ihandle;
struct ethercom sc_ethercom;
1996-09-30 20:34:14 +04:00
};
static int ofnet_match __P((struct device *, struct cfdata *, void *));
static void ofnet_attach __P((struct device *, struct device *, void *));
1996-09-30 20:34:14 +04:00
struct cfattach ofnet_ca = {
sizeof(struct ofnet_softc), ofnet_match, ofnet_attach
1996-09-30 20:34:14 +04:00
};
static void ofnet_read __P((struct ofnet_softc *));
static void ofnet_timer __P((struct ofnet_softc *));
static void ofnet_init __P((struct ofnet_softc *));
static void ofnet_stop __P((struct ofnet_softc *));
1996-09-30 20:34:14 +04:00
static void ofnet_start __P((struct ifnet *));
static int ofnet_ioctl __P((struct ifnet *, u_long, caddr_t));
static void ofnet_watchdog __P((struct ifnet *));
1996-09-30 20:34:14 +04:00
static int
ofnet_match(parent, match, aux)
1996-09-30 20:34:14 +04:00
struct device *parent;
struct cfdata *match;
void *aux;
1996-09-30 20:34:14 +04:00
{
struct ofbus_attach_args *oba = aux;
1996-09-30 20:34:14 +04:00
char type[32];
int l;
#if NIPKDB_OFN > 0
1996-09-30 20:34:14 +04:00
if (!parent)
return ipkdbprobe(match, aux);
1996-09-30 20:34:14 +04:00
#endif
if (strcmp(oba->oba_busname, "ofw"))
return (0);
if ((l = OF_getprop(oba->oba_phandle, "device_type", type,
sizeof type - 1)) < 0)
1996-09-30 20:34:14 +04:00
return 0;
if (l >= sizeof type)
return 0;
type[l] = 0;
if (strcmp(type, "network"))
return 0;
return 1;
}
static void
ofnet_attach(parent, self, aux)
1996-09-30 20:34:14 +04:00
struct device *parent, *self;
void *aux;
{
struct ofnet_softc *of = (void *)self;
struct ifnet *ifp = &of->sc_ethercom.ec_if;
struct ofbus_attach_args *oba = aux;
1996-09-30 20:34:14 +04:00
char path[256];
int l;
u_int8_t myaddr[ETHER_ADDR_LEN];
1996-09-30 20:34:14 +04:00
of->sc_phandle = oba->oba_phandle;
#if NIPKDB_OFN > 0
if (kifp &&
kifp->unit - 1 == of->sc_dev.dv_unit &&
OF_instance_to_package(kifp->port) == oba->oba_phandle) {
ipkdb_of = of;
1996-09-30 20:34:14 +04:00
of->sc_ihandle = kifp->port;
} else
#endif
if ((l = OF_package_to_path(oba->oba_phandle, path,
sizeof path - 1)) < 0 ||
l >= sizeof path ||
(path[l] = 0, !(of->sc_ihandle = OF_open(path))))
panic("ofnet_attach: unable to open");
if (OF_getprop(oba->oba_phandle, "mac-address", myaddr,
sizeof myaddr) < 0)
panic("ofnet_attach: no mac-address");
printf(": address %s\n", ether_sprintf(myaddr));
1996-09-30 20:34:14 +04:00
bcopy(of->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ);
ifp->if_softc = of;
ifp->if_start = ofnet_start;
ifp->if_ioctl = ofnet_ioctl;
ifp->if_watchdog = ofnet_watchdog;
1996-09-30 20:34:14 +04:00
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS;
if_attach(ifp);
ether_ifattach(ifp, myaddr);
1996-09-30 20:34:14 +04:00
#if NBPFILTER > 0
bpfattach(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header));
1996-09-30 20:34:14 +04:00
#endif
dk_establish(0, self); /* XXX */
}
static char buf[ETHERMTU + sizeof(struct ether_header)];
static void
ofnet_read(of)
struct ofnet_softc *of;
1996-09-30 20:34:14 +04:00
{
struct ifnet *ifp = &of->sc_ethercom.ec_if;
1996-09-30 20:34:14 +04:00
struct ether_header *eh;
struct mbuf *m, **mp, *head;
int l, len;
char *bufp;
#if NIPKDB_OFN > 0
ipkdbrint(kifp, ifp);
1996-09-30 20:34:14 +04:00
#endif
while (1) {
if ((len = OF_read(of->sc_ihandle, buf, sizeof buf)) < 0) {
if (len == -2 || len == 0)
1996-09-30 20:34:14 +04:00
return;
ifp->if_ierrors++;
continue;
}
if (len < sizeof(struct ether_header)) {
ifp->if_ierrors++;
continue;
}
bufp = buf;
/* Allocate a header mbuf */
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == 0) {
ifp->if_ierrors++;
continue;
}
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = len;
l = MHLEN;
head = 0;
mp = &head;
while (len > 0) {
if (head) {
MGET(m, M_DONTWAIT, MT_DATA);
if (m == 0) {
ifp->if_ierrors++;
m_freem(head);
head = 0;
break;
}
l = MLEN;
}
if (len >= MINCLSIZE) {
MCLGET(m, M_DONTWAIT);
1997-04-24 12:05:13 +04:00
if ((m->m_flags & M_EXT) == 0) {
ifp->if_ierrors++;
m_free(m);
m_freem(head);
head = 0;
break;
}
l = MCLBYTES;
1996-09-30 20:34:14 +04:00
}
/*
* Make sure the data after the Ethernet header
* is aligned.
*
* XXX Assumes the device is an ethernet, but
* XXX then so does other code in this driver.
*/
if (head == NULL) {
caddr_t newdata = (caddr_t)ALIGN(m->m_data +
sizeof(struct ether_header)) -
sizeof(struct ether_header);
l -= newdata - m->m_data;
m->m_data = newdata;
}
1996-09-30 20:34:14 +04:00
m->m_len = l = min(len, l);
bcopy(bufp, mtod(m, char *), l);
bufp += l;
len -= l;
*mp = m;
mp = &m->m_next;
}
if (head == 0)
continue;
eh = mtod(head, struct ether_header *);
#if NBPFILTER > 0
if (ifp->if_bpf)
bpf_mtap(ifp->if_bpf, m);
1996-09-30 20:34:14 +04:00
#endif
m_adj(head, sizeof(struct ether_header));
ifp->if_ipackets++;
ether_input(ifp, eh, head);
}
}
static void
ofnet_timer(of)
struct ofnet_softc *of;
1996-09-30 20:34:14 +04:00
{
ofnet_read(of);
timeout(ofnet_timer, of, 1);
1996-09-30 20:34:14 +04:00
}
static void
ofnet_init(of)
struct ofnet_softc *of;
1996-09-30 20:34:14 +04:00
{
struct ifnet *ifp = &of->sc_ethercom.ec_if;
1996-09-30 20:34:14 +04:00
if (ifp->if_flags & IFF_RUNNING)
return;
ifp->if_flags |= IFF_RUNNING;
/* Start reading from interface */
ofnet_timer(of);
1996-09-30 20:34:14 +04:00
/* Attempt to start output */
ofnet_start(ifp);
1996-09-30 20:34:14 +04:00
}
static void
ofnet_stop(of)
struct ofnet_softc *of;
1996-09-30 20:34:14 +04:00
{
untimeout(ofnet_timer, of);
of->sc_ethercom.ec_if.if_flags &= ~IFF_RUNNING;
1996-09-30 20:34:14 +04:00
}
static void
ofnet_start(ifp)
1996-09-30 20:34:14 +04:00
struct ifnet *ifp;
{
struct ofnet_softc *of = ifp->if_softc;
1996-09-30 20:34:14 +04:00
struct mbuf *m, *m0;
char *bufp;
int len;
if (!(ifp->if_flags & IFF_RUNNING))
return;
for (;;) {
/* First try reading any packets */
ofnet_read(of);
1996-09-30 20:34:14 +04:00
/* Now get the first packet on the queue */
IF_DEQUEUE(&ifp->if_snd, m0);
if (!m0)
return;
if (!(m0->m_flags & M_PKTHDR))
panic("ofnet_start: no header mbuf");
1996-09-30 20:34:14 +04:00
len = m0->m_pkthdr.len;
#if NBPFILTER > 0
if (ifp->if_bpf)
bpf_mtap(ifp->if_bpf, m0);
#endif
1996-09-30 20:34:14 +04:00
if (len > ETHERMTU + sizeof(struct ether_header)) {
/* packet too large, toss it */
ifp->if_oerrors++;
m_freem(m0);
continue;
}
for (bufp = buf; m = m0;) {
bcopy(mtod(m, char *), bufp, m->m_len);
bufp += m->m_len;
MFREE(m, m0);
}
if (OF_write(of->sc_ihandle, buf, bufp - buf) != bufp - buf)
ifp->if_oerrors++;
else
ifp->if_opackets++;
}
}
static int
ofnet_ioctl(ifp, cmd, data)
1996-09-30 20:34:14 +04:00
struct ifnet *ifp;
u_long cmd;
caddr_t data;
{
struct ofnet_softc *of = ifp->if_softc;
1996-09-30 20:34:14 +04:00
struct ifaddr *ifa = (struct ifaddr *)data;
struct ifreq *ifr = (struct ifreq *)data;
int error = 0;
switch (cmd) {
case SIOCSIFADDR:
ifp->if_flags |= IFF_UP;
switch (ifa->ifa_addr->sa_family) {
#ifdef INET
case AF_INET:
arp_ifinit(ifp, ifa);
1996-09-30 20:34:14 +04:00
break;
#endif
default:
break;
}
ofnet_init(of);
1996-09-30 20:34:14 +04:00
break;
case SIOCSIFFLAGS:
if ((ifp->if_flags & IFF_UP) == 0 &&
(ifp->if_flags & IFF_RUNNING) != 0) {
1996-09-30 20:34:14 +04:00
/* If interface is down, but running, stop it. */
ofnet_stop(of);
} else if ((ifp->if_flags & IFF_UP) != 0 &&
(ifp->if_flags & IFF_RUNNING) == 0) {
1996-09-30 20:34:14 +04:00
/* If interface is up, but not running, start it. */
ofnet_init(of);
1996-09-30 20:34:14 +04:00
} else {
/* Other flags are ignored. */
}
break;
default:
error = EINVAL;
break;
}
return error;
}
static void
ofnet_watchdog(ifp)
1996-09-30 20:34:14 +04:00
struct ifnet *ifp;
{
struct ofnet_softc *of = ifp->if_softc;
1996-09-30 20:34:14 +04:00
log(LOG_ERR, "%s: device timeout\n", of->sc_dev.dv_xname);
ifp->if_oerrors++;
ofnet_stop(of);
ofnet_init(of);
1996-09-30 20:34:14 +04:00
}
#if NIPKDB_OFN > 0
1996-09-30 20:34:14 +04:00
static void
ipkdbofstart(kip)
struct ipkdb_if *kip;
1996-09-30 20:34:14 +04:00
{
int unit = kip->unit - 1;
if (ipkdb_of)
ipkdbattach(kip, &ipkdb_of->sc_ethercom);
1996-09-30 20:34:14 +04:00
}
static void
ipkdbofleave(kip)
struct ipkdb_if *kip;
1996-09-30 20:34:14 +04:00
{
}
static int
ipkdbofrcv(kip, buf, poll)
struct ipkdb_if *kip;
1996-09-30 20:34:14 +04:00
u_char *buf;
int poll;
{
int l;
do {
l = OF_read(kip->port, buf, ETHERMTU);
if (l < 0)
l = 0;
} while (!poll && !l);
return l;
}
static void
ipkdbofsend(kip, buf, l)
struct ipkdb_if *kip;
1996-09-30 20:34:14 +04:00
u_char *buf;
int l;
{
OF_write(kip->port, buf, l);
}
static int
ipkdbprobe(match, aux)
struct cfdata *match;
void *aux;
1996-09-30 20:34:14 +04:00
{
struct ipkdb_if *kip = aux;
1996-09-30 20:34:14 +04:00
static char name[256];
int len;
int phandle;
kip->unit = match->cf_unit + 1;
1996-09-30 20:34:14 +04:00
if (!(kip->port = OF_open("net")))
return -1;
if ((len = OF_instance_to_path(kip->port, name, sizeof name - 1)) < 0 ||
len >= sizeof name)
1996-09-30 20:34:14 +04:00
return -1;
name[len] = 0;
if ((phandle = OF_instance_to_package(kip->port)) == -1)
return -1;
if (OF_getprop(phandle, "mac-address", kip->myenetaddr,
sizeof kip->myenetaddr) < 0)
1996-09-30 20:34:14 +04:00
return -1;
kip->flags |= IPKDB_MYHW;
1996-09-30 20:34:14 +04:00
kip->name = name;
kip->start = ipkdbofstart;
kip->leave = ipkdbofleave;
kip->receive = ipkdbofrcv;
kip->send = ipkdbofsend;
1996-09-30 20:34:14 +04:00
kifp = kip;
return 0;
}
#endif