This is a driver for Fore/Marconi HE155 and HE622 ATM cards. It is full

busdma and has extensively been tested on i386 and sparc64.

1 files changed, 486 insertions, 0 deletions

diff --git a/sys/dev/hatm/if_hatm_ioctl.c b/sys/dev/hatm/if_hatm_ioctl.c
new file mode 100644
index 000000000000..704b1410763a
--- /dev/null
+++ b/sys/dev/hatm/if_hatm_ioctl.c
@@ -0,0 +1,486 @@
+/*
+ * Copyright (c) 2001-2003
+ *	Fraunhofer Institute for Open Communication Systems (FhG Fokus).
+ * 	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.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 THE AUTHOR OR CONTRIBUTORS 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.
+ *
+ * Author: Hartmut Brandt <harti@freebsd.org>
+ *
+ * $FreeBSD$
+ *
+ * ForeHE driver.
+ *
+ * Ioctl handler.
+ */
+
+#include "opt_inet.h"
+#include "opt_natm.h"
+
+#include <sys/types.h>
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/malloc.h>
+#include <sys/kernel.h>
+#include <sys/bus.h>
+#include <sys/errno.h>
+#include <sys/conf.h>
+#include <sys/module.h>
+#include <sys/queue.h>
+#include <sys/syslog.h>
+#include <sys/condvar.h>
+#include <sys/sysctl.h>
+#include <vm/uma.h>
+
+#include <sys/sockio.h>
+#include <sys/mbuf.h>
+#include <sys/socket.h>
+
+#include <net/if.h>
+#include <net/if_media.h>
+#include <net/if_atm.h>
+#include <net/route.h>
+#include <netinet/in.h>
+#include <netinet/if_atm.h>
+
+#include <machine/bus.h>
+#include <machine/resource.h>
+#include <sys/bus.h>
+#include <sys/rman.h>
+#include <pci/pcireg.h>
+#include <pci/pcivar.h>
+
+#include <dev/utopia/utopia.h>
+#include <dev/hatm/if_hatmconf.h>
+#include <dev/hatm/if_hatmreg.h>
+#include <dev/hatm/if_hatmvar.h>
+
+static u_int hatm_natm_traffic = ATMIO_TRAFFIC_UBR;
+static u_int hatm_natm_pcr = 0;
+
+static int hatm_sysctl_natm_traffic(SYSCTL_HANDLER_ARGS);
+
+SYSCTL_DECL(_hw_atm);
+
+SYSCTL_PROC(_hw_atm, OID_AUTO, natm_traffic, CTLTYPE_UINT | CTLFLAG_RW,
+    &hatm_natm_traffic, sizeof(hatm_natm_traffic), hatm_sysctl_natm_traffic,
+    "IU", "traffic type for NATM connections");
+SYSCTL_UINT(_hw_atm, OID_AUTO, natm_pcr, CTLFLAG_RW,
+    &hatm_natm_pcr, 0, "PCR for NATM connections");
+
+/*
+ * Return a table of VCCs in a freshly allocated memory area.
+ * Here we have a problem: we first count, how many vccs we need
+ * to return. The we allocate the memory and finally fill it in.
+ * Because we cannot lock while calling malloc, the number of active
+ * vccs may change while we're in malloc. So we allocate a couple of
+ * vccs more and if space anyway is not enough re-iterate.
+ */
+static struct atmio_vcctable *
+hatm_getvccs(struct hatm_softc *sc)
+{
+	u_int cid, alloc;
+	size_t len;
+	struct atmio_vcctable *vccs;
+	struct atmio_vcc *v;
+
+	alloc = sc->open_vccs + 10;
+	vccs = NULL;
+
+  again:
+	len = sizeof(*vccs) + alloc * sizeof(vccs->vccs[0]);
+	vccs = reallocf(vccs, len, M_DEVBUF, M_WAITOK);
+	bzero(vccs, len);
+
+	/*
+	 * Fill in
+	 */
+	vccs->count = 0;
+	v = vccs->vccs;
+
+	mtx_lock(&sc->mtx);
+	for (cid = 0; cid < HE_MAX_VCCS; cid++)
+		if (sc->vccs[cid] != NULL &&
+		    (sc->vccs[cid]->vflags & (HE_VCC_RX_OPEN |
+		    HE_VCC_TX_OPEN))) {
+			if (++vccs->count == alloc) {
+				/*
+				 * too many - try again
+				 */
+				break;
+			}
+			*v++ = sc->vccs[cid]->param;
+		}
+	mtx_unlock(&sc->mtx);
+
+	if (cid == HE_MAX_VCCS)
+		return (vccs);
+
+	alloc *= 2;
+	goto again;
+}
+
+/*
+ * Try to open the given VCC.
+ */
+static int
+hatm_open_vcc(struct hatm_softc *sc, struct atmio_openvcc *arg)
+{
+	u_int cid;
+	struct hevcc *vcc;
+	int error = 0;
+
+	DBG(sc, VCC, ("Open VCC: %u.%u flags=%#x", arg->param.vpi,
+	    arg->param.vci, arg->param.flags));
+
+	if ((arg->param.vpi & ~HE_VPI_MASK) ||
+	    (arg->param.vci & ~HE_VCI_MASK) ||
+	    (arg->param.vci == 0))
+		return (EINVAL);
+	cid = HE_CID(arg->param.vpi, arg->param.vci);
+
+	if ((arg->param.flags & ATMIO_FLAG_NOTX) &&
+	    (arg->param.flags & ATMIO_FLAG_NORX))
+		return (EINVAL);
+
+	vcc = uma_zalloc(sc->vcc_zone, M_NOWAIT | M_ZERO);
+	if (vcc == NULL)
+		return (ENOMEM);
+
+	mtx_lock(&sc->mtx);
+	if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) {
+		error = EIO;
+		goto done;
+	}
+	if (sc->vccs[cid] != NULL) {
+		error = EBUSY;
+		goto done;
+	}
+	vcc->param = arg->param;
+	vcc->rxhand = arg->rxhand;
+	switch (vcc->param.aal) {
+
+	  case ATMIO_AAL_0:
+	  case ATMIO_AAL_5:
+	  case ATMIO_AAL_RAW:
+		break;
+
+	  default:
+		error = EINVAL;
+		goto done;
+	}
+	switch (vcc->param.traffic) {
+
+	  case ATMIO_TRAFFIC_UBR:
+	  case ATMIO_TRAFFIC_CBR:
+	  case ATMIO_TRAFFIC_ABR:
+		break;
+
+	  default:
+		error = EINVAL;
+		goto done;
+	}
+	vcc->ntpds = 0;
+	vcc->chain = vcc->last = NULL;
+	vcc->ibytes = vcc->ipackets = 0;
+	vcc->obytes = vcc->opackets = 0;
+
+	if (!(vcc->param.flags & ATMIO_FLAG_NOTX) &&
+	     (error = hatm_tx_vcc_can_open(sc, cid, vcc)) != 0)
+		goto done;
+
+	/* ok - go ahead */
+	sc->vccs[cid] = vcc;
+
+	if (!(vcc->param.flags & ATMIO_FLAG_NOTX))
+		hatm_tx_vcc_open(sc, cid);
+	if (!(vcc->param.flags & ATMIO_FLAG_NORX))
+		hatm_rx_vcc_open(sc, cid);
+
+#ifdef notyet
+	/* inform management about non-NG and NG-PVCs */
+	if (!(vcc->param.flags & ATMIO_FLAG_NG) ||
+	     (vcc->param.flags & ATMIO_FLAG_PVC))
+		atm_message(&sc->ifatm.ifnet, ATM_MSG_VCC_CHANGED,
+		   (1 << 24) | (arg->vpi << 16) | arg->vci);
+#endif
+
+	/* don't free below */
+	vcc = NULL;
+
+	sc->open_vccs++;
+
+  done:
+	mtx_unlock(&sc->mtx);
+	if (vcc != NULL)
+		uma_zfree(sc->vcc_zone, vcc);
+	return (error);
+}
+
+/*
+ * Enable ioctl for NATM. Map to an open ioctl.
+ */
+static int
+hatm_open_vcc1(struct hatm_softc *sc, struct atm_pseudoioctl *ph)
+{
+	struct atmio_openvcc *v;
+	int error;
+
+	if ((v = malloc(sizeof(*v), M_TEMP, M_NOWAIT | M_ZERO)) == NULL)
+		return (ENOMEM);
+
+	v->param.flags = ATM_PH_FLAGS(&ph->aph) &
+	    (ATM_PH_AAL5 | ATM_PH_LLCSNAP);
+	v->param.vpi = ATM_PH_VPI(&ph->aph);
+	v->param.vci = ATM_PH_VCI(&ph->aph);
+	v->param.aal = (ATM_PH_FLAGS(&ph->aph) & ATM_PH_AAL5)
+	    ? ATMIO_AAL_5 : ATMIO_AAL_0;
+	v->param.traffic = hatm_natm_traffic;
+	v->rxhand = ph->rxhand;
+	if ((v->param.tparam.pcr = hatm_natm_pcr) == 0 ||
+	    hatm_natm_pcr > sc->ifatm.mib.pcr)
+		v->param.tparam.pcr = sc->ifatm.mib.pcr;
+	v->param.tparam.mcr = 0;
+
+	error = hatm_open_vcc(sc, v);
+	if (error == 0)
+		sc->vccs[HE_CID(v->param.vpi, v->param.vci)]->vflags |=
+		    HE_VCC_ASYNC;
+
+	free(v, M_TEMP);
+
+	return (error);
+}
+
+/*
+ * VCC has been finally closed.
+ */
+void
+hatm_vcc_closed(struct hatm_softc *sc, u_int cid)
+{
+	struct hevcc *vcc = sc->vccs[cid];
+
+#ifdef notyet
+	/* inform management about non-NG and NG-PVCs */
+	if (!(vcc->param.flags & ATMIO_FLAG_NG) ||
+	    (vcc->param.flags & ATMIO_FLAG_PVC))
+		atm_message(&sc->ifatm.ifnet, ATM_MSG_VCC_CHANGED,
+		   (0 << 24) | (HE_VPI(cid) << 16) | HE_VCI(cid));
+#endif
+
+	sc->open_vccs--;
+	uma_zfree(sc->vcc_zone, vcc);
+	sc->vccs[cid] = NULL;
+}
+
+/*
+ * Try to close the given VCC
+ */
+static int
+hatm_close_vcc(struct hatm_softc *sc, struct atmio_closevcc *arg)
+{
+	u_int cid;
+	struct hevcc *vcc;
+	int error = 0;
+
+	DBG(sc, VCC, ("Close VCC: %u.%u", arg->vpi, arg->vci));
+
+	if((arg->vpi & ~HE_VPI_MASK) ||
+	   (arg->vci & ~HE_VCI_MASK) ||
+	   (arg->vci == 0))
+		return (EINVAL);
+	cid = HE_CID(arg->vpi, arg->vci);
+
+	mtx_lock(&sc->mtx);
+	vcc = sc->vccs[cid];
+	if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) {
+		error = EIO;
+		goto done;
+	}
+
+	if (vcc == NULL || !(vcc->vflags & HE_VCC_OPEN)) {
+		error = ENOENT;
+		goto done;
+	}
+
+	if (vcc->vflags & HE_VCC_TX_OPEN)
+		hatm_tx_vcc_close(sc, cid);
+	if (vcc->vflags & HE_VCC_RX_OPEN)
+		hatm_rx_vcc_close(sc, cid);
+
+	if (vcc->vflags & HE_VCC_ASYNC)
+		goto done;
+
+	while ((sc->ifatm.ifnet.if_flags & IFF_RUNNING) &&
+	       (vcc->vflags & (HE_VCC_TX_CLOSING | HE_VCC_RX_CLOSING)))
+		cv_wait(&sc->vcc_cv, &sc->mtx);
+
+	if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) {
+		error = EIO;
+		goto done;
+	}
+
+	if (!(vcc->vflags & ATMIO_FLAG_NOTX))
+		hatm_tx_vcc_closed(sc, cid);
+
+	hatm_vcc_closed(sc, cid);
+
+  done:
+	mtx_unlock(&sc->mtx);
+	return (error);
+}
+
+static int
+hatm_close_vcc1(struct hatm_softc *sc, struct atm_pseudoioctl *ph)
+{
+	struct atmio_closevcc v;
+
+	v.vpi = ATM_PH_VPI(&ph->aph);
+	v.vci = ATM_PH_VCI(&ph->aph);
+
+	return (hatm_close_vcc(sc, &v));
+}
+
+/*
+ * IOCTL handler
+ */
+int
+hatm_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
+{
+	struct ifreq *ifr = (struct ifreq *)data;
+	struct ifaddr *ifa = (struct ifaddr *)data;
+	struct hatm_softc *sc = (struct hatm_softc *)ifp->if_softc;
+	struct atmio_vcctable *vtab;
+	int error = 0;
+
+	switch (cmd) {
+
+	  case SIOCSIFADDR:
+		mtx_lock(&sc->mtx);
+		ifp->if_flags |= IFF_UP;
+		if (!(ifp->if_flags & IFF_RUNNING))
+			hatm_initialize(sc);
+		switch (ifa->ifa_addr->sa_family) {
+
+#ifdef INET
+		  case AF_INET:
+		  case AF_INET6:
+			ifa->ifa_rtrequest = atm_rtrequest;
+			break;
+#endif
+		  default:
+			break;
+		}
+		mtx_unlock(&sc->mtx);
+		break;
+
+	  case SIOCSIFFLAGS:
+		mtx_lock(&sc->mtx);
+		if (ifp->if_flags & IFF_UP) {
+			if (!(ifp->if_flags & IFF_RUNNING)) {
+				hatm_initialize(sc);
+			}
+		} else {
+			if (ifp->if_flags & IFF_RUNNING) {
+				hatm_stop(sc);
+			}
+		}
+		mtx_unlock(&sc->mtx);
+		break;
+
+	  case SIOCGIFMEDIA:
+	  case SIOCSIFMEDIA:
+		error = ifmedia_ioctl(ifp, ifr, &sc->media, cmd);
+		break;
+
+	case SIOCSIFMTU:
+		/*
+		 * Set the interface MTU.
+		 */
+		if (ifr->ifr_mtu > ATMMTU)
+			error = EINVAL;
+		else
+			ifp->if_mtu = ifr->ifr_mtu;
+		break;
+
+	  case SIOCATMGVCCS:
+		/* return vcc table */
+		vtab = hatm_getvccs(sc);
+		if (vtab == NULL) {
+			error = ENOMEM;
+			break;
+		}
+		error = copyout(vtab, ifr->ifr_data, sizeof(*vtab) +
+		    vtab->count * sizeof(vtab->vccs[0]));
+		free(vtab, M_DEVBUF);
+		break;
+
+	  case SIOCATMENA:	/* NATM internal use */
+		error = hatm_open_vcc1(sc, (struct atm_pseudoioctl *)data);
+		break;
+
+	  case SIOCATMDIS:	/* NATM internal use */
+		error = hatm_close_vcc1(sc, (struct atm_pseudoioctl *)data);
+		break;
+
+	  case SIOCATMGETVCCS:	/* netgraph internal use */
+		if ((vtab = hatm_getvccs(sc)) == NULL) {
+			error = ENOMEM;
+			break;
+		}
+		*(void **)data = vtab;
+		break;
+
+	  case SIOCATMOPENVCC:		/* netgraph/harp internal use */
+		error = hatm_open_vcc(sc, (struct atmio_openvcc *)data);
+		break;
+
+	  case SIOCATMCLOSEVCC:		/* netgraph and HARP internal use */
+		error = hatm_close_vcc(sc, (struct atmio_closevcc *)data);
+		break;
+
+	  default:
+		DBG(sc, IOCTL, ("cmd=%08lx arg=%p", cmd, data));
+		error = EINVAL;
+		break;
+	}
+
+	return (error);
+}
+
+static int
+hatm_sysctl_natm_traffic(SYSCTL_HANDLER_ARGS)
+{
+	int error;
+	int tmp;
+
+	tmp = hatm_natm_traffic;
+	error = sysctl_handle_int(oidp, &tmp, 0, req);
+	if (error != 0 || req->newptr == NULL)
+		return (error);
+
+	if (tmp != ATMIO_TRAFFIC_UBR && tmp != ATMIO_TRAFFIC_CBR)
+		return (EINVAL);
+
+	hatm_natm_traffic = tmp;
+	return (0);
+}