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