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.56 2005/07/13 01:38:50 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_files[fd].fp == fp) {
 115                         funsetfd(fdp, fd);
 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_files[fd].fp == nfp) {
 348                         funsetfd(fdp, fd);
 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_files[sv[1]].fp == fp2) {
 528                 funsetfd(fdp, sv[1]);
 529                 fdrop(fp2, td);
 530         }
 531         fdrop(fp2, td);
 532 free3:
 533         if (fdp->fd_files[sv[0]].fp == fp1) {
 534                 funsetfd(fdp, sv[0]);
 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  * If sopt->sopt_td == NULL, then sopt->sopt_val is treated as an
 950  * in kernel pointer instead of a userland pointer.  This allows us
 951  * to manipulate socket options in the emulation code.
 952  */
 953 int
 954 kern_setsockopt(int s, struct sockopt *sopt)
 955 {
 956         struct thread *td = curthread;
 957         struct proc *p = td->td_proc;
 958         struct file *fp;
 959         int error;
 960
 961         if (sopt->sopt_val == 0 && sopt->sopt_valsize != 0)
 962                 return (EFAULT);
 963         if (sopt->sopt_valsize < 0)
 964                 return (EINVAL);
 965
 966         error = holdsock(p->p_fd, s, &fp);
 967         if (error)
 968                 return (error);
 969
 970         error = sosetopt((struct socket *)fp->f_data, sopt);
 971         fdrop(fp, td);
 972         return (error);
 973 }
 974
 975 /*
 976  * setsockopt_args(int s, int level, int name, caddr_t val, int valsize)
 977  */
 978 int
 979 setsockopt(struct setsockopt_args *uap)
 980 {
 981         struct thread *td = curthread;
 982         struct sockopt sopt;
 983         int error;
 984
 985         sopt.sopt_level = uap->level;
 986         sopt.sopt_name = uap->name;
 987         sopt.sopt_val = uap->val;
 988         sopt.sopt_valsize = uap->valsize;
 989         sopt.sopt_td = td;
 990
 991         error = kern_setsockopt(uap->s, &sopt);
 992         return(error);
 993 }
 994
 995 /*
 996  * If sopt->sopt_td == NULL, then sopt->sopt_val is treated as an
 997  * in kernel pointer instead of a userland pointer.  This allows us
 998  * to manipulate socket options in the emulation code.
 999  */
1000 int
1001 kern_getsockopt(int s, struct sockopt *sopt)
1002 {
1003         struct thread *td = curthread;
1004         struct proc *p = td->td_proc;
1005         struct file *fp;
1006         int error;
1007
1008         if (sopt->sopt_val == 0 && sopt->sopt_valsize != 0)
1009                 return (EFAULT);
1010         if (sopt->sopt_valsize < 0)
1011                 return (EINVAL);
1012
1013         error = holdsock(p->p_fd, s, &fp);
1014         if (error)
1015                 return (error);
1016
1017         error = sogetopt((struct socket *)fp->f_data, sopt);
1018         fdrop(fp, td);
1019         return (error);
1020 }
1021
1022 /*
1023  * getsockopt_Args(int s, int level, int name, caddr_t val, int *avalsize)
1024  */
1025 int
1026 getsockopt(struct getsockopt_args *uap)
1027 {
1028         struct thread *td = curthread;
1029         struct  sockopt sopt;
1030         int     error, valsize;
1031
1032         if (uap->val) {
1033                 error = copyin(uap->avalsize, &valsize, sizeof(valsize));
1034                 if (error)
1035                         return (error);
1036                 if (valsize < 0)
1037                         return (EINVAL);
1038         } else {
1039                 valsize = 0;
1040         }
1041
1042         sopt.sopt_level = uap->level;
1043         sopt.sopt_name = uap->name;
1044         sopt.sopt_val = uap->val;
1045         sopt.sopt_valsize = valsize;
1046         sopt.sopt_td = td;
1047
1048         error = kern_getsockopt(uap->s, &sopt);
1049         if (error == 0) {
1050                 valsize = sopt.sopt_valsize;
1051                 error = copyout(&valsize, uap->avalsize, sizeof(valsize));
1052         }
1053         return (error);
1054 }
1055
1056 /*
1057  * The second argument to kern_getsockname() is a handle to a struct sockaddr.
1058  * This allows kern_getsockname() to return a pointer to an allocated struct
1059  * sockaddr which must be freed later with FREE().  The caller must
1060  * initialize *name to NULL.
1061  */
1062 int
1063 kern_getsockname(int s, struct sockaddr **name, int *namelen)
1064 {
1065         struct thread *td = curthread;
1066         struct proc *p = td->td_proc;
1067         struct file *fp;
1068         struct socket *so;
1069         struct sockaddr *sa = NULL;
1070         int error;
1071
1072         error = holdsock(p->p_fd, s, &fp);
1073         if (error)
1074                 return (error);
1075         if (*namelen < 0) {
1076                 fdrop(fp, td);
1077                 return (EINVAL);
1078         }
1079         so = (struct socket *)fp->f_data;
1080         error = so_pru_sockaddr(so, &sa);
1081         if (error == 0) {
1082                 if (sa == 0) {
1083                         *namelen = 0;
1084                 } else {
1085                         *namelen = MIN(*namelen, sa->sa_len);
1086                         *name = sa;
1087                 }
1088         }
1089
1090         fdrop(fp, td);
1091         return (error);
1092 }
1093
1094 /*
1095  * getsockname_args(int fdes, caddr_t asa, int *alen)
1096  *
1097  * Get socket name.
1098  */
1099 int
1100 getsockname(struct getsockname_args *uap)
1101 {
1102         struct sockaddr *sa = NULL;
1103         int error, sa_len;
1104
1105         error = copyin(uap->alen, &sa_len, sizeof(sa_len));
1106         if (error)
1107                 return (error);
1108
1109         error = kern_getsockname(uap->fdes, &sa, &sa_len);
1110
1111         if (error == 0)
1112                 error = copyout(sa, uap->asa, sa_len);
1113         if (error == 0)
1114                 error = copyout(&sa_len, uap->alen, sizeof(*uap->alen));
1115         if (sa)
1116                 FREE(sa, M_SONAME);
1117         return (error);
1118 }
1119
1120 /*
1121  * The second argument to kern_getpeername() is a handle to a struct sockaddr.
1122  * This allows kern_getpeername() to return a pointer to an allocated struct
1123  * sockaddr which must be freed later with FREE().  The caller must
1124  * initialize *name to NULL.
1125  */
1126 int
1127 kern_getpeername(int s, struct sockaddr **name, int *namelen)
1128 {
1129         struct thread *td = curthread;
1130         struct proc *p = td->td_proc;
1131         struct file *fp;
1132         struct socket *so;
1133         struct sockaddr *sa = NULL;
1134         int error;
1135
1136         error = holdsock(p->p_fd, s, &fp);
1137         if (error)
1138                 return (error);
1139         if (*namelen < 0) {
1140                 fdrop(fp, td);
1141                 return (EINVAL);
1142         }
1143         so = (struct socket *)fp->f_data;
1144         if ((so->so_state & (SS_ISCONNECTED|SS_ISCONFIRMING)) == 0) {
1145                 fdrop(fp, td);
1146                 return (ENOTCONN);
1147         }
1148         error = so_pru_peeraddr(so, &sa);
1149         if (error == 0) {
1150                 if (sa == 0) {
1151                         *namelen = 0;
1152                 } else {
1153                         *namelen = MIN(*namelen, sa->sa_len);
1154                         *name = sa;
1155                 }
1156         }
1157
1158         fdrop(fp, td);
1159         return (error);
1160 }
1161
1162 /*
1163  * getpeername_args(int fdes, caddr_t asa, int *alen)
1164  *
1165  * Get name of peer for connected socket.
1166  */
1167 int
1168 getpeername(struct getpeername_args *uap)
1169 {
1170         struct sockaddr *sa = NULL;
1171         int error, sa_len;
1172
1173         error = copyin(uap->alen, &sa_len, sizeof(sa_len));
1174         if (error)
1175                 return (error);
1176
1177         error = kern_getpeername(uap->fdes, &sa, &sa_len);
1178
1179         if (error == 0)
1180                 error = copyout(sa, uap->asa, sa_len);
1181         if (error == 0)
1182                 error = copyout(&sa_len, uap->alen, sizeof(*uap->alen));
1183         if (sa)
1184                 FREE(sa, M_SONAME);
1185         return (error);
1186 }
1187
1188 int
1189 getsockaddr(struct sockaddr **namp, caddr_t uaddr, size_t len)
1190 {
1191         struct sockaddr *sa;
1192         int error;
1193
1194         *namp = NULL;
1195         if (len > SOCK_MAXADDRLEN)
1196                 return ENAMETOOLONG;
1197         if (len < offsetof(struct sockaddr, sa_data[0]))
1198                 return EDOM;
1199         MALLOC(sa, struct sockaddr *, len, M_SONAME, M_WAITOK);
1200         error = copyin(uaddr, sa, len);
1201         if (error) {
1202                 FREE(sa, M_SONAME);
1203         } else {
1204 #if BYTE_ORDER != BIG_ENDIAN
1205                 /*
1206                  * The bind(), connect(), and sendto() syscalls were not
1207                  * versioned for COMPAT_43.  Thus, this check must stay.
1208                  */
1209                 if (sa->sa_family == 0 && sa->sa_len < AF_MAX)
1210                         sa->sa_family = sa->sa_len;
1211 #endif
1212                 sa->sa_len = len;
1213                 *namp = sa;
1214         }
1215         return error;
1216 }
1217
1218 /*
1219  * holdsock() - load the struct file pointer associated
1220  * with a socket into *fpp.  If an error occurs, non-zero
1221  * will be returned and *fpp will be set to NULL.
1222  */
1223 int
1224 holdsock(struct filedesc *fdp, int fdes, struct file **fpp)
1225 {
1226         struct file *fp;
1227         int error = 0;
1228
1229         *fpp = NULL;
1230         if ((unsigned)fdes >= fdp->fd_nfiles)
1231                 return EBADF;
1232         if ((fp = fdp->fd_files[fdes].fp) == NULL)
1233                 return EBADF;
1234         if (fp->f_type != DTYPE_SOCKET)
1235                 return ENOTSOCK;
1236         fhold(fp);
1237         *fpp = fp;
1238         return (error);
1239 }
1240
1241 /*
1242  * Detach a mapped page and release resources back to the system.
1243  * We must release our wiring and if the object is ripped out
1244  * from under the vm_page we become responsible for freeing the
1245  * page.
1246  *
1247  * XXX HACK XXX TEMPORARY UNTIL WE IMPLEMENT EXT MBUF REFERENCE COUNTING
1248  */
1249 static void
1250 sf_buf_mref(void *arg)
1251 {
1252         struct sfbuf_mref *sfm = arg;
1253
1254         ++sfm->mref_count;
1255 }
1256
1257 static void
1258 sf_buf_mfree(void *arg)
1259 {
1260         struct sfbuf_mref *sfm = arg;
1261         vm_page_t m;
1262
1263         KKASSERT(sfm->mref_count > 0);
1264         if (--sfm->mref_count == 0) {
1265                 m = sf_buf_page(sfm->sf);
1266                 sf_buf_free(sfm->sf);
1267                 crit_enter();
1268                 vm_page_unwire(m, 0);
1269                 if (m->wire_count == 0 && m->object == NULL)
1270                         vm_page_try_to_free(m);
1271                 crit_exit();
1272                 free(sfm, M_SENDFILE);
1273         }
1274 }
1275
1276 /*
1277  * sendfile(2).
1278  * int sendfile(int fd, int s, off_t offset, size_t nbytes,
1279  *       struct sf_hdtr *hdtr, off_t *sbytes, int flags)
1280  *
1281  * Send a file specified by 'fd' and starting at 'offset' to a socket
1282  * specified by 's'. Send only 'nbytes' of the file or until EOF if
1283  * nbytes == 0. Optionally add a header and/or trailer to the socket
1284  * output. If specified, write the total number of bytes sent into *sbytes.
1285  *
1286  * In FreeBSD kern/uipc_syscalls.c,v 1.103, a bug was fixed that caused
1287  * the headers to count against the remaining bytes to be sent from
1288  * the file descriptor.  We may wish to implement a compatibility syscall
1289  * in the future.
1290  */
1291 int
1292 sendfile(struct sendfile_args *uap)
1293 {
1294         struct thread *td = curthread;
1295         struct proc *p = td->td_proc;
1296         struct file *fp;
1297         struct filedesc *fdp;
1298         struct vnode *vp = NULL;
1299         struct sf_hdtr hdtr;
1300         struct iovec aiov[UIO_SMALLIOV], *iov = NULL;
1301         struct uio auio;
1302         struct mbuf *mheader = NULL;
1303         off_t hdtr_size = 0, sbytes;
1304         int error, hbytes = 0, tbytes;
1305
1306         KKASSERT(p);
1307         fdp = p->p_fd;
1308
1309         /*
1310          * Do argument checking. Must be a regular file in, stream
1311          * type and connected socket out, positive offset.
1312          */
1313         fp = holdfp(fdp, uap->fd, FREAD);
1314         if (fp == NULL) {
1315                 return (EBADF);
1316         }
1317         if (fp->f_type != DTYPE_VNODE) {
1318                 fdrop(fp, td);
1319                 return (EINVAL);
1320         }
1321         vp = (struct vnode *)fp->f_data;
1322         vref(vp);
1323         fdrop(fp, td);
1324
1325         /*
1326          * If specified, get the pointer to the sf_hdtr struct for
1327          * any headers/trailers.
1328          */
1329         if (uap->hdtr) {
1330                 error = copyin(uap->hdtr, &hdtr, sizeof(hdtr));
1331                 if (error)
1332                         goto done;
1333                 /*
1334                  * Send any headers.
1335                  */
1336                 if (hdtr.headers) {
1337                         error = iovec_copyin(hdtr.headers, &iov, aiov,
1338                             hdtr.hdr_cnt, &hbytes);
1339                         if (error)
1340                                 goto done;
1341                         auio.uio_iov = iov;
1342                         auio.uio_iovcnt = hdtr.hdr_cnt;
1343                         auio.uio_offset = 0;
1344                         auio.uio_segflg = UIO_USERSPACE;
1345                         auio.uio_rw = UIO_WRITE;
1346                         auio.uio_td = td;
1347                         auio.uio_resid = hbytes;
1348
1349                         mheader = m_uiomove(&auio);
1350
1351                         iovec_free(&iov, aiov);
1352                         if (mheader == NULL)
1353                                 goto done;
1354                 }
1355         }
1356
1357         error = kern_sendfile(vp, uap->s, uap->offset, uap->nbytes, mheader,
1358             &sbytes, uap->flags);
1359         if (error)
1360                 goto done;
1361
1362         /*
1363          * Send trailers. Wimp out and use writev(2).
1364          */
1365         if (uap->hdtr != NULL && hdtr.trailers != NULL) {
1366                 error = iovec_copyin(hdtr.trailers, &iov, aiov,
1367                     hdtr.trl_cnt, &auio.uio_resid);
1368                 if (error)
1369                         goto done;
1370                 auio.uio_iov = iov;
1371                 auio.uio_iovcnt = hdtr.trl_cnt;
1372                 auio.uio_offset = 0;
1373                 auio.uio_segflg = UIO_USERSPACE;
1374                 auio.uio_rw = UIO_WRITE;
1375                 auio.uio_td = td;
1376
1377                 error = kern_sendmsg(uap->s, NULL, &auio, NULL, 0, &tbytes);
1378
1379                 iovec_free(&iov, aiov);
1380                 if (error)
1381                         goto done;
1382                 hdtr_size += tbytes;    /* trailer bytes successfully sent */
1383         }
1384
1385 done:
1386         if (uap->sbytes != NULL) {
1387                 sbytes += hdtr_size;
1388                 copyout(&sbytes, uap->sbytes, sizeof(off_t));
1389         }
1390         if (vp)
1391                 vrele(vp);
1392         return (error);
1393 }
1394
1395 int
1396 kern_sendfile(struct vnode *vp, int sfd, off_t offset, size_t nbytes,
1397     struct mbuf *mheader, off_t *sbytes, int flags)
1398 {
1399         struct thread *td = curthread;
1400         struct proc *p = td->td_proc;
1401         struct vm_object *obj;
1402         struct socket *so;
1403         struct file *fp;
1404         struct mbuf *m;
1405         struct sf_buf *sf;
1406         struct sfbuf_mref *sfm;
1407         struct vm_page *pg;
1408         off_t off, xfsize;
1409         off_t hbytes = 0;
1410         int error = 0;
1411
1412         if (vp->v_type != VREG || VOP_GETVOBJECT(vp, &obj) != 0) {
1413                 error = EINVAL;
1414                 goto done0;
1415         }
1416         error = holdsock(p->p_fd, sfd, &fp);
1417         if (error)
1418                 goto done0;
1419         so = (struct socket *)fp->f_data;
1420         if (so->so_type != SOCK_STREAM) {
1421                 error = EINVAL;
1422                 goto done;
1423         }
1424         if ((so->so_state & SS_ISCONNECTED) == 0) {
1425                 error = ENOTCONN;
1426                 goto done;
1427         }
1428         if (offset < 0) {
1429                 error = EINVAL;
1430                 goto done;
1431         }
1432
1433         *sbytes = 0;
1434         /*
1435          * Protect against multiple writers to the socket.
1436          */
1437         (void) sblock(&so->so_snd, M_WAITOK);
1438
1439         /*
1440          * Loop through the pages in the file, starting with the requested
1441          * offset. Get a file page (do I/O if necessary), map the file page
1442          * into an sf_buf, attach an mbuf header to the sf_buf, and queue
1443          * it on the socket.
1444          */
1445         for (off = offset; ; off += xfsize, *sbytes += xfsize + hbytes) {
1446                 vm_pindex_t pindex;
1447                 vm_offset_t pgoff;
1448
1449                 pindex = OFF_TO_IDX(off);
1450 retry_lookup:
1451                 /*
1452                  * Calculate the amount to transfer. Not to exceed a page,
1453                  * the EOF, or the passed in nbytes.
1454                  */
1455                 xfsize = obj->un_pager.vnp.vnp_size - off;
1456                 if (xfsize > PAGE_SIZE)
1457                         xfsize = PAGE_SIZE;
1458                 pgoff = (vm_offset_t)(off & PAGE_MASK);
1459                 if (PAGE_SIZE - pgoff < xfsize)
1460                         xfsize = PAGE_SIZE - pgoff;
1461                 if (nbytes && xfsize > (nbytes - *sbytes))
1462                         xfsize = nbytes - *sbytes;
1463                 if (xfsize <= 0)
1464                         break;
1465                 /*
1466                  * Optimize the non-blocking case by looking at the socket space
1467                  * before going to the extra work of constituting the sf_buf.
1468                  */
1469                 if ((so->so_state & SS_NBIO) && sbspace(&so->so_snd) <= 0) {
1470                         if (so->so_state & SS_CANTSENDMORE)
1471                                 error = EPIPE;
1472                         else
1473                                 error = EAGAIN;
1474                         sbunlock(&so->so_snd);
1475                         goto done;
1476                 }
1477                 /*
1478                  * Attempt to look up the page.
1479                  *
1480                  *      Allocate if not found, wait and loop if busy, then
1481                  *      wire the page.  critical section protection is
1482                  *      required to maintain the object association (an
1483                  *      interrupt can free the page) through to the
1484                  *      vm_page_wire() call.
1485                  */
1486                 crit_enter();
1487                 pg = vm_page_lookup(obj, pindex);
1488                 if (pg == NULL) {
1489                         pg = vm_page_alloc(obj, pindex, VM_ALLOC_NORMAL);
1490                         if (pg == NULL) {
1491                                 vm_wait();
1492                                 crit_exit();
1493                                 goto retry_lookup;
1494                         }
1495                         vm_page_wakeup(pg);
1496                 } else if (vm_page_sleep_busy(pg, TRUE, "sfpbsy")) {
1497                         crit_exit();
1498                         goto retry_lookup;
1499                 }
1500                 vm_page_wire(pg);
1501                 crit_exit();
1502
1503                 /*
1504                  * If page is not valid for what we need, initiate I/O
1505                  */
1506
1507                 if (!pg->valid || !vm_page_is_valid(pg, pgoff, xfsize)) {
1508                         struct uio auio;
1509                         struct iovec aiov;
1510                         int bsize;
1511
1512                         /*
1513                          * Ensure that our page is still around when the I/O
1514                          * completes.
1515                          */
1516                         vm_page_io_start(pg);
1517
1518                         /*
1519                          * Get the page from backing store.
1520                          */
1521                         bsize = vp->v_mount->mnt_stat.f_iosize;
1522                         auio.uio_iov = &aiov;
1523                         auio.uio_iovcnt = 1;
1524                         aiov.iov_base = 0;
1525                         aiov.iov_len = MAXBSIZE;
1526                         auio.uio_resid = MAXBSIZE;
1527                         auio.uio_offset = trunc_page(off);
1528                         auio.uio_segflg = UIO_NOCOPY;
1529                         auio.uio_rw = UIO_READ;
1530                         auio.uio_td = td;
1531                         vn_lock(vp, LK_SHARED | LK_NOPAUSE | LK_RETRY, td);
1532                         error = VOP_READ(vp, &auio,
1533                                     IO_VMIO | ((MAXBSIZE / bsize) << 16),
1534                                     p->p_ucred);
1535                         VOP_UNLOCK(vp, 0, td);
1536                         vm_page_flag_clear(pg, PG_ZERO);
1537                         vm_page_io_finish(pg);
1538                         if (error) {
1539                                 crit_enter();
1540                                 vm_page_unwire(pg, 0);
1541                                 vm_page_try_to_free(pg);
1542                                 crit_exit();
1543                                 sbunlock(&so->so_snd);
1544                                 goto done;
1545                         }
1546                 }
1547
1548
1549                 /*
1550                  * Get a sendfile buf. We usually wait as long as necessary,
1551                  * but this wait can be interrupted.
1552                  */
1553                 if ((sf = sf_buf_alloc(pg, SFB_CATCH)) == NULL) {
1554                         crit_enter();
1555                         vm_page_unwire(pg, 0);
1556                         vm_page_try_to_free(pg);
1557                         crit_exit();
1558                         sbunlock(&so->so_snd);
1559                         error = EINTR;
1560                         goto done;
1561                 }
1562
1563                 /*
1564                  * Get an mbuf header and set it up as having external storage.
1565                  */
1566                 MGETHDR(m, MB_WAIT, MT_DATA);
1567                 if (m == NULL) {
1568                         error = ENOBUFS;
1569                         sf_buf_free(sf);
1570                         sbunlock(&so->so_snd);
1571                         goto done;
1572                 }
1573
1574                 /*
1575                  * sfm is a temporary hack, use a per-cpu cache for this.
1576                  */
1577                 sfm = malloc(sizeof(struct sfbuf_mref), M_SENDFILE, M_WAITOK);
1578                 sfm->sf = sf;
1579                 sfm->mref_count = 1;
1580
1581                 m->m_ext.ext_free = sf_buf_mfree;
1582                 m->m_ext.ext_ref = sf_buf_mref;
1583                 m->m_ext.ext_arg = sfm;
1584                 m->m_ext.ext_buf = (void *)sf->kva;
1585                 m->m_ext.ext_size = PAGE_SIZE;
1586                 m->m_data = (char *) sf->kva + pgoff;
1587                 m->m_flags |= M_EXT;
1588                 m->m_pkthdr.len = m->m_len = xfsize;
1589                 KKASSERT((m->m_flags & (M_EXT_CLUSTER)) == 0);
1590
1591                 if (mheader != NULL) {
1592                         hbytes = mheader->m_pkthdr.len;
1593                         mheader->m_pkthdr.len += m->m_pkthdr.len;
1594                         m_cat(mheader, m);
1595                         m = mheader;
1596                         mheader = NULL;
1597                 } else
1598                         hbytes = 0;
1599
1600                 /*
1601                  * Add the buffer to the socket buffer chain.
1602                  */
1603                 crit_enter();
1604 retry_space:
1605                 /*
1606                  * Make sure that the socket is still able to take more data.
1607                  * CANTSENDMORE being true usually means that the connection
1608                  * was closed. so_error is true when an error was sensed after
1609                  * a previous send.
1610                  * The state is checked after the page mapping and buffer
1611                  * allocation above since those operations may block and make
1612                  * any socket checks stale. From this point forward, nothing
1613                  * blocks before the pru_send (or more accurately, any blocking
1614                  * results in a loop back to here to re-check).
1615                  */
1616                 if ((so->so_state & SS_CANTSENDMORE) || so->so_error) {
1617                         if (so->so_state & SS_CANTSENDMORE) {
1618                                 error = EPIPE;
1619                         } else {
1620                                 error = so->so_error;
1621                                 so->so_error = 0;
1622                         }
1623                         m_freem(m);
1624                         sbunlock(&so->so_snd);
1625                         crit_exit();
1626                         goto done;
1627                 }
1628                 /*
1629                  * Wait for socket space to become available. We do this just
1630                  * after checking the connection state above in order to avoid
1631                  * a race condition with sbwait().
1632                  */
1633                 if (sbspace(&so->so_snd) < so->so_snd.sb_lowat) {
1634                         if (so->so_state & SS_NBIO) {
1635                                 m_freem(m);
1636                                 sbunlock(&so->so_snd);
1637                                 crit_exit();
1638                                 error = EAGAIN;
1639                                 goto done;
1640                         }
1641                         error = sbwait(&so->so_snd);
1642                         /*
1643                          * An error from sbwait usually indicates that we've
1644                          * been interrupted by a signal. If we've sent anything
1645                          * then return bytes sent, otherwise return the error.
1646                          */
1647                         if (error) {
1648                                 m_freem(m);
1649                                 sbunlock(&so->so_snd);
1650                                 crit_exit();
1651                                 goto done;
1652                         }
1653                         goto retry_space;
1654                 }
1655                 error = so_pru_send(so, 0, m, NULL, NULL, td);
1656                 crit_exit();
1657                 if (error) {
1658                         sbunlock(&so->so_snd);
1659                         goto done;
1660                 }
1661         }
1662         if (mheader != NULL) {
1663                 *sbytes += mheader->m_pkthdr.len;
1664                 error = so_pru_send(so, 0, mheader, NULL, NULL, td);
1665                 mheader = NULL;
1666         }
1667         sbunlock(&so->so_snd);
1668
1669 done:
1670         fdrop(fp, td);
1671 done0:
1672         if (mheader != NULL)
1673                 m_freem(mheader);
1674         return (error);
1675 }