Merge branch 'vendor/NCURSES'
[dragonfly.git] / sys / kern / kern_event.c
1 /*-
2  * Copyright (c) 1999,2000,2001 Jonathan Lemon <jlemon@FreeBSD.org>
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  *
26  * $FreeBSD: src/sys/kern/kern_event.c,v 1.2.2.10 2004/04/04 07:03:14 cperciva Exp $
27  * $DragonFly: src/sys/kern/kern_event.c,v 1.33 2007/02/03 17:05:57 corecode Exp $
28  */
29
30 #include <sys/param.h>
31 #include <sys/systm.h>
32 #include <sys/kernel.h>
33 #include <sys/proc.h>
34 #include <sys/malloc.h> 
35 #include <sys/unistd.h>
36 #include <sys/file.h>
37 #include <sys/lock.h>
38 #include <sys/fcntl.h>
39 #include <sys/select.h>
40 #include <sys/queue.h>
41 #include <sys/event.h>
42 #include <sys/eventvar.h>
43 #include <sys/poll.h>
44 #include <sys/protosw.h>
45 #include <sys/socket.h>
46 #include <sys/socketvar.h>
47 #include <sys/stat.h>
48 #include <sys/sysctl.h>
49 #include <sys/sysproto.h>
50 #include <sys/uio.h>
51 #include <sys/thread2.h>
52 #include <sys/signalvar.h>
53 #include <sys/filio.h>
54 #include <sys/file2.h>
55
56 #include <vm/vm_zone.h>
57
58 MALLOC_DEFINE(M_KQUEUE, "kqueue", "memory for kqueue system");
59
60 static int      kqueue_scan(struct file *fp, int maxevents,
61                     struct kevent *ulistp, const struct timespec *timeout,
62                     struct thread *td, int *res);
63 static int      kqueue_read(struct file *fp, struct uio *uio,
64                     struct ucred *cred, int flags);
65 static int      kqueue_write(struct file *fp, struct uio *uio,
66                     struct ucred *cred, int flags);
67 static int      kqueue_ioctl(struct file *fp, u_long com, caddr_t data,
68                     struct ucred *cred, struct sysmsg *msg);
69 static int      kqueue_poll(struct file *fp, int events, struct ucred *cred);
70 static int      kqueue_kqfilter(struct file *fp, struct knote *kn);
71 static int      kqueue_stat(struct file *fp, struct stat *st,
72                     struct ucred *cred);
73 static int      kqueue_close(struct file *fp);
74 static void     kqueue_wakeup(struct kqueue *kq);
75
76 /*
77  * MPSAFE
78  */
79 static struct fileops kqueueops = {
80         .fo_read = kqueue_read,
81         .fo_write = kqueue_write,
82         .fo_ioctl = kqueue_ioctl,
83         .fo_poll = kqueue_poll,
84         .fo_kqfilter = kqueue_kqfilter,
85         .fo_stat = kqueue_stat,
86         .fo_close = kqueue_close,
87         .fo_shutdown = nofo_shutdown
88 };
89
90 static void     knote_attach(struct knote *kn, struct filedesc *fdp);
91 static void     knote_drop(struct knote *kn, struct thread *td);
92 static void     knote_enqueue(struct knote *kn);
93 static void     knote_dequeue(struct knote *kn);
94 static void     knote_init(void);
95 static struct   knote *knote_alloc(void);
96 static void     knote_free(struct knote *kn);
97
98 static void     filt_kqdetach(struct knote *kn);
99 static int      filt_kqueue(struct knote *kn, long hint);
100 static int      filt_procattach(struct knote *kn);
101 static void     filt_procdetach(struct knote *kn);
102 static int      filt_proc(struct knote *kn, long hint);
103 static int      filt_fileattach(struct knote *kn);
104 static void     filt_timerexpire(void *knx);
105 static int      filt_timerattach(struct knote *kn);
106 static void     filt_timerdetach(struct knote *kn);
107 static int      filt_timer(struct knote *kn, long hint);
108
109 static struct filterops file_filtops =
110         { 1, filt_fileattach, NULL, NULL };
111 static struct filterops kqread_filtops =
112         { 1, NULL, filt_kqdetach, filt_kqueue };
113 static struct filterops proc_filtops =
114         { 0, filt_procattach, filt_procdetach, filt_proc };
115 static struct filterops timer_filtops =
116         { 0, filt_timerattach, filt_timerdetach, filt_timer };
117
118 static vm_zone_t        knote_zone;
119 static int              kq_ncallouts = 0;
120 static int              kq_calloutmax = (4 * 1024);
121 SYSCTL_INT(_kern, OID_AUTO, kq_calloutmax, CTLFLAG_RW,
122     &kq_calloutmax, 0, "Maximum number of callouts allocated for kqueue");
123
124 #define KNOTE_ACTIVATE(kn) do {                                         \
125         kn->kn_status |= KN_ACTIVE;                                     \
126         if ((kn->kn_status & (KN_QUEUED | KN_DISABLED)) == 0)           \
127                 knote_enqueue(kn);                                      \
128 } while(0)
129
130 #define KN_HASHSIZE             64              /* XXX should be tunable */
131 #define KN_HASH(val, mask)      (((val) ^ (val >> 8)) & (mask))
132
133 extern struct filterops aio_filtops;
134 extern struct filterops sig_filtops;
135
136 /*
137  * Table for for all system-defined filters.
138  */
139 static struct filterops *sysfilt_ops[] = {
140         &file_filtops,                  /* EVFILT_READ */
141         &file_filtops,                  /* EVFILT_WRITE */
142         &aio_filtops,                   /* EVFILT_AIO */
143         &file_filtops,                  /* EVFILT_VNODE */
144         &proc_filtops,                  /* EVFILT_PROC */
145         &sig_filtops,                   /* EVFILT_SIGNAL */
146         &timer_filtops,                 /* EVFILT_TIMER */
147 };
148
149 static int
150 filt_fileattach(struct knote *kn)
151 {
152         return (fo_kqfilter(kn->kn_fp, kn));
153 }
154
155 /*
156  * MPALMOSTSAFE - acquires mplock
157  */
158 static int
159 kqueue_kqfilter(struct file *fp, struct knote *kn)
160 {
161         struct kqueue *kq = (struct kqueue *)kn->kn_fp->f_data;
162
163         get_mplock();
164         if (kn->kn_filter != EVFILT_READ) {
165                 rel_mplock();
166                 return (1);
167         }
168
169         kn->kn_fop = &kqread_filtops;
170         SLIST_INSERT_HEAD(&kq->kq_sel.si_note, kn, kn_selnext);
171         rel_mplock();
172         return (0);
173 }
174
175 static void
176 filt_kqdetach(struct knote *kn)
177 {
178         struct kqueue *kq = (struct kqueue *)kn->kn_fp->f_data;
179
180         SLIST_REMOVE(&kq->kq_sel.si_note, kn, knote, kn_selnext);
181 }
182
183 /*ARGSUSED*/
184 static int
185 filt_kqueue(struct knote *kn, long hint)
186 {
187         struct kqueue *kq = (struct kqueue *)kn->kn_fp->f_data;
188
189         kn->kn_data = kq->kq_count;
190         return (kn->kn_data > 0);
191 }
192
193 static int
194 filt_procattach(struct knote *kn)
195 {
196         struct proc *p;
197         int immediate;
198
199         immediate = 0;
200         p = pfind(kn->kn_id);
201         if (p == NULL && (kn->kn_sfflags & NOTE_EXIT)) {
202                 p = zpfind(kn->kn_id);
203                 immediate = 1;
204         }
205         if (p == NULL)
206                 return (ESRCH);
207         if (!PRISON_CHECK(curthread->td_ucred, p->p_ucred))
208                 return (EACCES);
209
210         kn->kn_ptr.p_proc = p;
211         kn->kn_flags |= EV_CLEAR;               /* automatically set */
212
213         /*
214          * internal flag indicating registration done by kernel
215          */
216         if (kn->kn_flags & EV_FLAG1) {
217                 kn->kn_data = kn->kn_sdata;             /* ppid */
218                 kn->kn_fflags = NOTE_CHILD;
219                 kn->kn_flags &= ~EV_FLAG1;
220         }
221
222         /* XXX lock the proc here while adding to the list? */
223         SLIST_INSERT_HEAD(&p->p_klist, kn, kn_selnext);
224
225         /*
226          * Immediately activate any exit notes if the target process is a
227          * zombie.  This is necessary to handle the case where the target
228          * process, e.g. a child, dies before the kevent is registered.
229          */
230         if (immediate && filt_proc(kn, NOTE_EXIT))
231                 KNOTE_ACTIVATE(kn);
232
233         return (0);
234 }
235
236 /*
237  * The knote may be attached to a different process, which may exit,
238  * leaving nothing for the knote to be attached to.  So when the process
239  * exits, the knote is marked as DETACHED and also flagged as ONESHOT so
240  * it will be deleted when read out.  However, as part of the knote deletion,
241  * this routine is called, so a check is needed to avoid actually performing
242  * a detach, because the original process does not exist any more.
243  */
244 static void
245 filt_procdetach(struct knote *kn)
246 {
247         struct proc *p;
248
249         if (kn->kn_status & KN_DETACHED)
250                 return;
251         /* XXX locking?  this might modify another process. */
252         p = kn->kn_ptr.p_proc;
253         SLIST_REMOVE(&p->p_klist, kn, knote, kn_selnext);
254 }
255
256 static int
257 filt_proc(struct knote *kn, long hint)
258 {
259         u_int event;
260
261         /*
262          * mask off extra data
263          */
264         event = (u_int)hint & NOTE_PCTRLMASK;
265
266         /*
267          * if the user is interested in this event, record it.
268          */
269         if (kn->kn_sfflags & event)
270                 kn->kn_fflags |= event;
271
272         /*
273          * Process is gone, so flag the event as finished.  Detach the
274          * knote from the process now because the process will be poof,
275          * gone later on.
276          */
277         if (event == NOTE_EXIT) {
278                 struct proc *p = kn->kn_ptr.p_proc;
279                 if ((kn->kn_status & KN_DETACHED) == 0) {
280                         SLIST_REMOVE(&p->p_klist, kn, knote, kn_selnext);
281                         kn->kn_status |= KN_DETACHED;
282                         kn->kn_data = p->p_xstat;
283                         kn->kn_ptr.p_proc = NULL;
284                 }
285                 kn->kn_flags |= (EV_EOF | EV_ONESHOT); 
286                 return (1);
287         }
288
289         /*
290          * process forked, and user wants to track the new process,
291          * so attach a new knote to it, and immediately report an
292          * event with the parent's pid.
293          */
294         if ((event == NOTE_FORK) && (kn->kn_sfflags & NOTE_TRACK)) {
295                 struct kevent kev;
296                 int error;
297
298                 /*
299                  * register knote with new process.
300                  */
301                 kev.ident = hint & NOTE_PDATAMASK;      /* pid */
302                 kev.filter = kn->kn_filter;
303                 kev.flags = kn->kn_flags | EV_ADD | EV_ENABLE | EV_FLAG1;
304                 kev.fflags = kn->kn_sfflags;
305                 kev.data = kn->kn_id;                   /* parent */
306                 kev.udata = kn->kn_kevent.udata;        /* preserve udata */
307                 error = kqueue_register(kn->kn_kq, &kev, NULL);
308                 if (error)
309                         kn->kn_fflags |= NOTE_TRACKERR;
310         }
311
312         return (kn->kn_fflags != 0);
313 }
314
315 static void
316 filt_timerexpire(void *knx)
317 {
318         struct knote *kn = knx;
319         struct callout *calloutp;
320         struct timeval tv;
321         int tticks;
322
323         kn->kn_data++;
324         KNOTE_ACTIVATE(kn);
325
326         if ((kn->kn_flags & EV_ONESHOT) == 0) {
327                 tv.tv_sec = kn->kn_sdata / 1000;
328                 tv.tv_usec = (kn->kn_sdata % 1000) * 1000;
329                 tticks = tvtohz_high(&tv);
330                 calloutp = (struct callout *)kn->kn_hook;
331                 callout_reset(calloutp, tticks, filt_timerexpire, kn);
332         }
333 }
334
335 /*
336  * data contains amount of time to sleep, in milliseconds
337  */ 
338 static int
339 filt_timerattach(struct knote *kn)
340 {
341         struct callout *calloutp;
342         struct timeval tv;
343         int tticks;
344
345         if (kq_ncallouts >= kq_calloutmax)
346                 return (ENOMEM);
347         kq_ncallouts++;
348
349         tv.tv_sec = kn->kn_sdata / 1000;
350         tv.tv_usec = (kn->kn_sdata % 1000) * 1000;
351         tticks = tvtohz_high(&tv);
352
353         kn->kn_flags |= EV_CLEAR;               /* automatically set */
354         MALLOC(calloutp, struct callout *, sizeof(*calloutp),
355             M_KQUEUE, M_WAITOK);
356         callout_init(calloutp);
357         kn->kn_hook = (caddr_t)calloutp;
358         callout_reset(calloutp, tticks, filt_timerexpire, kn);
359
360         return (0);
361 }
362
363 static void
364 filt_timerdetach(struct knote *kn)
365 {
366         struct callout *calloutp;
367
368         calloutp = (struct callout *)kn->kn_hook;
369         callout_stop(calloutp);
370         FREE(calloutp, M_KQUEUE);
371         kq_ncallouts--;
372 }
373
374 static int
375 filt_timer(struct knote *kn, long hint)
376 {
377
378         return (kn->kn_data != 0);
379 }
380
381 /*
382  * MPSAFE
383  */
384 int
385 sys_kqueue(struct kqueue_args *uap)
386 {
387         struct thread *td = curthread;
388         struct kqueue *kq;
389         struct file *fp;
390         int fd, error;
391
392         error = falloc(td->td_lwp, &fp, &fd);
393         if (error)
394                 return (error);
395         fp->f_flag = FREAD | FWRITE;
396         fp->f_type = DTYPE_KQUEUE;
397         fp->f_ops = &kqueueops;
398
399         kq = kmalloc(sizeof(struct kqueue), M_KQUEUE, M_WAITOK | M_ZERO);
400         TAILQ_INIT(&kq->kq_head);
401         kq->kq_fdp = td->td_proc->p_fd;
402         fp->f_data = kq;
403
404         fsetfd(kq->kq_fdp, fp, fd);
405         uap->sysmsg_result = fd;
406         fdrop(fp);
407         return (error);
408 }
409
410 /*
411  * MPALMOSTSAFE
412  */
413 int
414 sys_kevent(struct kevent_args *uap)
415 {
416         struct thread *td = curthread;
417         struct proc *p = td->td_proc;
418         struct kevent *kevp;
419         struct kqueue *kq;
420         struct file *fp = NULL;
421         struct timespec ts;
422         int i, n, nerrors, error;
423
424         fp = holdfp(p->p_fd, uap->fd, -1);
425         if (fp == NULL)
426                 return (EBADF);
427         if (fp->f_type != DTYPE_KQUEUE) {
428                 fdrop(fp);
429                 return (EBADF);
430         }
431
432         if (uap->timeout != NULL) {
433                 error = copyin(uap->timeout, &ts, sizeof(ts));
434                 if (error)
435                         goto done;
436                 uap->timeout = &ts;
437         }
438
439         kq = (struct kqueue *)fp->f_data;
440         nerrors = 0;
441
442         get_mplock();
443         while (uap->nchanges > 0) {
444                 n = uap->nchanges > KQ_NEVENTS ? KQ_NEVENTS : uap->nchanges;
445                 error = copyin(uap->changelist, kq->kq_kev,
446                                n * sizeof(struct kevent));
447                 if (error)
448                         goto done;
449                 for (i = 0; i < n; i++) {
450                         kevp = &kq->kq_kev[i];
451                         kevp->flags &= ~EV_SYSFLAGS;
452                         error = kqueue_register(kq, kevp, td);
453                         if (error) {
454                                 if (uap->nevents != 0) {
455                                         kevp->flags = EV_ERROR;
456                                         kevp->data = error;
457                                         (void) copyout((caddr_t)kevp,
458                                             (caddr_t)uap->eventlist,
459                                             sizeof(*kevp));
460                                         uap->eventlist++;
461                                         uap->nevents--;
462                                         nerrors++;
463                                 } else {
464                                         goto done;
465                                 }
466                         }
467                 }
468                 uap->nchanges -= n;
469                 uap->changelist += n;
470         }
471         if (nerrors) {
472                 uap->sysmsg_result = nerrors;
473                 error = 0;
474                 goto done;
475         }
476
477         error = kqueue_scan(fp, uap->nevents, uap->eventlist,
478                             uap->timeout, td, &uap->sysmsg_result);
479 done:
480         rel_mplock();
481         if (fp != NULL)
482                 fdrop(fp);
483         return (error);
484 }
485
486 int
487 kqueue_register(struct kqueue *kq, struct kevent *kev, struct thread *td)
488 {
489         struct filedesc *fdp = kq->kq_fdp;
490         struct filterops *fops;
491         struct file *fp = NULL;
492         struct knote *kn = NULL;
493         int error = 0;
494
495         if (kev->filter < 0) {
496                 if (kev->filter + EVFILT_SYSCOUNT < 0)
497                         return (EINVAL);
498                 fops = sysfilt_ops[~kev->filter];       /* to 0-base index */
499         } else {
500                 /*
501                  * XXX
502                  * filter attach routine is responsible for insuring that
503                  * the identifier can be attached to it.
504                  */
505                 kprintf("unknown filter: %d\n", kev->filter);
506                 return (EINVAL);
507         }
508
509         if (fops->f_isfd) {
510                 /* validate descriptor */
511                 fp = holdfp(fdp, kev->ident, -1);
512                 if (fp == NULL)
513                         return (EBADF);
514
515                 if (kev->ident < fdp->fd_knlistsize) {
516                         SLIST_FOREACH(kn, &fdp->fd_knlist[kev->ident], kn_link)
517                                 if (kq == kn->kn_kq &&
518                                     kev->filter == kn->kn_filter)
519                                         break;
520                 }
521         } else {
522                 if (fdp->fd_knhashmask != 0) {
523                         struct klist *list;
524                         
525                         list = &fdp->fd_knhash[
526                             KN_HASH((u_long)kev->ident, fdp->fd_knhashmask)];
527                         SLIST_FOREACH(kn, list, kn_link)
528                                 if (kev->ident == kn->kn_id &&
529                                     kq == kn->kn_kq &&
530                                     kev->filter == kn->kn_filter)
531                                         break;
532                 }
533         }
534
535         if (kn == NULL && ((kev->flags & EV_ADD) == 0)) {
536                 error = ENOENT;
537                 goto done;
538         }
539
540         /*
541          * kn now contains the matching knote, or NULL if no match
542          */
543         if (kev->flags & EV_ADD) {
544
545                 if (kn == NULL) {
546                         kn = knote_alloc();
547                         if (kn == NULL) {
548                                 error = ENOMEM;
549                                 goto done;
550                         }
551                         kn->kn_fp = fp;
552                         kn->kn_kq = kq;
553                         kn->kn_fop = fops;
554
555                         /*
556                          * apply reference count to knote structure, and
557                          * do not release it at the end of this routine.
558                          */
559                         fp = NULL;
560
561                         kn->kn_sfflags = kev->fflags;
562                         kn->kn_sdata = kev->data;
563                         kev->fflags = 0;
564                         kev->data = 0;
565                         kn->kn_kevent = *kev;
566
567                         knote_attach(kn, fdp);
568                         if ((error = fops->f_attach(kn)) != 0) {
569                                 knote_drop(kn, td);
570                                 goto done;
571                         }
572                 } else {
573                         /*
574                          * The user may change some filter values after the
575                          * initial EV_ADD, but doing so will not reset any 
576                          * filter which have already been triggered.
577                          */
578                         kn->kn_sfflags = kev->fflags;
579                         kn->kn_sdata = kev->data;
580                         kn->kn_kevent.udata = kev->udata;
581                 }
582
583                 crit_enter();
584                 if (kn->kn_fop->f_event(kn, 0))
585                         KNOTE_ACTIVATE(kn);
586                 crit_exit();
587         } else if (kev->flags & EV_DELETE) {
588                 kn->kn_fop->f_detach(kn);
589                 knote_drop(kn, td);
590                 goto done;
591         }
592
593         if ((kev->flags & EV_DISABLE) &&
594             ((kn->kn_status & KN_DISABLED) == 0)) {
595                 crit_enter();
596                 kn->kn_status |= KN_DISABLED;
597                 crit_exit();
598         }
599
600         if ((kev->flags & EV_ENABLE) && (kn->kn_status & KN_DISABLED)) {
601                 crit_enter();
602                 kn->kn_status &= ~KN_DISABLED;
603                 if ((kn->kn_status & KN_ACTIVE) &&
604                     ((kn->kn_status & KN_QUEUED) == 0))
605                         knote_enqueue(kn);
606                 crit_exit();
607         }
608
609 done:
610         if (fp != NULL)
611                 fdrop(fp);
612         return (error);
613 }
614
615 static int
616 kqueue_scan(struct file *fp, int maxevents, struct kevent *ulistp,
617         const struct timespec *tsp, struct thread *td, int *res)
618 {
619         struct kqueue *kq = (struct kqueue *)fp->f_data;
620         struct kevent *kevp;
621         struct timeval atv, rtv, ttv;
622         struct knote *kn, marker;
623         int count, timeout, nkev = 0, error = 0;
624
625         count = maxevents;
626         if (count == 0)
627                 goto done;
628
629         if (tsp != NULL) {
630                 TIMESPEC_TO_TIMEVAL(&atv, tsp);
631                 if (itimerfix(&atv)) {
632                         error = EINVAL;
633                         goto done;
634                 }
635                 if (tsp->tv_sec == 0 && tsp->tv_nsec == 0)
636                         timeout = -1;
637                 else 
638                         timeout = atv.tv_sec > 24 * 60 * 60 ?
639                             24 * 60 * 60 * hz : tvtohz_high(&atv);
640                 getmicrouptime(&rtv);
641                 timevaladd(&atv, &rtv);
642         } else {
643                 atv.tv_sec = 0;
644                 atv.tv_usec = 0;
645                 timeout = 0;
646         }
647         goto start;
648
649 retry:
650         if (atv.tv_sec || atv.tv_usec) {
651                 getmicrouptime(&rtv);
652                 if (timevalcmp(&rtv, &atv, >=))
653                         goto done;
654                 ttv = atv;
655                 timevalsub(&ttv, &rtv);
656                 timeout = ttv.tv_sec > 24 * 60 * 60 ?
657                         24 * 60 * 60 * hz : tvtohz_high(&ttv);
658         }
659
660 start:
661         kevp = kq->kq_kev;
662         crit_enter();
663         if (kq->kq_count == 0) {
664                 if (timeout < 0) { 
665                         error = EWOULDBLOCK;
666                 } else {
667                         kq->kq_state |= KQ_SLEEP;
668                         error = tsleep(kq, PCATCH, "kqread", timeout);
669                 }
670                 crit_exit();
671                 if (error == 0)
672                         goto retry;
673                 /* don't restart after signals... */
674                 if (error == ERESTART)
675                         error = EINTR;
676                 else if (error == EWOULDBLOCK)
677                         error = 0;
678                 goto done;
679         }
680
681         TAILQ_INSERT_TAIL(&kq->kq_head, &marker, kn_tqe); 
682         while (count) {
683                 kn = TAILQ_FIRST(&kq->kq_head);
684                 TAILQ_REMOVE(&kq->kq_head, kn, kn_tqe); 
685                 if (kn == &marker) {
686                         crit_exit();
687                         if (count == maxevents)
688                                 goto retry;
689                         goto done;
690                 }
691                 if (kn->kn_status & KN_DISABLED) {
692                         kn->kn_status &= ~KN_QUEUED;
693                         kq->kq_count--;
694                         continue;
695                 }
696                 if ((kn->kn_flags & EV_ONESHOT) == 0 &&
697                     kn->kn_fop->f_event(kn, 0) == 0) {
698                         kn->kn_status &= ~(KN_QUEUED | KN_ACTIVE);
699                         kq->kq_count--;
700                         continue;
701                 }
702                 *kevp = kn->kn_kevent;
703                 kevp++;
704                 nkev++;
705                 if (kn->kn_flags & EV_ONESHOT) {
706                         kn->kn_status &= ~KN_QUEUED;
707                         kq->kq_count--;
708                         crit_exit();
709                         kn->kn_fop->f_detach(kn);
710                         knote_drop(kn, td);
711                         crit_enter();
712                 } else if (kn->kn_flags & EV_CLEAR) {
713                         kn->kn_data = 0;
714                         kn->kn_fflags = 0;
715                         kn->kn_status &= ~(KN_QUEUED | KN_ACTIVE);
716                         kq->kq_count--;
717                 } else {
718                         TAILQ_INSERT_TAIL(&kq->kq_head, kn, kn_tqe); 
719                 }
720                 count--;
721                 if (nkev == KQ_NEVENTS) {
722                         crit_exit();
723                         error = copyout((caddr_t)&kq->kq_kev, (caddr_t)ulistp,
724                             sizeof(struct kevent) * nkev);
725                         ulistp += nkev;
726                         nkev = 0;
727                         kevp = kq->kq_kev;
728                         crit_enter();
729                         if (error)
730                                 break;
731                 }
732         }
733         TAILQ_REMOVE(&kq->kq_head, &marker, kn_tqe); 
734         crit_exit();
735 done:
736         if (nkev != 0)
737                 error = copyout((caddr_t)&kq->kq_kev, (caddr_t)ulistp,
738                     sizeof(struct kevent) * nkev);
739         *res = maxevents - count;
740         return (error);
741 }
742
743 /*
744  * XXX
745  * This could be expanded to call kqueue_scan, if desired.
746  *
747  * MPSAFE
748  */
749 static int
750 kqueue_read(struct file *fp, struct uio *uio, struct ucred *cred, int flags)
751 {
752         return (ENXIO);
753 }
754
755 /*
756  * MPSAFE
757  */
758 static int
759 kqueue_write(struct file *fp, struct uio *uio, struct ucred *cred, int flags)
760 {
761         return (ENXIO);
762 }
763
764 /*
765  * MPSAFE
766  */
767 static int
768 kqueue_ioctl(struct file *fp, u_long com, caddr_t data,
769              struct ucred *cred, struct sysmsg *msg)
770 {
771         struct kqueue *kq;
772         int error;
773
774         get_mplock();
775         kq = (struct kqueue *)fp->f_data;
776
777         switch(com) {
778         case FIOASYNC:
779                 if (*(int *)data)
780                         kq->kq_state |= KQ_ASYNC;
781                 else
782                         kq->kq_state &= ~KQ_ASYNC;
783                 error = 0;
784                 break;
785         case FIOSETOWN:
786                 error = fsetown(*(int *)data, &kq->kq_sigio);
787                 break;
788         default:
789                 error = ENOTTY;
790                 break;
791         }
792         rel_mplock();
793         return (error);
794 }
795
796 /*
797  * MPALMOSTSAFE - acquires mplock
798  */
799 static int
800 kqueue_poll(struct file *fp, int events, struct ucred *cred)
801 {
802         struct kqueue *kq = (struct kqueue *)fp->f_data;
803         int revents = 0;
804
805         get_mplock();
806         crit_enter();
807         if (events & (POLLIN | POLLRDNORM)) {
808                 if (kq->kq_count) {
809                         revents |= events & (POLLIN | POLLRDNORM);
810                 } else {
811                         selrecord(curthread, &kq->kq_sel);
812                         kq->kq_state |= KQ_SEL;
813                 }
814         }
815         crit_exit();
816         rel_mplock();
817         return (revents);
818 }
819
820 /*
821  * MPSAFE
822  */
823 static int
824 kqueue_stat(struct file *fp, struct stat *st, struct ucred *cred)
825 {
826         struct kqueue *kq = (struct kqueue *)fp->f_data;
827
828         bzero((void *)st, sizeof(*st));
829         st->st_size = kq->kq_count;
830         st->st_blksize = sizeof(struct kevent);
831         st->st_mode = S_IFIFO;
832         return (0);
833 }
834
835 /*
836  * MPALMOSTSAFE - acquires mplock
837  */
838 static int
839 kqueue_close(struct file *fp)
840 {
841         struct thread *td = curthread;
842         struct proc *p = td->td_proc;
843         struct kqueue *kq = (struct kqueue *)fp->f_data;
844         struct filedesc *fdp;
845         struct knote **knp, *kn, *kn0;
846         int i;
847
848         KKASSERT(p);
849         get_mplock();
850         fdp = p->p_fd;
851         for (i = 0; i < fdp->fd_knlistsize; i++) {
852                 knp = &SLIST_FIRST(&fdp->fd_knlist[i]);
853                 kn = *knp;
854                 while (kn != NULL) {
855                         kn0 = SLIST_NEXT(kn, kn_link);
856                         if (kq == kn->kn_kq) {
857                                 kn->kn_fop->f_detach(kn);
858                                 fdrop(kn->kn_fp);
859                                 knote_free(kn);
860                                 *knp = kn0;
861                         } else {
862                                 knp = &SLIST_NEXT(kn, kn_link);
863                         }
864                         kn = kn0;
865                 }
866         }
867         if (fdp->fd_knhashmask != 0) {
868                 for (i = 0; i < fdp->fd_knhashmask + 1; i++) {
869                         knp = &SLIST_FIRST(&fdp->fd_knhash[i]);
870                         kn = *knp;
871                         while (kn != NULL) {
872                                 kn0 = SLIST_NEXT(kn, kn_link);
873                                 if (kq == kn->kn_kq) {
874                                         kn->kn_fop->f_detach(kn);
875                 /* XXX non-fd release of kn->kn_ptr */
876                                         knote_free(kn);
877                                         *knp = kn0;
878                                 } else {
879                                         knp = &SLIST_NEXT(kn, kn_link);
880                                 }
881                                 kn = kn0;
882                         }
883                 }
884         }
885         fp->f_data = NULL;
886         funsetown(kq->kq_sigio);
887         rel_mplock();
888
889         kfree(kq, M_KQUEUE);
890         return (0);
891 }
892
893 static void
894 kqueue_wakeup(struct kqueue *kq)
895 {
896         if (kq->kq_state & KQ_SLEEP) {
897                 kq->kq_state &= ~KQ_SLEEP;
898                 wakeup(kq);
899         }
900         if (kq->kq_state & KQ_SEL) {
901                 kq->kq_state &= ~KQ_SEL;
902                 selwakeup(&kq->kq_sel);
903         }
904         KNOTE(&kq->kq_sel.si_note, 0);
905 }
906
907 /*
908  * walk down a list of knotes, activating them if their event has triggered.
909  */
910 void
911 knote(struct klist *list, long hint)
912 {
913         struct knote *kn;
914
915         SLIST_FOREACH(kn, list, kn_selnext)
916                 if (kn->kn_fop->f_event(kn, hint))
917                         KNOTE_ACTIVATE(kn);
918 }
919
920 /*
921  * remove all knotes from a specified klist
922  */
923 void
924 knote_remove(struct thread *td, struct klist *list)
925 {
926         struct knote *kn;
927
928         while ((kn = SLIST_FIRST(list)) != NULL) {
929                 kn->kn_fop->f_detach(kn);
930                 knote_drop(kn, td);
931         }
932 }
933
934 /*
935  * remove all knotes referencing a specified fd
936  */
937 void
938 knote_fdclose(struct proc *p, int fd)
939 {
940         struct filedesc *fdp = p->p_fd;
941         struct klist *list = &fdp->fd_knlist[fd];
942         /* Take any thread of p */
943         struct thread *td = FIRST_LWP_IN_PROC(p)->lwp_thread;
944
945         knote_remove(td, list);
946 }
947
948 static void
949 knote_attach(struct knote *kn, struct filedesc *fdp)
950 {
951         struct klist *list;
952         int size;
953
954         if (! kn->kn_fop->f_isfd) {
955                 if (fdp->fd_knhashmask == 0)
956                         fdp->fd_knhash = hashinit(KN_HASHSIZE, M_KQUEUE,
957                             &fdp->fd_knhashmask);
958                 list = &fdp->fd_knhash[KN_HASH(kn->kn_id, fdp->fd_knhashmask)];
959                 goto done;
960         }
961
962         if (fdp->fd_knlistsize <= kn->kn_id) {
963                 size = fdp->fd_knlistsize;
964                 while (size <= kn->kn_id)
965                         size += KQEXTENT;
966                 MALLOC(list, struct klist *,
967                     size * sizeof(struct klist *), M_KQUEUE, M_WAITOK);
968                 bcopy((caddr_t)fdp->fd_knlist, (caddr_t)list,
969                     fdp->fd_knlistsize * sizeof(struct klist *));
970                 bzero((caddr_t)list +
971                     fdp->fd_knlistsize * sizeof(struct klist *),
972                     (size - fdp->fd_knlistsize) * sizeof(struct klist *));
973                 if (fdp->fd_knlist != NULL)
974                         FREE(fdp->fd_knlist, M_KQUEUE);
975                 fdp->fd_knlistsize = size;
976                 fdp->fd_knlist = list;
977         }
978         list = &fdp->fd_knlist[kn->kn_id];
979 done:
980         SLIST_INSERT_HEAD(list, kn, kn_link);
981         kn->kn_status = 0;
982 }
983
984 /*
985  * should be called outside of a critical section, since we don't want to
986  * hold a critical section while calling fdrop and free.
987  */
988 static void
989 knote_drop(struct knote *kn, struct thread *td)
990 {
991         struct filedesc *fdp;
992         struct klist *list;
993
994         KKASSERT(td->td_proc);
995         fdp = td->td_proc->p_fd;
996         if (kn->kn_fop->f_isfd)
997                 list = &fdp->fd_knlist[kn->kn_id];
998         else
999                 list = &fdp->fd_knhash[KN_HASH(kn->kn_id, fdp->fd_knhashmask)];
1000
1001         SLIST_REMOVE(list, kn, knote, kn_link);
1002         if (kn->kn_status & KN_QUEUED)
1003                 knote_dequeue(kn);
1004         if (kn->kn_fop->f_isfd)
1005                 fdrop(kn->kn_fp);
1006         knote_free(kn);
1007 }
1008
1009
1010 static void
1011 knote_enqueue(struct knote *kn)
1012 {
1013         struct kqueue *kq = kn->kn_kq;
1014
1015         crit_enter();
1016         KASSERT((kn->kn_status & KN_QUEUED) == 0, ("knote already queued"));
1017
1018         TAILQ_INSERT_TAIL(&kq->kq_head, kn, kn_tqe); 
1019         kn->kn_status |= KN_QUEUED;
1020         ++kq->kq_count;
1021
1022         /*
1023          * Send SIGIO on request (typically set up as a mailbox signal)
1024          */
1025         if (kq->kq_sigio && (kq->kq_state & KQ_ASYNC) && kq->kq_count == 1)
1026                 pgsigio(kq->kq_sigio, SIGIO, 0);
1027         crit_exit();
1028         kqueue_wakeup(kq);
1029 }
1030
1031 static void
1032 knote_dequeue(struct knote *kn)
1033 {
1034         struct kqueue *kq = kn->kn_kq;
1035
1036         KASSERT(kn->kn_status & KN_QUEUED, ("knote not queued"));
1037         crit_enter();
1038
1039         TAILQ_REMOVE(&kq->kq_head, kn, kn_tqe); 
1040         kn->kn_status &= ~KN_QUEUED;
1041         kq->kq_count--;
1042         crit_exit();
1043 }
1044
1045 static void
1046 knote_init(void)
1047 {
1048         knote_zone = zinit("KNOTE", sizeof(struct knote), 0, 0, 1);
1049 }
1050 SYSINIT(knote, SI_SUB_PSEUDO, SI_ORDER_ANY, knote_init, NULL)
1051
1052 static struct knote *
1053 knote_alloc(void)
1054 {
1055         return ((struct knote *)zalloc(knote_zone));
1056 }
1057
1058 static void
1059 knote_free(struct knote *kn)
1060 {
1061         zfree(knote_zone, kn);
1062 }