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