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 | POLLHUP | 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 | POLLHUP | POLLRDNORM)) { 1347 int notes = NOTE_OLDAPI; 1348 if ((pfd->events & (POLLIN | POLLRDNORM)) == 0) 1349 notes |= NOTE_HUPONLY; 1350 1351 EV_SET(kev++, pfd->fd, EVFILT_READ, EV_ADD|EV_ENABLE, 1352 notes, 0, (void *)(uintptr_t) 1353 (pkap->lwp->lwp_kqueue_serial + pkap->pfds)); 1354 } 1355 if (pfd->events & (POLLOUT | POLLWRNORM)) { 1356 EV_SET(kev++, pfd->fd, EVFILT_WRITE, EV_ADD|EV_ENABLE, 1357 NOTE_OLDAPI, 0, (void *)(uintptr_t) 1358 (pkap->lwp->lwp_kqueue_serial + pkap->pfds)); 1359 } 1360 if (pfd->events & (POLLPRI | POLLRDBAND)) { 1361 EV_SET(kev++, pfd->fd, EVFILT_EXCEPT, EV_ADD|EV_ENABLE, 1362 NOTE_OLDAPI | NOTE_OOB, 0, 1363 (void *)(uintptr_t) 1364 (pkap->lwp->lwp_kqueue_serial + pkap->pfds)); 1365 } 1366 1367 if (nseldebug) { 1368 kprintf("poll index %d/%d fd %d events %08x " 1369 "serial %ju\n", pkap->pfds, pkap->nfds-1, 1370 pfd->fd, pfd->events, 1371 (uintmax_t)pkap->lwp->lwp_kqueue_serial); 1372 } 1373 1374 ++pkap->pfds; 1375 (*events) += kev_count; 1376 } 1377 1378 return (0); 1379 } 1380 1381 static int 1382 poll_copyout(void *arg, struct kevent *kevp, int count, int *res) 1383 { 1384 struct poll_kevent_copyin_args *pkap; 1385 struct pollfd *pfd; 1386 struct kevent kev; 1387 int count_res; 1388 int i; 1389 int n; 1390 uint64_t pi; 1391 1392 pkap = (struct poll_kevent_copyin_args *)arg; 1393 1394 for (i = 0; i < count; ++i) { 1395 /* 1396 * Extract the poll array index and delete spurious events. 1397 * We can easily tell if the serial number is incorrect 1398 * by checking whether the extracted index is out of range. 1399 */ 1400 pi = (uint64_t)(uintptr_t)kevp[i].udata - 1401 pkap->lwp->lwp_kqueue_serial; 1402 1403 if (pi >= pkap->nfds) { 1404 deregister: 1405 kev = kevp[i]; 1406 kev.flags = EV_DISABLE|EV_DELETE; 1407 n = 1; 1408 kqueue_register(&pkap->lwp->lwp_kqueue, &kev, &n); 1409 if (nseldebug) { 1410 kprintf("poll index %ju out of range against " 1411 "serial %ju\n", (uintmax_t)pi, 1412 (uintmax_t)pkap->lwp->lwp_kqueue_serial); 1413 } 1414 continue; 1415 } 1416 1417 /* 1418 * Locate the pollfd and process events 1419 */ 1420 pfd = &pkap->fds[pi]; 1421 if (kevp[i].ident == pfd->fd) { 1422 /* 1423 * A single descriptor may generate an error against 1424 * more than one filter, make sure to set the 1425 * appropriate flags but do not increment (*res) 1426 * more than once. 1427 */ 1428 count_res = (pfd->revents == 0); 1429 if (kevp[i].flags & EV_ERROR) { 1430 switch(kevp[i].data) { 1431 case EBADF: 1432 case POLLNVAL: 1433 /* Bad file descriptor */ 1434 if (count_res) 1435 ++*res; 1436 pfd->revents |= POLLNVAL; 1437 break; 1438 default: 1439 /* 1440 * Poll silently swallows any unknown 1441 * errors except in the case of POLLPRI 1442 * (OOB/urgent data). 1443 * 1444 * ALWAYS filter out EOPNOTSUPP errors 1445 * from filters, common applications 1446 * set POLLPRI|POLLRDBAND and most 1447 * filters do not support EVFILT_EXCEPT. 1448 * 1449 * We also filter out ENODEV since 1450 * dev_dkqfilter returns ENODEV if 1451 * EOPNOTSUPP is returned in an 1452 * inner call. 1453 * 1454 * XXX: fix this 1455 */ 1456 if (kevp[i].filter != EVFILT_READ && 1457 kevp[i].filter != EVFILT_WRITE && 1458 kevp[i].data != EOPNOTSUPP && 1459 kevp[i].data != ENODEV) { 1460 if (count_res) 1461 ++*res; 1462 pfd->revents |= POLLERR; 1463 } 1464 break; 1465 } 1466 if (pfd->revents == 0 && nseldebug) { 1467 kprintf("poll index EV_ERROR %ju fd %d " 1468 "filter %d error %jd\n", 1469 (uintmax_t)pi, pfd->fd, 1470 kevp[i].filter, 1471 (intmax_t)kevp[i].data); 1472 } 1473 1474 /* 1475 * Silently deregister any unhandled EV_ERROR 1476 * condition (usually EOPNOTSUPP). 1477 */ 1478 if (pfd->revents == 0) 1479 goto deregister; 1480 continue; 1481 } 1482 1483 switch (kevp[i].filter) { 1484 case EVFILT_READ: 1485 /* 1486 * NODATA on the read side can indicate a 1487 * half-closed situation and not necessarily 1488 * a disconnect, so depend on the user 1489 * issuing a read() and getting 0 bytes back. 1490 * 1491 * If EV_HUP is set the peer completely 1492 * disconnected and we can set POLLHUP. 1493 * Linux can return POLLHUP even if read 1494 * data has not been drained, so we should 1495 * too. 1496 */ 1497 /* if (kevp[i].flags & EV_NODATA) */ { 1498 if (kevp[i].flags & EV_HUP) 1499 pfd->revents |= POLLHUP; 1500 } 1501 if ((kevp[i].flags & EV_EOF) && 1502 kevp[i].fflags != 0) 1503 pfd->revents |= POLLERR; 1504 if (pfd->events & POLLIN) 1505 pfd->revents |= POLLIN; 1506 if (pfd->events & POLLRDNORM) 1507 pfd->revents |= POLLRDNORM; 1508 break; 1509 case EVFILT_WRITE: 1510 /* 1511 * As per the OpenGroup POLLHUP is mutually 1512 * exclusive with the writability flags. I 1513 * consider this a bit broken but... 1514 * 1515 * In this case a disconnect is implied even 1516 * for a half-closed (write side) situation. 1517 */ 1518 if (kevp[i].flags & EV_EOF) { 1519 pfd->revents |= POLLHUP; 1520 if (kevp[i].fflags != 0) 1521 pfd->revents |= POLLERR; 1522 } else { 1523 if (pfd->events & POLLOUT) 1524 pfd->revents |= POLLOUT; 1525 if (pfd->events & POLLWRNORM) 1526 pfd->revents |= POLLWRNORM; 1527 } 1528 break; 1529 case EVFILT_EXCEPT: 1530 /* 1531 * EV_NODATA should never be tagged for this 1532 * filter. 1533 */ 1534 if (pfd->events & POLLPRI) 1535 pfd->revents |= POLLPRI; 1536 if (pfd->events & POLLRDBAND) 1537 pfd->revents |= POLLRDBAND; 1538 break; 1539 } 1540 1541 if (nseldebug) { 1542 kprintf("poll index %ju/%d fd %d " 1543 "revents %08x\n", (uintmax_t)pi, pkap->nfds, 1544 pfd->fd, pfd->revents); 1545 } 1546 1547 if (count_res && pfd->revents) 1548 ++*res; 1549 } 1550 1551 /* 1552 * We must deregister any kqueue poll event that does not 1553 * set poll return bits to prevent a live-lock. 1554 */ 1555 if (pfd->revents == 0) { 1556 kprintf("poll index %ju no-action %ju/%d " 1557 "events=%08x kevpfilt=%d/%08x\n", 1558 (uintmax_t)pi, (uintmax_t)kevp[i].ident, 1559 pfd->fd, pfd->events, 1560 kevp[i].filter, kevp[i].flags); 1561 goto deregister; 1562 } 1563 } 1564 1565 return (0); 1566 } 1567 1568 static int 1569 dopoll(int nfds, struct pollfd *fds, struct timespec *ts, int *res, int flags) 1570 { 1571 struct poll_kevent_copyin_args ka; 1572 struct pollfd sfds[64]; 1573 int bytes; 1574 int error; 1575 1576 *res = 0; 1577 if (nfds < 0) 1578 return (EINVAL); 1579 1580 if (nfds == 0 && ts) 1581 return (dotimeout_only(ts)); 1582 1583 /* 1584 * This is a bit arbitrary but we need to limit internal kmallocs. 1585 */ 1586 if (nfds > maxfilesperproc * 2) 1587 nfds = maxfilesperproc * 2; 1588 bytes = sizeof(struct pollfd) * nfds; 1589 1590 ka.lwp = curthread->td_lwp; 1591 ka.nfds = nfds; 1592 ka.pfds = 0; 1593 ka.error = 0; 1594 1595 if (ka.nfds < 64) 1596 ka.fds = sfds; 1597 else 1598 ka.fds = kmalloc(bytes, M_SELECT, M_WAITOK); 1599 1600 error = copyin(fds, ka.fds, bytes); 1601 if (error == 0) 1602 error = kern_kevent(&ka.lwp->lwp_kqueue, 0x7FFFFFFF, res, &ka, 1603 poll_copyin, poll_copyout, ts, flags); 1604 1605 if (error == 0) 1606 error = copyout(ka.fds, fds, bytes); 1607 1608 if (ka.fds != sfds) 1609 kfree(ka.fds, M_SELECT); 1610 1611 ka.lwp->lwp_kqueue_serial += nfds; 1612 1613 return (error); 1614 } 1615 1616 static int 1617 socket_wait_copyin(void *arg, struct kevent *kevp, int maxevents, int *events) 1618 { 1619 return (0); 1620 } 1621 1622 static int 1623 socket_wait_copyout(void *arg, struct kevent *kevp, int count, int *res) 1624 { 1625 ++*res; 1626 return (0); 1627 } 1628 1629 extern struct fileops socketops; 1630 1631 /* 1632 * NOTE: Callers of socket_wait() must already have a reference on the 1633 * socket. 1634 */ 1635 int 1636 socket_wait(struct socket *so, struct timespec *ts, int *res) 1637 { 1638 struct thread *td = curthread; 1639 struct file *fp; 1640 struct kqueue kq; 1641 struct kevent kev; 1642 int error, fd; 1643 int n; 1644 1645 if ((error = falloc(td->td_lwp, &fp, &fd)) != 0) 1646 return (error); 1647 1648 fp->f_type = DTYPE_SOCKET; 1649 fp->f_flag = FREAD | FWRITE; 1650 fp->f_ops = &socketops; 1651 fp->f_data = so; 1652 fsetfd(td->td_lwp->lwp_proc->p_fd, fp, fd); 1653 fsetfdflags(td->td_proc->p_fd, fd, UF_EXCLOSE); 1654 1655 bzero(&kq, sizeof(kq)); 1656 kqueue_init(&kq, td->td_lwp->lwp_proc->p_fd); 1657 EV_SET(&kev, fd, EVFILT_READ, EV_ADD|EV_ENABLE, 0, 0, NULL); 1658 n = 1; 1659 if ((error = kqueue_register(&kq, &kev, &n)) != 0) { 1660 fdrop(fp); 1661 return (error); 1662 } 1663 1664 error = kern_kevent(&kq, 1, res, NULL, socket_wait_copyin, 1665 socket_wait_copyout, ts, 0); 1666 1667 EV_SET(&kev, fd, EVFILT_READ, EV_DELETE|EV_DISABLE, 0, 0, NULL); 1668 n = 1; 1669 kqueue_register(&kq, &kev, &n); 1670 fp->f_ops = &badfileops; 1671 fdrop(fp); 1672 1673 return (error); 1674 } 1675 1676 /* 1677 * OpenBSD poll system call. 1678 * XXX this isn't quite a true representation.. OpenBSD uses select ops. 1679 * 1680 * MPSAFE 1681 */ 1682 int 1683 sys_openbsd_poll(struct sysmsg *sysmsg, const struct openbsd_poll_args *uap) 1684 { 1685 return (sys_poll(sysmsg, (const struct poll_args *)uap)); 1686 } 1687 1688 /*ARGSUSED*/ 1689 int 1690 seltrue(cdev_t dev, int events) 1691 { 1692 return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM)); 1693 } 1694