sys/net/raw_usrreq.c

   1 /*
   2  * Copyright (c) 1980, 1986, 1993
   3  *      The Regents of the University of California.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. All advertising materials mentioning features or use of this software
  14  *    must display the following acknowledgement:
  15  *      This product includes software developed by the University of
  16  *      California, Berkeley and its contributors.
  17  * 4. Neither the name of the University nor the names of its contributors
  18  *    may be used to endorse or promote products derived from this software
  19  *    without specific prior written permission.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31  * SUCH DAMAGE.
  32  *
  33  *      @(#)raw_usrreq.c        8.1 (Berkeley) 6/10/93
  34  * $FreeBSD: src/sys/net/raw_usrreq.c,v 1.18 1999/08/28 00:48:28 peter Exp $
  35  * $DragonFly: src/sys/net/raw_usrreq.c,v 1.4 2003/06/25 03:56:02 dillon Exp $
  36  */
  37
  38 #include <sys/param.h>
  39 #include <sys/systm.h>
  40 #include <sys/mbuf.h>
  41 #include <sys/proc.h>
  42 #include <sys/protosw.h>
  43 #include <sys/socket.h>
  44 #include <sys/socketvar.h>
  45
  46 #include <net/raw_cb.h>
  47
  48 /*
  49  * Initialize raw connection block q.
  50  */
  51 void
  52 raw_init()
  53 {
  54         LIST_INIT(&rawcb_list);
  55 }
  56
  57
  58 /*
  59  * Raw protocol input routine.  Find the socket
  60  * associated with the packet(s) and move them over.  If
  61  * nothing exists for this packet, drop it.
  62  */
  63 /*
  64  * Raw protocol interface.
  65  */
  66 void
  67 raw_input(m0, proto, src, dst)
  68         struct mbuf *m0;
  69         struct sockproto *proto;
  70         struct sockaddr *src, *dst;
  71 {
  72         struct rawcb *rp;
  73         struct mbuf *m = m0;
  74         int sockets = 0;
  75         struct socket *last;
  76
  77         last = 0;
  78         LIST_FOREACH(rp, &rawcb_list, list) {
  79                 if (rp->rcb_proto.sp_family != proto->sp_family)
  80                         continue;
  81                 if (rp->rcb_proto.sp_protocol  &&
  82                     rp->rcb_proto.sp_protocol != proto->sp_protocol)
  83                         continue;
  84                 /*
  85                  * We assume the lower level routines have
  86                  * placed the address in a canonical format
  87                  * suitable for a structure comparison.
  88                  *
  89                  * Note that if the lengths are not the same
  90                  * the comparison will fail at the first byte.
  91                  */
  92 #define equal(a1, a2) \
  93   (bcmp((caddr_t)(a1), (caddr_t)(a2), a1->sa_len) == 0)
  94                 if (rp->rcb_laddr && !equal(rp->rcb_laddr, dst))
  95                         continue;
  96                 if (rp->rcb_faddr && !equal(rp->rcb_faddr, src))
  97                         continue;
  98                 if (last) {
  99                         struct mbuf *n;
 100                         n = m_copy(m, 0, (int)M_COPYALL);
 101                         if (n) {
 102                                 if (sbappendaddr(&last->so_rcv, src,
 103                                     n, (struct mbuf *)0) == 0)
 104                                         /* should notify about lost packet */
 105                                         m_freem(n);
 106                                 else {
 107                                         sorwakeup(last);
 108                                         sockets++;
 109                                 }
 110                         }
 111                 }
 112                 last = rp->rcb_socket;
 113         }
 114         if (last) {
 115                 if (sbappendaddr(&last->so_rcv, src,
 116                     m, (struct mbuf *)0) == 0)
 117                         m_freem(m);
 118                 else {
 119                         sorwakeup(last);
 120                         sockets++;
 121                 }
 122         } else
 123                 m_freem(m);
 124 }
 125
 126 /*ARGSUSED*/
 127 void
 128 raw_ctlinput(cmd, arg, dummy)
 129         int cmd;
 130         struct sockaddr *arg;
 131         void *dummy;
 132 {
 133
 134         if (cmd < 0 || cmd > PRC_NCMDS)
 135                 return;
 136         /* INCOMPLETE */
 137 }
 138
 139 static int
 140 raw_uabort(struct socket *so)
 141 {
 142         struct rawcb *rp = sotorawcb(so);
 143
 144         if (rp == 0)
 145                 return EINVAL;
 146         raw_disconnect(rp);
 147         sofree(so);
 148         soisdisconnected(so);
 149         return 0;
 150 }
 151
 152 /* pru_accept is EOPNOTSUPP */
 153
 154 static int
 155 raw_uattach(struct socket *so, int proto, struct thread *td)
 156 {
 157         struct rawcb *rp = sotorawcb(so);
 158         int error;
 159
 160         if (rp == 0)
 161                 return EINVAL;
 162         if ((error = suser(td)) != 0)
 163                 return error;
 164         return raw_attach(so, proto);
 165 }
 166
 167 static int
 168 raw_ubind(struct socket *so, struct sockaddr *nam, struct thread *td)
 169 {
 170         return EINVAL;
 171 }
 172
 173 static int
 174 raw_uconnect(struct socket *so, struct sockaddr *nam, struct thread *td)
 175 {
 176         return EINVAL;
 177 }
 178
 179 /* pru_connect2 is EOPNOTSUPP */
 180 /* pru_control is EOPNOTSUPP */
 181
 182 static int
 183 raw_udetach(struct socket *so)
 184 {
 185         struct rawcb *rp = sotorawcb(so);
 186
 187         if (rp == 0)
 188                 return EINVAL;
 189
 190         raw_detach(rp);
 191         return 0;
 192 }
 193
 194 static int
 195 raw_udisconnect(struct socket *so)
 196 {
 197         struct rawcb *rp = sotorawcb(so);
 198
 199         if (rp == 0)
 200                 return EINVAL;
 201         if (rp->rcb_faddr == 0) {
 202                 return ENOTCONN;
 203         }
 204         raw_disconnect(rp);
 205         soisdisconnected(so);
 206         return 0;
 207 }
 208
 209 /* pru_listen is EOPNOTSUPP */
 210
 211 static int
 212 raw_upeeraddr(struct socket *so, struct sockaddr **nam)
 213 {
 214         struct rawcb *rp = sotorawcb(so);
 215
 216         if (rp == 0)
 217                 return EINVAL;
 218         if (rp->rcb_faddr == 0) {
 219                 return ENOTCONN;
 220         }
 221         *nam = dup_sockaddr(rp->rcb_faddr, 1);
 222         return 0;
 223 }
 224
 225 /* pru_rcvd is EOPNOTSUPP */
 226 /* pru_rcvoob is EOPNOTSUPP */
 227
 228 static int
 229 raw_usend(struct socket *so, int flags, struct mbuf *m,
 230           struct sockaddr *nam, struct mbuf *control, struct thread *td)
 231 {
 232         int error;
 233         struct rawcb *rp = sotorawcb(so);
 234
 235         if (rp == 0) {
 236                 error = EINVAL;
 237                 goto release;
 238         }
 239
 240         if (flags & PRUS_OOB) {
 241                 error = EOPNOTSUPP;
 242                 goto release;
 243         }
 244
 245         if (control && control->m_len) {
 246                 error = EOPNOTSUPP;
 247                 goto release;
 248         }
 249         if (nam) {
 250                 if (rp->rcb_faddr) {
 251                         error = EISCONN;
 252                         goto release;
 253                 }
 254                 rp->rcb_faddr = nam;
 255         } else if (rp->rcb_faddr == 0) {
 256                 error = ENOTCONN;
 257                 goto release;
 258         }
 259         error = (*so->so_proto->pr_output)(m, so);
 260         m = NULL;
 261         if (nam)
 262                 rp->rcb_faddr = 0;
 263 release:
 264         if (m != NULL)
 265                 m_freem(m);
 266         return (error);
 267 }
 268
 269 /* pru_sense is null */
 270
 271 static int
 272 raw_ushutdown(struct socket *so)
 273 {
 274         struct rawcb *rp = sotorawcb(so);
 275
 276         if (rp == 0)
 277                 return EINVAL;
 278         socantsendmore(so);
 279         return 0;
 280 }
 281
 282 static int
 283 raw_usockaddr(struct socket *so, struct sockaddr **nam)
 284 {
 285         struct rawcb *rp = sotorawcb(so);
 286
 287         if (rp == 0)
 288                 return EINVAL;
 289         if (rp->rcb_laddr == 0)
 290                 return EINVAL;
 291         *nam = dup_sockaddr(rp->rcb_laddr, 1);
 292         return 0;
 293 }
 294
 295 struct pr_usrreqs raw_usrreqs = {
 296         raw_uabort, pru_accept_notsupp, raw_uattach, raw_ubind, raw_uconnect,
 297         pru_connect2_notsupp, pru_control_notsupp, raw_udetach,
 298         raw_udisconnect, pru_listen_notsupp, raw_upeeraddr, pru_rcvd_notsupp,
 299         pru_rcvoob_notsupp, raw_usend, pru_sense_null, raw_ushutdown,
 300         raw_usockaddr, sosend, soreceive, sopoll
 301 };