sys/netinet/if_atm.c

   1 /*      $NetBSD: if_atm.c,v 1.6 1996/10/13 02:03:01 christos Exp $       */
   2
   3 /*-
   4  *
   5  * Copyright (c) 1996 Charles D. Cranor and Washington University.
   6  * All rights reserved.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions
  10  * are met:
  11  * 1. Redistributions of source code must retain the above copyright
  12  *    notice, this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright
  14  *    notice, this list of conditions and the following disclaimer in the
  15  *    documentation and/or other materials provided with the distribution.
  16  * 3. All advertising materials mentioning features or use of this software
  17  *    must display the following acknowledgement:
  18  *      This product includes software developed by Charles D. Cranor and
  19  *      Washington University.
  20  * 4. The name of the author may not be used to endorse or promote products
  21  *    derived from this software without specific prior written permission.
  22  *
  23  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  24  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  25  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  26  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  28  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  29  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  30  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  31  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  32  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  33  */
  34 #include <sys/cdefs.h>
  35 __FBSDID("$FreeBSD$");
  36
  37 /*
  38  * IP <=> ATM address resolution.
  39  */
  40 #include "opt_inet.h"
  41 #include "opt_inet6.h"
  42 #include "opt_natm.h"
  43
  44 #if defined(INET) || defined(INET6)
  45
  46 #include <sys/param.h>
  47 #include <sys/systm.h>
  48 #include <sys/queue.h>
  49 #include <sys/mbuf.h>
  50 #include <sys/socket.h>
  51 #include <sys/sockio.h>
  52 #include <sys/syslog.h>
  53
  54 #include <net/if.h>
  55 #include <net/if_var.h>
  56 #include <net/if_dl.h>
  57 #include <net/route.h>
  58 #include <net/if_atm.h>
  59
  60 #include <netinet/in.h>
  61 #include <netinet/if_atm.h>
  62
  63 #ifdef NATM
  64 #include <netnatm/natm.h>
  65 #endif
  66
  67 #define SDL(s) ((struct sockaddr_dl *)s)
  68
  69 #define GET3BYTE(V, A, L)       do {                            \
  70         (V) = ((A)[0] << 16) | ((A)[1] << 8) | (A)[2];          \
  71         (A) += 3;                                               \
  72         (L) -= 3;                                               \
  73     } while (0)
  74
  75 #define GET2BYTE(V, A, L)       do {                            \
  76         (V) = ((A)[0] << 8) | (A)[1];                           \
  77         (A) += 2;                                               \
  78         (L) -= 2;                                               \
  79     } while (0)
  80
  81 #define GET1BYTE(V, A, L)       do {                            \
  82         (V) = *(A)++;                                           \
  83         (L)--;                                                  \
  84     } while (0)
  85
  86
  87 /*
  88  * atm_rtrequest: handle ATM rt request (in support of generic code)
  89  *   inputs: "req" = request code
  90  *           "rt" = route entry
  91  *           "info" = rt_addrinfo
  92  */
  93 void
  94 atm_rtrequest(int req, struct rtentry *rt, struct rt_addrinfo *info)
  95 {
  96         struct sockaddr *gate = rt->rt_gateway;
  97         struct atmio_openvcc op;
  98         struct atmio_closevcc cl;
  99         u_char *addr;
 100         u_int alen;
 101 #ifdef NATM
 102         struct sockaddr_in *sin;
 103         struct natmpcb *npcb = NULL;
 104 #endif
 105         static struct sockaddr_dl null_sdl = {sizeof(null_sdl), AF_LINK};
 106
 107         if (rt->rt_flags & RTF_GATEWAY)   /* link level requests only */
 108                 return;
 109
 110         switch (req) {
 111
 112         case RTM_RESOLVE: /* resolve: only happens when cloning */
 113                 printf("atm_rtrequest: RTM_RESOLVE request detected?\n");
 114                 break;
 115
 116         case RTM_ADD:
 117                 /*
 118                  * route added by a command (e.g. ifconfig, route, arp...).
 119                  *
 120                  * first check to see if this is not a host route, in which
 121                  * case we are being called via "ifconfig" to set the address.
 122                  */
 123                 if ((rt->rt_flags & RTF_HOST) == 0) {
 124                         rt_setgate(rt,rt_key(rt),(struct sockaddr *)&null_sdl);
 125                         gate = rt->rt_gateway;
 126                         SDL(gate)->sdl_type = rt->rt_ifp->if_type;
 127                         SDL(gate)->sdl_index = rt->rt_ifp->if_index;
 128                         break;
 129                 }
 130
 131                 if (gate->sa_family != AF_LINK ||
 132                     gate->sa_len < sizeof(null_sdl)) {
 133                         log(LOG_DEBUG, "atm_rtrequest: bad gateway value");
 134                         break;
 135                 }
 136
 137                 KASSERT(rt->rt_ifp->if_ioctl != NULL,
 138                     ("atm_rtrequest: null ioctl"));
 139
 140                 /*
 141                  * Parse and verify the link level address as
 142                  * an open request
 143                  */
 144 #ifdef NATM
 145                 NATM_LOCK();
 146 #endif
 147                 bzero(&op, sizeof(op));
 148                 addr = LLADDR(SDL(gate));
 149                 alen = SDL(gate)->sdl_alen;
 150                 if (alen < 4) {
 151                         printf("%s: bad link-level address\n", __func__);
 152                         goto failed;
 153                 }
 154
 155                 if (alen == 4) {
 156                         /* old type address */
 157                         GET1BYTE(op.param.flags, addr, alen);
 158                         GET1BYTE(op.param.vpi, addr, alen);
 159                         GET2BYTE(op.param.vci, addr, alen);
 160                         op.param.traffic = ATMIO_TRAFFIC_UBR;
 161                         op.param.aal = (op.param.flags & ATM_PH_AAL5) ?
 162                             ATMIO_AAL_5 : ATMIO_AAL_0;
 163                 } else {
 164                         /* new address */
 165                         op.param.aal = ATMIO_AAL_5;
 166
 167                         GET1BYTE(op.param.flags, addr, alen);
 168                         op.param.flags &= ATM_PH_LLCSNAP;
 169
 170                         GET1BYTE(op.param.vpi, addr, alen);
 171                         GET2BYTE(op.param.vci, addr, alen);
 172
 173                         GET1BYTE(op.param.traffic, addr, alen);
 174
 175                         switch (op.param.traffic) {
 176
 177                           case ATMIO_TRAFFIC_UBR:
 178                                 if (alen >= 3)
 179                                         GET3BYTE(op.param.tparam.pcr,
 180                                             addr, alen);
 181                                 break;
 182
 183                           case ATMIO_TRAFFIC_CBR:
 184                                 if (alen < 3)
 185                                         goto bad_param;
 186                                 GET3BYTE(op.param.tparam.pcr, addr, alen);
 187                                 break;
 188
 189                           case ATMIO_TRAFFIC_VBR:
 190                                 if (alen < 3 * 3)
 191                                         goto bad_param;
 192                                 GET3BYTE(op.param.tparam.pcr, addr, alen);
 193                                 GET3BYTE(op.param.tparam.scr, addr, alen);
 194                                 GET3BYTE(op.param.tparam.mbs, addr, alen);
 195                                 break;
 196
 197                           case ATMIO_TRAFFIC_ABR:
 198                                 if (alen < 4 * 3 + 2 + 1 * 2 + 3)
 199                                         goto bad_param;
 200                                 GET3BYTE(op.param.tparam.pcr, addr, alen);
 201                                 GET3BYTE(op.param.tparam.mcr, addr, alen);
 202                                 GET3BYTE(op.param.tparam.icr, addr, alen);
 203                                 GET3BYTE(op.param.tparam.tbe, addr, alen);
 204                                 GET1BYTE(op.param.tparam.nrm, addr, alen);
 205                                 GET1BYTE(op.param.tparam.trm, addr, alen);
 206                                 GET2BYTE(op.param.tparam.adtf, addr, alen);
 207                                 GET1BYTE(op.param.tparam.rif, addr, alen);
 208                                 GET1BYTE(op.param.tparam.rdf, addr, alen);
 209                                 GET1BYTE(op.param.tparam.cdf, addr, alen);
 210                                 break;
 211
 212                           default:
 213                           bad_param:
 214                                 printf("%s: bad traffic params\n", __func__);
 215                                 goto failed;
 216                         }
 217                 }
 218                 op.param.rmtu = op.param.tmtu = rt->rt_ifp->if_mtu;
 219 #ifdef NATM
 220                 /*
 221                  * let native ATM know we are using this VCI/VPI
 222                  * (i.e. reserve it)
 223                  */
 224                 sin = (struct sockaddr_in *) rt_key(rt);
 225                 if (sin->sin_family != AF_INET)
 226                         goto failed;
 227                 npcb = npcb_add(NULL, rt->rt_ifp, op.param.vci,  op.param.vpi);
 228                 if (npcb == NULL)
 229                         goto failed;
 230                 npcb->npcb_flags |= NPCB_IP;
 231                 npcb->ipaddr.s_addr = sin->sin_addr.s_addr;
 232                 /* XXX: move npcb to llinfo when ATM ARP is ready */
 233 #ifdef __notyet_restored__
 234                 rt->rt_llinfo = (caddr_t) npcb;
 235 #endif
 236                 rt->rt_flags |= RTF_LLINFO;
 237 #endif
 238                 /*
 239                  * let the lower level know this circuit is active
 240                  */
 241                 op.rxhand = NULL;
 242                 op.param.flags |= ATMIO_FLAG_ASYNC;
 243                 if (rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMOPENVCC,
 244                     (caddr_t)&op) != 0) {
 245                         printf("atm: couldn't add VC\n");
 246                         goto failed;
 247                 }
 248
 249                 SDL(gate)->sdl_type = rt->rt_ifp->if_type;
 250                 SDL(gate)->sdl_index = rt->rt_ifp->if_index;
 251
 252 #ifdef NATM
 253                 NATM_UNLOCK();
 254 #endif
 255                 break;
 256
 257 failed:
 258 #ifdef NATM
 259                 if (npcb) {
 260                         npcb_free(npcb, NPCB_DESTROY);
 261 #ifdef __notyet_restored__
 262                         rt->rt_llinfo = NULL;
 263 #endif
 264                         rt->rt_flags &= ~RTF_LLINFO;
 265                 }
 266                 NATM_UNLOCK();
 267 #endif
 268                 /* mark as invalid. We cannot RTM_DELETE the route from
 269                  * here, because the recursive call to rtrequest1 does
 270                  * not really work. */
 271                 rt->rt_flags |= RTF_REJECT;
 272                 break;
 273
 274         case RTM_DELETE:
 275 #ifdef NATM
 276                 /*
 277                  * tell native ATM we are done with this VC
 278                  */
 279                 if (rt->rt_flags & RTF_LLINFO) {
 280                         NATM_LOCK();
 281 #ifdef __notyet_restored__
 282                         npcb_free((struct natmpcb *)rt->rt_llinfo,
 283                             NPCB_DESTROY);
 284                         rt->rt_llinfo = NULL;
 285 #endif
 286                         rt->rt_flags &= ~RTF_LLINFO;
 287                         NATM_UNLOCK();
 288                 }
 289 #endif
 290                 /*
 291                  * tell the lower layer to disable this circuit
 292                  */
 293                 bzero(&op, sizeof(op));
 294                 addr = LLADDR(SDL(gate));
 295                 addr++;
 296                 cl.vpi = *addr++;
 297                 cl.vci = *addr++ << 8;
 298                 cl.vci |= *addr++;
 299                 (void)rt->rt_ifp->if_ioctl(rt->rt_ifp, SIOCATMCLOSEVCC,
 300                     (caddr_t)&cl);
 301                 break;
 302         }
 303 }
 304
 305 /*
 306  * atmresolve:
 307  *   inputs:
 308  *     [1] "rt" = the link level route to use (or null if need to look one up)
 309  *     [2] "m" = mbuf containing the data to be sent
 310  *     [3] "dst" = sockaddr_in (IP) address of dest.
 311  *   output:
 312  *     [4] "desten" = ATM pseudo header which we will fill in VPI/VCI info
 313  *   return:
 314  *     0 == resolve FAILED; note that "m" gets m_freem'd in this case
 315  *     1 == resolve OK; desten contains result
 316  *
 317  *   XXX: will need more work if we wish to support ATMARP in the kernel,
 318  *   but this is enough for PVCs entered via the "route" command.
 319  */
 320 int
 321 atmresolve(struct rtentry *rt, struct mbuf *m, const struct sockaddr *dst,
 322     struct atm_pseudohdr *desten)
 323 {
 324         struct sockaddr_dl *sdl;
 325
 326         if (m->m_flags & (M_BCAST | M_MCAST)) {
 327                 log(LOG_INFO,
 328                     "atmresolve: BCAST/MCAST packet detected/dumped\n");
 329                 goto bad;
 330         }
 331
 332         if (rt == NULL) {
 333                 /* link level on table 0 XXX MRT */
 334                 rt = RTALLOC1(__DECONST(struct sockaddr *, dst), 0);
 335                 if (rt == NULL)
 336                         goto bad;       /* failed */
 337                 RT_REMREF(rt);          /* don't keep LL references */
 338                 if ((rt->rt_flags & RTF_GATEWAY) != 0 ||
 339                     rt->rt_gateway->sa_family != AF_LINK) {
 340                         RT_UNLOCK(rt);
 341                         goto bad;
 342                 }
 343                 RT_UNLOCK(rt);
 344         }
 345
 346         /*
 347          * note that rt_gateway is a sockaddr_dl which contains the
 348          * atm_pseudohdr data structure for this route.   we currently
 349          * don't need any rt_llinfo info (but will if we want to support
 350          * ATM ARP [c.f. if_ether.c]).
 351          */
 352         sdl = SDL(rt->rt_gateway);
 353
 354         /*
 355          * Check the address family and length is valid, the address
 356          * is resolved; otherwise, try to resolve.
 357          */
 358         if (sdl->sdl_family == AF_LINK && sdl->sdl_alen >= sizeof(*desten)) {
 359                 bcopy(LLADDR(sdl), desten, sizeof(*desten));
 360                 return (1);     /* ok, go for it! */
 361         }
 362
 363         /*
 364          * we got an entry, but it doesn't have valid link address
 365          * info in it (it is prob. the interface route, which has
 366          * sdl_alen == 0).    dump packet.  (fall through to "bad").
 367          */
 368 bad:
 369         m_freem(m);
 370         return (0);
 371 }
 372 #endif /* INET */