1 /* 2 * Copyright (c) 1982, 1986, 1989, 1993 3 * The Regents of the University of California. All rights reserved. 4 * (c) UNIX System Laboratories, Inc. 5 * All or some portions of this file are derived from material licensed 6 * to the University of California by American Telephone and Telegraph 7 * Co. or Unix System Laboratories, Inc. and are reproduced herein with 8 * the permission of UNIX System Laboratories, Inc. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. Neither the name of the University nor the names of its contributors 19 * may be used to endorse or promote products derived from this software 20 * without specific prior written permission. 21 * 22 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 * SUCH DAMAGE. 33 * 34 * @(#)sys_generic.c 8.5 (Berkeley) 1/21/94 35 * $FreeBSD: src/sys/kern/sys_generic.c,v 1.55.2.10 2001/03/17 10:39:32 peter Exp $ 36 */ 37 38 #include "opt_ktrace.h" 39 40 #include <sys/param.h> 41 #include <sys/systm.h> 42 #include <sys/sysmsg.h> 43 #include <sys/event.h> 44 #include <sys/filedesc.h> 45 #include <sys/filio.h> 46 #include <sys/fcntl.h> 47 #include <sys/file.h> 48 #include <sys/proc.h> 49 #include <sys/signalvar.h> 50 #include <sys/socketvar.h> 51 #include <sys/malloc.h> 52 #include <sys/uio.h> 53 #include <sys/kernel.h> 54 #include <sys/kern_syscall.h> 55 #include <sys/mapped_ioctl.h> 56 #include <sys/poll.h> 57 #include <sys/queue.h> 58 #include <sys/resourcevar.h> 59 #include <sys/socketops.h> 60 #include <sys/sysctl.h> 61 #include <sys/sysent.h> 62 #include <sys/buf.h> 63 #ifdef KTRACE 64 #include <sys/ktrace.h> 65 #endif 66 #include <vm/vm.h> 67 #include <vm/vm_page.h> 68 69 #include <sys/file2.h> 70 #include <sys/spinlock2.h> 71 72 #include <machine/limits.h> 73 74 static MALLOC_DEFINE(M_IOCTLOPS, "ioctlops", "ioctl data buffer"); 75 static MALLOC_DEFINE(M_IOCTLMAP, "ioctlmap", "mapped ioctl handler buffer"); 76 static MALLOC_DEFINE(M_SELECT, "select", "select() buffer"); 77 MALLOC_DEFINE(M_IOV, "iov", "large iov's"); 78 79 typedef struct kfd_set { 80 fd_mask fds_bits[2]; 81 } kfd_set; 82 83 enum select_copyin_states { 84 COPYIN_READ, COPYIN_WRITE, COPYIN_EXCEPT, COPYIN_DONE }; 85 86 struct select_kevent_copyin_args { 87 kfd_set *read_set; 88 kfd_set *write_set; 89 kfd_set *except_set; 90 int active_set; /* One of select_copyin_states */ 91 struct lwp *lwp; /* Pointer to our lwp */ 92 int num_fds; /* Number of file descriptors (syscall arg) */ 93 int proc_fds; /* Processed fd's (wraps) */ 94 int error; /* Returned to userland */ 95 }; 96 97 struct poll_kevent_copyin_args { 98 struct lwp *lwp; 99 struct pollfd *fds; 100 int nfds; 101 int pfds; 102 int error; 103 }; 104 105 static struct lwkt_token mioctl_token = LWKT_TOKEN_INITIALIZER(mioctl_token); 106 107 static int doselect(int nd, fd_set *in, fd_set *ou, fd_set *ex, 108 struct timespec *ts, int *res); 109 static int dopoll(int nfds, struct pollfd *fds, struct timespec *ts, 110 int *res, int flags); 111 static int dofileread(int, struct file *, struct uio *, int, size_t *); 112 static int dofilewrite(int, struct file *, struct uio *, int, size_t *); 113 114 /* 115 * Read system call. 116 * 117 * MPSAFE 118 */ 119 int 120 sys_read(struct sysmsg *sysmsg, const struct read_args *uap) 121 { 122 struct thread *td = curthread; 123 struct uio auio; 124 struct iovec aiov; 125 int error; 126 127 if ((ssize_t)uap->nbyte < 0) 128 error = EINVAL; 129 130 aiov.iov_base = uap->buf; 131 aiov.iov_len = uap->nbyte; 132 auio.uio_iov = &aiov; 133 auio.uio_iovcnt = 1; 134 auio.uio_offset = -1; 135 auio.uio_resid = uap->nbyte; 136 auio.uio_rw = UIO_READ; 137 auio.uio_segflg = UIO_USERSPACE; 138 auio.uio_td = td; 139 140 error = kern_preadv(uap->fd, &auio, 0, &sysmsg->sysmsg_szresult); 141 return(error); 142 } 143 144 /* 145 * Positioned (Pread) read system call 146 * 147 * MPSAFE 148 */ 149 int 150 sys_extpread(struct sysmsg *sysmsg, const struct extpread_args *uap) 151 { 152 struct thread *td = curthread; 153 struct uio auio; 154 struct iovec aiov; 155 int error; 156 int flags; 157 158 if ((ssize_t)uap->nbyte < 0) 159 return(EINVAL); 160 161 aiov.iov_base = uap->buf; 162 aiov.iov_len = uap->nbyte; 163 auio.uio_iov = &aiov; 164 auio.uio_iovcnt = 1; 165 auio.uio_offset = uap->offset; 166 auio.uio_resid = uap->nbyte; 167 auio.uio_rw = UIO_READ; 168 auio.uio_segflg = UIO_USERSPACE; 169 auio.uio_td = td; 170 171 flags = uap->flags & O_FMASK; 172 if (uap->offset != (off_t)-1) 173 flags |= O_FOFFSET; 174 175 error = kern_preadv(uap->fd, &auio, flags, &sysmsg->sysmsg_szresult); 176 return(error); 177 } 178 179 /* 180 * Scatter read system call. 181 * 182 * MPSAFE 183 */ 184 int 185 sys_readv(struct sysmsg *sysmsg, const struct readv_args *uap) 186 { 187 struct thread *td = curthread; 188 struct uio auio; 189 struct iovec aiov[UIO_SMALLIOV], *iov = NULL; 190 int error; 191 192 error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt, 193 &auio.uio_resid); 194 if (error) 195 return (error); 196 auio.uio_iov = iov; 197 auio.uio_iovcnt = uap->iovcnt; 198 auio.uio_offset = -1; 199 auio.uio_rw = UIO_READ; 200 auio.uio_segflg = UIO_USERSPACE; 201 auio.uio_td = td; 202 203 error = kern_preadv(uap->fd, &auio, 0, &sysmsg->sysmsg_szresult); 204 205 iovec_free(&iov, aiov); 206 return (error); 207 } 208 209 210 /* 211 * Scatter positioned read system call. 212 * 213 * MPSAFE 214 */ 215 int 216 sys_extpreadv(struct sysmsg *sysmsg, const struct extpreadv_args *uap) 217 { 218 struct thread *td = curthread; 219 struct uio auio; 220 struct iovec aiov[UIO_SMALLIOV], *iov = NULL; 221 int error; 222 int flags; 223 224 error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt, 225 &auio.uio_resid); 226 if (error) 227 return (error); 228 auio.uio_iov = iov; 229 auio.uio_iovcnt = uap->iovcnt; 230 auio.uio_offset = uap->offset; 231 auio.uio_rw = UIO_READ; 232 auio.uio_segflg = UIO_USERSPACE; 233 auio.uio_td = td; 234 235 flags = uap->flags & O_FMASK; 236 if (uap->offset != (off_t)-1) 237 flags |= O_FOFFSET; 238 239 error = kern_preadv(uap->fd, &auio, flags, &sysmsg->sysmsg_szresult); 240 241 iovec_free(&iov, aiov); 242 return(error); 243 } 244 245 /* 246 * MPSAFE 247 */ 248 int 249 kern_preadv(int fd, struct uio *auio, int flags, size_t *res) 250 { 251 struct thread *td = curthread; 252 struct file *fp; 253 int error; 254 255 fp = holdfp(td, fd, FREAD); 256 if (fp == NULL) 257 return (EBADF); 258 if (flags & O_FOFFSET && fp->f_type != DTYPE_VNODE) { 259 error = ESPIPE; 260 } else { 261 error = dofileread(fd, fp, auio, flags, res); 262 } 263 dropfp(td, fd, fp); 264 265 return(error); 266 } 267 268 /* 269 * Common code for readv and preadv that reads data in 270 * from a file using the passed in uio, offset, and flags. 271 * 272 * MPALMOSTSAFE - ktrace needs help 273 */ 274 static int 275 dofileread(int fd, struct file *fp, struct uio *auio, int flags, size_t *res) 276 { 277 int error; 278 size_t len; 279 #ifdef KTRACE 280 struct thread *td = curthread; 281 struct iovec *ktriov = NULL; 282 struct uio ktruio; 283 #endif 284 285 #ifdef KTRACE 286 /* 287 * if tracing, save a copy of iovec 288 */ 289 if (KTRPOINT(td, KTR_GENIO)) { 290 int iovlen = auio->uio_iovcnt * sizeof(struct iovec); 291 292 ktriov = kmalloc(iovlen, M_TEMP, M_WAITOK); 293 bcopy((caddr_t)auio->uio_iov, (caddr_t)ktriov, iovlen); 294 ktruio = *auio; 295 } 296 #endif 297 len = auio->uio_resid; 298 error = fo_read(fp, auio, fp->f_cred, flags); 299 if (error) { 300 if (auio->uio_resid != len && (error == ERESTART || 301 error == EINTR || error == EWOULDBLOCK)) 302 error = 0; 303 } 304 #ifdef KTRACE 305 if (ktriov != NULL) { 306 if (error == 0) { 307 ktruio.uio_iov = ktriov; 308 ktruio.uio_resid = len - auio->uio_resid; 309 ktrgenio(td->td_lwp, fd, UIO_READ, &ktruio, error); 310 } 311 kfree(ktriov, M_TEMP); 312 } 313 #endif 314 if (error == 0) 315 *res = len - auio->uio_resid; 316 317 return(error); 318 } 319 320 /* 321 * Write system call 322 * 323 * MPSAFE 324 */ 325 int 326 sys_write(struct sysmsg *sysmsg, const struct write_args *uap) 327 { 328 struct thread *td = curthread; 329 struct uio auio; 330 struct iovec aiov; 331 int error; 332 333 if ((ssize_t)uap->nbyte < 0) 334 error = EINVAL; 335 336 aiov.iov_base = (void *)(uintptr_t)uap->buf; 337 aiov.iov_len = uap->nbyte; 338 auio.uio_iov = &aiov; 339 auio.uio_iovcnt = 1; 340 auio.uio_offset = -1; 341 auio.uio_resid = uap->nbyte; 342 auio.uio_rw = UIO_WRITE; 343 auio.uio_segflg = UIO_USERSPACE; 344 auio.uio_td = td; 345 346 error = kern_pwritev(uap->fd, &auio, 0, &sysmsg->sysmsg_szresult); 347 348 return(error); 349 } 350 351 /* 352 * Pwrite system call 353 * 354 * MPSAFE 355 */ 356 int 357 sys_extpwrite(struct sysmsg *sysmsg, const struct extpwrite_args *uap) 358 { 359 struct thread *td = curthread; 360 struct uio auio; 361 struct iovec aiov; 362 int error; 363 int flags; 364 365 if ((ssize_t)uap->nbyte < 0) 366 error = EINVAL; 367 368 aiov.iov_base = (void *)(uintptr_t)uap->buf; 369 aiov.iov_len = uap->nbyte; 370 auio.uio_iov = &aiov; 371 auio.uio_iovcnt = 1; 372 auio.uio_offset = uap->offset; 373 auio.uio_resid = uap->nbyte; 374 auio.uio_rw = UIO_WRITE; 375 auio.uio_segflg = UIO_USERSPACE; 376 auio.uio_td = td; 377 378 flags = uap->flags & O_FMASK; 379 if (uap->offset != (off_t)-1) 380 flags |= O_FOFFSET; 381 error = kern_pwritev(uap->fd, &auio, flags, &sysmsg->sysmsg_szresult); 382 return(error); 383 } 384 385 /* 386 * MPSAFE 387 */ 388 int 389 sys_writev(struct sysmsg *sysmsg, const struct writev_args *uap) 390 { 391 struct thread *td = curthread; 392 struct uio auio; 393 struct iovec aiov[UIO_SMALLIOV], *iov = NULL; 394 int error; 395 396 error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt, 397 &auio.uio_resid); 398 if (error) 399 return (error); 400 auio.uio_iov = iov; 401 auio.uio_iovcnt = uap->iovcnt; 402 auio.uio_offset = -1; 403 auio.uio_rw = UIO_WRITE; 404 auio.uio_segflg = UIO_USERSPACE; 405 auio.uio_td = td; 406 407 error = kern_pwritev(uap->fd, &auio, 0, &sysmsg->sysmsg_szresult); 408 409 iovec_free(&iov, aiov); 410 return (error); 411 } 412 413 414 /* 415 * Gather positioned write system call 416 * 417 * MPSAFE 418 */ 419 int 420 sys_extpwritev(struct sysmsg *sysmsg, const struct extpwritev_args *uap) 421 { 422 struct thread *td = curthread; 423 struct uio auio; 424 struct iovec aiov[UIO_SMALLIOV], *iov = NULL; 425 int error; 426 int flags; 427 428 error = iovec_copyin(uap->iovp, &iov, aiov, uap->iovcnt, 429 &auio.uio_resid); 430 if (error) 431 return (error); 432 auio.uio_iov = iov; 433 auio.uio_iovcnt = uap->iovcnt; 434 auio.uio_offset = uap->offset; 435 auio.uio_rw = UIO_WRITE; 436 auio.uio_segflg = UIO_USERSPACE; 437 auio.uio_td = td; 438 439 flags = uap->flags & O_FMASK; 440 if (uap->offset != (off_t)-1) 441 flags |= O_FOFFSET; 442 443 error = kern_pwritev(uap->fd, &auio, flags, &sysmsg->sysmsg_szresult); 444 445 iovec_free(&iov, aiov); 446 return(error); 447 } 448 449 /* 450 * MPSAFE 451 */ 452 int 453 kern_pwritev(int fd, struct uio *auio, int flags, size_t *res) 454 { 455 struct thread *td = curthread; 456 struct file *fp; 457 int error; 458 459 fp = holdfp(td, fd, FWRITE); 460 if (fp == NULL) 461 return (EBADF); 462 else if ((flags & O_FOFFSET) && fp->f_type != DTYPE_VNODE) { 463 error = ESPIPE; 464 } else { 465 error = dofilewrite(fd, fp, auio, flags, res); 466 } 467 dropfp(td, fd, fp); 468 469 return(error); 470 } 471 472 /* 473 * Common code for writev and pwritev that writes data to 474 * a file using the passed in uio, offset, and flags. 475 * 476 * MPALMOSTSAFE - ktrace needs help 477 */ 478 static int 479 dofilewrite(int fd, struct file *fp, struct uio *auio, int flags, size_t *res) 480 { 481 struct thread *td = curthread; 482 struct lwp *lp = td->td_lwp; 483 int error; 484 size_t len; 485 #ifdef KTRACE 486 struct iovec *ktriov = NULL; 487 struct uio ktruio; 488 #endif 489 490 #ifdef KTRACE 491 /* 492 * if tracing, save a copy of iovec and uio 493 */ 494 if (KTRPOINT(td, KTR_GENIO)) { 495 int iovlen = auio->uio_iovcnt * sizeof(struct iovec); 496 497 ktriov = kmalloc(iovlen, M_TEMP, M_WAITOK); 498 bcopy((caddr_t)auio->uio_iov, (caddr_t)ktriov, iovlen); 499 ktruio = *auio; 500 } 501 #endif 502 len = auio->uio_resid; 503 error = fo_write(fp, auio, fp->f_cred, flags); 504 if (error) { 505 if (auio->uio_resid != len && (error == ERESTART || 506 error == EINTR || error == EWOULDBLOCK)) 507 error = 0; 508 /* Socket layer is responsible for issuing SIGPIPE. */ 509 if (error == EPIPE && fp->f_type != DTYPE_SOCKET) 510 lwpsignal(lp->lwp_proc, lp, SIGPIPE); 511 } 512 #ifdef KTRACE 513 if (ktriov != NULL) { 514 if (error == 0) { 515 ktruio.uio_iov = ktriov; 516 ktruio.uio_resid = len - auio->uio_resid; 517 ktrgenio(lp, fd, UIO_WRITE, &ktruio, error); 518 } 519 kfree(ktriov, M_TEMP); 520 } 521 #endif 522 if (error == 0) 523 *res = len - auio->uio_resid; 524 525 return(error); 526 } 527 528 /* 529 * Ioctl system call 530 * 531 * MPSAFE 532 */ 533 int 534 sys_ioctl(struct sysmsg *sysmsg, const struct ioctl_args *uap) 535 { 536 int error; 537 538 error = mapped_ioctl(uap->fd, uap->com, uap->data, NULL, sysmsg); 539 return (error); 540 } 541 542 struct ioctl_map_entry { 543 const char *subsys; 544 struct ioctl_map_range *cmd_ranges; 545 LIST_ENTRY(ioctl_map_entry) entries; 546 }; 547 548 /* 549 * The true heart of all ioctl syscall handlers (native, emulation). 550 * If map != NULL, it will be searched for a matching entry for com, 551 * and appropriate conversions/conversion functions will be utilized. 552 * 553 * MPSAFE 554 */ 555 int 556 mapped_ioctl(int fd, u_long com, caddr_t uspc_data, struct ioctl_map *map, 557 struct sysmsg *msg) 558 { 559 struct thread *td = curthread; 560 struct proc *p = td->td_proc; 561 struct ucred *cred; 562 struct file *fp; 563 struct ioctl_map_range *iomc = NULL; 564 int error; 565 u_int size; 566 u_long ocom = com; 567 caddr_t data, memp; 568 int tmp; 569 #define STK_PARAMS 128 570 union { 571 char stkbuf[STK_PARAMS]; 572 long align; 573 } ubuf; 574 575 KKASSERT(p); 576 cred = td->td_ucred; 577 memp = NULL; 578 579 fp = holdfp(td, fd, FREAD|FWRITE); 580 if (fp == NULL) 581 return(EBADF); 582 583 if (map != NULL) { /* obey translation map */ 584 u_long maskcmd; 585 struct ioctl_map_entry *e; 586 587 maskcmd = com & map->mask; 588 589 lwkt_gettoken(&mioctl_token); 590 LIST_FOREACH(e, &map->mapping, entries) { 591 for (iomc = e->cmd_ranges; iomc->start != 0 || 592 iomc->maptocmd != 0 || iomc->wrapfunc != NULL || 593 iomc->mapfunc != NULL; 594 iomc++) { 595 if (maskcmd >= iomc->start && 596 maskcmd <= iomc->end) 597 break; 598 } 599 600 /* Did we find a match? */ 601 if (iomc->start != 0 || iomc->maptocmd != 0 || 602 iomc->wrapfunc != NULL || iomc->mapfunc != NULL) 603 break; 604 } 605 lwkt_reltoken(&mioctl_token); 606 607 if (iomc == NULL || 608 (iomc->start == 0 && iomc->maptocmd == 0 609 && iomc->wrapfunc == NULL && iomc->mapfunc == NULL)) { 610 kprintf("%s: 'ioctl' fd=%d, cmd=0x%lx ('%c',%d) not implemented\n", 611 map->sys, fd, maskcmd, 612 (int)((maskcmd >> 8) & 0xff), 613 (int)(maskcmd & 0xff)); 614 error = EINVAL; 615 goto done; 616 } 617 618 /* 619 * If it's a non-range one to one mapping, maptocmd should be 620 * correct. If it's a ranged one to one mapping, we pass the 621 * original value of com, and for a range mapped to a different 622 * range, we always need a mapping function to translate the 623 * ioctl to our native ioctl. Ex. 6500-65ff <-> 9500-95ff 624 */ 625 if (iomc->start == iomc->end && iomc->maptocmd == iomc->maptoend) { 626 com = iomc->maptocmd; 627 } else if (iomc->start == iomc->maptocmd && iomc->end == iomc->maptoend) { 628 if (iomc->mapfunc != NULL) 629 com = iomc->mapfunc(iomc->start, iomc->end, 630 iomc->start, iomc->end, 631 com, com); 632 } else { 633 if (iomc->mapfunc != NULL) { 634 com = iomc->mapfunc(iomc->start, iomc->end, 635 iomc->maptocmd, iomc->maptoend, 636 com, ocom); 637 } else { 638 kprintf("%s: Invalid mapping for fd=%d, cmd=%#lx ('%c',%d)\n", 639 map->sys, fd, maskcmd, 640 (int)((maskcmd >> 8) & 0xff), 641 (int)(maskcmd & 0xff)); 642 error = EINVAL; 643 goto done; 644 } 645 } 646 } 647 648 switch (com) { 649 case FIONCLEX: 650 error = fclrfdflags(p->p_fd, fd, UF_EXCLOSE); 651 goto done; 652 case FIOCLEX: 653 error = fsetfdflags(p->p_fd, fd, UF_EXCLOSE); 654 goto done; 655 } 656 657 /* 658 * Interpret high order word to find amount of data to be 659 * copied to/from the user's address space. 660 */ 661 size = IOCPARM_LEN(com); 662 if (size > IOCPARM_MAX) { 663 error = ENOTTY; 664 goto done; 665 } 666 667 if ((com & IOC_VOID) == 0 && size > sizeof(ubuf.stkbuf)) { 668 memp = kmalloc(size, M_IOCTLOPS, M_WAITOK); 669 data = memp; 670 } else { 671 memp = NULL; 672 data = ubuf.stkbuf; 673 } 674 if (com & IOC_VOID) { 675 *(caddr_t *)data = uspc_data; 676 } else if (com & IOC_IN) { 677 if (size != 0) { 678 error = copyin(uspc_data, data, (size_t)size); 679 if (error) 680 goto done; 681 } else { 682 *(caddr_t *)data = uspc_data; 683 } 684 } else if ((com & IOC_OUT) != 0 && size) { 685 /* 686 * Zero the buffer so the user always 687 * gets back something deterministic. 688 */ 689 bzero(data, (size_t)size); 690 } 691 692 switch (com) { 693 case FIONBIO: 694 if ((tmp = *(int *)data)) 695 atomic_set_int(&fp->f_flag, FNONBLOCK); 696 else 697 atomic_clear_int(&fp->f_flag, FNONBLOCK); 698 error = 0; 699 break; 700 701 case FIOASYNC: 702 if ((tmp = *(int *)data)) 703 atomic_set_int(&fp->f_flag, FASYNC); 704 else 705 atomic_clear_int(&fp->f_flag, FASYNC); 706 error = fo_ioctl(fp, FIOASYNC, (caddr_t)&tmp, cred, msg); 707 break; 708 709 default: 710 /* 711 * If there is a override function, 712 * call it instead of directly routing the call 713 */ 714 if (map != NULL && iomc->wrapfunc != NULL) 715 error = iomc->wrapfunc(fp, com, ocom, data, cred); 716 else 717 error = fo_ioctl(fp, com, data, cred, msg); 718 /* 719 * Copy any data to user, size was 720 * already set and checked above. 721 */ 722 if (error == 0 && (com & IOC_OUT) != 0 && size != 0) 723 error = copyout(data, uspc_data, (size_t)size); 724 break; 725 } 726 done: 727 if (memp != NULL) 728 kfree(memp, M_IOCTLOPS); 729 dropfp(td, fd, fp); 730 731 return(error); 732 } 733 734 /* 735 * MPSAFE 736 */ 737 int 738 mapped_ioctl_register_handler(struct ioctl_map_handler *he) 739 { 740 struct ioctl_map_entry *ne; 741 742 KKASSERT(he != NULL && he->map != NULL && he->cmd_ranges != NULL && 743 he->subsys != NULL && *he->subsys != '\0'); 744 745 ne = kmalloc(sizeof(struct ioctl_map_entry), M_IOCTLMAP, 746 M_WAITOK | M_ZERO); 747 748 ne->subsys = he->subsys; 749 ne->cmd_ranges = he->cmd_ranges; 750 751 lwkt_gettoken(&mioctl_token); 752 LIST_INSERT_HEAD(&he->map->mapping, ne, entries); 753 lwkt_reltoken(&mioctl_token); 754 755 return(0); 756 } 757 758 /* 759 * MPSAFE 760 */ 761 int 762 mapped_ioctl_unregister_handler(struct ioctl_map_handler *he) 763 { 764 struct ioctl_map_entry *ne; 765 int error = EINVAL; 766 767 KKASSERT(he != NULL && he->map != NULL && he->cmd_ranges != NULL); 768 769 lwkt_gettoken(&mioctl_token); 770 LIST_FOREACH(ne, &he->map->mapping, entries) { 771 if (ne->cmd_ranges == he->cmd_ranges) { 772 LIST_REMOVE(ne, entries); 773 kfree(ne, M_IOCTLMAP); 774 error = 0; 775 break; 776 } 777 } 778 lwkt_reltoken(&mioctl_token); 779 return(error); 780 } 781 782 static int nseldebug; 783 SYSCTL_INT(_kern, OID_AUTO, nseldebug, CTLFLAG_RW, &nseldebug, 0, ""); 784 785 /* 786 * Select system call. 787 * 788 * MPSAFE 789 */ 790 int 791 sys_select(struct sysmsg *sysmsg, const struct select_args *uap) 792 { 793 struct timeval ktv; 794 struct timespec *ktsp, kts; 795 int error; 796 797 /* 798 * Get timeout if any. 799 */ 800 if (uap->tv != NULL) { 801 error = copyin(uap->tv, &ktv, sizeof (ktv)); 802 if (error) 803 return (error); 804 TIMEVAL_TO_TIMESPEC(&ktv, &kts); 805 ktsp = &kts; 806 } else { 807 ktsp = NULL; 808 } 809 810 /* 811 * Do real work. 812 */ 813 error = doselect(uap->nd, uap->in, uap->ou, uap->ex, ktsp, 814 &sysmsg->sysmsg_result); 815 816 return (error); 817 } 818 819 820 /* 821 * Pselect system call. 822 */ 823 int 824 sys_pselect(struct sysmsg *sysmsg, const struct pselect_args *uap) 825 { 826 struct thread *td = curthread; 827 struct lwp *lp = td->td_lwp; 828 struct timespec *ktsp, kts; 829 sigset_t sigmask; 830 int error; 831 832 /* 833 * Get timeout if any. 834 */ 835 if (uap->ts != NULL) { 836 error = copyin(uap->ts, &kts, sizeof (kts)); 837 if (error) 838 return (error); 839 ktsp = &kts; 840 } else { 841 ktsp = NULL; 842 } 843 844 /* 845 * Install temporary signal mask if any provided. 846 */ 847 if (uap->sigmask != NULL) { 848 error = copyin(uap->sigmask, &sigmask, sizeof(sigmask)); 849 if (error) 850 return (error); 851 lwkt_gettoken(&lp->lwp_proc->p_token); 852 lp->lwp_oldsigmask = lp->lwp_sigmask; 853 SIG_CANTMASK(sigmask); 854 lp->lwp_sigmask = sigmask; 855 lwkt_reltoken(&lp->lwp_proc->p_token); 856 } 857 858 /* 859 * Do real job. 860 */ 861 error = doselect(uap->nd, uap->in, uap->ou, uap->ex, ktsp, 862 &sysmsg->sysmsg_result); 863 864 if (uap->sigmask != NULL) { 865 lwkt_gettoken(&lp->lwp_proc->p_token); 866 /* doselect() responsible for turning ERESTART into EINTR */ 867 KKASSERT(error != ERESTART); 868 if (error == EINTR) { 869 /* 870 * We can't restore the previous signal mask now 871 * because it could block the signal that interrupted 872 * us. So make a note to restore it after executing 873 * the handler. 874 */ 875 lp->lwp_flags |= LWP_OLDMASK; 876 } else { 877 /* 878 * No handler to run. Restore previous mask immediately. 879 */ 880 lp->lwp_sigmask = lp->lwp_oldsigmask; 881 } 882 lwkt_reltoken(&lp->lwp_proc->p_token); 883 } 884 885 return (error); 886 } 887 888 static int 889 select_copyin(void *arg, struct kevent *kevp, int maxevents, int *events) 890 { 891 struct select_kevent_copyin_args *skap = NULL; 892 struct kevent *kev; 893 int fd; 894 kfd_set *fdp = NULL; 895 short filter = 0; 896 u_int fflags = 0; 897 898 skap = (struct select_kevent_copyin_args *)arg; 899 900 if (*events == maxevents) 901 return (0); 902 903 while (skap->active_set < COPYIN_DONE) { 904 switch (skap->active_set) { 905 case COPYIN_READ: 906 /* 907 * Register descriptors for the read filter 908 */ 909 fdp = skap->read_set; 910 filter = EVFILT_READ; 911 fflags = NOTE_OLDAPI; 912 if (fdp) 913 break; 914 ++skap->active_set; 915 skap->proc_fds = 0; 916 /* fall through */ 917 case COPYIN_WRITE: 918 /* 919 * Register descriptors for the write filter 920 */ 921 fdp = skap->write_set; 922 filter = EVFILT_WRITE; 923 fflags = NOTE_OLDAPI; 924 if (fdp) 925 break; 926 ++skap->active_set; 927 skap->proc_fds = 0; 928 /* fall through */ 929 case COPYIN_EXCEPT: 930 /* 931 * Register descriptors for the exception filter 932 */ 933 fdp = skap->except_set; 934 filter = EVFILT_EXCEPT; 935 fflags = NOTE_OLDAPI | NOTE_OOB; 936 if (fdp) 937 break; 938 ++skap->active_set; 939 skap->proc_fds = 0; 940 /* fall through */ 941 case COPYIN_DONE: 942 /* 943 * Nothing left to register 944 */ 945 return(0); 946 /* NOT REACHED */ 947 } 948 949 while (skap->proc_fds < skap->num_fds) { 950 fd = skap->proc_fds; 951 if (FD_ISSET(fd, fdp)) { 952 kev = &kevp[*events]; 953 EV_SET(kev, fd, filter, 954 EV_ADD|EV_ENABLE, 955 fflags, 0, 956 (void *)(uintptr_t) 957 skap->lwp->lwp_kqueue_serial); 958 FD_CLR(fd, fdp); 959 ++*events; 960 961 if (nseldebug) { 962 kprintf("select fd %d filter %d " 963 "serial %ju\n", fd, filter, 964 (uintmax_t) 965 skap->lwp->lwp_kqueue_serial); 966 } 967 } 968 ++skap->proc_fds; 969 if (*events == maxevents) 970 return (0); 971 } 972 skap->active_set++; 973 skap->proc_fds = 0; 974 } 975 976 return (0); 977 } 978 979 static int 980 select_copyout(void *arg, struct kevent *kevp, int count, int *res) 981 { 982 struct select_kevent_copyin_args *skap; 983 struct kevent kev; 984 int i; 985 int n; 986 987 skap = (struct select_kevent_copyin_args *)arg; 988 989 for (i = 0; i < count; ++i) { 990 /* 991 * Filter out and delete spurious events 992 */ 993 if ((uint64_t)(uintptr_t)kevp[i].udata != 994 skap->lwp->lwp_kqueue_serial) { 995 deregister: 996 kev = kevp[i]; 997 kev.flags = EV_DISABLE|EV_DELETE; 998 n = 1; 999 kqueue_register(&skap->lwp->lwp_kqueue, &kev, &n); 1000 if (nseldebug) { 1001 kprintf("select fd %ju mismatched serial %ju\n", 1002 (uintmax_t)kevp[i].ident, 1003 (uintmax_t)skap->lwp->lwp_kqueue_serial); 1004 } 1005 continue; 1006 } 1007 1008 /* 1009 * Handle errors 1010 */ 1011 if (kevp[i].flags & EV_ERROR) { 1012 int error = kevp[i].data; 1013 1014 switch (error) { 1015 case EBADF: 1016 /* 1017 * A bad file descriptor is considered a 1018 * fatal error for select, bail out. 1019 */ 1020 skap->error = error; 1021 *res = -1; 1022 return error; 1023 1024 default: 1025 /* 1026 * Select silently swallows any unknown errors 1027 * for descriptors in the read or write sets. 1028 * 1029 * ALWAYS filter out EOPNOTSUPP errors from 1030 * filters (at least until all filters support 1031 * EVFILT_EXCEPT) 1032 * 1033 * We also filter out ENODEV since dev_dkqfilter 1034 * returns ENODEV if EOPNOTSUPP is returned in an 1035 * inner call. 1036 * 1037 * XXX: fix this 1038 */ 1039 if (kevp[i].filter != EVFILT_READ && 1040 kevp[i].filter != EVFILT_WRITE && 1041 error != EOPNOTSUPP && 1042 error != ENODEV) { 1043 skap->error = error; 1044 *res = -1; 1045 return error; 1046 } 1047 break; 1048 } 1049 1050 /* 1051 * We must deregister any unsupported select events 1052 * to avoid a live-lock. 1053 */ 1054 if (nseldebug) { 1055 kprintf("select fd %ju filter %d error %d\n", 1056 (uintmax_t)kevp[i].ident, 1057 kevp[i].filter, error); 1058 } 1059 goto deregister; 1060 } 1061 1062 switch (kevp[i].filter) { 1063 case EVFILT_READ: 1064 FD_SET(kevp[i].ident, skap->read_set); 1065 break; 1066 case EVFILT_WRITE: 1067 FD_SET(kevp[i].ident, skap->write_set); 1068 break; 1069 case EVFILT_EXCEPT: 1070 FD_SET(kevp[i].ident, skap->except_set); 1071 break; 1072 } 1073 1074 ++*res; 1075 } 1076 1077 return (0); 1078 } 1079 1080 /* 1081 * Copy select bits in from userland. Allocate kernel memory if the 1082 * set is large. 1083 */ 1084 static int 1085 getbits(int bytes, fd_set *in_set, kfd_set **out_set, kfd_set *tmp_set) 1086 { 1087 int error; 1088 1089 if (in_set) { 1090 if (bytes < sizeof(*tmp_set)) 1091 *out_set = tmp_set; 1092 else 1093 *out_set = kmalloc(bytes, M_SELECT, M_WAITOK); 1094 error = copyin(in_set, *out_set, bytes); 1095 } else { 1096 *out_set = NULL; 1097 error = 0; 1098 } 1099 return (error); 1100 } 1101 1102 /* 1103 * Copy returned select bits back out to userland. 1104 */ 1105 static int 1106 putbits(int bytes, kfd_set *in_set, fd_set *out_set) 1107 { 1108 int error; 1109 1110 if (in_set) { 1111 error = copyout(in_set, out_set, bytes); 1112 } else { 1113 error = 0; 1114 } 1115 return (error); 1116 } 1117 1118 static int 1119 dotimeout_only(struct timespec *ts) 1120 { 1121 return(nanosleep1(ts, NULL)); 1122 } 1123 1124 /* 1125 * Common code for sys_select() and sys_pselect(). 1126 * 1127 * in, out and ex are userland pointers. ts must point to validated 1128 * kernel-side timeout value or NULL for infinite timeout. res must 1129 * point to syscall return value. 1130 */ 1131 static int 1132 doselect(int nd, fd_set *read, fd_set *write, fd_set *except, 1133 struct timespec *ts, int *res) 1134 { 1135 struct proc *p = curproc; 1136 struct select_kevent_copyin_args *kap, ka; 1137 int bytes, error; 1138 kfd_set read_tmp; 1139 kfd_set write_tmp; 1140 kfd_set except_tmp; 1141 1142 *res = 0; 1143 if (nd < 0) 1144 return (EINVAL); 1145 if (nd == 0 && ts) 1146 return (dotimeout_only(ts)); 1147 1148 if (nd > p->p_fd->fd_nfiles) /* limit kmalloc */ 1149 nd = p->p_fd->fd_nfiles; 1150 1151 kap = &ka; 1152 kap->lwp = curthread->td_lwp; 1153 kap->num_fds = nd; 1154 kap->proc_fds = 0; 1155 kap->error = 0; 1156 kap->active_set = COPYIN_READ; 1157 1158 /* 1159 * Calculate bytes based on the number of __fd_mask[] array entries 1160 * multiplied by the size of __fd_mask. 1161 */ 1162 bytes = howmany(nd, __NFDBITS) * sizeof(__fd_mask); 1163 1164 /* kap->read_set = NULL; not needed */ 1165 kap->write_set = NULL; 1166 kap->except_set = NULL; 1167 1168 error = getbits(bytes, read, &kap->read_set, &read_tmp); 1169 if (error == 0) 1170 error = getbits(bytes, write, &kap->write_set, &write_tmp); 1171 if (error == 0) 1172 error = getbits(bytes, except, &kap->except_set, &except_tmp); 1173 if (error) 1174 goto done; 1175 1176 /* 1177 * NOTE: Make sure the max events passed to kern_kevent() is 1178 * effectively unlimited. (nd * 3) accomplishes this. 1179 * 1180 * (*res) continues to increment as returned events are 1181 * loaded in. 1182 */ 1183 error = kern_kevent(&kap->lwp->lwp_kqueue, 0x7FFFFFFF, res, kap, 1184 select_copyin, select_copyout, ts, 0); 1185 if (error == 0) 1186 error = putbits(bytes, kap->read_set, read); 1187 if (error == 0) 1188 error = putbits(bytes, kap->write_set, write); 1189 if (error == 0) 1190 error = putbits(bytes, kap->except_set, except); 1191 1192 /* 1193 * An error from an individual event that should be passed 1194 * back to userland (EBADF) 1195 */ 1196 if (kap->error) 1197 error = kap->error; 1198 1199 /* 1200 * Clean up. 1201 */ 1202 done: 1203 if (kap->read_set && kap->read_set != &read_tmp) 1204 kfree(kap->read_set, M_SELECT); 1205 if (kap->write_set && kap->write_set != &write_tmp) 1206 kfree(kap->write_set, M_SELECT); 1207 if (kap->except_set && kap->except_set != &except_tmp) 1208 kfree(kap->except_set, M_SELECT); 1209 1210 kap->lwp->lwp_kqueue_serial += kap->num_fds; 1211 1212 return (error); 1213 } 1214 1215 /* 1216 * Poll system call. 1217 * 1218 * MPSAFE 1219 */ 1220 int 1221 sys_poll(struct sysmsg *sysmsg, const struct poll_args *uap) 1222 { 1223 struct timespec ts, *tsp; 1224 int error; 1225 1226 if (uap->timeout != INFTIM) { 1227 if (uap->timeout < 0) 1228 return (EINVAL); 1229 ts.tv_sec = uap->timeout / 1000; 1230 ts.tv_nsec = (uap->timeout % 1000) * 1000 * 1000; 1231 tsp = &ts; 1232 } else { 1233 tsp = NULL; 1234 } 1235 1236 error = dopoll(uap->nfds, uap->fds, tsp, &sysmsg->sysmsg_result, 0); 1237 1238 return (error); 1239 } 1240 1241 /* 1242 * Ppoll system call. 1243 * 1244 * MPSAFE 1245 */ 1246 int 1247 sys_ppoll(struct sysmsg *sysmsg, const struct ppoll_args *uap) 1248 { 1249 struct thread *td = curthread; 1250 struct lwp *lp = td->td_lwp; 1251 struct timespec *ktsp, kts; 1252 sigset_t sigmask; 1253 int error; 1254 1255 /* 1256 * Get timeout if any. 1257 */ 1258 if (uap->ts != NULL) { 1259 error = copyin(uap->ts, &kts, sizeof (kts)); 1260 if (error) 1261 return (error); 1262 ktsp = &kts; 1263 } else { 1264 ktsp = NULL; 1265 } 1266 1267 /* 1268 * Install temporary signal mask if any provided. 1269 */ 1270 if (uap->sigmask != NULL) { 1271 error = copyin(uap->sigmask, &sigmask, sizeof(sigmask)); 1272 if (error) 1273 return (error); 1274 lwkt_gettoken(&lp->lwp_proc->p_token); 1275 lp->lwp_oldsigmask = lp->lwp_sigmask; 1276 SIG_CANTMASK(sigmask); 1277 lp->lwp_sigmask = sigmask; 1278 lwkt_reltoken(&lp->lwp_proc->p_token); 1279 } 1280 1281 error = dopoll(uap->nfds, uap->fds, ktsp, &sysmsg->sysmsg_result, 1282 ktsp != NULL ? KEVENT_TIMEOUT_PRECISE : 0); 1283 1284 if (uap->sigmask != NULL) { 1285 lwkt_gettoken(&lp->lwp_proc->p_token); 1286 /* dopoll() responsible for turning ERESTART into EINTR */ 1287 KKASSERT(error != ERESTART); 1288 if (error == EINTR) { 1289 /* 1290 * We can't restore the previous signal mask now 1291 * because it could block the signal that interrupted 1292 * us. So make a note to restore it after executing 1293 * the handler. 1294 */ 1295 lp->lwp_flags |= LWP_OLDMASK; 1296 } else { 1297 /* 1298 * No handler to run. Restore previous mask immediately. 1299 */ 1300 lp->lwp_sigmask = lp->lwp_oldsigmask; 1301 } 1302 lwkt_reltoken(&lp->lwp_proc->p_token); 1303 } 1304 1305 return (error); 1306 } 1307 1308 static int 1309 poll_copyin(void *arg, struct kevent *kevp, int maxevents, int *events) 1310 { 1311 struct poll_kevent_copyin_args *pkap; 1312 struct pollfd *pfd; 1313 struct kevent *kev; 1314 int kev_count; 1315 1316 pkap = (struct poll_kevent_copyin_args *)arg; 1317 1318 while (pkap->pfds < pkap->nfds) { 1319 pfd = &pkap->fds[pkap->pfds]; 1320 1321 /* Clear return events */ 1322 pfd->revents = 0; 1323 1324 /* Do not check if fd is equal to -1 */ 1325 if (pfd->fd == -1) { 1326 ++pkap->pfds; 1327 continue; 1328 } 1329 1330 kev_count = 0; 1331 if (pfd->events & (POLLIN | POLLRDNORM)) 1332 kev_count++; 1333 if (pfd->events & (POLLOUT | POLLWRNORM)) 1334 kev_count++; 1335 if (pfd->events & (POLLPRI | POLLRDBAND)) 1336 kev_count++; 1337 1338 if (*events + kev_count > maxevents) 1339 return (0); 1340 1341 /* 1342 * NOTE: A combined serial number and poll array index is 1343 * stored in kev->udata. 1344 */ 1345 kev = &kevp[*events]; 1346 if (pfd->events & (POLLIN | POLLRDNORM)) { 1347 EV_SET(kev++, pfd->fd, EVFILT_READ, EV_ADD|EV_ENABLE, 1348 NOTE_OLDAPI, 0, (void *)(uintptr_t) 1349 (pkap->lwp->lwp_kqueue_serial + pkap->pfds)); 1350 } 1351 if (pfd->events & (POLLOUT | POLLWRNORM)) { 1352 EV_SET(kev++, pfd->fd, EVFILT_WRITE, EV_ADD|EV_ENABLE, 1353 NOTE_OLDAPI, 0, (void *)(uintptr_t) 1354 (pkap->lwp->lwp_kqueue_serial + pkap->pfds)); 1355 } 1356 if (pfd->events & (POLLPRI | POLLRDBAND)) { 1357 EV_SET(kev++, pfd->fd, EVFILT_EXCEPT, EV_ADD|EV_ENABLE, 1358 NOTE_OLDAPI | NOTE_OOB, 0, 1359 (void *)(uintptr_t) 1360 (pkap->lwp->lwp_kqueue_serial + pkap->pfds)); 1361 } 1362 1363 if (nseldebug) { 1364 kprintf("poll index %d/%d fd %d events %08x " 1365 "serial %ju\n", pkap->pfds, pkap->nfds-1, 1366 pfd->fd, pfd->events, 1367 (uintmax_t)pkap->lwp->lwp_kqueue_serial); 1368 } 1369 1370 ++pkap->pfds; 1371 (*events) += kev_count; 1372 } 1373 1374 return (0); 1375 } 1376 1377 static int 1378 poll_copyout(void *arg, struct kevent *kevp, int count, int *res) 1379 { 1380 struct poll_kevent_copyin_args *pkap; 1381 struct pollfd *pfd; 1382 struct kevent kev; 1383 int count_res; 1384 int i; 1385 int n; 1386 uint64_t pi; 1387 1388 pkap = (struct poll_kevent_copyin_args *)arg; 1389 1390 for (i = 0; i < count; ++i) { 1391 /* 1392 * Extract the poll array index and delete spurious events. 1393 * We can easily tell if the serial number is incorrect 1394 * by checking whether the extracted index is out of range. 1395 */ 1396 pi = (uint64_t)(uintptr_t)kevp[i].udata - 1397 pkap->lwp->lwp_kqueue_serial; 1398 1399 if (pi >= pkap->nfds) { 1400 deregister: 1401 kev = kevp[i]; 1402 kev.flags = EV_DISABLE|EV_DELETE; 1403 n = 1; 1404 kqueue_register(&pkap->lwp->lwp_kqueue, &kev, &n); 1405 if (nseldebug) { 1406 kprintf("poll index %ju out of range against " 1407 "serial %ju\n", (uintmax_t)pi, 1408 (uintmax_t)pkap->lwp->lwp_kqueue_serial); 1409 } 1410 continue; 1411 } 1412 1413 /* 1414 * Locate the pollfd and process events 1415 */ 1416 pfd = &pkap->fds[pi]; 1417 if (kevp[i].ident == pfd->fd) { 1418 /* 1419 * A single descriptor may generate an error against 1420 * more than one filter, make sure to set the 1421 * appropriate flags but do not increment (*res) 1422 * more than once. 1423 */ 1424 count_res = (pfd->revents == 0); 1425 if (kevp[i].flags & EV_ERROR) { 1426 switch(kevp[i].data) { 1427 case EBADF: 1428 case POLLNVAL: 1429 /* Bad file descriptor */ 1430 if (count_res) 1431 ++*res; 1432 pfd->revents |= POLLNVAL; 1433 break; 1434 default: 1435 /* 1436 * Poll silently swallows any unknown 1437 * errors except in the case of POLLPRI 1438 * (OOB/urgent data). 1439 * 1440 * ALWAYS filter out EOPNOTSUPP errors 1441 * from filters, common applications 1442 * set POLLPRI|POLLRDBAND and most 1443 * filters do not support EVFILT_EXCEPT. 1444 * 1445 * We also filter out ENODEV since 1446 * dev_dkqfilter returns ENODEV if 1447 * EOPNOTSUPP is returned in an 1448 * inner call. 1449 * 1450 * XXX: fix this 1451 */ 1452 if (kevp[i].filter != EVFILT_READ && 1453 kevp[i].filter != EVFILT_WRITE && 1454 kevp[i].data != EOPNOTSUPP && 1455 kevp[i].data != ENODEV) { 1456 if (count_res) 1457 ++*res; 1458 pfd->revents |= POLLERR; 1459 } 1460 break; 1461 } 1462 if (pfd->revents == 0 && nseldebug) { 1463 kprintf("poll index EV_ERROR %ju fd %d " 1464 "filter %d error %jd\n", 1465 (uintmax_t)pi, pfd->fd, 1466 kevp[i].filter, 1467 (intmax_t)kevp[i].data); 1468 } 1469 1470 /* 1471 * Silently deregister any unhandled EV_ERROR 1472 * condition (usually EOPNOTSUPP). 1473 */ 1474 if (pfd->revents == 0) 1475 goto deregister; 1476 continue; 1477 } 1478 1479 switch (kevp[i].filter) { 1480 case EVFILT_READ: 1481 /* 1482 * NODATA on the read side can indicate a 1483 * half-closed situation and not necessarily 1484 * a disconnect, so depend on the user 1485 * issuing a read() and getting 0 bytes back. 1486 * 1487 * If EV_HUP is set the peer completely 1488 * disconnected and we can set POLLHUP 1489 * once data is exhausted. 1490 */ 1491 if (kevp[i].flags & EV_NODATA) { 1492 if (kevp[i].flags & EV_HUP) 1493 pfd->revents |= POLLHUP; 1494 } 1495 if ((kevp[i].flags & EV_EOF) && 1496 kevp[i].fflags != 0) 1497 pfd->revents |= POLLERR; 1498 if (pfd->events & POLLIN) 1499 pfd->revents |= POLLIN; 1500 if (pfd->events & POLLRDNORM) 1501 pfd->revents |= POLLRDNORM; 1502 break; 1503 case EVFILT_WRITE: 1504 /* 1505 * As per the OpenGroup POLLHUP is mutually 1506 * exclusive with the writability flags. I 1507 * consider this a bit broken but... 1508 * 1509 * In this case a disconnect is implied even 1510 * for a half-closed (write side) situation. 1511 */ 1512 if (kevp[i].flags & EV_EOF) { 1513 pfd->revents |= POLLHUP; 1514 if (kevp[i].fflags != 0) 1515 pfd->revents |= POLLERR; 1516 } else { 1517 if (pfd->events & POLLOUT) 1518 pfd->revents |= POLLOUT; 1519 if (pfd->events & POLLWRNORM) 1520 pfd->revents |= POLLWRNORM; 1521 } 1522 break; 1523 case EVFILT_EXCEPT: 1524 /* 1525 * EV_NODATA should never be tagged for this 1526 * filter. 1527 */ 1528 if (pfd->events & POLLPRI) 1529 pfd->revents |= POLLPRI; 1530 if (pfd->events & POLLRDBAND) 1531 pfd->revents |= POLLRDBAND; 1532 break; 1533 } 1534 1535 if (nseldebug) { 1536 kprintf("poll index %ju/%d fd %d " 1537 "revents %08x\n", (uintmax_t)pi, pkap->nfds, 1538 pfd->fd, pfd->revents); 1539 } 1540 1541 if (count_res && pfd->revents) 1542 ++*res; 1543 } 1544 1545 /* 1546 * We must deregister any kqueue poll event that does not 1547 * set poll return bits to prevent a live-lock. 1548 */ 1549 if (pfd->revents == 0) { 1550 kprintf("poll index %ju no-action %ju/%d " 1551 "events=%08x kevpfilt=%d/%08x\n", 1552 (uintmax_t)pi, (uintmax_t)kevp[i].ident, 1553 pfd->fd, pfd->events, 1554 kevp[i].filter, kevp[i].flags); 1555 goto deregister; 1556 } 1557 } 1558 1559 return (0); 1560 } 1561 1562 static int 1563 dopoll(int nfds, struct pollfd *fds, struct timespec *ts, int *res, int flags) 1564 { 1565 struct poll_kevent_copyin_args ka; 1566 struct pollfd sfds[64]; 1567 int bytes; 1568 int error; 1569 1570 *res = 0; 1571 if (nfds < 0) 1572 return (EINVAL); 1573 1574 if (nfds == 0 && ts) 1575 return (dotimeout_only(ts)); 1576 1577 /* 1578 * This is a bit arbitrary but we need to limit internal kmallocs. 1579 */ 1580 if (nfds > maxfilesperproc * 2) 1581 nfds = maxfilesperproc * 2; 1582 bytes = sizeof(struct pollfd) * nfds; 1583 1584 ka.lwp = curthread->td_lwp; 1585 ka.nfds = nfds; 1586 ka.pfds = 0; 1587 ka.error = 0; 1588 1589 if (ka.nfds < 64) 1590 ka.fds = sfds; 1591 else 1592 ka.fds = kmalloc(bytes, M_SELECT, M_WAITOK); 1593 1594 error = copyin(fds, ka.fds, bytes); 1595 if (error == 0) 1596 error = kern_kevent(&ka.lwp->lwp_kqueue, 0x7FFFFFFF, res, &ka, 1597 poll_copyin, poll_copyout, ts, flags); 1598 1599 if (error == 0) 1600 error = copyout(ka.fds, fds, bytes); 1601 1602 if (ka.fds != sfds) 1603 kfree(ka.fds, M_SELECT); 1604 1605 ka.lwp->lwp_kqueue_serial += nfds; 1606 1607 return (error); 1608 } 1609 1610 static int 1611 socket_wait_copyin(void *arg, struct kevent *kevp, int maxevents, int *events) 1612 { 1613 return (0); 1614 } 1615 1616 static int 1617 socket_wait_copyout(void *arg, struct kevent *kevp, int count, int *res) 1618 { 1619 ++*res; 1620 return (0); 1621 } 1622 1623 extern struct fileops socketops; 1624 1625 /* 1626 * NOTE: Callers of socket_wait() must already have a reference on the 1627 * socket. 1628 */ 1629 int 1630 socket_wait(struct socket *so, struct timespec *ts, int *res) 1631 { 1632 struct thread *td = curthread; 1633 struct file *fp; 1634 struct kqueue kq; 1635 struct kevent kev; 1636 int error, fd; 1637 int n; 1638 1639 if ((error = falloc(td->td_lwp, &fp, &fd)) != 0) 1640 return (error); 1641 1642 fp->f_type = DTYPE_SOCKET; 1643 fp->f_flag = FREAD | FWRITE; 1644 fp->f_ops = &socketops; 1645 fp->f_data = so; 1646 fsetfd(td->td_lwp->lwp_proc->p_fd, fp, fd); 1647 fsetfdflags(td->td_proc->p_fd, fd, UF_EXCLOSE); 1648 1649 bzero(&kq, sizeof(kq)); 1650 kqueue_init(&kq, td->td_lwp->lwp_proc->p_fd); 1651 EV_SET(&kev, fd, EVFILT_READ, EV_ADD|EV_ENABLE, 0, 0, NULL); 1652 n = 1; 1653 if ((error = kqueue_register(&kq, &kev, &n)) != 0) { 1654 fdrop(fp); 1655 return (error); 1656 } 1657 1658 error = kern_kevent(&kq, 1, res, NULL, socket_wait_copyin, 1659 socket_wait_copyout, ts, 0); 1660 1661 EV_SET(&kev, fd, EVFILT_READ, EV_DELETE|EV_DISABLE, 0, 0, NULL); 1662 n = 1; 1663 kqueue_register(&kq, &kev, &n); 1664 fp->f_ops = &badfileops; 1665 fdrop(fp); 1666 1667 return (error); 1668 } 1669 1670 /* 1671 * OpenBSD poll system call. 1672 * XXX this isn't quite a true representation.. OpenBSD uses select ops. 1673 * 1674 * MPSAFE 1675 */ 1676 int 1677 sys_openbsd_poll(struct sysmsg *sysmsg, const struct openbsd_poll_args *uap) 1678 { 1679 return (sys_poll(sysmsg, (const struct poll_args *)uap)); 1680 } 1681 1682 /*ARGSUSED*/ 1683 int 1684 seltrue(cdev_t dev, int events) 1685 { 1686 return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM)); 1687 } 1688