if_hatm_ioctl.c revision 116491
1116491Sharti/* 2116491Sharti * Copyright (c) 2001-2003 3116491Sharti * Fraunhofer Institute for Open Communication Systems (FhG Fokus). 4116491Sharti * All rights reserved. 5116491Sharti * 6116491Sharti * Redistribution and use in source and binary forms, with or without 7116491Sharti * modification, are permitted provided that the following conditions 8116491Sharti * are met: 9116491Sharti * 1. Redistributions of source code must retain the above copyright 10116491Sharti * notice, this list of conditions and the following disclaimer. 11116491Sharti * 2. Redistributions in binary form must reproduce the above copyright 12116491Sharti * notice, this list of conditions and the following disclaimer in the 13116491Sharti * documentation and/or other materials provided with the distribution. 14116491Sharti * 15116491Sharti * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16116491Sharti * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17116491Sharti * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18116491Sharti * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19116491Sharti * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20116491Sharti * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21116491Sharti * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22116491Sharti * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23116491Sharti * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24116491Sharti * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25116491Sharti * SUCH DAMAGE. 26116491Sharti * 27116491Sharti * Author: Hartmut Brandt <harti@freebsd.org> 28116491Sharti * 29116491Sharti * $FreeBSD: head/sys/dev/hatm/if_hatm_ioctl.c 116491 2003-06-17 16:12:50Z harti $ 30116491Sharti * 31116491Sharti * ForeHE driver. 32116491Sharti * 33116491Sharti * Ioctl handler. 34116491Sharti */ 35116491Sharti 36116491Sharti#include "opt_inet.h" 37116491Sharti#include "opt_natm.h" 38116491Sharti 39116491Sharti#include <sys/types.h> 40116491Sharti#include <sys/param.h> 41116491Sharti#include <sys/systm.h> 42116491Sharti#include <sys/malloc.h> 43116491Sharti#include <sys/kernel.h> 44116491Sharti#include <sys/bus.h> 45116491Sharti#include <sys/errno.h> 46116491Sharti#include <sys/conf.h> 47116491Sharti#include <sys/module.h> 48116491Sharti#include <sys/queue.h> 49116491Sharti#include <sys/syslog.h> 50116491Sharti#include <sys/condvar.h> 51116491Sharti#include <sys/sysctl.h> 52116491Sharti#include <vm/uma.h> 53116491Sharti 54116491Sharti#include <sys/sockio.h> 55116491Sharti#include <sys/mbuf.h> 56116491Sharti#include <sys/socket.h> 57116491Sharti 58116491Sharti#include <net/if.h> 59116491Sharti#include <net/if_media.h> 60116491Sharti#include <net/if_atm.h> 61116491Sharti#include <net/route.h> 62116491Sharti#include <netinet/in.h> 63116491Sharti#include <netinet/if_atm.h> 64116491Sharti 65116491Sharti#include <machine/bus.h> 66116491Sharti#include <machine/resource.h> 67116491Sharti#include <sys/bus.h> 68116491Sharti#include <sys/rman.h> 69116491Sharti#include <pci/pcireg.h> 70116491Sharti#include <pci/pcivar.h> 71116491Sharti 72116491Sharti#include <dev/utopia/utopia.h> 73116491Sharti#include <dev/hatm/if_hatmconf.h> 74116491Sharti#include <dev/hatm/if_hatmreg.h> 75116491Sharti#include <dev/hatm/if_hatmvar.h> 76116491Sharti 77116491Shartistatic u_int hatm_natm_traffic = ATMIO_TRAFFIC_UBR; 78116491Shartistatic u_int hatm_natm_pcr = 0; 79116491Sharti 80116491Shartistatic int hatm_sysctl_natm_traffic(SYSCTL_HANDLER_ARGS); 81116491Sharti 82116491ShartiSYSCTL_DECL(_hw_atm); 83116491Sharti 84116491ShartiSYSCTL_PROC(_hw_atm, OID_AUTO, natm_traffic, CTLTYPE_UINT | CTLFLAG_RW, 85116491Sharti &hatm_natm_traffic, sizeof(hatm_natm_traffic), hatm_sysctl_natm_traffic, 86116491Sharti "IU", "traffic type for NATM connections"); 87116491ShartiSYSCTL_UINT(_hw_atm, OID_AUTO, natm_pcr, CTLFLAG_RW, 88116491Sharti &hatm_natm_pcr, 0, "PCR for NATM connections"); 89116491Sharti 90116491Sharti/* 91116491Sharti * Return a table of VCCs in a freshly allocated memory area. 92116491Sharti * Here we have a problem: we first count, how many vccs we need 93116491Sharti * to return. The we allocate the memory and finally fill it in. 94116491Sharti * Because we cannot lock while calling malloc, the number of active 95116491Sharti * vccs may change while we're in malloc. So we allocate a couple of 96116491Sharti * vccs more and if space anyway is not enough re-iterate. 97116491Sharti */ 98116491Shartistatic struct atmio_vcctable * 99116491Shartihatm_getvccs(struct hatm_softc *sc) 100116491Sharti{ 101116491Sharti u_int cid, alloc; 102116491Sharti size_t len; 103116491Sharti struct atmio_vcctable *vccs; 104116491Sharti struct atmio_vcc *v; 105116491Sharti 106116491Sharti alloc = sc->open_vccs + 10; 107116491Sharti vccs = NULL; 108116491Sharti 109116491Sharti again: 110116491Sharti len = sizeof(*vccs) + alloc * sizeof(vccs->vccs[0]); 111116491Sharti vccs = reallocf(vccs, len, M_DEVBUF, M_WAITOK); 112116491Sharti bzero(vccs, len); 113116491Sharti 114116491Sharti /* 115116491Sharti * Fill in 116116491Sharti */ 117116491Sharti vccs->count = 0; 118116491Sharti v = vccs->vccs; 119116491Sharti 120116491Sharti mtx_lock(&sc->mtx); 121116491Sharti for (cid = 0; cid < HE_MAX_VCCS; cid++) 122116491Sharti if (sc->vccs[cid] != NULL && 123116491Sharti (sc->vccs[cid]->vflags & (HE_VCC_RX_OPEN | 124116491Sharti HE_VCC_TX_OPEN))) { 125116491Sharti if (++vccs->count == alloc) { 126116491Sharti /* 127116491Sharti * too many - try again 128116491Sharti */ 129116491Sharti break; 130116491Sharti } 131116491Sharti *v++ = sc->vccs[cid]->param; 132116491Sharti } 133116491Sharti mtx_unlock(&sc->mtx); 134116491Sharti 135116491Sharti if (cid == HE_MAX_VCCS) 136116491Sharti return (vccs); 137116491Sharti 138116491Sharti alloc *= 2; 139116491Sharti goto again; 140116491Sharti} 141116491Sharti 142116491Sharti/* 143116491Sharti * Try to open the given VCC. 144116491Sharti */ 145116491Shartistatic int 146116491Shartihatm_open_vcc(struct hatm_softc *sc, struct atmio_openvcc *arg) 147116491Sharti{ 148116491Sharti u_int cid; 149116491Sharti struct hevcc *vcc; 150116491Sharti int error = 0; 151116491Sharti 152116491Sharti DBG(sc, VCC, ("Open VCC: %u.%u flags=%#x", arg->param.vpi, 153116491Sharti arg->param.vci, arg->param.flags)); 154116491Sharti 155116491Sharti if ((arg->param.vpi & ~HE_VPI_MASK) || 156116491Sharti (arg->param.vci & ~HE_VCI_MASK) || 157116491Sharti (arg->param.vci == 0)) 158116491Sharti return (EINVAL); 159116491Sharti cid = HE_CID(arg->param.vpi, arg->param.vci); 160116491Sharti 161116491Sharti if ((arg->param.flags & ATMIO_FLAG_NOTX) && 162116491Sharti (arg->param.flags & ATMIO_FLAG_NORX)) 163116491Sharti return (EINVAL); 164116491Sharti 165116491Sharti vcc = uma_zalloc(sc->vcc_zone, M_NOWAIT | M_ZERO); 166116491Sharti if (vcc == NULL) 167116491Sharti return (ENOMEM); 168116491Sharti 169116491Sharti mtx_lock(&sc->mtx); 170116491Sharti if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) { 171116491Sharti error = EIO; 172116491Sharti goto done; 173116491Sharti } 174116491Sharti if (sc->vccs[cid] != NULL) { 175116491Sharti error = EBUSY; 176116491Sharti goto done; 177116491Sharti } 178116491Sharti vcc->param = arg->param; 179116491Sharti vcc->rxhand = arg->rxhand; 180116491Sharti switch (vcc->param.aal) { 181116491Sharti 182116491Sharti case ATMIO_AAL_0: 183116491Sharti case ATMIO_AAL_5: 184116491Sharti case ATMIO_AAL_RAW: 185116491Sharti break; 186116491Sharti 187116491Sharti default: 188116491Sharti error = EINVAL; 189116491Sharti goto done; 190116491Sharti } 191116491Sharti switch (vcc->param.traffic) { 192116491Sharti 193116491Sharti case ATMIO_TRAFFIC_UBR: 194116491Sharti case ATMIO_TRAFFIC_CBR: 195116491Sharti case ATMIO_TRAFFIC_ABR: 196116491Sharti break; 197116491Sharti 198116491Sharti default: 199116491Sharti error = EINVAL; 200116491Sharti goto done; 201116491Sharti } 202116491Sharti vcc->ntpds = 0; 203116491Sharti vcc->chain = vcc->last = NULL; 204116491Sharti vcc->ibytes = vcc->ipackets = 0; 205116491Sharti vcc->obytes = vcc->opackets = 0; 206116491Sharti 207116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NOTX) && 208116491Sharti (error = hatm_tx_vcc_can_open(sc, cid, vcc)) != 0) 209116491Sharti goto done; 210116491Sharti 211116491Sharti /* ok - go ahead */ 212116491Sharti sc->vccs[cid] = vcc; 213116491Sharti 214116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NOTX)) 215116491Sharti hatm_tx_vcc_open(sc, cid); 216116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NORX)) 217116491Sharti hatm_rx_vcc_open(sc, cid); 218116491Sharti 219116491Sharti#ifdef notyet 220116491Sharti /* inform management about non-NG and NG-PVCs */ 221116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NG) || 222116491Sharti (vcc->param.flags & ATMIO_FLAG_PVC)) 223116491Sharti atm_message(&sc->ifatm.ifnet, ATM_MSG_VCC_CHANGED, 224116491Sharti (1 << 24) | (arg->vpi << 16) | arg->vci); 225116491Sharti#endif 226116491Sharti 227116491Sharti /* don't free below */ 228116491Sharti vcc = NULL; 229116491Sharti 230116491Sharti sc->open_vccs++; 231116491Sharti 232116491Sharti done: 233116491Sharti mtx_unlock(&sc->mtx); 234116491Sharti if (vcc != NULL) 235116491Sharti uma_zfree(sc->vcc_zone, vcc); 236116491Sharti return (error); 237116491Sharti} 238116491Sharti 239116491Sharti/* 240116491Sharti * Enable ioctl for NATM. Map to an open ioctl. 241116491Sharti */ 242116491Shartistatic int 243116491Shartihatm_open_vcc1(struct hatm_softc *sc, struct atm_pseudoioctl *ph) 244116491Sharti{ 245116491Sharti struct atmio_openvcc *v; 246116491Sharti int error; 247116491Sharti 248116491Sharti if ((v = malloc(sizeof(*v), M_TEMP, M_NOWAIT | M_ZERO)) == NULL) 249116491Sharti return (ENOMEM); 250116491Sharti 251116491Sharti v->param.flags = ATM_PH_FLAGS(&ph->aph) & 252116491Sharti (ATM_PH_AAL5 | ATM_PH_LLCSNAP); 253116491Sharti v->param.vpi = ATM_PH_VPI(&ph->aph); 254116491Sharti v->param.vci = ATM_PH_VCI(&ph->aph); 255116491Sharti v->param.aal = (ATM_PH_FLAGS(&ph->aph) & ATM_PH_AAL5) 256116491Sharti ? ATMIO_AAL_5 : ATMIO_AAL_0; 257116491Sharti v->param.traffic = hatm_natm_traffic; 258116491Sharti v->rxhand = ph->rxhand; 259116491Sharti if ((v->param.tparam.pcr = hatm_natm_pcr) == 0 || 260116491Sharti hatm_natm_pcr > sc->ifatm.mib.pcr) 261116491Sharti v->param.tparam.pcr = sc->ifatm.mib.pcr; 262116491Sharti v->param.tparam.mcr = 0; 263116491Sharti 264116491Sharti error = hatm_open_vcc(sc, v); 265116491Sharti if (error == 0) 266116491Sharti sc->vccs[HE_CID(v->param.vpi, v->param.vci)]->vflags |= 267116491Sharti HE_VCC_ASYNC; 268116491Sharti 269116491Sharti free(v, M_TEMP); 270116491Sharti 271116491Sharti return (error); 272116491Sharti} 273116491Sharti 274116491Sharti/* 275116491Sharti * VCC has been finally closed. 276116491Sharti */ 277116491Shartivoid 278116491Shartihatm_vcc_closed(struct hatm_softc *sc, u_int cid) 279116491Sharti{ 280116491Sharti struct hevcc *vcc = sc->vccs[cid]; 281116491Sharti 282116491Sharti#ifdef notyet 283116491Sharti /* inform management about non-NG and NG-PVCs */ 284116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NG) || 285116491Sharti (vcc->param.flags & ATMIO_FLAG_PVC)) 286116491Sharti atm_message(&sc->ifatm.ifnet, ATM_MSG_VCC_CHANGED, 287116491Sharti (0 << 24) | (HE_VPI(cid) << 16) | HE_VCI(cid)); 288116491Sharti#endif 289116491Sharti 290116491Sharti sc->open_vccs--; 291116491Sharti uma_zfree(sc->vcc_zone, vcc); 292116491Sharti sc->vccs[cid] = NULL; 293116491Sharti} 294116491Sharti 295116491Sharti/* 296116491Sharti * Try to close the given VCC 297116491Sharti */ 298116491Shartistatic int 299116491Shartihatm_close_vcc(struct hatm_softc *sc, struct atmio_closevcc *arg) 300116491Sharti{ 301116491Sharti u_int cid; 302116491Sharti struct hevcc *vcc; 303116491Sharti int error = 0; 304116491Sharti 305116491Sharti DBG(sc, VCC, ("Close VCC: %u.%u", arg->vpi, arg->vci)); 306116491Sharti 307116491Sharti if((arg->vpi & ~HE_VPI_MASK) || 308116491Sharti (arg->vci & ~HE_VCI_MASK) || 309116491Sharti (arg->vci == 0)) 310116491Sharti return (EINVAL); 311116491Sharti cid = HE_CID(arg->vpi, arg->vci); 312116491Sharti 313116491Sharti mtx_lock(&sc->mtx); 314116491Sharti vcc = sc->vccs[cid]; 315116491Sharti if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) { 316116491Sharti error = EIO; 317116491Sharti goto done; 318116491Sharti } 319116491Sharti 320116491Sharti if (vcc == NULL || !(vcc->vflags & HE_VCC_OPEN)) { 321116491Sharti error = ENOENT; 322116491Sharti goto done; 323116491Sharti } 324116491Sharti 325116491Sharti if (vcc->vflags & HE_VCC_TX_OPEN) 326116491Sharti hatm_tx_vcc_close(sc, cid); 327116491Sharti if (vcc->vflags & HE_VCC_RX_OPEN) 328116491Sharti hatm_rx_vcc_close(sc, cid); 329116491Sharti 330116491Sharti if (vcc->vflags & HE_VCC_ASYNC) 331116491Sharti goto done; 332116491Sharti 333116491Sharti while ((sc->ifatm.ifnet.if_flags & IFF_RUNNING) && 334116491Sharti (vcc->vflags & (HE_VCC_TX_CLOSING | HE_VCC_RX_CLOSING))) 335116491Sharti cv_wait(&sc->vcc_cv, &sc->mtx); 336116491Sharti 337116491Sharti if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) { 338116491Sharti error = EIO; 339116491Sharti goto done; 340116491Sharti } 341116491Sharti 342116491Sharti if (!(vcc->vflags & ATMIO_FLAG_NOTX)) 343116491Sharti hatm_tx_vcc_closed(sc, cid); 344116491Sharti 345116491Sharti hatm_vcc_closed(sc, cid); 346116491Sharti 347116491Sharti done: 348116491Sharti mtx_unlock(&sc->mtx); 349116491Sharti return (error); 350116491Sharti} 351116491Sharti 352116491Shartistatic int 353116491Shartihatm_close_vcc1(struct hatm_softc *sc, struct atm_pseudoioctl *ph) 354116491Sharti{ 355116491Sharti struct atmio_closevcc v; 356116491Sharti 357116491Sharti v.vpi = ATM_PH_VPI(&ph->aph); 358116491Sharti v.vci = ATM_PH_VCI(&ph->aph); 359116491Sharti 360116491Sharti return (hatm_close_vcc(sc, &v)); 361116491Sharti} 362116491Sharti 363116491Sharti/* 364116491Sharti * IOCTL handler 365116491Sharti */ 366116491Shartiint 367116491Shartihatm_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 368116491Sharti{ 369116491Sharti struct ifreq *ifr = (struct ifreq *)data; 370116491Sharti struct ifaddr *ifa = (struct ifaddr *)data; 371116491Sharti struct hatm_softc *sc = (struct hatm_softc *)ifp->if_softc; 372116491Sharti struct atmio_vcctable *vtab; 373116491Sharti int error = 0; 374116491Sharti 375116491Sharti switch (cmd) { 376116491Sharti 377116491Sharti case SIOCSIFADDR: 378116491Sharti mtx_lock(&sc->mtx); 379116491Sharti ifp->if_flags |= IFF_UP; 380116491Sharti if (!(ifp->if_flags & IFF_RUNNING)) 381116491Sharti hatm_initialize(sc); 382116491Sharti switch (ifa->ifa_addr->sa_family) { 383116491Sharti 384116491Sharti#ifdef INET 385116491Sharti case AF_INET: 386116491Sharti case AF_INET6: 387116491Sharti ifa->ifa_rtrequest = atm_rtrequest; 388116491Sharti break; 389116491Sharti#endif 390116491Sharti default: 391116491Sharti break; 392116491Sharti } 393116491Sharti mtx_unlock(&sc->mtx); 394116491Sharti break; 395116491Sharti 396116491Sharti case SIOCSIFFLAGS: 397116491Sharti mtx_lock(&sc->mtx); 398116491Sharti if (ifp->if_flags & IFF_UP) { 399116491Sharti if (!(ifp->if_flags & IFF_RUNNING)) { 400116491Sharti hatm_initialize(sc); 401116491Sharti } 402116491Sharti } else { 403116491Sharti if (ifp->if_flags & IFF_RUNNING) { 404116491Sharti hatm_stop(sc); 405116491Sharti } 406116491Sharti } 407116491Sharti mtx_unlock(&sc->mtx); 408116491Sharti break; 409116491Sharti 410116491Sharti case SIOCGIFMEDIA: 411116491Sharti case SIOCSIFMEDIA: 412116491Sharti error = ifmedia_ioctl(ifp, ifr, &sc->media, cmd); 413116491Sharti break; 414116491Sharti 415116491Sharti case SIOCSIFMTU: 416116491Sharti /* 417116491Sharti * Set the interface MTU. 418116491Sharti */ 419116491Sharti if (ifr->ifr_mtu > ATMMTU) 420116491Sharti error = EINVAL; 421116491Sharti else 422116491Sharti ifp->if_mtu = ifr->ifr_mtu; 423116491Sharti break; 424116491Sharti 425116491Sharti case SIOCATMGVCCS: 426116491Sharti /* return vcc table */ 427116491Sharti vtab = hatm_getvccs(sc); 428116491Sharti if (vtab == NULL) { 429116491Sharti error = ENOMEM; 430116491Sharti break; 431116491Sharti } 432116491Sharti error = copyout(vtab, ifr->ifr_data, sizeof(*vtab) + 433116491Sharti vtab->count * sizeof(vtab->vccs[0])); 434116491Sharti free(vtab, M_DEVBUF); 435116491Sharti break; 436116491Sharti 437116491Sharti case SIOCATMENA: /* NATM internal use */ 438116491Sharti error = hatm_open_vcc1(sc, (struct atm_pseudoioctl *)data); 439116491Sharti break; 440116491Sharti 441116491Sharti case SIOCATMDIS: /* NATM internal use */ 442116491Sharti error = hatm_close_vcc1(sc, (struct atm_pseudoioctl *)data); 443116491Sharti break; 444116491Sharti 445116491Sharti case SIOCATMGETVCCS: /* netgraph internal use */ 446116491Sharti if ((vtab = hatm_getvccs(sc)) == NULL) { 447116491Sharti error = ENOMEM; 448116491Sharti break; 449116491Sharti } 450116491Sharti *(void **)data = vtab; 451116491Sharti break; 452116491Sharti 453116491Sharti case SIOCATMOPENVCC: /* netgraph/harp internal use */ 454116491Sharti error = hatm_open_vcc(sc, (struct atmio_openvcc *)data); 455116491Sharti break; 456116491Sharti 457116491Sharti case SIOCATMCLOSEVCC: /* netgraph and HARP internal use */ 458116491Sharti error = hatm_close_vcc(sc, (struct atmio_closevcc *)data); 459116491Sharti break; 460116491Sharti 461116491Sharti default: 462116491Sharti DBG(sc, IOCTL, ("cmd=%08lx arg=%p", cmd, data)); 463116491Sharti error = EINVAL; 464116491Sharti break; 465116491Sharti } 466116491Sharti 467116491Sharti return (error); 468116491Sharti} 469116491Sharti 470116491Shartistatic int 471116491Shartihatm_sysctl_natm_traffic(SYSCTL_HANDLER_ARGS) 472116491Sharti{ 473116491Sharti int error; 474116491Sharti int tmp; 475116491Sharti 476116491Sharti tmp = hatm_natm_traffic; 477116491Sharti error = sysctl_handle_int(oidp, &tmp, 0, req); 478116491Sharti if (error != 0 || req->newptr == NULL) 479116491Sharti return (error); 480116491Sharti 481116491Sharti if (tmp != ATMIO_TRAFFIC_UBR && tmp != ATMIO_TRAFFIC_CBR) 482116491Sharti return (EINVAL); 483116491Sharti 484116491Sharti hatm_natm_traffic = tmp; 485116491Sharti return (0); 486116491Sharti} 487