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.7 2004/06/06 19:16:07 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 pru_attach_info *ai)
 156 {
 157         struct rawcb *rp = sotorawcb(so);
 158         int error;
 159
 160         if (rp == 0)
 161                 return EINVAL;
 162         if ((error = suser_cred(ai->p_ucred, NULL_CRED_OKAY)) != 0)
 163                 return error;
 164         return raw_attach(so, proto, ai->sb_rlimit);
 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);
 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         struct pr_output_info oi;
 235
 236         if (rp == 0) {
 237                 error = EINVAL;
 238                 goto release;
 239         }
 240
 241         if (flags & PRUS_OOB) {
 242                 error = EOPNOTSUPP;
 243                 goto release;
 244         }
 245
 246         if (control && control->m_len) {
 247                 error = EOPNOTSUPP;
 248                 goto release;
 249         }
 250         if (nam) {
 251                 if (rp->rcb_faddr) {
 252                         error = EISCONN;
 253                         goto release;
 254                 }
 255                 rp->rcb_faddr = nam;
 256         } else if (rp->rcb_faddr == 0) {
 257                 error = ENOTCONN;
 258                 goto release;
 259         }
 260         oi.p_pid = td->td_proc->p_pid;
 261         error = (*so->so_proto->pr_output)(m, so, &oi);
 262         m = NULL;
 263         if (nam)
 264                 rp->rcb_faddr = 0;
 265 release:
 266         if (m != NULL)
 267                 m_freem(m);
 268         return (error);
 269 }
 270
 271 /* pru_sense is null */
 272
 273 static int
 274 raw_ushutdown(struct socket *so)
 275 {
 276         struct rawcb *rp = sotorawcb(so);
 277
 278         if (rp == 0)
 279                 return EINVAL;
 280         socantsendmore(so);
 281         return 0;
 282 }
 283
 284 static int
 285 raw_usockaddr(struct socket *so, struct sockaddr **nam)
 286 {
 287         struct rawcb *rp = sotorawcb(so);
 288
 289         if (rp == 0)
 290                 return EINVAL;
 291         if (rp->rcb_laddr == 0)
 292                 return EINVAL;
 293         *nam = dup_sockaddr(rp->rcb_laddr);
 294         return 0;
 295 }
 296
 297 struct pr_usrreqs raw_usrreqs = {
 298         raw_uabort, pru_accept_notsupp, raw_uattach, raw_ubind, raw_uconnect,
 299         pru_connect2_notsupp, pru_control_notsupp, raw_udetach,
 300         raw_udisconnect, pru_listen_notsupp, raw_upeeraddr, pru_rcvd_notsupp,
 301         pru_rcvoob_notsupp, raw_usend, pru_sense_null, raw_ushutdown,
 302         raw_usockaddr, sosend, soreceive, sopoll
 303 };