sys/net/raw_usrreq.c

   1 /*      $NetBSD: raw_usrreq.c,v 1.34 2008/04/24 11:38:37 ad Exp $       */
   2
   3 /*
   4  * Copyright (c) 1980, 1986, 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  *      @(#)raw_usrreq.c        8.1 (Berkeley) 6/10/93
  32  */
  33
  34 #include <sys/cdefs.h>
  35 __KERNEL_RCSID(0, "$NetBSD: raw_usrreq.c,v 1.34 2008/04/24 11:38:37 ad Exp $");
  36
  37 #include <sys/param.h>
  38 #include <sys/mbuf.h>
  39 #include <sys/domain.h>
  40 #include <sys/protosw.h>
  41 #include <sys/socket.h>
  42 #include <sys/socketvar.h>
  43 #include <sys/errno.h>
  44 #include <sys/systm.h>
  45 #include <sys/proc.h>
  46 #include <sys/kauth.h>
  47
  48 #include <net/if.h>
  49 #include <net/route.h>
  50 #include <net/netisr.h>
  51 #include <net/raw_cb.h>
  52
  53 #include <machine/stdarg.h>
  54
  55 /*
  56  * Initialize raw connection block q.
  57  */
  58 void
  59 raw_init(void)
  60 {
  61
  62         LIST_INIT(&rawcb);
  63 }
  64
  65 static inline int
  66 equal(const struct sockaddr *a1, const struct sockaddr *a2)
  67 {
  68         return memcmp(a1, a2, a1->sa_len) == 0;
  69 }
  70
  71 /*
  72  * Raw protocol input routine.  Find the socket
  73  * associated with the packet(s) and move them over.  If
  74  * nothing exists for this packet, drop it.
  75  */
  76 /*
  77  * Raw protocol interface.
  78  */
  79 void
  80 raw_input(struct mbuf *m0, ...)
  81 {
  82         struct rawcb *rp;
  83         struct mbuf *m = m0;
  84         struct socket *last;
  85         va_list ap;
  86         struct sockproto *proto;
  87         struct sockaddr *src, *dst;
  88
  89         KASSERT(mutex_owned(softnet_lock));
  90
  91         va_start(ap, m0);
  92         proto = va_arg(ap, struct sockproto *);
  93         src = va_arg(ap, struct sockaddr *);
  94         dst = va_arg(ap, struct sockaddr *);
  95         va_end(ap);
  96
  97         last = NULL;
  98         LIST_FOREACH(rp, &rawcb, rcb_list) {
  99                 if (rp->rcb_proto.sp_family != proto->sp_family)
 100                         continue;
 101                 if (rp->rcb_proto.sp_protocol  &&
 102                     rp->rcb_proto.sp_protocol != proto->sp_protocol)
 103                         continue;
 104                 /*
 105                  * We assume the lower level routines have
 106                  * placed the address in a canonical format
 107                  * suitable for a structure comparison.
 108                  *
 109                  * Note that if the lengths are not the same
 110                  * the comparison will fail at the first byte.
 111                  */
 112                 if (rp->rcb_laddr && !equal(rp->rcb_laddr, dst))
 113                         continue;
 114                 if (rp->rcb_faddr && !equal(rp->rcb_faddr, src))
 115                         continue;
 116                 if (last != NULL) {
 117                         struct mbuf *n;
 118                         if ((n = m_copy(m, 0, M_COPYALL)) == NULL)
 119                                 ;
 120                         else if (sbappendaddr(&last->so_rcv, src, n, NULL) == 0)
 121                                 /* should notify about lost packet */
 122                                 m_freem(n);
 123                         else {
 124                                 sorwakeup(last);
 125                         }
 126                 }
 127                 last = rp->rcb_socket;
 128         }
 129         if (last == NULL || sbappendaddr(&last->so_rcv, src, m, NULL) == 0)
 130                 m_freem(m);
 131         else {
 132                 sorwakeup(last);
 133         }
 134 }
 135
 136 /*ARGSUSED*/
 137 void *
 138 raw_ctlinput(int cmd, const struct sockaddr *arg, void *d)
 139 {
 140
 141         if ((unsigned)cmd >= PRC_NCMDS)
 142                 return NULL;
 143         return NULL;
 144         /* INCOMPLETE */
 145 }
 146
 147 void
 148 raw_setsockaddr(struct rawcb *rp, struct mbuf *nam)
 149 {
 150
 151         nam->m_len = rp->rcb_laddr->sa_len;
 152         memcpy(mtod(nam, void *), rp->rcb_laddr, (size_t)nam->m_len);
 153 }
 154
 155 void
 156 raw_setpeeraddr(struct rawcb *rp, struct mbuf *nam)
 157 {
 158
 159         nam->m_len = rp->rcb_faddr->sa_len;
 160         memcpy(mtod(nam, void *), rp->rcb_faddr, (size_t)nam->m_len);
 161 }
 162
 163 /*ARGSUSED*/
 164 int
 165 raw_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
 166     struct mbuf *control, struct lwp *l)
 167 {
 168         struct rawcb *rp;
 169         int s;
 170         int error = 0;
 171
 172         if (req == PRU_CONTROL)
 173                 return (EOPNOTSUPP);
 174
 175         s = splsoftnet();
 176         KERNEL_LOCK(1, NULL);
 177         rp = sotorawcb(so);
 178 #ifdef DIAGNOSTIC
 179         if (req != PRU_SEND && req != PRU_SENDOOB && control)
 180                 panic("raw_usrreq: unexpected control mbuf");
 181 #endif
 182         if (rp == NULL && req != PRU_ATTACH) {
 183                 error = EINVAL;
 184                 goto release;
 185         }
 186
 187         switch (req) {
 188
 189         /*
 190          * Allocate a raw control block and fill in the
 191          * necessary info to allow packets to be routed to
 192          * the appropriate raw interface routine.
 193          */
 194         case PRU_ATTACH:
 195                 sosetlock(so);
 196                 if (l == NULL)
 197                         break;
 198
 199                 /* XXX: raw socket permissions are checked in socreate() */
 200
 201                 error = raw_attach(so, (int)(long)nam);
 202                 break;
 203
 204         /*
 205          * Destroy state just before socket deallocation.
 206          * Flush data or not depending on the options.
 207          */
 208         case PRU_DETACH:
 209                 raw_detach(rp);
 210                 break;
 211
 212         /*
 213          * If a socket isn't bound to a single address,
 214          * the raw input routine will hand it anything
 215          * within that protocol family (assuming there's
 216          * nothing else around it should go to).
 217          */
 218         case PRU_BIND:
 219         case PRU_LISTEN:
 220         case PRU_CONNECT:
 221         case PRU_CONNECT2:
 222                 error = EOPNOTSUPP;
 223                 break;
 224
 225         case PRU_DISCONNECT:
 226                 soisdisconnected(so);
 227                 raw_disconnect(rp);
 228                 break;
 229
 230         /*
 231          * Mark the connection as being incapable of further input.
 232          */
 233         case PRU_SHUTDOWN:
 234                 socantsendmore(so);
 235                 break;
 236
 237         case PRU_RCVD:
 238                 error = EOPNOTSUPP;
 239                 break;
 240
 241         /*
 242          * Ship a packet out.  The appropriate raw output
 243          * routine handles any massaging necessary.
 244          */
 245         case PRU_SEND:
 246                 if (control && control->m_len) {
 247                         m_freem(control);
 248                         m_freem(m);
 249                         error = EINVAL;
 250                         break;
 251                 }
 252                 if (nam) {
 253                         if ((so->so_state & SS_ISCONNECTED) != 0) {
 254                                 error = EISCONN;
 255                                 goto die;
 256                         }
 257                         error = (*so->so_proto->pr_usrreq)(so, PRU_CONNECT,
 258                             NULL, nam, NULL, l);
 259                         if (error) {
 260                         die:
 261                                 m_freem(m);
 262                                 break;
 263                         }
 264                 } else {
 265                         if ((so->so_state & SS_ISCONNECTED) == 0) {
 266                                 error = ENOTCONN;
 267                                 goto die;
 268                         }
 269                 }
 270                 error = (*so->so_proto->pr_output)(m, so);
 271                 if (nam)
 272                         raw_disconnect(rp);
 273                 break;
 274
 275         case PRU_SENSE:
 276                 /*
 277                  * stat: don't bother with a blocksize.
 278                  */
 279                 return (0);
 280
 281         /*
 282          * Not supported.
 283          */
 284         case PRU_RCVOOB:
 285                 error = EOPNOTSUPP;
 286                 break;
 287
 288         case PRU_SENDOOB:
 289                 m_freem(control);
 290                 m_freem(m);
 291                 error = EOPNOTSUPP;
 292                 break;
 293
 294         case PRU_SOCKADDR:
 295                 if (rp->rcb_laddr == NULL) {
 296                         error = EINVAL;
 297                         break;
 298                 }
 299                 raw_setsockaddr(rp, nam);
 300                 break;
 301
 302         case PRU_PEERADDR:
 303                 if (rp->rcb_faddr == NULL) {
 304                         error = ENOTCONN;
 305                         break;
 306                 }
 307                 raw_setpeeraddr(rp, nam);
 308                 break;
 309
 310         default:
 311                 panic("raw_usrreq");
 312         }
 313
 314 release:
 315         KERNEL_UNLOCK_ONE(NULL);
 316         splx(s);
 317         return (error);
 318 }