sys/compat/linux/linux_event.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   3  *
   4  * Copyright (c) 2007 Roman Divacky
   5  * Copyright (c) 2014 Dmitry Chagin
   6  * 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  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  */
  29
  30 #include <sys/cdefs.h>
  31 __FBSDID("$FreeBSD$");
  32
  33 #include "opt_compat.h"
  34
  35 #include <sys/param.h>
  36 #include <sys/systm.h>
  37 #include <sys/imgact.h>
  38 #include <sys/kernel.h>
  39 #include <sys/limits.h>
  40 #include <sys/lock.h>
  41 #include <sys/mutex.h>
  42 #include <sys/callout.h>
  43 #include <sys/capsicum.h>
  44 #include <sys/types.h>
  45 #include <sys/user.h>
  46 #include <sys/file.h>
  47 #include <sys/filedesc.h>
  48 #include <sys/filio.h>
  49 #include <sys/errno.h>
  50 #include <sys/event.h>
  51 #include <sys/poll.h>
  52 #include <sys/proc.h>
  53 #include <sys/selinfo.h>
  54 #include <sys/specialfd.h>
  55 #include <sys/sx.h>
  56 #include <sys/syscallsubr.h>
  57 #include <sys/timespec.h>
  58 #include <sys/eventfd.h>
  59
  60 #ifdef COMPAT_LINUX32
  61 #include <machine/../linux32/linux.h>
  62 #include <machine/../linux32/linux32_proto.h>
  63 #else
  64 #include <machine/../linux/linux.h>
  65 #include <machine/../linux/linux_proto.h>
  66 #endif
  67
  68 #include <compat/linux/linux_emul.h>
  69 #include <compat/linux/linux_event.h>
  70 #include <compat/linux/linux_file.h>
  71 #include <compat/linux/linux_timer.h>
  72 #include <compat/linux/linux_util.h>
  73
  74 typedef uint64_t        epoll_udata_t;
  75
  76 struct epoll_event {
  77         uint32_t        events;
  78         epoll_udata_t   data;
  79 }
  80 #if defined(__amd64__)
  81 __attribute__((packed))
  82 #endif
  83 ;
  84
  85 #define LINUX_MAX_EVENTS        (INT_MAX / sizeof(struct epoll_event))
  86
  87 static int      epoll_to_kevent(struct thread *td, int fd,
  88                     struct epoll_event *l_event, struct kevent *kevent,
  89                     int *nkevents);
  90 static void     kevent_to_epoll(struct kevent *kevent, struct epoll_event *l_event);
  91 static int      epoll_kev_copyout(void *arg, struct kevent *kevp, int count);
  92 static int      epoll_kev_copyin(void *arg, struct kevent *kevp, int count);
  93 static int      epoll_register_kevent(struct thread *td, struct file *epfp,
  94                     int fd, int filter, unsigned int flags);
  95 static int      epoll_fd_registered(struct thread *td, struct file *epfp,
  96                     int fd);
  97 static int      epoll_delete_all_events(struct thread *td, struct file *epfp,
  98                     int fd);
  99
 100 struct epoll_copyin_args {
 101         struct kevent   *changelist;
 102 };
 103
 104 struct epoll_copyout_args {
 105         struct epoll_event      *leventlist;
 106         struct proc             *p;
 107         uint32_t                count;
 108         int                     error;
 109 };
 110
 111 /* timerfd */
 112 typedef uint64_t        timerfd_t;
 113
 114 static fo_rdwr_t        timerfd_read;
 115 static fo_ioctl_t       timerfd_ioctl;
 116 static fo_poll_t        timerfd_poll;
 117 static fo_kqfilter_t    timerfd_kqfilter;
 118 static fo_stat_t        timerfd_stat;
 119 static fo_close_t       timerfd_close;
 120 static fo_fill_kinfo_t  timerfd_fill_kinfo;
 121
 122 static struct fileops timerfdops = {
 123         .fo_read = timerfd_read,
 124         .fo_write = invfo_rdwr,
 125         .fo_truncate = invfo_truncate,
 126         .fo_ioctl = timerfd_ioctl,
 127         .fo_poll = timerfd_poll,
 128         .fo_kqfilter = timerfd_kqfilter,
 129         .fo_stat = timerfd_stat,
 130         .fo_close = timerfd_close,
 131         .fo_chmod = invfo_chmod,
 132         .fo_chown = invfo_chown,
 133         .fo_sendfile = invfo_sendfile,
 134         .fo_fill_kinfo = timerfd_fill_kinfo,
 135         .fo_flags = DFLAG_PASSABLE
 136 };
 137
 138 static void     filt_timerfddetach(struct knote *kn);
 139 static int      filt_timerfdread(struct knote *kn, long hint);
 140
 141 static struct filterops timerfd_rfiltops = {
 142         .f_isfd = 1,
 143         .f_detach = filt_timerfddetach,
 144         .f_event = filt_timerfdread
 145 };
 146
 147 struct timerfd {
 148         clockid_t       tfd_clockid;
 149         struct itimerspec tfd_time;
 150         struct callout  tfd_callout;
 151         timerfd_t       tfd_count;
 152         bool            tfd_canceled;
 153         struct selinfo  tfd_sel;
 154         struct mtx      tfd_lock;
 155 };
 156
 157 static void     linux_timerfd_expire(void *);
 158 static void     linux_timerfd_curval(struct timerfd *, struct itimerspec *);
 159
 160 static int
 161 epoll_create_common(struct thread *td, int flags)
 162 {
 163
 164         return (kern_kqueue(td, flags, NULL));
 165 }
 166
 167 #ifdef LINUX_LEGACY_SYSCALLS
 168 int
 169 linux_epoll_create(struct thread *td, struct linux_epoll_create_args *args)
 170 {
 171
 172         /*
 173          * args->size is unused. Linux just tests it
 174          * and then forgets it as well.
 175          */
 176         if (args->size <= 0)
 177                 return (EINVAL);
 178
 179         return (epoll_create_common(td, 0));
 180 }
 181 #endif
 182
 183 int
 184 linux_epoll_create1(struct thread *td, struct linux_epoll_create1_args *args)
 185 {
 186         int flags;
 187
 188         if ((args->flags & ~(LINUX_O_CLOEXEC)) != 0)
 189                 return (EINVAL);
 190
 191         flags = 0;
 192         if ((args->flags & LINUX_O_CLOEXEC) != 0)
 193                 flags |= O_CLOEXEC;
 194
 195         return (epoll_create_common(td, flags));
 196 }
 197
 198 /* Structure converting function from epoll to kevent. */
 199 static int
 200 epoll_to_kevent(struct thread *td, int fd, struct epoll_event *l_event,
 201     struct kevent *kevent, int *nkevents)
 202 {
 203         uint32_t levents = l_event->events;
 204         struct linux_pemuldata *pem;
 205         struct proc *p;
 206         unsigned short kev_flags = EV_ADD | EV_ENABLE;
 207
 208         /* flags related to how event is registered */
 209         if ((levents & LINUX_EPOLLONESHOT) != 0)
 210                 kev_flags |= EV_DISPATCH;
 211         if ((levents & LINUX_EPOLLET) != 0)
 212                 kev_flags |= EV_CLEAR;
 213         if ((levents & LINUX_EPOLLERR) != 0)
 214                 kev_flags |= EV_ERROR;
 215         if ((levents & LINUX_EPOLLRDHUP) != 0)
 216                 kev_flags |= EV_EOF;
 217
 218         /* flags related to what event is registered */
 219         if ((levents & LINUX_EPOLL_EVRD) != 0) {
 220                 EV_SET(kevent, fd, EVFILT_READ, kev_flags, 0, 0, 0);
 221                 kevent->ext[0] = l_event->data;
 222                 ++kevent;
 223                 ++(*nkevents);
 224         }
 225         if ((levents & LINUX_EPOLL_EVWR) != 0) {
 226                 EV_SET(kevent, fd, EVFILT_WRITE, kev_flags, 0, 0, 0);
 227                 kevent->ext[0] = l_event->data;
 228                 ++kevent;
 229                 ++(*nkevents);
 230         }
 231         /* zero event mask is legal */
 232         if ((levents & (LINUX_EPOLL_EVRD | LINUX_EPOLL_EVWR)) == 0) {
 233                 EV_SET(kevent++, fd, EVFILT_READ, EV_ADD|EV_DISABLE, 0, 0, 0);
 234                 ++(*nkevents);
 235         }
 236
 237         if ((levents & ~(LINUX_EPOLL_EVSUP)) != 0) {
 238                 p = td->td_proc;
 239
 240                 pem = pem_find(p);
 241                 KASSERT(pem != NULL, ("epoll proc emuldata not found.\n"));
 242
 243                 LINUX_PEM_XLOCK(pem);
 244                 if ((pem->flags & LINUX_XUNSUP_EPOLL) == 0) {
 245                         pem->flags |= LINUX_XUNSUP_EPOLL;
 246                         LINUX_PEM_XUNLOCK(pem);
 247                         linux_msg(td, "epoll_ctl unsupported flags: 0x%x",
 248                             levents);
 249                 } else
 250                         LINUX_PEM_XUNLOCK(pem);
 251                 return (EINVAL);
 252         }
 253
 254         return (0);
 255 }
 256
 257 /*
 258  * Structure converting function from kevent to epoll. In a case
 259  * this is called on error in registration we store the error in
 260  * event->data and pick it up later in linux_epoll_ctl().
 261  */
 262 static void
 263 kevent_to_epoll(struct kevent *kevent, struct epoll_event *l_event)
 264 {
 265
 266         l_event->data = kevent->ext[0];
 267
 268         if ((kevent->flags & EV_ERROR) != 0) {
 269                 l_event->events = LINUX_EPOLLERR;
 270                 return;
 271         }
 272
 273         /* XXX EPOLLPRI, EPOLLHUP */
 274         switch (kevent->filter) {
 275         case EVFILT_READ:
 276                 l_event->events = LINUX_EPOLLIN;
 277                 if ((kevent->flags & EV_EOF) != 0)
 278                         l_event->events |= LINUX_EPOLLRDHUP;
 279         break;
 280         case EVFILT_WRITE:
 281                 l_event->events = LINUX_EPOLLOUT;
 282         break;
 283         }
 284 }
 285
 286 /*
 287  * Copyout callback used by kevent. This converts kevent
 288  * events to epoll events and copies them back to the
 289  * userspace. This is also called on error on registering
 290  * of the filter.
 291  */
 292 static int
 293 epoll_kev_copyout(void *arg, struct kevent *kevp, int count)
 294 {
 295         struct epoll_copyout_args *args;
 296         struct epoll_event *eep;
 297         int error, i;
 298
 299         args = (struct epoll_copyout_args*) arg;
 300         eep = malloc(sizeof(*eep) * count, M_EPOLL, M_WAITOK | M_ZERO);
 301
 302         for (i = 0; i < count; i++)
 303                 kevent_to_epoll(&kevp[i], &eep[i]);
 304
 305         error = copyout(eep, args->leventlist, count * sizeof(*eep));
 306         if (error == 0) {
 307                 args->leventlist += count;
 308                 args->count += count;
 309         } else if (args->error == 0)
 310                 args->error = error;
 311
 312         free(eep, M_EPOLL);
 313         return (error);
 314 }
 315
 316 /*
 317  * Copyin callback used by kevent. This copies already
 318  * converted filters from kernel memory to the kevent
 319  * internal kernel memory. Hence the memcpy instead of
 320  * copyin.
 321  */
 322 static int
 323 epoll_kev_copyin(void *arg, struct kevent *kevp, int count)
 324 {
 325         struct epoll_copyin_args *args;
 326
 327         args = (struct epoll_copyin_args*) arg;
 328
 329         memcpy(kevp, args->changelist, count * sizeof(*kevp));
 330         args->changelist += count;
 331
 332         return (0);
 333 }
 334
 335 /*
 336  * Load epoll filter, convert it to kevent filter
 337  * and load it into kevent subsystem.
 338  */
 339 int
 340 linux_epoll_ctl(struct thread *td, struct linux_epoll_ctl_args *args)
 341 {
 342         struct file *epfp, *fp;
 343         struct epoll_copyin_args ciargs;
 344         struct kevent kev[2];
 345         struct kevent_copyops k_ops = { &ciargs,
 346                                         NULL,
 347                                         epoll_kev_copyin};
 348         struct epoll_event le;
 349         cap_rights_t rights;
 350         int nchanges = 0;
 351         int error;
 352
 353         if (args->op != LINUX_EPOLL_CTL_DEL) {
 354                 error = copyin(args->event, &le, sizeof(le));
 355                 if (error != 0)
 356                         return (error);
 357         }
 358
 359         error = fget(td, args->epfd,
 360             cap_rights_init_one(&rights, CAP_KQUEUE_CHANGE), &epfp);
 361         if (error != 0)
 362                 return (error);
 363         if (epfp->f_type != DTYPE_KQUEUE) {
 364                 error = EINVAL;
 365                 goto leave1;
 366         }
 367
 368          /* Protect user data vector from incorrectly supplied fd. */
 369         error = fget(td, args->fd,
 370                      cap_rights_init_one(&rights, CAP_POLL_EVENT), &fp);
 371         if (error != 0)
 372                 goto leave1;
 373
 374         /* Linux disallows spying on himself */
 375         if (epfp == fp) {
 376                 error = EINVAL;
 377                 goto leave0;
 378         }
 379
 380         ciargs.changelist = kev;
 381
 382         if (args->op != LINUX_EPOLL_CTL_DEL) {
 383                 error = epoll_to_kevent(td, args->fd, &le, kev, &nchanges);
 384                 if (error != 0)
 385                         goto leave0;
 386         }
 387
 388         switch (args->op) {
 389         case LINUX_EPOLL_CTL_MOD:
 390                 error = epoll_delete_all_events(td, epfp, args->fd);
 391                 if (error != 0)
 392                         goto leave0;
 393                 break;
 394
 395         case LINUX_EPOLL_CTL_ADD:
 396                 if (epoll_fd_registered(td, epfp, args->fd)) {
 397                         error = EEXIST;
 398                         goto leave0;
 399                 }
 400                 break;
 401
 402         case LINUX_EPOLL_CTL_DEL:
 403                 /* CTL_DEL means unregister this fd with this epoll */
 404                 error = epoll_delete_all_events(td, epfp, args->fd);
 405                 goto leave0;
 406
 407         default:
 408                 error = EINVAL;
 409                 goto leave0;
 410         }
 411
 412         error = kern_kevent_fp(td, epfp, nchanges, 0, &k_ops, NULL);
 413
 414 leave0:
 415         fdrop(fp, td);
 416
 417 leave1:
 418         fdrop(epfp, td);
 419         return (error);
 420 }
 421
 422 /*
 423  * Wait for a filter to be triggered on the epoll file descriptor.
 424  */
 425 static int
 426 linux_epoll_wait_common(struct thread *td, int epfd, struct epoll_event *events,
 427     int maxevents, int timeout, sigset_t *uset)
 428 {
 429         struct epoll_copyout_args coargs;
 430         struct kevent_copyops k_ops = { &coargs,
 431                                         epoll_kev_copyout,
 432                                         NULL};
 433         struct timespec ts, *tsp;
 434         cap_rights_t rights;
 435         struct file *epfp;
 436         sigset_t omask;
 437         int error;
 438
 439         if (maxevents <= 0 || maxevents > LINUX_MAX_EVENTS)
 440                 return (EINVAL);
 441
 442         error = fget(td, epfd,
 443             cap_rights_init_one(&rights, CAP_KQUEUE_EVENT), &epfp);
 444         if (error != 0)
 445                 return (error);
 446         if (epfp->f_type != DTYPE_KQUEUE) {
 447                 error = EINVAL;
 448                 goto leave;
 449         }
 450         if (uset != NULL) {
 451                 error = kern_sigprocmask(td, SIG_SETMASK, uset,
 452                     &omask, 0);
 453                 if (error != 0)
 454                         goto leave;
 455                 td->td_pflags |= TDP_OLDMASK;
 456                 /*
 457                  * Make sure that ast() is called on return to
 458                  * usermode and TDP_OLDMASK is cleared, restoring old
 459                  * sigmask.
 460                  */
 461                 thread_lock(td);
 462                 td->td_flags |= TDF_ASTPENDING;
 463                 thread_unlock(td);
 464         }
 465
 466         coargs.leventlist = events;
 467         coargs.p = td->td_proc;
 468         coargs.count = 0;
 469         coargs.error = 0;
 470
 471         /*
 472          * Linux epoll_wait(2) man page states that timeout of -1 causes caller
 473          * to block indefinitely. Real implementation does it if any negative
 474          * timeout value is passed.
 475          */
 476         if (timeout >= 0) {
 477                 /* Convert from milliseconds to timespec. */
 478                 ts.tv_sec = timeout / 1000;
 479                 ts.tv_nsec = (timeout % 1000) * 1000000;
 480                 tsp = &ts;
 481         } else {
 482                 tsp = NULL;
 483         }
 484
 485         error = kern_kevent_fp(td, epfp, 0, maxevents, &k_ops, tsp);
 486         if (error == 0 && coargs.error != 0)
 487                 error = coargs.error;
 488
 489         /*
 490          * kern_kevent might return ENOMEM which is not expected from epoll_wait.
 491          * Maybe we should translate that but I don't think it matters at all.
 492          */
 493         if (error == 0)
 494                 td->td_retval[0] = coargs.count;
 495
 496         if (uset != NULL)
 497                 error = kern_sigprocmask(td, SIG_SETMASK, &omask,
 498                     NULL, 0);
 499 leave:
 500         fdrop(epfp, td);
 501         return (error);
 502 }
 503
 504 #ifdef LINUX_LEGACY_SYSCALLS
 505 int
 506 linux_epoll_wait(struct thread *td, struct linux_epoll_wait_args *args)
 507 {
 508
 509         return (linux_epoll_wait_common(td, args->epfd, args->events,
 510             args->maxevents, args->timeout, NULL));
 511 }
 512 #endif
 513
 514 int
 515 linux_epoll_pwait(struct thread *td, struct linux_epoll_pwait_args *args)
 516 {
 517         sigset_t mask, *pmask;
 518         l_sigset_t lmask;
 519         int error;
 520
 521         if (args->mask != NULL) {
 522                 if (args->sigsetsize != sizeof(l_sigset_t))
 523                         return (EINVAL);
 524                 error = copyin(args->mask, &lmask, sizeof(l_sigset_t));
 525                 if (error != 0)
 526                         return (error);
 527                 linux_to_bsd_sigset(&lmask, &mask);
 528                 pmask = &mask;
 529         } else
 530                 pmask = NULL;
 531         return (linux_epoll_wait_common(td, args->epfd, args->events,
 532             args->maxevents, args->timeout, pmask));
 533 }
 534
 535 static int
 536 epoll_register_kevent(struct thread *td, struct file *epfp, int fd, int filter,
 537     unsigned int flags)
 538 {
 539         struct epoll_copyin_args ciargs;
 540         struct kevent kev;
 541         struct kevent_copyops k_ops = { &ciargs,
 542                                         NULL,
 543                                         epoll_kev_copyin};
 544
 545         ciargs.changelist = &kev;
 546         EV_SET(&kev, fd, filter, flags, 0, 0, 0);
 547
 548         return (kern_kevent_fp(td, epfp, 1, 0, &k_ops, NULL));
 549 }
 550
 551 static int
 552 epoll_fd_registered(struct thread *td, struct file *epfp, int fd)
 553 {
 554         /*
 555          * Set empty filter flags to avoid accidental modification of already
 556          * registered events. In the case of event re-registration:
 557          * 1. If event does not exists kevent() does nothing and returns ENOENT
 558          * 2. If event does exists, it's enabled/disabled state is preserved
 559          *    but fflags, data and udata fields are overwritten. So we can not
 560          *    set socket lowats and store user's context pointer in udata.
 561          */
 562         if (epoll_register_kevent(td, epfp, fd, EVFILT_READ, 0) != ENOENT ||
 563             epoll_register_kevent(td, epfp, fd, EVFILT_WRITE, 0) != ENOENT)
 564                 return (1);
 565
 566         return (0);
 567 }
 568
 569 static int
 570 epoll_delete_all_events(struct thread *td, struct file *epfp, int fd)
 571 {
 572         int error1, error2;
 573
 574         error1 = epoll_register_kevent(td, epfp, fd, EVFILT_READ, EV_DELETE);
 575         error2 = epoll_register_kevent(td, epfp, fd, EVFILT_WRITE, EV_DELETE);
 576
 577         /* return 0 if at least one result positive */
 578         return (error1 == 0 ? 0 : error2);
 579 }
 580
 581 #ifdef LINUX_LEGACY_SYSCALLS
 582 int
 583 linux_eventfd(struct thread *td, struct linux_eventfd_args *args)
 584 {
 585         struct specialfd_eventfd ae;
 586
 587         bzero(&ae, sizeof(ae));
 588         ae.initval = args->initval;
 589         return (kern_specialfd(td, SPECIALFD_EVENTFD, &ae));
 590 }
 591 #endif
 592
 593 int
 594 linux_eventfd2(struct thread *td, struct linux_eventfd2_args *args)
 595 {
 596         struct specialfd_eventfd ae;
 597         int flags;
 598
 599         if ((args->flags & ~(LINUX_O_CLOEXEC | LINUX_O_NONBLOCK |
 600             LINUX_EFD_SEMAPHORE)) != 0)
 601                 return (EINVAL);
 602         flags = 0;
 603         if ((args->flags & LINUX_O_CLOEXEC) != 0)
 604                 flags |= EFD_CLOEXEC;
 605         if ((args->flags & LINUX_O_NONBLOCK) != 0)
 606                 flags |= EFD_NONBLOCK;
 607         if ((args->flags & LINUX_EFD_SEMAPHORE) != 0)
 608                 flags |= EFD_SEMAPHORE;
 609
 610         bzero(&ae, sizeof(ae));
 611         ae.flags = flags;
 612         ae.initval = args->initval;
 613         return (kern_specialfd(td, SPECIALFD_EVENTFD, &ae));
 614 }
 615
 616 int
 617 linux_timerfd_create(struct thread *td, struct linux_timerfd_create_args *args)
 618 {
 619         struct filedesc *fdp;
 620         struct timerfd *tfd;
 621         struct file *fp;
 622         clockid_t clockid;
 623         int fflags, fd, error;
 624
 625         if ((args->flags & ~LINUX_TFD_CREATE_FLAGS) != 0)
 626                 return (EINVAL);
 627
 628         error = linux_to_native_clockid(&clockid, args->clockid);
 629         if (error != 0)
 630                 return (error);
 631         if (clockid != CLOCK_REALTIME && clockid != CLOCK_MONOTONIC)
 632                 return (EINVAL);
 633
 634         fflags = 0;
 635         if ((args->flags & LINUX_TFD_CLOEXEC) != 0)
 636                 fflags |= O_CLOEXEC;
 637
 638         fdp = td->td_proc->p_fd;
 639         error = falloc(td, &fp, &fd, fflags);
 640         if (error != 0)
 641                 return (error);
 642
 643         tfd = malloc(sizeof(*tfd), M_EPOLL, M_WAITOK | M_ZERO);
 644         tfd->tfd_clockid = clockid;
 645         mtx_init(&tfd->tfd_lock, "timerfd", NULL, MTX_DEF);
 646
 647         callout_init_mtx(&tfd->tfd_callout, &tfd->tfd_lock, 0);
 648         knlist_init_mtx(&tfd->tfd_sel.si_note, &tfd->tfd_lock);
 649
 650         fflags = FREAD;
 651         if ((args->flags & LINUX_O_NONBLOCK) != 0)
 652                 fflags |= FNONBLOCK;
 653
 654         finit(fp, fflags, DTYPE_LINUXTFD, tfd, &timerfdops);
 655         fdrop(fp, td);
 656
 657         td->td_retval[0] = fd;
 658         return (error);
 659 }
 660
 661 static int
 662 timerfd_close(struct file *fp, struct thread *td)
 663 {
 664         struct timerfd *tfd;
 665
 666         tfd = fp->f_data;
 667         if (fp->f_type != DTYPE_LINUXTFD || tfd == NULL)
 668                 return (EINVAL);
 669
 670         timespecclear(&tfd->tfd_time.it_value);
 671         timespecclear(&tfd->tfd_time.it_interval);
 672
 673         mtx_lock(&tfd->tfd_lock);
 674         callout_drain(&tfd->tfd_callout);
 675         mtx_unlock(&tfd->tfd_lock);
 676
 677         seldrain(&tfd->tfd_sel);
 678         knlist_destroy(&tfd->tfd_sel.si_note);
 679
 680         fp->f_ops = &badfileops;
 681         mtx_destroy(&tfd->tfd_lock);
 682         free(tfd, M_EPOLL);
 683
 684         return (0);
 685 }
 686
 687 static int
 688 timerfd_read(struct file *fp, struct uio *uio, struct ucred *active_cred,
 689     int flags, struct thread *td)
 690 {
 691         struct timerfd *tfd;
 692         timerfd_t count;
 693         int error;
 694
 695         tfd = fp->f_data;
 696         if (fp->f_type != DTYPE_LINUXTFD || tfd == NULL)
 697                 return (EINVAL);
 698
 699         if (uio->uio_resid < sizeof(timerfd_t))
 700                 return (EINVAL);
 701
 702         error = 0;
 703         mtx_lock(&tfd->tfd_lock);
 704 retry:
 705         if (tfd->tfd_canceled) {
 706                 tfd->tfd_count = 0;
 707                 mtx_unlock(&tfd->tfd_lock);
 708                 return (ECANCELED);
 709         }
 710         if (tfd->tfd_count == 0) {
 711                 if ((fp->f_flag & FNONBLOCK) != 0) {
 712                         mtx_unlock(&tfd->tfd_lock);
 713                         return (EAGAIN);
 714                 }
 715                 error = mtx_sleep(&tfd->tfd_count, &tfd->tfd_lock, PCATCH, "ltfdrd", 0);
 716                 if (error == 0)
 717                         goto retry;
 718         }
 719         if (error == 0) {
 720                 count = tfd->tfd_count;
 721                 tfd->tfd_count = 0;
 722                 mtx_unlock(&tfd->tfd_lock);
 723                 error = uiomove(&count, sizeof(timerfd_t), uio);
 724         } else
 725                 mtx_unlock(&tfd->tfd_lock);
 726
 727         return (error);
 728 }
 729
 730 static int
 731 timerfd_poll(struct file *fp, int events, struct ucred *active_cred,
 732     struct thread *td)
 733 {
 734         struct timerfd *tfd;
 735         int revents = 0;
 736
 737         tfd = fp->f_data;
 738         if (fp->f_type != DTYPE_LINUXTFD || tfd == NULL)
 739                 return (POLLERR);
 740
 741         mtx_lock(&tfd->tfd_lock);
 742         if ((events & (POLLIN|POLLRDNORM)) && tfd->tfd_count > 0)
 743                 revents |= events & (POLLIN|POLLRDNORM);
 744         if (revents == 0)
 745                 selrecord(td, &tfd->tfd_sel);
 746         mtx_unlock(&tfd->tfd_lock);
 747
 748         return (revents);
 749 }
 750
 751 static int
 752 timerfd_kqfilter(struct file *fp, struct knote *kn)
 753 {
 754         struct timerfd *tfd;
 755
 756         tfd = fp->f_data;
 757         if (fp->f_type != DTYPE_LINUXTFD || tfd == NULL)
 758                 return (EINVAL);
 759
 760         if (kn->kn_filter == EVFILT_READ)
 761                 kn->kn_fop = &timerfd_rfiltops;
 762         else
 763                 return (EINVAL);
 764
 765         kn->kn_hook = tfd;
 766         knlist_add(&tfd->tfd_sel.si_note, kn, 0);
 767
 768         return (0);
 769 }
 770
 771 static void
 772 filt_timerfddetach(struct knote *kn)
 773 {
 774         struct timerfd *tfd = kn->kn_hook;
 775
 776         mtx_lock(&tfd->tfd_lock);
 777         knlist_remove(&tfd->tfd_sel.si_note, kn, 1);
 778         mtx_unlock(&tfd->tfd_lock);
 779 }
 780
 781 static int
 782 filt_timerfdread(struct knote *kn, long hint)
 783 {
 784         struct timerfd *tfd = kn->kn_hook;
 785
 786         return (tfd->tfd_count > 0);
 787 }
 788
 789 static int
 790 timerfd_ioctl(struct file *fp, u_long cmd, void *data,
 791     struct ucred *active_cred, struct thread *td)
 792 {
 793
 794         if (fp->f_data == NULL || fp->f_type != DTYPE_LINUXTFD)
 795                 return (EINVAL);
 796
 797         switch (cmd) {
 798         case FIONBIO:
 799         case FIOASYNC:
 800                 return (0);
 801         }
 802
 803         return (ENOTTY);
 804 }
 805
 806 static int
 807 timerfd_stat(struct file *fp, struct stat *st, struct ucred *active_cred,
 808     struct thread *td)
 809 {
 810
 811         return (ENXIO);
 812 }
 813
 814 static int
 815 timerfd_fill_kinfo(struct file *fp, struct kinfo_file *kif, struct filedesc *fdp)
 816 {
 817
 818         kif->kf_type = KF_TYPE_UNKNOWN;
 819         return (0);
 820 }
 821
 822 static void
 823 linux_timerfd_clocktime(struct timerfd *tfd, struct timespec *ts)
 824 {
 825
 826         if (tfd->tfd_clockid == CLOCK_REALTIME)
 827                 getnanotime(ts);
 828         else    /* CLOCK_MONOTONIC */
 829                 getnanouptime(ts);
 830 }
 831
 832 static void
 833 linux_timerfd_curval(struct timerfd *tfd, struct itimerspec *ots)
 834 {
 835         struct timespec cts;
 836
 837         linux_timerfd_clocktime(tfd, &cts);
 838         *ots = tfd->tfd_time;
 839         if (ots->it_value.tv_sec != 0 || ots->it_value.tv_nsec != 0) {
 840                 timespecsub(&ots->it_value, &cts, &ots->it_value);
 841                 if (ots->it_value.tv_sec < 0 ||
 842                     (ots->it_value.tv_sec == 0 &&
 843                      ots->it_value.tv_nsec == 0)) {
 844                         ots->it_value.tv_sec  = 0;
 845                         ots->it_value.tv_nsec = 1;
 846                 }
 847         }
 848 }
 849
 850 int
 851 linux_timerfd_gettime(struct thread *td, struct linux_timerfd_gettime_args *args)
 852 {
 853         struct l_itimerspec lots;
 854         struct itimerspec ots;
 855         struct timerfd *tfd;
 856         struct file *fp;
 857         int error;
 858
 859         error = fget(td, args->fd, &cap_read_rights, &fp);
 860         if (error != 0)
 861                 return (error);
 862         tfd = fp->f_data;
 863         if (fp->f_type != DTYPE_LINUXTFD || tfd == NULL) {
 864                 error = EINVAL;
 865                 goto out;
 866         }
 867
 868         mtx_lock(&tfd->tfd_lock);
 869         linux_timerfd_curval(tfd, &ots);
 870         mtx_unlock(&tfd->tfd_lock);
 871
 872         error = native_to_linux_itimerspec(&lots, &ots);
 873         if (error == 0)
 874                 error = copyout(&lots, args->old_value, sizeof(lots));
 875
 876 out:
 877         fdrop(fp, td);
 878         return (error);
 879 }
 880
 881 int
 882 linux_timerfd_settime(struct thread *td, struct linux_timerfd_settime_args *args)
 883 {
 884         struct l_itimerspec lots;
 885         struct itimerspec nts, ots;
 886         struct timespec cts, ts;
 887         struct timerfd *tfd;
 888         struct timeval tv;
 889         struct file *fp;
 890         int error;
 891
 892         if ((args->flags & ~LINUX_TFD_SETTIME_FLAGS) != 0)
 893                 return (EINVAL);
 894
 895         error = copyin(args->new_value, &lots, sizeof(lots));
 896         if (error != 0)
 897                 return (error);
 898         error = linux_to_native_itimerspec(&nts, &lots);
 899         if (error != 0)
 900                 return (error);
 901
 902         error = fget(td, args->fd, &cap_write_rights, &fp);
 903         if (error != 0)
 904                 return (error);
 905         tfd = fp->f_data;
 906         if (fp->f_type != DTYPE_LINUXTFD || tfd == NULL) {
 907                 error = EINVAL;
 908                 goto out;
 909         }
 910
 911         mtx_lock(&tfd->tfd_lock);
 912         if (!timespecisset(&nts.it_value))
 913                 timespecclear(&nts.it_interval);
 914         if (args->old_value != NULL)
 915                 linux_timerfd_curval(tfd, &ots);
 916
 917         tfd->tfd_time = nts;
 918         tfd->tfd_count = 0;
 919         if (timespecisset(&nts.it_value)) {
 920                 linux_timerfd_clocktime(tfd, &cts);
 921                 ts = nts.it_value;
 922                 if ((args->flags & LINUX_TFD_TIMER_ABSTIME) == 0) {
 923                         timespecadd(&tfd->tfd_time.it_value, &cts,
 924                                 &tfd->tfd_time.it_value);
 925                 } else {
 926                         timespecsub(&ts, &cts, &ts);
 927                 }
 928                 TIMESPEC_TO_TIMEVAL(&tv, &ts);
 929                 callout_reset(&tfd->tfd_callout, tvtohz(&tv),
 930                         linux_timerfd_expire, tfd);
 931                 tfd->tfd_canceled = false;
 932         } else {
 933                 tfd->tfd_canceled = true;
 934                 callout_stop(&tfd->tfd_callout);
 935         }
 936         mtx_unlock(&tfd->tfd_lock);
 937
 938         if (args->old_value != NULL) {
 939                 error = native_to_linux_itimerspec(&lots, &ots);
 940                 if (error == 0)
 941                         error = copyout(&lots, args->old_value, sizeof(lots));
 942         }
 943
 944 out:
 945         fdrop(fp, td);
 946         return (error);
 947 }
 948
 949 static void
 950 linux_timerfd_expire(void *arg)
 951 {
 952         struct timespec cts, ts;
 953         struct timeval tv;
 954         struct timerfd *tfd;
 955
 956         tfd = (struct timerfd *)arg;
 957
 958         linux_timerfd_clocktime(tfd, &cts);
 959         if (timespeccmp(&cts, &tfd->tfd_time.it_value, >=)) {
 960                 if (timespecisset(&tfd->tfd_time.it_interval))
 961                         timespecadd(&tfd->tfd_time.it_value,
 962                                     &tfd->tfd_time.it_interval,
 963                                     &tfd->tfd_time.it_value);
 964                 else
 965                         /* single shot timer */
 966                         timespecclear(&tfd->tfd_time.it_value);
 967                 if (timespecisset(&tfd->tfd_time.it_value)) {
 968                         timespecsub(&tfd->tfd_time.it_value, &cts, &ts);
 969                         TIMESPEC_TO_TIMEVAL(&tv, &ts);
 970                         callout_reset(&tfd->tfd_callout, tvtohz(&tv),
 971                                 linux_timerfd_expire, tfd);
 972                 }
 973                 tfd->tfd_count++;
 974                 KNOTE_LOCKED(&tfd->tfd_sel.si_note, 0);
 975                 selwakeup(&tfd->tfd_sel);
 976                 wakeup(&tfd->tfd_count);
 977         } else if (timespecisset(&tfd->tfd_time.it_value)) {
 978                 timespecsub(&tfd->tfd_time.it_value, &cts, &ts);
 979                 TIMESPEC_TO_TIMEVAL(&tv, &ts);
 980                 callout_reset(&tfd->tfd_callout, tvtohz(&tv),
 981                     linux_timerfd_expire, tfd);
 982         }
 983 }