Add required range checks prior to kmalloc()ing socket option buffer space.
[dragonfly.git] / sys / kern / uipc_syscalls.c
1 /*
2  * Copyright (c) 1982, 1986, 1989, 1990, 1993
3  *      The Regents of the University of California.  All rights reserved.
4  *
5  * sendfile(2) and related extensions:
6  * Copyright (c) 1998, David Greenman. 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 the University of
19  *      California, Berkeley and its contributors.
20  * 4. Neither the name of the University nor the names of its contributors
21  *    may be used to endorse or promote products derived from this software
22  *    without specific prior written permission.
23  *
24  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
25  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
28  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
29  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
30  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
31  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34  * SUCH DAMAGE.
35  *
36  *      @(#)uipc_syscalls.c     8.4 (Berkeley) 2/21/94
37  * $FreeBSD: src/sys/kern/uipc_syscalls.c,v 1.65.2.17 2003/04/04 17:11:16 tegge Exp $
38  * $DragonFly: src/sys/kern/uipc_syscalls.c,v 1.91 2008/11/10 18:16:52 dillon Exp $
39  */
40
41 #include "opt_ktrace.h"
42 #include "opt_sctp.h"
43
44 #include <sys/param.h>
45 #include <sys/systm.h>
46 #include <sys/kernel.h>
47 #include <sys/sysproto.h>
48 #include <sys/malloc.h>
49 #include <sys/filedesc.h>
50 #include <sys/event.h>
51 #include <sys/proc.h>
52 #include <sys/fcntl.h>
53 #include <sys/file.h>
54 #include <sys/filio.h>
55 #include <sys/kern_syscall.h>
56 #include <sys/mbuf.h>
57 #include <sys/protosw.h>
58 #include <sys/sfbuf.h>
59 #include <sys/socket.h>
60 #include <sys/socketvar.h>
61 #include <sys/socketops.h>
62 #include <sys/uio.h>
63 #include <sys/vnode.h>
64 #include <sys/lock.h>
65 #include <sys/mount.h>
66 #ifdef KTRACE
67 #include <sys/ktrace.h>
68 #endif
69 #include <vm/vm.h>
70 #include <vm/vm_object.h>
71 #include <vm/vm_page.h>
72 #include <vm/vm_pageout.h>
73 #include <vm/vm_kern.h>
74 #include <vm/vm_extern.h>
75 #include <sys/file2.h>
76 #include <sys/signalvar.h>
77 #include <sys/serialize.h>
78
79 #include <sys/thread2.h>
80 #include <sys/msgport2.h>
81 #include <sys/socketvar2.h>
82 #include <net/netmsg2.h>
83
84 #ifdef SCTP
85 #include <netinet/sctp_peeloff.h>
86 #endif /* SCTP */
87
88 struct sfbuf_mref {
89         struct sf_buf   *sf;
90         int             mref_count;
91 };
92
93 static MALLOC_DEFINE(M_SENDFILE, "sendfile", "sendfile sfbuf ref structures");
94
95 /*
96  * System call interface to the socket abstraction.
97  */
98
99 extern  struct fileops socketops;
100
101 /*
102  * socket_args(int domain, int type, int protocol)
103  */
104 int
105 kern_socket(int domain, int type, int protocol, int *res)
106 {
107         struct thread *td = curthread;
108         struct proc *p = td->td_proc;
109         struct socket *so;
110         struct file *fp;
111         int fd, error;
112
113         KKASSERT(p);
114
115         error = falloc(p, &fp, &fd);
116         if (error)
117                 return (error);
118         error = socreate(domain, &so, type, protocol, td);
119         if (error) {
120                 fsetfd(p, NULL, fd);
121         } else {
122                 fp->f_type = DTYPE_SOCKET;
123                 fp->f_flag = FREAD | FWRITE;
124                 fp->f_ops = &socketops;
125                 fp->f_data = so;
126                 *res = fd;
127                 fsetfd(p, fp, fd);
128         }
129         fdrop(fp);
130         return (error);
131 }
132
133 int
134 sys_socket(struct socket_args *uap)
135 {
136         int error;
137
138         error = kern_socket(uap->domain, uap->type, uap->protocol,
139             &uap->sysmsg_result);
140
141         return (error);
142 }
143
144 int
145 kern_bind(int s, struct sockaddr *sa)
146 {
147         struct thread *td = curthread;
148         struct proc *p = td->td_proc;
149         struct file *fp;
150         int error;
151
152         KKASSERT(p);
153         error = holdsock(p->p_fd, s, &fp);
154         if (error)
155                 return (error);
156         error = sobind((struct socket *)fp->f_data, sa, td);
157         fdrop(fp);
158         return (error);
159 }
160
161 /*
162  * bind_args(int s, caddr_t name, int namelen)
163  */
164 int
165 sys_bind(struct bind_args *uap)
166 {
167         struct sockaddr *sa;
168         int error;
169
170         error = getsockaddr(&sa, uap->name, uap->namelen);
171         if (error)
172                 return (error);
173         error = kern_bind(uap->s, sa);
174         FREE(sa, M_SONAME);
175
176         return (error);
177 }
178
179 int
180 kern_listen(int s, int backlog)
181 {
182         struct thread *td = curthread;
183         struct proc *p = td->td_proc;
184         struct file *fp;
185         int error;
186
187         KKASSERT(p);
188         error = holdsock(p->p_fd, s, &fp);
189         if (error)
190                 return (error);
191         error = solisten((struct socket *)fp->f_data, backlog, td);
192         fdrop(fp);
193         return(error);
194 }
195
196 /*
197  * listen_args(int s, int backlog)
198  */
199 int
200 sys_listen(struct listen_args *uap)
201 {
202         int error;
203
204         error = kern_listen(uap->s, uap->backlog);
205         return (error);
206 }
207
208 /*
209  * Returns the accepted socket as well.
210  */
211 static boolean_t
212 soaccept_predicate(struct netmsg *msg0)
213 {
214         struct netmsg_so_notify *msg = (struct netmsg_so_notify *)msg0;
215         struct socket *head = msg->nm_so;
216
217         if (head->so_error != 0) {
218                 msg->nm_netmsg.nm_lmsg.ms_error = head->so_error;
219                 return (TRUE);
220         }
221         if (!TAILQ_EMPTY(&head->so_comp)) {
222                 /* Abuse nm_so field as copy in/copy out parameter. XXX JH */
223                 msg->nm_so = TAILQ_FIRST(&head->so_comp);
224                 TAILQ_REMOVE(&head->so_comp, msg->nm_so, so_list);
225                 head->so_qlen--;
226
227                 msg->nm_netmsg.nm_lmsg.ms_error = 0;
228                 return (TRUE);
229         }
230         if (head->so_state & SS_CANTRCVMORE) {
231                 msg->nm_netmsg.nm_lmsg.ms_error = ECONNABORTED;
232                 return (TRUE);
233         }
234         if (msg->nm_fflags & FNONBLOCK) {
235                 msg->nm_netmsg.nm_lmsg.ms_error = EWOULDBLOCK;
236                 return (TRUE);
237         }
238
239         return (FALSE);
240 }
241
242 /*
243  * The second argument to kern_accept() is a handle to a struct sockaddr.
244  * This allows kern_accept() to return a pointer to an allocated struct
245  * sockaddr which must be freed later with FREE().  The caller must
246  * initialize *name to NULL.
247  */
248 int
249 kern_accept(int s, int fflags, struct sockaddr **name, int *namelen, int *res)
250 {
251         struct thread *td = curthread;
252         struct proc *p = td->td_proc;
253         struct file *lfp = NULL;
254         struct file *nfp = NULL;
255         struct sockaddr *sa;
256         struct socket *head, *so;
257         struct netmsg_so_notify msg;
258         lwkt_port_t port;
259         int fd;
260         u_int fflag;            /* type must match fp->f_flag */
261         int error, tmp;
262
263         *res = -1;
264         if (name && namelen && *namelen < 0)
265                 return (EINVAL);
266
267         error = holdsock(p->p_fd, s, &lfp);
268         if (error)
269                 return (error);
270
271         error = falloc(p, &nfp, &fd);
272         if (error) {            /* Probably ran out of file descriptors. */
273                 fdrop(lfp);
274                 return (error);
275         }
276         head = (struct socket *)lfp->f_data;
277         if ((head->so_options & SO_ACCEPTCONN) == 0) {
278                 error = EINVAL;
279                 goto done;
280         }
281
282         if (fflags & O_FBLOCKING)
283                 fflags |= lfp->f_flag & ~FNONBLOCK;
284         else if (fflags & O_FNONBLOCKING)
285                 fflags |= lfp->f_flag | FNONBLOCK;
286         else
287                 fflags = lfp->f_flag;
288
289         /* optimize for uniprocessor case later XXX JH */
290         port = head->so_proto->pr_mport(head, NULL, NULL, PRU_PRED);
291         netmsg_init_abortable(&msg.nm_netmsg, &curthread->td_msgport,
292                               0,
293                               netmsg_so_notify,
294                               netmsg_so_notify_doabort);
295         msg.nm_predicate = soaccept_predicate;
296         msg.nm_fflags = fflags;
297         msg.nm_so = head;
298         msg.nm_etype = NM_REVENT;
299         error = lwkt_domsg(port, &msg.nm_netmsg.nm_lmsg, PCATCH);
300         if (error)
301                 goto done;
302
303         /*
304          * At this point we have the connection that's ready to be accepted.
305          */
306         so = msg.nm_so;
307
308         fflag = lfp->f_flag;
309
310         /* connection has been removed from the listen queue */
311         KNOTE(&head->so_rcv.ssb_sel.si_note, 0);
312
313         so->so_state &= ~SS_COMP;
314         so->so_head = NULL;
315         if (head->so_sigio != NULL)
316                 fsetown(fgetown(head->so_sigio), &so->so_sigio);
317
318         nfp->f_type = DTYPE_SOCKET;
319         nfp->f_flag = fflag;
320         nfp->f_ops = &socketops;
321         nfp->f_data = so;
322         /* Sync socket nonblocking/async state with file flags */
323         tmp = fflag & FNONBLOCK;
324         (void) fo_ioctl(nfp, FIONBIO, (caddr_t)&tmp, p->p_ucred);
325         tmp = fflag & FASYNC;
326         (void) fo_ioctl(nfp, FIOASYNC, (caddr_t)&tmp, p->p_ucred);
327
328         sa = NULL;
329         error = soaccept(so, &sa);
330
331         /*
332          * Set the returned name and namelen as applicable.  Set the returned
333          * namelen to 0 for older code which might ignore the return value
334          * from accept.
335          */
336         if (error == 0) {
337                 if (sa && name && namelen) {
338                         if (*namelen > sa->sa_len)
339                                 *namelen = sa->sa_len;
340                         *name = sa;
341                 } else {
342                         if (sa)
343                                 FREE(sa, M_SONAME);
344                 }
345         }
346
347 done:
348         /*
349          * If an error occured clear the reserved descriptor, else associate
350          * nfp with it.
351          *
352          * Note that *res is normally ignored if an error is returned but
353          * a syscall message will still have access to the result code.
354          */
355         if (error) {
356                 fsetfd(p, NULL, fd);
357         } else {
358                 *res = fd;
359                 fsetfd(p, nfp, fd);
360         }
361         fdrop(nfp);
362         fdrop(lfp);
363         return (error);
364 }
365
366 /*
367  * accept(int s, caddr_t name, int *anamelen)
368  */
369 int
370 sys_accept(struct accept_args *uap)
371 {
372         struct sockaddr *sa = NULL;
373         int sa_len;
374         int error;
375
376         if (uap->name) {
377                 error = copyin(uap->anamelen, &sa_len, sizeof(sa_len));
378                 if (error)
379                         return (error);
380
381                 error = kern_accept(uap->s, 0, &sa, &sa_len, &uap->sysmsg_result);
382
383                 if (error == 0)
384                         error = copyout(sa, uap->name, sa_len);
385                 if (error == 0) {
386                         error = copyout(&sa_len, uap->anamelen,
387                             sizeof(*uap->anamelen));
388                 }
389                 if (sa)
390                         FREE(sa, M_SONAME);
391         } else {
392                 error = kern_accept(uap->s, 0, NULL, 0, &uap->sysmsg_result);
393         }
394         return (error);
395 }
396
397 /*
398  * extaccept(int s, int fflags, caddr_t name, int *anamelen)
399  */
400 int
401 sys_extaccept(struct extaccept_args *uap)
402 {
403         struct sockaddr *sa = NULL;
404         int sa_len;
405         int error;
406         int fflags = uap->flags & O_FMASK;
407
408         if (uap->name) {
409                 error = copyin(uap->anamelen, &sa_len, sizeof(sa_len));
410                 if (error)
411                         return (error);
412
413                 error = kern_accept(uap->s, fflags, &sa, &sa_len, &uap->sysmsg_result);
414
415                 if (error == 0)
416                         error = copyout(sa, uap->name, sa_len);
417                 if (error == 0) {
418                         error = copyout(&sa_len, uap->anamelen,
419                             sizeof(*uap->anamelen));
420                 }
421                 if (sa)
422                         FREE(sa, M_SONAME);
423         } else {
424                 error = kern_accept(uap->s, fflags, NULL, 0, &uap->sysmsg_result);
425         }
426         return (error);
427 }
428
429
430 /*
431  * Returns TRUE if predicate satisfied.
432  */
433 static boolean_t
434 soconnected_predicate(struct netmsg *msg0)
435 {
436         struct netmsg_so_notify *msg = (struct netmsg_so_notify *)msg0;
437         struct socket *so = msg->nm_so;
438
439         /* check predicate */
440         if (!(so->so_state & SS_ISCONNECTING) || so->so_error != 0) {
441                 msg->nm_netmsg.nm_lmsg.ms_error = so->so_error;
442                 return (TRUE);
443         }
444
445         return (FALSE);
446 }
447
448 int
449 kern_connect(int s, int fflags, struct sockaddr *sa)
450 {
451         struct thread *td = curthread;
452         struct proc *p = td->td_proc;
453         struct file *fp;
454         struct socket *so;
455         int error, interrupted = 0;
456
457         error = holdsock(p->p_fd, s, &fp);
458         if (error)
459                 return (error);
460         so = (struct socket *)fp->f_data;
461
462         if (fflags & O_FBLOCKING)
463                 /* fflags &= ~FNONBLOCK; */;
464         else if (fflags & O_FNONBLOCKING)
465                 fflags |= FNONBLOCK;
466         else
467                 fflags = fp->f_flag;
468
469         if (so->so_state & SS_ISCONNECTING) {
470                 error = EALREADY;
471                 goto done;
472         }
473         error = soconnect(so, sa, td);
474         if (error)
475                 goto bad;
476         if ((fflags & FNONBLOCK) && (so->so_state & SS_ISCONNECTING)) {
477                 error = EINPROGRESS;
478                 goto done;
479         }
480         if ((so->so_state & SS_ISCONNECTING) && so->so_error == 0) {
481                 struct netmsg_so_notify msg;
482                 lwkt_port_t port;
483
484                 port = so->so_proto->pr_mport(so, sa, NULL, PRU_PRED);
485                 netmsg_init_abortable(&msg.nm_netmsg, 
486                                       &curthread->td_msgport,
487                                       0,
488                                       netmsg_so_notify,
489                                       netmsg_so_notify_doabort);
490                 msg.nm_predicate = soconnected_predicate;
491                 msg.nm_so = so;
492                 msg.nm_etype = NM_REVENT;
493                 error = lwkt_domsg(port, &msg.nm_netmsg.nm_lmsg, PCATCH);
494                 if (error == EINTR || error == ERESTART)
495                         interrupted = 1;
496         }
497         if (error == 0) {
498                 error = so->so_error;
499                 so->so_error = 0;
500         }
501 bad:
502         if (!interrupted)
503                 so->so_state &= ~SS_ISCONNECTING;
504         if (error == ERESTART)
505                 error = EINTR;
506 done:
507         fdrop(fp);
508         return (error);
509 }
510
511 /*
512  * connect_args(int s, caddr_t name, int namelen)
513  */
514 int
515 sys_connect(struct connect_args *uap)
516 {
517         struct sockaddr *sa;
518         int error;
519
520         error = getsockaddr(&sa, uap->name, uap->namelen);
521         if (error)
522                 return (error);
523         error = kern_connect(uap->s, 0, sa);
524         FREE(sa, M_SONAME);
525
526         return (error);
527 }
528
529 /*
530  * connect_args(int s, int fflags, caddr_t name, int namelen)
531  */
532 int
533 sys_extconnect(struct extconnect_args *uap)
534 {
535         struct sockaddr *sa;
536         int error;
537         int fflags = uap->flags & O_FMASK;
538
539         error = getsockaddr(&sa, uap->name, uap->namelen);
540         if (error)
541                 return (error);
542         error = kern_connect(uap->s, fflags, sa);
543         FREE(sa, M_SONAME);
544
545         return (error);
546 }
547
548 int
549 kern_socketpair(int domain, int type, int protocol, int *sv)
550 {
551         struct thread *td = curthread;
552         struct proc *p = td->td_proc;
553         struct file *fp1, *fp2;
554         struct socket *so1, *so2;
555         int fd1, fd2, error;
556
557         KKASSERT(p);
558         error = socreate(domain, &so1, type, protocol, td);
559         if (error)
560                 return (error);
561         error = socreate(domain, &so2, type, protocol, td);
562         if (error)
563                 goto free1;
564         error = falloc(p, &fp1, &fd1);
565         if (error)
566                 goto free2;
567         sv[0] = fd1;
568         fp1->f_data = so1;
569         error = falloc(p, &fp2, &fd2);
570         if (error)
571                 goto free3;
572         fp2->f_data = so2;
573         sv[1] = fd2;
574         error = soconnect2(so1, so2);
575         if (error)
576                 goto free4;
577         if (type == SOCK_DGRAM) {
578                 /*
579                  * Datagram socket connection is asymmetric.
580                  */
581                  error = soconnect2(so2, so1);
582                  if (error)
583                         goto free4;
584         }
585         fp1->f_type = fp2->f_type = DTYPE_SOCKET;
586         fp1->f_flag = fp2->f_flag = FREAD|FWRITE;
587         fp1->f_ops = fp2->f_ops = &socketops;
588         fsetfd(p, fp1, fd1);
589         fsetfd(p, fp2, fd2);
590         fdrop(fp1);
591         fdrop(fp2);
592         return (error);
593 free4:
594         fsetfd(p, NULL, fd2);
595         fdrop(fp2);
596 free3:
597         fsetfd(p, NULL, fd1);
598         fdrop(fp1);
599 free2:
600         (void)soclose(so2, 0);
601 free1:
602         (void)soclose(so1, 0);
603         return (error);
604 }
605
606 /*
607  * socketpair(int domain, int type, int protocol, int *rsv)
608  */
609 int
610 sys_socketpair(struct socketpair_args *uap)
611 {
612         int error, sockv[2];
613
614         error = kern_socketpair(uap->domain, uap->type, uap->protocol, sockv);
615
616         if (error == 0)
617                 error = copyout(sockv, uap->rsv, sizeof(sockv));
618         return (error);
619 }
620
621 int
622 kern_sendmsg(int s, struct sockaddr *sa, struct uio *auio,
623     struct mbuf *control, int flags, int *res)
624 {
625         struct thread *td = curthread;
626         struct lwp *lp = td->td_lwp;
627         struct proc *p = td->td_proc;
628         struct file *fp;
629         int len, error;
630         struct socket *so;
631 #ifdef KTRACE
632         struct iovec *ktriov = NULL;
633         struct uio ktruio;
634 #endif
635
636         error = holdsock(p->p_fd, s, &fp);
637         if (error)
638                 return (error);
639         if (auio->uio_resid < 0) {
640                 error = EINVAL;
641                 goto done;
642         }
643 #ifdef KTRACE
644         if (KTRPOINT(td, KTR_GENIO)) {
645                 int iovlen = auio->uio_iovcnt * sizeof (struct iovec);
646
647                 MALLOC(ktriov, struct iovec *, iovlen, M_TEMP, M_WAITOK);
648                 bcopy((caddr_t)auio->uio_iov, (caddr_t)ktriov, iovlen);
649                 ktruio = *auio;
650         }
651 #endif
652         len = auio->uio_resid;
653         so = (struct socket *)fp->f_data;
654         if ((flags & (MSG_FNONBLOCKING|MSG_FBLOCKING)) == 0) {
655                 if (fp->f_flag & FNONBLOCK)
656                         flags |= MSG_FNONBLOCKING;
657         }
658         error = so_pru_sosend(so, sa, auio, NULL, control, flags, td);
659         if (error) {
660                 if (auio->uio_resid != len && (error == ERESTART ||
661                     error == EINTR || error == EWOULDBLOCK))
662                         error = 0;
663                 if (error == EPIPE)
664                         lwpsignal(p, lp, SIGPIPE);
665         }
666 #ifdef KTRACE
667         if (ktriov != NULL) {
668                 if (error == 0) {
669                         ktruio.uio_iov = ktriov;
670                         ktruio.uio_resid = len - auio->uio_resid;
671                         ktrgenio(lp, s, UIO_WRITE, &ktruio, error);
672                 }
673                 FREE(ktriov, M_TEMP);
674         }
675 #endif
676         if (error == 0)
677                 *res  = len - auio->uio_resid;
678 done:
679         fdrop(fp);
680         return (error);
681 }
682
683 /*
684  * sendto_args(int s, caddr_t buf, size_t len, int flags, caddr_t to, int tolen)
685  */
686 int
687 sys_sendto(struct sendto_args *uap)
688 {
689         struct thread *td = curthread;
690         struct uio auio;
691         struct iovec aiov;
692         struct sockaddr *sa = NULL;
693         int error;
694
695         if (uap->to) {
696                 error = getsockaddr(&sa, uap->to, uap->tolen);
697                 if (error)
698                         return (error);
699         }
700         aiov.iov_base = uap->buf;
701         aiov.iov_len = uap->len;
702         auio.uio_iov = &aiov;
703         auio.uio_iovcnt = 1;
704         auio.uio_offset = 0;
705         auio.uio_resid = uap->len;
706         auio.uio_segflg = UIO_USERSPACE;
707         auio.uio_rw = UIO_WRITE;
708         auio.uio_td = td;
709
710         error = kern_sendmsg(uap->s, sa, &auio, NULL, uap->flags,
711             &uap->sysmsg_result);
712
713         if (sa)
714                 FREE(sa, M_SONAME);
715         return (error);
716 }
717
718 /*
719  * sendmsg_args(int s, caddr_t msg, int flags)
720  */
721 int
722 sys_sendmsg(struct sendmsg_args *uap)
723 {
724         struct thread *td = curthread;
725         struct msghdr msg;
726         struct uio auio;
727         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
728         struct sockaddr *sa = NULL;
729         struct mbuf *control = NULL;
730         int error;
731
732         error = copyin(uap->msg, (caddr_t)&msg, sizeof(msg));
733         if (error)
734                 return (error);
735
736         /*
737          * Conditionally copyin msg.msg_name.
738          */
739         if (msg.msg_name) {
740                 error = getsockaddr(&sa, msg.msg_name, msg.msg_namelen);
741                 if (error)
742                         return (error);
743         }
744
745         /*
746          * Populate auio.
747          */
748         error = iovec_copyin(msg.msg_iov, &iov, aiov, msg.msg_iovlen,
749                              &auio.uio_resid);
750         if (error)
751                 goto cleanup2;
752         auio.uio_iov = iov;
753         auio.uio_iovcnt = msg.msg_iovlen;
754         auio.uio_offset = 0;
755         auio.uio_segflg = UIO_USERSPACE;
756         auio.uio_rw = UIO_WRITE;
757         auio.uio_td = td;
758
759         /*
760          * Conditionally copyin msg.msg_control.
761          */
762         if (msg.msg_control) {
763                 if (msg.msg_controllen < sizeof(struct cmsghdr) ||
764                     msg.msg_controllen > MLEN) {
765                         error = EINVAL;
766                         goto cleanup;
767                 }
768                 control = m_get(MB_WAIT, MT_CONTROL);
769                 if (control == NULL) {
770                         error = ENOBUFS;
771                         goto cleanup;
772                 }
773                 control->m_len = msg.msg_controllen;
774                 error = copyin(msg.msg_control, mtod(control, caddr_t),
775                     msg.msg_controllen);
776                 if (error) {
777                         m_free(control);
778                         goto cleanup;
779                 }
780         }
781
782         error = kern_sendmsg(uap->s, sa, &auio, control, uap->flags,
783             &uap->sysmsg_result);
784
785 cleanup:
786         iovec_free(&iov, aiov);
787 cleanup2:
788         if (sa)
789                 FREE(sa, M_SONAME);
790         return (error);
791 }
792
793 /*
794  * kern_recvmsg() takes a handle to sa and control.  If the handle is non-
795  * null, it returns a dynamically allocated struct sockaddr and an mbuf.
796  * Don't forget to FREE() and m_free() these if they are returned.
797  */
798 int
799 kern_recvmsg(int s, struct sockaddr **sa, struct uio *auio,
800     struct mbuf **control, int *flags, int *res)
801 {
802         struct thread *td = curthread;
803         struct proc *p = td->td_proc;
804         struct file *fp;
805         int len, error;
806         int lflags;
807         struct socket *so;
808 #ifdef KTRACE
809         struct iovec *ktriov = NULL;
810         struct uio ktruio;
811 #endif
812
813         error = holdsock(p->p_fd, s, &fp);
814         if (error)
815                 return (error);
816         if (auio->uio_resid < 0) {
817                 error = EINVAL;
818                 goto done;
819         }
820 #ifdef KTRACE
821         if (KTRPOINT(td, KTR_GENIO)) {
822                 int iovlen = auio->uio_iovcnt * sizeof (struct iovec);
823
824                 MALLOC(ktriov, struct iovec *, iovlen, M_TEMP, M_WAITOK);
825                 bcopy(auio->uio_iov, ktriov, iovlen);
826                 ktruio = *auio;
827         }
828 #endif
829         len = auio->uio_resid;
830         so = (struct socket *)fp->f_data;
831
832         if (flags == NULL || (*flags & (MSG_FNONBLOCKING|MSG_FBLOCKING)) == 0) {
833                 if (fp->f_flag & FNONBLOCK) {
834                         if (flags) {
835                                 *flags |= MSG_FNONBLOCKING;
836                         } else {
837                                 lflags = MSG_FNONBLOCKING;
838                                 flags = &lflags;
839                         }
840                 }
841         }
842
843         error = so_pru_soreceive(so, sa, auio, NULL, control, flags);
844         if (error) {
845                 if (auio->uio_resid != len && (error == ERESTART ||
846                     error == EINTR || error == EWOULDBLOCK))
847                         error = 0;
848         }
849 #ifdef KTRACE
850         if (ktriov != NULL) {
851                 if (error == 0) {
852                         ktruio.uio_iov = ktriov;
853                         ktruio.uio_resid = len - auio->uio_resid;
854                         ktrgenio(td->td_lwp, s, UIO_READ, &ktruio, error);
855                 }
856                 FREE(ktriov, M_TEMP);
857         }
858 #endif
859         if (error == 0)
860                 *res = len - auio->uio_resid;
861 done:
862         fdrop(fp);
863         return (error);
864 }
865
866 /*
867  * recvfrom_args(int s, caddr_t buf, size_t len, int flags, 
868  *                      caddr_t from, int *fromlenaddr)
869  */
870 int
871 sys_recvfrom(struct recvfrom_args *uap)
872 {
873         struct thread *td = curthread;
874         struct uio auio;
875         struct iovec aiov;
876         struct sockaddr *sa = NULL;
877         int error, fromlen;
878
879         if (uap->from && uap->fromlenaddr) {
880                 error = copyin(uap->fromlenaddr, &fromlen, sizeof(fromlen));
881                 if (error)
882                         return (error);
883                 if (fromlen < 0)
884                         return (EINVAL);
885         } else {
886                 fromlen = 0;
887         }
888         aiov.iov_base = uap->buf;
889         aiov.iov_len = uap->len;
890         auio.uio_iov = &aiov;
891         auio.uio_iovcnt = 1;
892         auio.uio_offset = 0;
893         auio.uio_resid = uap->len;
894         auio.uio_segflg = UIO_USERSPACE;
895         auio.uio_rw = UIO_READ;
896         auio.uio_td = td;
897
898         error = kern_recvmsg(uap->s, uap->from ? &sa : NULL, &auio, NULL,
899             &uap->flags, &uap->sysmsg_result);
900
901         if (error == 0 && uap->from) {
902                 /* note: sa may still be NULL */
903                 if (sa) {
904                         fromlen = MIN(fromlen, sa->sa_len);
905                         error = copyout(sa, uap->from, fromlen);
906                 } else {
907                         fromlen = 0;
908                 }
909                 if (error == 0) {
910                         error = copyout(&fromlen, uap->fromlenaddr,
911                                         sizeof(fromlen));
912                 }
913         }
914         if (sa)
915                 FREE(sa, M_SONAME);
916
917         return (error);
918 }
919
920 /*
921  * recvmsg_args(int s, struct msghdr *msg, int flags)
922  */
923 int
924 sys_recvmsg(struct recvmsg_args *uap)
925 {
926         struct thread *td = curthread;
927         struct msghdr msg;
928         struct uio auio;
929         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
930         struct mbuf *m, *control = NULL;
931         struct sockaddr *sa = NULL;
932         caddr_t ctlbuf;
933         socklen_t *ufromlenp, *ucontrollenp;
934         int error, fromlen, controllen, len, flags, *uflagsp;
935
936         /*
937          * This copyin handles everything except the iovec.
938          */
939         error = copyin(uap->msg, &msg, sizeof(msg));
940         if (error)
941                 return (error);
942
943         if (msg.msg_name && msg.msg_namelen < 0)
944                 return (EINVAL);
945         if (msg.msg_control && msg.msg_controllen < 0)
946                 return (EINVAL);
947
948         ufromlenp = (socklen_t *)((caddr_t)uap->msg + offsetof(struct msghdr,
949             msg_namelen));
950         ucontrollenp = (socklen_t *)((caddr_t)uap->msg + offsetof(struct msghdr,
951             msg_controllen));
952         uflagsp = (int *)((caddr_t)uap->msg + offsetof(struct msghdr,
953             msg_flags));
954
955         /*
956          * Populate auio.
957          */
958         error = iovec_copyin(msg.msg_iov, &iov, aiov, msg.msg_iovlen,
959                              &auio.uio_resid);
960         if (error)
961                 return (error);
962         auio.uio_iov = iov;
963         auio.uio_iovcnt = msg.msg_iovlen;
964         auio.uio_offset = 0;
965         auio.uio_segflg = UIO_USERSPACE;
966         auio.uio_rw = UIO_READ;
967         auio.uio_td = td;
968
969         flags = uap->flags;
970
971         error = kern_recvmsg(uap->s, msg.msg_name ? &sa : NULL, &auio,
972             msg.msg_control ? &control : NULL, &flags, &uap->sysmsg_result);
973
974         /*
975          * Conditionally copyout the name and populate the namelen field.
976          */
977         if (error == 0 && msg.msg_name) {
978                 /* note: sa may still be NULL */
979                 if (sa != NULL) {
980                         fromlen = MIN(msg.msg_namelen, sa->sa_len);
981                         error = copyout(sa, msg.msg_name, fromlen);
982                 } else {
983                         fromlen = 0;
984                 }
985                 if (error == 0)
986                         error = copyout(&fromlen, ufromlenp,
987                             sizeof(*ufromlenp));
988         }
989
990         /*
991          * Copyout msg.msg_control and msg.msg_controllen.
992          */
993         if (error == 0 && msg.msg_control) {
994                 len = msg.msg_controllen;
995                 m = control;
996                 ctlbuf = (caddr_t)msg.msg_control;
997
998                 while(m && len > 0) {
999                         unsigned int tocopy;
1000
1001                         if (len >= m->m_len) {
1002                                 tocopy = m->m_len;
1003                         } else {
1004                                 msg.msg_flags |= MSG_CTRUNC;
1005                                 tocopy = len;
1006                         }
1007
1008                         error = copyout(mtod(m, caddr_t), ctlbuf, tocopy);
1009                         if (error)
1010                                 goto cleanup;
1011
1012                         ctlbuf += tocopy;
1013                         len -= tocopy;
1014                         m = m->m_next;
1015                 }
1016                 controllen = ctlbuf - (caddr_t)msg.msg_control;
1017                 error = copyout(&controllen, ucontrollenp,
1018                     sizeof(*ucontrollenp));
1019         }
1020
1021         if (error == 0)
1022                 error = copyout(&flags, uflagsp, sizeof(*uflagsp));
1023
1024 cleanup:
1025         if (sa)
1026                 FREE(sa, M_SONAME);
1027         iovec_free(&iov, aiov);
1028         if (control)
1029                 m_freem(control);
1030         return (error);
1031 }
1032
1033 /*
1034  * If sopt->sopt_td == NULL, then sopt->sopt_val is treated as an
1035  * in kernel pointer instead of a userland pointer.  This allows us
1036  * to manipulate socket options in the emulation code.
1037  */
1038 int
1039 kern_setsockopt(int s, struct sockopt *sopt)
1040 {
1041         struct thread *td = curthread;
1042         struct proc *p = td->td_proc;
1043         struct file *fp;
1044         int error;
1045
1046         if (sopt->sopt_val == NULL && sopt->sopt_valsize != 0)
1047                 return (EFAULT);
1048         if (sopt->sopt_valsize < 0)
1049                 return (EINVAL);
1050
1051         error = holdsock(p->p_fd, s, &fp);
1052         if (error)
1053                 return (error);
1054
1055         error = sosetopt((struct socket *)fp->f_data, sopt);
1056         fdrop(fp);
1057         return (error);
1058 }
1059
1060 /*
1061  * setsockopt_args(int s, int level, int name, caddr_t val, int valsize)
1062  */
1063 int
1064 sys_setsockopt(struct setsockopt_args *uap)
1065 {
1066         struct thread *td = curthread;
1067         struct sockopt sopt;
1068         int error;
1069
1070         sopt.sopt_level = uap->level;
1071         sopt.sopt_name = uap->name;
1072         sopt.sopt_valsize = uap->valsize;
1073         sopt.sopt_td = td;
1074
1075         if (sopt.sopt_valsize < 0 || sopt.sopt_valsize > SOMAXOPT_SIZE)
1076                 return (EINVAL);
1077         if (sopt.sopt_val == NULL && sopt.sopt_valsize)
1078                 return (EINVAL);
1079
1080         if (uap->val) {
1081                 sopt.sopt_val = kmalloc(sopt.sopt_valsize, M_TEMP, M_WAITOK);
1082                 error = copyin(uap->val, sopt.sopt_val, sopt.sopt_valsize);
1083                 if (error)
1084                         goto out;
1085         } else {
1086                 sopt.sopt_val = NULL;
1087         }
1088         error = kern_setsockopt(uap->s, &sopt);
1089         if (error)
1090                 goto out;
1091         if (uap->val)
1092                 error = copyout(sopt.sopt_val, uap->val, sopt.sopt_valsize);
1093 out:
1094         if (uap->val)
1095                 kfree(sopt.sopt_val, M_TEMP);
1096         return(error);
1097 }
1098
1099 /*
1100  * If sopt->sopt_td == NULL, then sopt->sopt_val is treated as an
1101  * in kernel pointer instead of a userland pointer.  This allows us
1102  * to manipulate socket options in the emulation code.
1103  */
1104 int
1105 kern_getsockopt(int s, struct sockopt *sopt)
1106 {
1107         struct thread *td = curthread;
1108         struct proc *p = td->td_proc;
1109         struct file *fp;
1110         int error;
1111
1112         if (sopt->sopt_val == NULL && sopt->sopt_valsize != 0)
1113                 return (EFAULT);
1114         if (sopt->sopt_valsize < 0 || sopt->sopt_valsize > SOMAXOPT_SIZE)
1115                 return (EINVAL);
1116
1117         error = holdsock(p->p_fd, s, &fp);
1118         if (error)
1119                 return (error);
1120
1121         error = sogetopt((struct socket *)fp->f_data, sopt);
1122         fdrop(fp);
1123         return (error);
1124 }
1125
1126 /*
1127  * getsockopt_Args(int s, int level, int name, caddr_t val, int *avalsize)
1128  */
1129 int
1130 sys_getsockopt(struct getsockopt_args *uap)
1131 {
1132         struct thread *td = curthread;
1133         struct  sockopt sopt;
1134         int     error, valsize;
1135
1136         if (uap->val) {
1137                 error = copyin(uap->avalsize, &valsize, sizeof(valsize));
1138                 if (error)
1139                         return (error);
1140                 if (valsize < 0)
1141                         return (EINVAL);
1142         } else {
1143                 valsize = 0;
1144         }
1145
1146         sopt.sopt_level = uap->level;
1147         sopt.sopt_name = uap->name;
1148         sopt.sopt_valsize = valsize;
1149         sopt.sopt_td = td;
1150
1151         if (valsize < 0 || valsize > SOMAXOPT_SIZE)
1152                 return (EINVAL);
1153
1154         if (uap->val) {
1155                 sopt.sopt_val = kmalloc(sopt.sopt_valsize, M_TEMP, M_WAITOK);
1156                 error = copyin(uap->val, sopt.sopt_val, sopt.sopt_valsize);
1157                 if (error)
1158                         goto out;
1159         } else {
1160                 sopt.sopt_val = NULL;
1161         }
1162         error = kern_getsockopt(uap->s, &sopt);
1163         if (error)
1164                 goto out;
1165         valsize = sopt.sopt_valsize;
1166         error = copyout(&valsize, uap->avalsize, sizeof(valsize));
1167         if (error)
1168                 goto out;
1169         if (uap->val)
1170                 error = copyout(sopt.sopt_val, uap->val, sopt.sopt_valsize);
1171 out:
1172         if (uap->val)
1173                 kfree(sopt.sopt_val, M_TEMP);
1174         return (error);
1175 }
1176
1177 /*
1178  * The second argument to kern_getsockname() is a handle to a struct sockaddr.
1179  * This allows kern_getsockname() to return a pointer to an allocated struct
1180  * sockaddr which must be freed later with FREE().  The caller must
1181  * initialize *name to NULL.
1182  */
1183 int
1184 kern_getsockname(int s, struct sockaddr **name, int *namelen)
1185 {
1186         struct thread *td = curthread;
1187         struct proc *p = td->td_proc;
1188         struct file *fp;
1189         struct socket *so;
1190         struct sockaddr *sa = NULL;
1191         int error;
1192
1193         error = holdsock(p->p_fd, s, &fp);
1194         if (error)
1195                 return (error);
1196         if (*namelen < 0) {
1197                 fdrop(fp);
1198                 return (EINVAL);
1199         }
1200         so = (struct socket *)fp->f_data;
1201         error = so_pru_sockaddr(so, &sa);
1202         if (error == 0) {
1203                 if (sa == NULL) {
1204                         *namelen = 0;
1205                 } else {
1206                         *namelen = MIN(*namelen, sa->sa_len);
1207                         *name = sa;
1208                 }
1209         }
1210
1211         fdrop(fp);
1212         return (error);
1213 }
1214
1215 /*
1216  * getsockname_args(int fdes, caddr_t asa, int *alen)
1217  *
1218  * Get socket name.
1219  */
1220 int
1221 sys_getsockname(struct getsockname_args *uap)
1222 {
1223         struct sockaddr *sa = NULL;
1224         int error, sa_len;
1225
1226         error = copyin(uap->alen, &sa_len, sizeof(sa_len));
1227         if (error)
1228                 return (error);
1229
1230         error = kern_getsockname(uap->fdes, &sa, &sa_len);
1231
1232         if (error == 0)
1233                 error = copyout(sa, uap->asa, sa_len);
1234         if (error == 0)
1235                 error = copyout(&sa_len, uap->alen, sizeof(*uap->alen));
1236         if (sa)
1237                 FREE(sa, M_SONAME);
1238         return (error);
1239 }
1240
1241 /*
1242  * The second argument to kern_getpeername() is a handle to a struct sockaddr.
1243  * This allows kern_getpeername() to return a pointer to an allocated struct
1244  * sockaddr which must be freed later with FREE().  The caller must
1245  * initialize *name to NULL.
1246  */
1247 int
1248 kern_getpeername(int s, struct sockaddr **name, int *namelen)
1249 {
1250         struct thread *td = curthread;
1251         struct proc *p = td->td_proc;
1252         struct file *fp;
1253         struct socket *so;
1254         struct sockaddr *sa = NULL;
1255         int error;
1256
1257         error = holdsock(p->p_fd, s, &fp);
1258         if (error)
1259                 return (error);
1260         if (*namelen < 0) {
1261                 fdrop(fp);
1262                 return (EINVAL);
1263         }
1264         so = (struct socket *)fp->f_data;
1265         if ((so->so_state & (SS_ISCONNECTED|SS_ISCONFIRMING)) == 0) {
1266                 fdrop(fp);
1267                 return (ENOTCONN);
1268         }
1269         error = so_pru_peeraddr(so, &sa);
1270         if (error == 0) {
1271                 if (sa == NULL) {
1272                         *namelen = 0;
1273                 } else {
1274                         *namelen = MIN(*namelen, sa->sa_len);
1275                         *name = sa;
1276                 }
1277         }
1278
1279         fdrop(fp);
1280         return (error);
1281 }
1282
1283 /*
1284  * getpeername_args(int fdes, caddr_t asa, int *alen)
1285  *
1286  * Get name of peer for connected socket.
1287  */
1288 int
1289 sys_getpeername(struct getpeername_args *uap)
1290 {
1291         struct sockaddr *sa = NULL;
1292         int error, sa_len;
1293
1294         error = copyin(uap->alen, &sa_len, sizeof(sa_len));
1295         if (error)
1296                 return (error);
1297
1298         error = kern_getpeername(uap->fdes, &sa, &sa_len);
1299
1300         if (error == 0)
1301                 error = copyout(sa, uap->asa, sa_len);
1302         if (error == 0)
1303                 error = copyout(&sa_len, uap->alen, sizeof(*uap->alen));
1304         if (sa)
1305                 FREE(sa, M_SONAME);
1306         return (error);
1307 }
1308
1309 int
1310 getsockaddr(struct sockaddr **namp, caddr_t uaddr, size_t len)
1311 {
1312         struct sockaddr *sa;
1313         int error;
1314
1315         *namp = NULL;
1316         if (len > SOCK_MAXADDRLEN)
1317                 return ENAMETOOLONG;
1318         if (len < offsetof(struct sockaddr, sa_data[0]))
1319                 return EDOM;
1320         MALLOC(sa, struct sockaddr *, len, M_SONAME, M_WAITOK);
1321         error = copyin(uaddr, sa, len);
1322         if (error) {
1323                 FREE(sa, M_SONAME);
1324         } else {
1325 #if BYTE_ORDER != BIG_ENDIAN
1326                 /*
1327                  * The bind(), connect(), and sendto() syscalls were not
1328                  * versioned for COMPAT_43.  Thus, this check must stay.
1329                  */
1330                 if (sa->sa_family == 0 && sa->sa_len < AF_MAX)
1331                         sa->sa_family = sa->sa_len;
1332 #endif
1333                 sa->sa_len = len;
1334                 *namp = sa;
1335         }
1336         return error;
1337 }
1338
1339 /*
1340  * Detach a mapped page and release resources back to the system.
1341  * We must release our wiring and if the object is ripped out
1342  * from under the vm_page we become responsible for freeing the
1343  * page.  These routines must be MPSAFE.
1344  *
1345  * XXX HACK XXX TEMPORARY UNTIL WE IMPLEMENT EXT MBUF REFERENCE COUNTING
1346  *
1347  * XXX vm_page_*() routines are not MPSAFE yet, the MP lock is required.
1348  */
1349 static void
1350 sf_buf_mref(void *arg)
1351 {
1352         struct sfbuf_mref *sfm = arg;
1353
1354         /*
1355          * We must already hold a ref so there is no race to 0, just 
1356          * atomically increment the count.
1357          */
1358         atomic_add_int(&sfm->mref_count, 1);
1359 }
1360
1361 static void
1362 sf_buf_mfree(void *arg)
1363 {
1364         struct sfbuf_mref *sfm = arg;
1365         vm_page_t m;
1366
1367         KKASSERT(sfm->mref_count > 0);
1368         if (atomic_fetchadd_int(&sfm->mref_count, -1) == 1) {
1369                 /*
1370                  * XXX vm_page_*() and SFBUF routines not MPSAFE yet.
1371                  */
1372                 get_mplock();
1373                 crit_enter();
1374                 m = sf_buf_page(sfm->sf);
1375                 sf_buf_free(sfm->sf);
1376                 vm_page_unwire(m, 0);
1377                 if (m->wire_count == 0 && m->object == NULL)
1378                         vm_page_try_to_free(m);
1379                 crit_exit();
1380                 rel_mplock();
1381                 kfree(sfm, M_SENDFILE);
1382         }
1383 }
1384
1385 /*
1386  * sendfile(2).
1387  * int sendfile(int fd, int s, off_t offset, size_t nbytes,
1388  *       struct sf_hdtr *hdtr, off_t *sbytes, int flags)
1389  *
1390  * Send a file specified by 'fd' and starting at 'offset' to a socket
1391  * specified by 's'. Send only 'nbytes' of the file or until EOF if
1392  * nbytes == 0. Optionally add a header and/or trailer to the socket
1393  * output. If specified, write the total number of bytes sent into *sbytes.
1394  *
1395  * In FreeBSD kern/uipc_syscalls.c,v 1.103, a bug was fixed that caused
1396  * the headers to count against the remaining bytes to be sent from
1397  * the file descriptor.  We may wish to implement a compatibility syscall
1398  * in the future.
1399  */
1400 int
1401 sys_sendfile(struct sendfile_args *uap)
1402 {
1403         struct thread *td = curthread;
1404         struct proc *p = td->td_proc;
1405         struct file *fp;
1406         struct vnode *vp = NULL;
1407         struct sf_hdtr hdtr;
1408         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
1409         struct uio auio;
1410         struct mbuf *mheader = NULL;
1411         off_t hdtr_size = 0, sbytes;
1412         int error, hbytes = 0, tbytes;
1413
1414         KKASSERT(p);
1415
1416         /*
1417          * Do argument checking. Must be a regular file in, stream
1418          * type and connected socket out, positive offset.
1419          */
1420         fp = holdfp(p->p_fd, uap->fd, FREAD);
1421         if (fp == NULL) {
1422                 return (EBADF);
1423         }
1424         if (fp->f_type != DTYPE_VNODE) {
1425                 fdrop(fp);
1426                 return (EINVAL);
1427         }
1428         vp = (struct vnode *)fp->f_data;
1429         vref(vp);
1430         fdrop(fp);
1431
1432         /*
1433          * If specified, get the pointer to the sf_hdtr struct for
1434          * any headers/trailers.
1435          */
1436         if (uap->hdtr) {
1437                 error = copyin(uap->hdtr, &hdtr, sizeof(hdtr));
1438                 if (error)
1439                         goto done;
1440                 /*
1441                  * Send any headers.
1442                  */
1443                 if (hdtr.headers) {
1444                         error = iovec_copyin(hdtr.headers, &iov, aiov,
1445                                              hdtr.hdr_cnt, &hbytes);
1446                         if (error)
1447                                 goto done;
1448                         auio.uio_iov = iov;
1449                         auio.uio_iovcnt = hdtr.hdr_cnt;
1450                         auio.uio_offset = 0;
1451                         auio.uio_segflg = UIO_USERSPACE;
1452                         auio.uio_rw = UIO_WRITE;
1453                         auio.uio_td = td;
1454                         auio.uio_resid = hbytes;
1455
1456                         mheader = m_uiomove(&auio);
1457
1458                         iovec_free(&iov, aiov);
1459                         if (mheader == NULL)
1460                                 goto done;
1461                 }
1462         }
1463
1464         error = kern_sendfile(vp, uap->s, uap->offset, uap->nbytes, mheader,
1465             &sbytes, uap->flags);
1466         if (error)
1467                 goto done;
1468
1469         /*
1470          * Send trailers. Wimp out and use writev(2).
1471          */
1472         if (uap->hdtr != NULL && hdtr.trailers != NULL) {
1473                 error = iovec_copyin(hdtr.trailers, &iov, aiov,
1474                                      hdtr.trl_cnt, &auio.uio_resid);
1475                 if (error)
1476                         goto done;
1477                 auio.uio_iov = iov;
1478                 auio.uio_iovcnt = hdtr.trl_cnt;
1479                 auio.uio_offset = 0;
1480                 auio.uio_segflg = UIO_USERSPACE;
1481                 auio.uio_rw = UIO_WRITE;
1482                 auio.uio_td = td;
1483
1484                 error = kern_sendmsg(uap->s, NULL, &auio, NULL, 0, &tbytes);
1485
1486                 iovec_free(&iov, aiov);
1487                 if (error)
1488                         goto done;
1489                 hdtr_size += tbytes;    /* trailer bytes successfully sent */
1490         }
1491
1492 done:
1493         if (uap->sbytes != NULL) {
1494                 sbytes += hdtr_size;
1495                 copyout(&sbytes, uap->sbytes, sizeof(off_t));
1496         }
1497         if (vp)
1498                 vrele(vp);
1499         return (error);
1500 }
1501
1502 int
1503 kern_sendfile(struct vnode *vp, int sfd, off_t offset, size_t nbytes,
1504     struct mbuf *mheader, off_t *sbytes, int flags)
1505 {
1506         struct thread *td = curthread;
1507         struct proc *p = td->td_proc;
1508         struct vm_object *obj;
1509         struct socket *so;
1510         struct file *fp;
1511         struct mbuf *m;
1512         struct sf_buf *sf;
1513         struct sfbuf_mref *sfm;
1514         struct vm_page *pg;
1515         off_t off, xfsize;
1516         off_t hbytes = 0;
1517         int error = 0;
1518
1519         if (vp->v_type != VREG) {
1520                 error = EINVAL;
1521                 goto done0;
1522         }
1523         if ((obj = vp->v_object) == NULL) {
1524                 error = EINVAL;
1525                 goto done0;
1526         }
1527         error = holdsock(p->p_fd, sfd, &fp);
1528         if (error)
1529                 goto done0;
1530         so = (struct socket *)fp->f_data;
1531         if (so->so_type != SOCK_STREAM) {
1532                 error = EINVAL;
1533                 goto done;
1534         }
1535         if ((so->so_state & SS_ISCONNECTED) == 0) {
1536                 error = ENOTCONN;
1537                 goto done;
1538         }
1539         if (offset < 0) {
1540                 error = EINVAL;
1541                 goto done;
1542         }
1543
1544         *sbytes = 0;
1545         /*
1546          * Protect against multiple writers to the socket.
1547          */
1548         ssb_lock(&so->so_snd, M_WAITOK);
1549
1550         /*
1551          * Loop through the pages in the file, starting with the requested
1552          * offset. Get a file page (do I/O if necessary), map the file page
1553          * into an sf_buf, attach an mbuf header to the sf_buf, and queue
1554          * it on the socket.
1555          */
1556         for (off = offset; ; off += xfsize, *sbytes += xfsize + hbytes) {
1557                 vm_pindex_t pindex;
1558                 vm_offset_t pgoff;
1559
1560                 pindex = OFF_TO_IDX(off);
1561 retry_lookup:
1562                 /*
1563                  * Calculate the amount to transfer. Not to exceed a page,
1564                  * the EOF, or the passed in nbytes.
1565                  */
1566                 xfsize = vp->v_filesize - off;
1567                 if (xfsize > PAGE_SIZE)
1568                         xfsize = PAGE_SIZE;
1569                 pgoff = (vm_offset_t)(off & PAGE_MASK);
1570                 if (PAGE_SIZE - pgoff < xfsize)
1571                         xfsize = PAGE_SIZE - pgoff;
1572                 if (nbytes && xfsize > (nbytes - *sbytes))
1573                         xfsize = nbytes - *sbytes;
1574                 if (xfsize <= 0)
1575                         break;
1576                 /*
1577                  * Optimize the non-blocking case by looking at the socket space
1578                  * before going to the extra work of constituting the sf_buf.
1579                  */
1580                 if ((fp->f_flag & FNONBLOCK) && ssb_space(&so->so_snd) <= 0) {
1581                         if (so->so_state & SS_CANTSENDMORE)
1582                                 error = EPIPE;
1583                         else
1584                                 error = EAGAIN;
1585                         ssb_unlock(&so->so_snd);
1586                         goto done;
1587                 }
1588                 /*
1589                  * Attempt to look up the page.  
1590                  *
1591                  *      Allocate if not found, wait and loop if busy, then
1592                  *      wire the page.  critical section protection is
1593                  *      required to maintain the object association (an
1594                  *      interrupt can free the page) through to the
1595                  *      vm_page_wire() call.
1596                  */
1597                 crit_enter();
1598                 pg = vm_page_lookup(obj, pindex);
1599                 if (pg == NULL) {
1600                         pg = vm_page_alloc(obj, pindex, VM_ALLOC_NORMAL);
1601                         if (pg == NULL) {
1602                                 vm_wait(0);
1603                                 crit_exit();
1604                                 goto retry_lookup;
1605                         }
1606                         vm_page_wakeup(pg);
1607                 } else if (vm_page_sleep_busy(pg, TRUE, "sfpbsy")) {
1608                         crit_exit();
1609                         goto retry_lookup;
1610                 }
1611                 vm_page_wire(pg);
1612                 crit_exit();
1613
1614                 /*
1615                  * If page is not valid for what we need, initiate I/O
1616                  */
1617
1618                 if (!pg->valid || !vm_page_is_valid(pg, pgoff, xfsize)) {
1619                         struct uio auio;
1620                         struct iovec aiov;
1621                         int bsize;
1622
1623                         /*
1624                          * Ensure that our page is still around when the I/O 
1625                          * completes.
1626                          */
1627                         vm_page_io_start(pg);
1628
1629                         /*
1630                          * Get the page from backing store.
1631                          */
1632                         bsize = vp->v_mount->mnt_stat.f_iosize;
1633                         auio.uio_iov = &aiov;
1634                         auio.uio_iovcnt = 1;
1635                         aiov.iov_base = 0;
1636                         aiov.iov_len = MAXBSIZE;
1637                         auio.uio_resid = MAXBSIZE;
1638                         auio.uio_offset = trunc_page(off);
1639                         auio.uio_segflg = UIO_NOCOPY;
1640                         auio.uio_rw = UIO_READ;
1641                         auio.uio_td = td;
1642                         vn_lock(vp, LK_SHARED | LK_RETRY);
1643                         error = VOP_READ(vp, &auio, 
1644                                     IO_VMIO | ((MAXBSIZE / bsize) << 16),
1645                                     p->p_ucred);
1646                         vn_unlock(vp);
1647                         vm_page_flag_clear(pg, PG_ZERO);
1648                         vm_page_io_finish(pg);
1649                         if (error) {
1650                                 crit_enter();
1651                                 vm_page_unwire(pg, 0);
1652                                 vm_page_try_to_free(pg);
1653                                 crit_exit();
1654                                 ssb_unlock(&so->so_snd);
1655                                 goto done;
1656                         }
1657                 }
1658
1659
1660                 /*
1661                  * Get a sendfile buf. We usually wait as long as necessary,
1662                  * but this wait can be interrupted.
1663                  */
1664                 if ((sf = sf_buf_alloc(pg, SFB_CATCH)) == NULL) {
1665                         crit_enter();
1666                         vm_page_unwire(pg, 0);
1667                         vm_page_try_to_free(pg);
1668                         crit_exit();
1669                         ssb_unlock(&so->so_snd);
1670                         error = EINTR;
1671                         goto done;
1672                 }
1673
1674                 /*
1675                  * Get an mbuf header and set it up as having external storage.
1676                  */
1677                 MGETHDR(m, MB_WAIT, MT_DATA);
1678                 if (m == NULL) {
1679                         error = ENOBUFS;
1680                         sf_buf_free(sf);
1681                         ssb_unlock(&so->so_snd);
1682                         goto done;
1683                 }
1684
1685                 /*
1686                  * sfm is a temporary hack, use a per-cpu cache for this.
1687                  */
1688                 sfm = kmalloc(sizeof(struct sfbuf_mref), M_SENDFILE, M_WAITOK);
1689                 sfm->sf = sf;
1690                 sfm->mref_count = 1;
1691
1692                 m->m_ext.ext_free = sf_buf_mfree;
1693                 m->m_ext.ext_ref = sf_buf_mref;
1694                 m->m_ext.ext_arg = sfm;
1695                 m->m_ext.ext_buf = (void *)sf->kva;
1696                 m->m_ext.ext_size = PAGE_SIZE;
1697                 m->m_data = (char *) sf->kva + pgoff;
1698                 m->m_flags |= M_EXT;
1699                 m->m_pkthdr.len = m->m_len = xfsize;
1700                 KKASSERT((m->m_flags & (M_EXT_CLUSTER)) == 0);
1701
1702                 if (mheader != NULL) {
1703                         hbytes = mheader->m_pkthdr.len;
1704                         mheader->m_pkthdr.len += m->m_pkthdr.len;
1705                         m_cat(mheader, m);
1706                         m = mheader;
1707                         mheader = NULL;
1708                 } else
1709                         hbytes = 0;
1710
1711                 /*
1712                  * Add the buffer to the socket buffer chain.
1713                  */
1714                 crit_enter();
1715 retry_space:
1716                 /*
1717                  * Make sure that the socket is still able to take more data.
1718                  * CANTSENDMORE being true usually means that the connection
1719                  * was closed. so_error is true when an error was sensed after
1720                  * a previous send.
1721                  * The state is checked after the page mapping and buffer
1722                  * allocation above since those operations may block and make
1723                  * any socket checks stale. From this point forward, nothing
1724                  * blocks before the pru_send (or more accurately, any blocking
1725                  * results in a loop back to here to re-check).
1726                  */
1727                 if ((so->so_state & SS_CANTSENDMORE) || so->so_error) {
1728                         if (so->so_state & SS_CANTSENDMORE) {
1729                                 error = EPIPE;
1730                         } else {
1731                                 error = so->so_error;
1732                                 so->so_error = 0;
1733                         }
1734                         m_freem(m);
1735                         ssb_unlock(&so->so_snd);
1736                         crit_exit();
1737                         goto done;
1738                 }
1739                 /*
1740                  * Wait for socket space to become available. We do this just
1741                  * after checking the connection state above in order to avoid
1742                  * a race condition with ssb_wait().
1743                  */
1744                 if (ssb_space(&so->so_snd) < so->so_snd.ssb_lowat) {
1745                         if (fp->f_flag & FNONBLOCK) {
1746                                 m_freem(m);
1747                                 ssb_unlock(&so->so_snd);
1748                                 crit_exit();
1749                                 error = EAGAIN;
1750                                 goto done;
1751                         }
1752                         error = ssb_wait(&so->so_snd);
1753                         /*
1754                          * An error from ssb_wait usually indicates that we've
1755                          * been interrupted by a signal. If we've sent anything
1756                          * then return bytes sent, otherwise return the error.
1757                          */
1758                         if (error) {
1759                                 m_freem(m);
1760                                 ssb_unlock(&so->so_snd);
1761                                 crit_exit();
1762                                 goto done;
1763                         }
1764                         goto retry_space;
1765                 }
1766                 error = so_pru_send(so, 0, m, NULL, NULL, td);
1767                 crit_exit();
1768                 if (error) {
1769                         ssb_unlock(&so->so_snd);
1770                         goto done;
1771                 }
1772         }
1773         if (mheader != NULL) {
1774                 *sbytes += mheader->m_pkthdr.len;
1775                 error = so_pru_send(so, 0, mheader, NULL, NULL, td);
1776                 mheader = NULL;
1777         }
1778         ssb_unlock(&so->so_snd);
1779
1780 done:
1781         fdrop(fp);
1782 done0:
1783         if (mheader != NULL)
1784                 m_freem(mheader);
1785         return (error);
1786 }
1787
1788 int
1789 sys_sctp_peeloff(struct sctp_peeloff_args *uap)
1790 {
1791 #ifdef SCTP
1792         struct thread *td = curthread;
1793         struct proc *p = td->td_proc;
1794         struct file *lfp = NULL;
1795         struct file *nfp = NULL;
1796         int error;
1797         struct socket *head, *so;
1798         caddr_t assoc_id;
1799         int fd;
1800         short fflag;            /* type must match fp->f_flag */
1801
1802         assoc_id = uap->name;
1803         error = holdsock(p->p_fd, uap->sd, &lfp);
1804         if (error) {
1805                 return (error);
1806         }
1807         crit_enter();
1808         head = (struct socket *)lfp->f_data;
1809         error = sctp_can_peel_off(head, assoc_id);
1810         if (error) {
1811                 crit_exit();
1812                 goto done;
1813         }
1814         /*
1815          * At this point we know we do have a assoc to pull
1816          * we proceed to get the fd setup. This may block
1817          * but that is ok.
1818          */
1819
1820         fflag = lfp->f_flag;
1821         error = falloc(p, &nfp, &fd);
1822         if (error) {
1823                 /*
1824                  * Probably ran out of file descriptors. Put the
1825                  * unaccepted connection back onto the queue and
1826                  * do another wakeup so some other process might
1827                  * have a chance at it.
1828                  */
1829                 crit_exit();
1830                 goto done;
1831         }
1832         uap->sysmsg_result = fd;
1833
1834         so = sctp_get_peeloff(head, assoc_id, &error);
1835         if (so == NULL) {
1836                 /*
1837                  * Either someone else peeled it off OR
1838                  * we can't get a socket.
1839                  */
1840                 goto noconnection;
1841         }
1842         so->so_state &= ~SS_COMP;
1843         so->so_state &= ~SS_NOFDREF;
1844         so->so_head = NULL;
1845         if (head->so_sigio != NULL)
1846                 fsetown(fgetown(head->so_sigio), &so->so_sigio);
1847
1848         nfp->f_type = DTYPE_SOCKET;
1849         nfp->f_flag = fflag;
1850         nfp->f_ops = &socketops;
1851         nfp->f_data = so;
1852
1853 noconnection:
1854         /*
1855          * Assign the file pointer to the reserved descriptor, or clear
1856          * the reserved descriptor if an error occured.
1857          */
1858         if (error)
1859                 fsetfd(p, NULL, fd);
1860         else
1861                 fsetfd(p, nfp, fd);
1862         crit_exit();
1863         /*
1864          * Release explicitly held references before returning.
1865          */
1866 done:
1867         if (nfp != NULL)
1868                 fdrop(nfp);
1869         fdrop(lfp);
1870         return (error);
1871 #else /* SCTP */
1872         return(EOPNOTSUPP);
1873 #endif /* SCTP */
1874 }