if_hatm_ioctl.c revision 118540
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 118540 2003-08-06 13:16:51Z 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 * Try to open the given VCC. 93116491Sharti */ 94116491Shartistatic int 95116491Shartihatm_open_vcc(struct hatm_softc *sc, struct atmio_openvcc *arg) 96116491Sharti{ 97116491Sharti u_int cid; 98116491Sharti struct hevcc *vcc; 99116491Sharti int error = 0; 100116491Sharti 101116491Sharti DBG(sc, VCC, ("Open VCC: %u.%u flags=%#x", arg->param.vpi, 102116491Sharti arg->param.vci, arg->param.flags)); 103116491Sharti 104116491Sharti if ((arg->param.vpi & ~HE_VPI_MASK) || 105116491Sharti (arg->param.vci & ~HE_VCI_MASK) || 106116491Sharti (arg->param.vci == 0)) 107116491Sharti return (EINVAL); 108116491Sharti cid = HE_CID(arg->param.vpi, arg->param.vci); 109116491Sharti 110116491Sharti if ((arg->param.flags & ATMIO_FLAG_NOTX) && 111116491Sharti (arg->param.flags & ATMIO_FLAG_NORX)) 112116491Sharti return (EINVAL); 113116491Sharti 114116491Sharti vcc = uma_zalloc(sc->vcc_zone, M_NOWAIT | M_ZERO); 115116491Sharti if (vcc == NULL) 116116491Sharti return (ENOMEM); 117116491Sharti 118116491Sharti mtx_lock(&sc->mtx); 119116491Sharti if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) { 120116491Sharti error = EIO; 121116491Sharti goto done; 122116491Sharti } 123116491Sharti if (sc->vccs[cid] != NULL) { 124116491Sharti error = EBUSY; 125116491Sharti goto done; 126116491Sharti } 127116491Sharti vcc->param = arg->param; 128116491Sharti vcc->rxhand = arg->rxhand; 129116491Sharti switch (vcc->param.aal) { 130116491Sharti 131116491Sharti case ATMIO_AAL_0: 132116491Sharti case ATMIO_AAL_5: 133116491Sharti case ATMIO_AAL_RAW: 134116491Sharti break; 135116491Sharti 136116491Sharti default: 137116491Sharti error = EINVAL; 138116491Sharti goto done; 139116491Sharti } 140116491Sharti switch (vcc->param.traffic) { 141116491Sharti 142116491Sharti case ATMIO_TRAFFIC_UBR: 143116491Sharti case ATMIO_TRAFFIC_CBR: 144116491Sharti case ATMIO_TRAFFIC_ABR: 145116491Sharti break; 146116491Sharti 147116491Sharti default: 148116491Sharti error = EINVAL; 149116491Sharti goto done; 150116491Sharti } 151116491Sharti vcc->ntpds = 0; 152116491Sharti vcc->chain = vcc->last = NULL; 153116491Sharti vcc->ibytes = vcc->ipackets = 0; 154116491Sharti vcc->obytes = vcc->opackets = 0; 155116491Sharti 156116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NOTX) && 157116491Sharti (error = hatm_tx_vcc_can_open(sc, cid, vcc)) != 0) 158116491Sharti goto done; 159116491Sharti 160116491Sharti /* ok - go ahead */ 161116491Sharti sc->vccs[cid] = vcc; 162116491Sharti 163116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NOTX)) 164116491Sharti hatm_tx_vcc_open(sc, cid); 165116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NORX)) 166116491Sharti hatm_rx_vcc_open(sc, cid); 167116491Sharti 168116491Sharti /* inform management about non-NG and NG-PVCs */ 169116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NG) || 170116491Sharti (vcc->param.flags & ATMIO_FLAG_PVC)) 171118170Sharti ATMEV_SEND_VCC_CHANGED(&sc->ifatm, arg->param.vpi, 172118170Sharti arg->param.vci, 1); 173116491Sharti 174116491Sharti /* don't free below */ 175116491Sharti vcc = NULL; 176116491Sharti 177116491Sharti sc->open_vccs++; 178116491Sharti 179116491Sharti done: 180116491Sharti mtx_unlock(&sc->mtx); 181116491Sharti if (vcc != NULL) 182116491Sharti uma_zfree(sc->vcc_zone, vcc); 183116491Sharti return (error); 184116491Sharti} 185116491Sharti 186116491Sharti/* 187116491Sharti * Enable ioctl for NATM. Map to an open ioctl. 188116491Sharti */ 189116491Shartistatic int 190116491Shartihatm_open_vcc1(struct hatm_softc *sc, struct atm_pseudoioctl *ph) 191116491Sharti{ 192116491Sharti struct atmio_openvcc *v; 193116491Sharti int error; 194116491Sharti 195116491Sharti if ((v = malloc(sizeof(*v), M_TEMP, M_NOWAIT | M_ZERO)) == NULL) 196116491Sharti return (ENOMEM); 197116491Sharti 198116491Sharti v->param.flags = ATM_PH_FLAGS(&ph->aph) & 199116491Sharti (ATM_PH_AAL5 | ATM_PH_LLCSNAP); 200118540Sharti v->param.flags |= ATMIO_FLAG_ASYNC; 201116491Sharti v->param.vpi = ATM_PH_VPI(&ph->aph); 202116491Sharti v->param.vci = ATM_PH_VCI(&ph->aph); 203116491Sharti v->param.aal = (ATM_PH_FLAGS(&ph->aph) & ATM_PH_AAL5) 204116491Sharti ? ATMIO_AAL_5 : ATMIO_AAL_0; 205116491Sharti v->param.traffic = hatm_natm_traffic; 206116491Sharti v->rxhand = ph->rxhand; 207116491Sharti if ((v->param.tparam.pcr = hatm_natm_pcr) == 0 || 208116491Sharti hatm_natm_pcr > sc->ifatm.mib.pcr) 209116491Sharti v->param.tparam.pcr = sc->ifatm.mib.pcr; 210116491Sharti v->param.tparam.mcr = 0; 211116491Sharti 212116491Sharti error = hatm_open_vcc(sc, v); 213116491Sharti 214116491Sharti free(v, M_TEMP); 215116491Sharti 216116491Sharti return (error); 217116491Sharti} 218116491Sharti 219116491Sharti/* 220116491Sharti * VCC has been finally closed. 221116491Sharti */ 222116491Shartivoid 223116491Shartihatm_vcc_closed(struct hatm_softc *sc, u_int cid) 224116491Sharti{ 225116491Sharti struct hevcc *vcc = sc->vccs[cid]; 226116491Sharti 227116491Sharti /* inform management about non-NG and NG-PVCs */ 228116491Sharti if (!(vcc->param.flags & ATMIO_FLAG_NG) || 229116491Sharti (vcc->param.flags & ATMIO_FLAG_PVC)) 230118170Sharti ATMEV_SEND_VCC_CHANGED(&sc->ifatm, HE_VPI(cid), HE_VCI(cid), 0); 231116491Sharti 232116491Sharti sc->open_vccs--; 233116491Sharti uma_zfree(sc->vcc_zone, vcc); 234116491Sharti sc->vccs[cid] = NULL; 235116491Sharti} 236116491Sharti 237116491Sharti/* 238116491Sharti * Try to close the given VCC 239116491Sharti */ 240116491Shartistatic int 241116491Shartihatm_close_vcc(struct hatm_softc *sc, struct atmio_closevcc *arg) 242116491Sharti{ 243116491Sharti u_int cid; 244116491Sharti struct hevcc *vcc; 245116491Sharti int error = 0; 246116491Sharti 247116491Sharti DBG(sc, VCC, ("Close VCC: %u.%u", arg->vpi, arg->vci)); 248116491Sharti 249116491Sharti if((arg->vpi & ~HE_VPI_MASK) || 250116491Sharti (arg->vci & ~HE_VCI_MASK) || 251116491Sharti (arg->vci == 0)) 252116491Sharti return (EINVAL); 253116491Sharti cid = HE_CID(arg->vpi, arg->vci); 254116491Sharti 255116491Sharti mtx_lock(&sc->mtx); 256116491Sharti vcc = sc->vccs[cid]; 257116491Sharti if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) { 258116491Sharti error = EIO; 259116491Sharti goto done; 260116491Sharti } 261116491Sharti 262116491Sharti if (vcc == NULL || !(vcc->vflags & HE_VCC_OPEN)) { 263116491Sharti error = ENOENT; 264116491Sharti goto done; 265116491Sharti } 266116491Sharti 267116491Sharti if (vcc->vflags & HE_VCC_TX_OPEN) 268116491Sharti hatm_tx_vcc_close(sc, cid); 269116491Sharti if (vcc->vflags & HE_VCC_RX_OPEN) 270116491Sharti hatm_rx_vcc_close(sc, cid); 271116491Sharti 272118540Sharti if (vcc->param.flags & ATMIO_FLAG_ASYNC) 273116491Sharti goto done; 274116491Sharti 275116491Sharti while ((sc->ifatm.ifnet.if_flags & IFF_RUNNING) && 276116491Sharti (vcc->vflags & (HE_VCC_TX_CLOSING | HE_VCC_RX_CLOSING))) 277116491Sharti cv_wait(&sc->vcc_cv, &sc->mtx); 278116491Sharti 279116491Sharti if (!(sc->ifatm.ifnet.if_flags & IFF_RUNNING)) { 280116491Sharti error = EIO; 281116491Sharti goto done; 282116491Sharti } 283116491Sharti 284116491Sharti if (!(vcc->vflags & ATMIO_FLAG_NOTX)) 285116491Sharti hatm_tx_vcc_closed(sc, cid); 286116491Sharti 287116491Sharti hatm_vcc_closed(sc, cid); 288116491Sharti 289116491Sharti done: 290116491Sharti mtx_unlock(&sc->mtx); 291116491Sharti return (error); 292116491Sharti} 293116491Sharti 294116491Shartistatic int 295116491Shartihatm_close_vcc1(struct hatm_softc *sc, struct atm_pseudoioctl *ph) 296116491Sharti{ 297116491Sharti struct atmio_closevcc v; 298116491Sharti 299116491Sharti v.vpi = ATM_PH_VPI(&ph->aph); 300116491Sharti v.vci = ATM_PH_VCI(&ph->aph); 301116491Sharti 302116491Sharti return (hatm_close_vcc(sc, &v)); 303116491Sharti} 304116491Sharti 305116491Sharti/* 306116491Sharti * IOCTL handler 307116491Sharti */ 308116491Shartiint 309116491Shartihatm_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 310116491Sharti{ 311116491Sharti struct ifreq *ifr = (struct ifreq *)data; 312116491Sharti struct ifaddr *ifa = (struct ifaddr *)data; 313116491Sharti struct hatm_softc *sc = (struct hatm_softc *)ifp->if_softc; 314116491Sharti struct atmio_vcctable *vtab; 315116491Sharti int error = 0; 316116491Sharti 317116491Sharti switch (cmd) { 318116491Sharti 319116491Sharti case SIOCSIFADDR: 320116491Sharti mtx_lock(&sc->mtx); 321116491Sharti ifp->if_flags |= IFF_UP; 322116491Sharti if (!(ifp->if_flags & IFF_RUNNING)) 323116491Sharti hatm_initialize(sc); 324116491Sharti switch (ifa->ifa_addr->sa_family) { 325116491Sharti 326116491Sharti#ifdef INET 327116491Sharti case AF_INET: 328116491Sharti case AF_INET6: 329116491Sharti ifa->ifa_rtrequest = atm_rtrequest; 330116491Sharti break; 331116491Sharti#endif 332116491Sharti default: 333116491Sharti break; 334116491Sharti } 335116491Sharti mtx_unlock(&sc->mtx); 336116491Sharti break; 337116491Sharti 338116491Sharti case SIOCSIFFLAGS: 339116491Sharti mtx_lock(&sc->mtx); 340116491Sharti if (ifp->if_flags & IFF_UP) { 341116491Sharti if (!(ifp->if_flags & IFF_RUNNING)) { 342116491Sharti hatm_initialize(sc); 343116491Sharti } 344116491Sharti } else { 345116491Sharti if (ifp->if_flags & IFF_RUNNING) { 346116491Sharti hatm_stop(sc); 347116491Sharti } 348116491Sharti } 349116491Sharti mtx_unlock(&sc->mtx); 350116491Sharti break; 351116491Sharti 352116491Sharti case SIOCGIFMEDIA: 353116491Sharti case SIOCSIFMEDIA: 354116491Sharti error = ifmedia_ioctl(ifp, ifr, &sc->media, cmd); 355116491Sharti break; 356116491Sharti 357116491Sharti case SIOCSIFMTU: 358116491Sharti /* 359116491Sharti * Set the interface MTU. 360116491Sharti */ 361116491Sharti if (ifr->ifr_mtu > ATMMTU) 362116491Sharti error = EINVAL; 363116491Sharti else 364116491Sharti ifp->if_mtu = ifr->ifr_mtu; 365116491Sharti break; 366116491Sharti 367116491Sharti case SIOCATMGVCCS: 368116491Sharti /* return vcc table */ 369118205Sharti vtab = atm_getvccs((struct atmio_vcc **)sc->vccs, 370118205Sharti HE_MAX_VCCS, sc->open_vccs, &sc->mtx, 1); 371116491Sharti error = copyout(vtab, ifr->ifr_data, sizeof(*vtab) + 372116491Sharti vtab->count * sizeof(vtab->vccs[0])); 373116491Sharti free(vtab, M_DEVBUF); 374116491Sharti break; 375116491Sharti 376116491Sharti case SIOCATMENA: /* NATM internal use */ 377116491Sharti error = hatm_open_vcc1(sc, (struct atm_pseudoioctl *)data); 378116491Sharti break; 379116491Sharti 380116491Sharti case SIOCATMDIS: /* NATM internal use */ 381116491Sharti error = hatm_close_vcc1(sc, (struct atm_pseudoioctl *)data); 382116491Sharti break; 383116491Sharti 384116491Sharti case SIOCATMGETVCCS: /* netgraph internal use */ 385118205Sharti vtab = atm_getvccs((struct atmio_vcc **)sc->vccs, 386118205Sharti HE_MAX_VCCS, sc->open_vccs, &sc->mtx, 0); 387118205Sharti if (vtab == NULL) { 388116491Sharti error = ENOMEM; 389116491Sharti break; 390116491Sharti } 391116491Sharti *(void **)data = vtab; 392116491Sharti break; 393116491Sharti 394116491Sharti case SIOCATMOPENVCC: /* netgraph/harp internal use */ 395116491Sharti error = hatm_open_vcc(sc, (struct atmio_openvcc *)data); 396116491Sharti break; 397116491Sharti 398116491Sharti case SIOCATMCLOSEVCC: /* netgraph and HARP internal use */ 399116491Sharti error = hatm_close_vcc(sc, (struct atmio_closevcc *)data); 400116491Sharti break; 401116491Sharti 402116491Sharti default: 403116491Sharti DBG(sc, IOCTL, ("cmd=%08lx arg=%p", cmd, data)); 404116491Sharti error = EINVAL; 405116491Sharti break; 406116491Sharti } 407116491Sharti 408116491Sharti return (error); 409116491Sharti} 410116491Sharti 411116491Shartistatic int 412116491Shartihatm_sysctl_natm_traffic(SYSCTL_HANDLER_ARGS) 413116491Sharti{ 414116491Sharti int error; 415116491Sharti int tmp; 416116491Sharti 417116491Sharti tmp = hatm_natm_traffic; 418116491Sharti error = sysctl_handle_int(oidp, &tmp, 0, req); 419116491Sharti if (error != 0 || req->newptr == NULL) 420116491Sharti return (error); 421116491Sharti 422116491Sharti if (tmp != ATMIO_TRAFFIC_UBR && tmp != ATMIO_TRAFFIC_CBR) 423116491Sharti return (EINVAL); 424116491Sharti 425116491Sharti hatm_natm_traffic = tmp; 426116491Sharti return (0); 427116491Sharti} 428