sys/netiso/cltp_usrreq.c

   1 /*      $NetBSD: cltp_usrreq.c,v 1.39 2009/03/18 17:06:52 cegger Exp $  */
   2
   3 /*
   4  * Copyright (c) 1989, 1993
   5  *      The Regents of the University of California.  All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  * 3. Neither the name of the University nor the names of its contributors
  16  *    may be used to endorse or promote products derived from this software
  17  *    without specific prior written permission.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  29  * SUCH DAMAGE.
  30  *
  31  *      @(#)cltp_usrreq.c       8.1 (Berkeley) 6/10/93
  32  */
  33
  34 #include <sys/cdefs.h>
  35 __KERNEL_RCSID(0, "$NetBSD: cltp_usrreq.c,v 1.39 2009/03/18 17:06:52 cegger Exp $");
  36
  37 #ifndef CLTPOVAL_SRC            /* XXX -- till files gets changed */
  38 #include <sys/param.h>
  39 #include <sys/malloc.h>
  40 #include <sys/mbuf.h>
  41 #include <sys/protosw.h>
  42 #include <sys/socket.h>
  43 #include <sys/socketvar.h>
  44 #include <sys/errno.h>
  45 #include <sys/stat.h>
  46 #include <sys/systm.h>
  47 #include <sys/proc.h>
  48
  49 #include <net/if.h>
  50 #include <net/route.h>
  51
  52 #include <netiso/argo_debug.h>
  53 #include <netiso/iso.h>
  54 #include <netiso/iso_pcb.h>
  55 #include <netiso/iso_var.h>
  56 #include <netiso/clnp.h>
  57 #include <netiso/cltp_var.h>
  58 #include <netiso/tp_param.h>
  59 #include <netiso/tp_var.h>
  60
  61 #include <machine/stdarg.h>
  62 #endif
  63
  64
  65 /*
  66  * CLTP protocol implementation.
  67  * Per ISO 8602, December, 1987.
  68  */
  69 void
  70 cltp_init(void)
  71 {
  72
  73         cltb.isop_next = cltb.isop_prev = &cltb;
  74 }
  75
  76 int cltp_cksum = 1;
  77 struct isopcb   cltb;
  78 struct cltpstat cltpstat;
  79
  80
  81 /* ARGUSED */
  82 void
  83 cltp_input(struct mbuf *m0, ...)
  84 {
  85         struct sockaddr *srcsa, *dstsa;
  86         u_int           cons_channel;
  87         struct isopcb *isop;
  88         struct mbuf *m = m0;
  89         struct mbuf *m_src = 0;
  90         u_char *up = mtod(m, u_char *);
  91         struct sockaddr_iso *src;
  92         int             len, hdrlen = *up + 1, dlen = 0;
  93         u_char         *uplim = up + hdrlen;
  94         void *        dtsap = NULL;
  95         va_list ap;
  96
  97         va_start(ap, m0);
  98         srcsa = va_arg(ap, struct sockaddr *);
  99         dstsa = va_arg(ap, struct sockaddr *);
 100         cons_channel = va_arg(ap, int);
 101         va_end(ap);
 102         src = satosiso(srcsa);
 103
 104         for (len = 0; m; m = m->m_next)
 105                 len += m->m_len;
 106         up += 2;                /* skip header */
 107         while (up < uplim)
 108                 switch (*up) {  /* process options */
 109                 case CLTPOVAL_SRC:
 110                         src->siso_tlen = up[1];
 111                         src->siso_len = up[1] +
 112                             ((const char *)TSEL(src) - (const char *)src);
 113                         if (src->siso_len < sizeof(*src))
 114                                 src->siso_len = sizeof(*src);
 115                         else if (src->siso_len > sizeof(*src)) {
 116                                 MGET(m_src, M_DONTWAIT, MT_SONAME);
 117                                 if (m_src == 0)
 118                                         goto bad;
 119                                 m_src->m_len = src->siso_len;
 120                                 src = mtod(m_src, struct sockaddr_iso *);
 121                                 memcpy((void *) src, (void *) srcsa, srcsa->sa_len);
 122                         }
 123                         memcpy(WRITABLE_TSEL(src), (char *)up + 2, up[1]);
 124                         up += 2 + src->siso_tlen;
 125                         continue;
 126
 127                 case CLTPOVAL_DST:
 128                         dtsap = 2 + (char *)up;
 129                         dlen = up[1];
 130                         up += 2 + dlen;
 131                         continue;
 132
 133                 case CLTPOVAL_CSM:
 134                         if (iso_check_csum(m0, len)) {
 135                                 cltpstat.cltps_badsum++;
 136                                 goto bad;
 137                         }
 138                         up += 4;
 139                         continue;
 140
 141                 default:
 142                         printf("clts: unknown option (%x)\n", up[0]);
 143                         cltpstat.cltps_hdrops++;
 144                         goto bad;
 145                 }
 146         if (dlen == 0 || src->siso_tlen == 0)
 147                 goto bad;
 148         for (isop = cltb.isop_next;; isop = isop->isop_next) {
 149                 if (isop == &cltb) {
 150                         cltpstat.cltps_noport++;
 151                         goto bad;
 152                 }
 153                 if (isop->isop_laddr &&
 154                     memcmp(TSEL(isop->isop_laddr), dtsap, dlen) == 0)
 155                         break;
 156         }
 157         m = m0;
 158         m->m_len -= hdrlen;
 159         m->m_data += hdrlen;
 160         if (sbappendaddr(&isop->isop_socket->so_rcv, sisotosa(src), m,
 161                          (struct mbuf *) 0) == 0)
 162                 goto bad;
 163         cltpstat.cltps_ipackets++;
 164         sorwakeup(isop->isop_socket);
 165         m0 = 0;
 166 bad:
 167         if (src != satosiso(srcsa))
 168                 m_freem(m_src);
 169         if (m0)
 170                 m_freem(m0);
 171 }
 172
 173 /*
 174  * Notify a cltp user of an asynchronous error;
 175  * just wake up so that he can collect error status.
 176  */
 177 void
 178 cltp_notify(struct isopcb *isop)
 179 {
 180
 181         sorwakeup(isop->isop_socket);
 182         sowwakeup(isop->isop_socket);
 183 }
 184
 185 void
 186 cltp_ctlinput(
 187     int cmd,
 188     const struct sockaddr *sa,
 189     void *dummy)
 190 {
 191         const struct sockaddr_iso *siso;
 192
 193         if ((unsigned)cmd >= PRC_NCMDS)
 194                 return;
 195         if (sa->sa_family != AF_ISO && sa->sa_family != AF_CCITT)
 196                 return;
 197         siso = satocsiso(sa);
 198         if (siso == 0 || siso->siso_nlen == 0)
 199                 return;
 200
 201         switch (cmd) {
 202         case PRC_ROUTEDEAD:
 203         case PRC_REDIRECT_NET:
 204         case PRC_REDIRECT_HOST:
 205         case PRC_REDIRECT_TOSNET:
 206         case PRC_REDIRECT_TOSHOST:
 207                 iso_pcbnotify(&cltb, siso,
 208                               (int) isoctlerrmap[cmd], iso_rtchange);
 209                 break;
 210
 211         default:
 212                 if (isoctlerrmap[cmd] == 0)
 213                         return; /* XXX */
 214                 iso_pcbnotify(&cltb, siso, (int) isoctlerrmap[cmd],
 215                               cltp_notify);
 216         }
 217 }
 218
 219 int
 220 cltp_output(struct mbuf *m, ...)
 221 {
 222         struct isopcb *isop;
 223         int    len;
 224         struct sockaddr_iso *siso;
 225         int             hdrlen, error = 0, docsum;
 226         u_char *up;
 227         va_list ap;
 228
 229         va_start(ap, m);
 230         isop = va_arg(ap, struct isopcb *);
 231         va_end(ap);
 232
 233         if (isop->isop_laddr == 0 || isop->isop_faddr == 0) {
 234                 error = ENOTCONN;
 235                 goto bad;
 236         }
 237         /*
 238          * Calculate data length and get a mbuf for CLTP header.
 239          */
 240         hdrlen = 2 + 2 + isop->isop_laddr->siso_tlen
 241                 + 2 + isop->isop_faddr->siso_tlen;
 242         docsum = /* isop->isop_flags & CLNP_NO_CKSUM */ cltp_cksum;
 243         if (docsum)
 244                 hdrlen += 4;
 245         M_PREPEND(m, hdrlen, M_WAIT);
 246         len = m->m_pkthdr.len;
 247         /*
 248          * Fill in mbuf with extended CLTP header
 249          */
 250         up = mtod(m, u_char *);
 251         up[0] = hdrlen - 1;
 252         up[1] = UD_TPDU_type;
 253         up[2] = CLTPOVAL_SRC;
 254         up[3] = (siso = isop->isop_laddr)->siso_tlen;
 255         up += 4;
 256         memcpy((void *) up, TSEL(siso), siso->siso_tlen);
 257         up += siso->siso_tlen;
 258         up[0] = CLTPOVAL_DST;
 259         up[1] = (siso = isop->isop_faddr)->siso_tlen;
 260         up += 2;
 261         memcpy((void *) up, TSEL(siso), siso->siso_tlen);
 262         /*
 263          * Stuff checksum and output datagram.
 264          */
 265         if (docsum) {
 266                 up += siso->siso_tlen;
 267                 up[0] = CLTPOVAL_CSM;
 268                 up[1] = 2;
 269                 iso_gen_csum(m, 2 + up - mtod(m, u_char *), len);
 270         }
 271         cltpstat.cltps_opackets++;
 272         return (tpclnp_output(m, len, isop, !docsum));
 273 bad:
 274         m_freem(m);
 275         return (error);
 276 }
 277
 278 u_long          cltp_sendspace = 9216;  /* really max datagram size */
 279 u_long          cltp_recvspace = 40 * (1024 + sizeof(struct sockaddr_iso));
 280 /* 40 1K datagrams */
 281
 282
 283 /* ARGSUSED */
 284 int
 285 cltp_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam, struct mbuf *control, struct lwp *l)
 286 {
 287         struct isopcb *isop;
 288         int s;
 289         int error = 0;
 290
 291         if (req == PRU_CONTROL)
 292                 return (iso_control(so, (long)m, (void *)nam,
 293                     (struct ifnet *)control, l));
 294
 295         if (req == PRU_PURGEIF) {
 296                 mutex_enter(softnet_lock);
 297                 iso_purgeif((struct ifnet *)control);
 298                 mutex_exit(softnet_lock);
 299                 return (0);
 300         }
 301
 302         s = splsoftnet();
 303         isop = sotoisopcb(so);
 304 #ifdef DIAGNOSTIC
 305         if (req != PRU_SEND && req != PRU_SENDOOB && control)
 306                 panic("cltp_usrreq: unexpected control mbuf");
 307 #endif
 308         if (isop == 0 && req != PRU_ATTACH) {
 309                 error = EINVAL;
 310                 goto release;
 311         }
 312
 313         switch (req) {
 314
 315         case PRU_ATTACH:
 316                 sosetlock(so);
 317                 if (isop != 0) {
 318                         error = EISCONN;
 319                         break;
 320                 }
 321                 if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
 322                         error = soreserve(so, cltp_sendspace, cltp_recvspace);
 323                         if (error)
 324                                 break;
 325                 }
 326                 error = iso_pcballoc(so, &cltb);
 327                 if (error)
 328                         break;
 329                 break;
 330
 331         case PRU_DETACH:
 332                 iso_pcbdetach(isop);
 333                 break;
 334
 335         case PRU_BIND:
 336                 error = iso_pcbbind(isop, nam, l);
 337                 break;
 338
 339         case PRU_LISTEN:
 340                 error = EOPNOTSUPP;
 341                 break;
 342
 343         case PRU_CONNECT:
 344                 error = iso_pcbconnect(isop, nam, l);
 345                 if (error)
 346                         break;
 347                 soisconnected(so);
 348                 break;
 349
 350         case PRU_CONNECT2:
 351                 error = EOPNOTSUPP;
 352                 break;
 353
 354         case PRU_DISCONNECT:
 355                 soisdisconnected(so);
 356                 iso_pcbdisconnect(isop);
 357                 break;
 358
 359         case PRU_SHUTDOWN:
 360                 socantsendmore(so);
 361                 break;
 362
 363         case PRU_RCVD:
 364                 error = EOPNOTSUPP;
 365                 break;
 366
 367         case PRU_SEND:
 368                 if (control && control->m_len) {
 369                         m_freem(control);
 370                         m_freem(m);
 371                         error = EINVAL;
 372                         break;
 373                 }
 374                 if (nam) {
 375                         if ((so->so_state & SS_ISCONNECTED) != 0) {
 376                                 error = EISCONN;
 377                                 goto die;
 378                         }
 379                         error = iso_pcbconnect(isop, nam, l);
 380                         if (error) {
 381                         die:
 382                                 m_freem(m);
 383                                 break;
 384                         }
 385                 } else {
 386                         if ((so->so_state & SS_ISCONNECTED) == 0) {
 387                                 error = ENOTCONN;
 388                                 goto die;
 389                         }
 390                 }
 391                 error = cltp_output(m, isop);
 392                 if (nam)
 393                         iso_pcbdisconnect(isop);
 394                 break;
 395
 396         case PRU_SENSE:
 397                 /*
 398                  * stat: don't bother with a blocksize.
 399                  */
 400                 splx(s);
 401                 return (0);
 402
 403         case PRU_RCVOOB:
 404                 error = EOPNOTSUPP;
 405                 break;
 406
 407         case PRU_SENDOOB:
 408                 m_freem(control);
 409                 m_freem(m);
 410                 error = EOPNOTSUPP;
 411                 break;
 412
 413         case PRU_SOCKADDR:
 414                 iso_getnetaddr(isop, nam, TP_LOCAL);
 415                 break;
 416
 417         case PRU_PEERADDR:
 418                 iso_getnetaddr(isop, nam, TP_FOREIGN);
 419                 break;
 420
 421         default:
 422                 panic("cltp_usrreq");
 423         }
 424
 425 release:
 426         splx(s);
 427         return (error);
 428 }