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