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