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