sys_select.c revision 1.17 1 1.17 rmind /* $NetBSD: sys_select.c,v 1.17 2009/11/01 21:14:21 rmind Exp $ */
2 1.1 ad
3 1.1 ad /*-
4 1.13 ad * Copyright (c) 2007, 2008, 2009 The NetBSD Foundation, Inc.
5 1.1 ad * All rights reserved.
6 1.1 ad *
7 1.1 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.1 ad * by Andrew Doran.
9 1.1 ad *
10 1.1 ad * Redistribution and use in source and binary forms, with or without
11 1.1 ad * modification, are permitted provided that the following conditions
12 1.1 ad * are met:
13 1.1 ad * 1. Redistributions of source code must retain the above copyright
14 1.1 ad * notice, this list of conditions and the following disclaimer.
15 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 ad * notice, this list of conditions and the following disclaimer in the
17 1.1 ad * documentation and/or other materials provided with the distribution.
18 1.1 ad *
19 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 ad * POSSIBILITY OF SUCH DAMAGE.
30 1.1 ad */
31 1.1 ad
32 1.1 ad /*
33 1.1 ad * Copyright (c) 1982, 1986, 1989, 1993
34 1.1 ad * The Regents of the University of California. All rights reserved.
35 1.1 ad * (c) UNIX System Laboratories, Inc.
36 1.1 ad * All or some portions of this file are derived from material licensed
37 1.1 ad * to the University of California by American Telephone and Telegraph
38 1.1 ad * Co. or Unix System Laboratories, Inc. and are reproduced herein with
39 1.1 ad * the permission of UNIX System Laboratories, Inc.
40 1.1 ad *
41 1.1 ad * Redistribution and use in source and binary forms, with or without
42 1.1 ad * modification, are permitted provided that the following conditions
43 1.1 ad * are met:
44 1.1 ad * 1. Redistributions of source code must retain the above copyright
45 1.1 ad * notice, this list of conditions and the following disclaimer.
46 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
47 1.1 ad * notice, this list of conditions and the following disclaimer in the
48 1.1 ad * documentation and/or other materials provided with the distribution.
49 1.1 ad * 3. Neither the name of the University nor the names of its contributors
50 1.1 ad * may be used to endorse or promote products derived from this software
51 1.1 ad * without specific prior written permission.
52 1.1 ad *
53 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
54 1.1 ad * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
55 1.1 ad * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
56 1.1 ad * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
57 1.1 ad * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
58 1.1 ad * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
59 1.1 ad * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
60 1.1 ad * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
61 1.1 ad * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
62 1.1 ad * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
63 1.1 ad * SUCH DAMAGE.
64 1.1 ad *
65 1.1 ad * @(#)sys_generic.c 8.9 (Berkeley) 2/14/95
66 1.1 ad */
67 1.1 ad
68 1.1 ad /*
69 1.1 ad * System calls relating to files.
70 1.1 ad */
71 1.1 ad
72 1.1 ad #include <sys/cdefs.h>
73 1.17 rmind __KERNEL_RCSID(0, "$NetBSD: sys_select.c,v 1.17 2009/11/01 21:14:21 rmind Exp $");
74 1.1 ad
75 1.1 ad #include <sys/param.h>
76 1.1 ad #include <sys/systm.h>
77 1.1 ad #include <sys/filedesc.h>
78 1.1 ad #include <sys/ioctl.h>
79 1.1 ad #include <sys/file.h>
80 1.1 ad #include <sys/proc.h>
81 1.1 ad #include <sys/socketvar.h>
82 1.1 ad #include <sys/signalvar.h>
83 1.1 ad #include <sys/uio.h>
84 1.1 ad #include <sys/kernel.h>
85 1.1 ad #include <sys/stat.h>
86 1.1 ad #include <sys/poll.h>
87 1.1 ad #include <sys/vnode.h>
88 1.1 ad #include <sys/mount.h>
89 1.1 ad #include <sys/syscallargs.h>
90 1.1 ad #include <sys/cpu.h>
91 1.1 ad #include <sys/atomic.h>
92 1.1 ad #include <sys/socketvar.h>
93 1.1 ad #include <sys/sleepq.h>
94 1.1 ad
95 1.1 ad /* Flags for lwp::l_selflag. */
96 1.1 ad #define SEL_RESET 0 /* awoken, interrupted, or not yet polling */
97 1.1 ad #define SEL_SCANNING 1 /* polling descriptors */
98 1.1 ad #define SEL_BLOCKING 2 /* about to block on select_cv */
99 1.1 ad
100 1.1 ad /* Per-CPU state for select()/poll(). */
101 1.1 ad #if MAXCPUS > 32
102 1.1 ad #error adjust this code
103 1.1 ad #endif
104 1.1 ad typedef struct selcpu {
105 1.13 ad kmutex_t *sc_lock;
106 1.1 ad sleepq_t sc_sleepq;
107 1.1 ad int sc_ncoll;
108 1.1 ad uint32_t sc_mask;
109 1.1 ad } selcpu_t;
110 1.1 ad
111 1.17 rmind static int selscan(char *, u_int, register_t *);
112 1.17 rmind static int pollscan(struct pollfd *, u_int, register_t *);
113 1.1 ad static void selclear(void);
114 1.1 ad
115 1.1 ad static syncobj_t select_sobj = {
116 1.1 ad SOBJ_SLEEPQ_FIFO,
117 1.1 ad sleepq_unsleep,
118 1.1 ad sleepq_changepri,
119 1.1 ad sleepq_lendpri,
120 1.1 ad syncobj_noowner,
121 1.1 ad };
122 1.1 ad
123 1.1 ad /*
124 1.1 ad * Select system call.
125 1.1 ad */
126 1.1 ad int
127 1.12 christos sys___pselect50(struct lwp *l, const struct sys___pselect50_args *uap,
128 1.12 christos register_t *retval)
129 1.1 ad {
130 1.1 ad /* {
131 1.1 ad syscallarg(int) nd;
132 1.1 ad syscallarg(fd_set *) in;
133 1.1 ad syscallarg(fd_set *) ou;
134 1.1 ad syscallarg(fd_set *) ex;
135 1.1 ad syscallarg(const struct timespec *) ts;
136 1.1 ad syscallarg(sigset_t *) mask;
137 1.1 ad } */
138 1.14 christos struct timespec ats, *ts = NULL;
139 1.1 ad sigset_t amask, *mask = NULL;
140 1.1 ad int error;
141 1.1 ad
142 1.1 ad if (SCARG(uap, ts)) {
143 1.1 ad error = copyin(SCARG(uap, ts), &ats, sizeof(ats));
144 1.1 ad if (error)
145 1.1 ad return error;
146 1.14 christos ts = &ats;
147 1.1 ad }
148 1.1 ad if (SCARG(uap, mask) != NULL) {
149 1.1 ad error = copyin(SCARG(uap, mask), &amask, sizeof(amask));
150 1.1 ad if (error)
151 1.1 ad return error;
152 1.1 ad mask = &amask;
153 1.1 ad }
154 1.1 ad
155 1.1 ad return selcommon(l, retval, SCARG(uap, nd), SCARG(uap, in),
156 1.14 christos SCARG(uap, ou), SCARG(uap, ex), ts, mask);
157 1.1 ad }
158 1.1 ad
159 1.1 ad int
160 1.14 christos inittimeleft(struct timespec *ts, struct timespec *sleepts)
161 1.1 ad {
162 1.14 christos if (itimespecfix(ts))
163 1.1 ad return -1;
164 1.14 christos getnanouptime(sleepts);
165 1.1 ad return 0;
166 1.1 ad }
167 1.1 ad
168 1.1 ad int
169 1.14 christos gettimeleft(struct timespec *ts, struct timespec *sleepts)
170 1.1 ad {
171 1.1 ad /*
172 1.1 ad * We have to recalculate the timeout on every retry.
173 1.1 ad */
174 1.14 christos struct timespec sleptts;
175 1.1 ad /*
176 1.14 christos * reduce ts by elapsed time
177 1.1 ad * based on monotonic time scale
178 1.1 ad */
179 1.14 christos getnanouptime(&sleptts);
180 1.14 christos timespecadd(ts, sleepts, ts);
181 1.14 christos timespecsub(ts, &sleptts, ts);
182 1.14 christos *sleepts = sleptts;
183 1.14 christos return tstohz(ts);
184 1.1 ad }
185 1.1 ad
186 1.1 ad int
187 1.12 christos sys___select50(struct lwp *l, const struct sys___select50_args *uap,
188 1.12 christos register_t *retval)
189 1.1 ad {
190 1.1 ad /* {
191 1.1 ad syscallarg(int) nd;
192 1.1 ad syscallarg(fd_set *) in;
193 1.1 ad syscallarg(fd_set *) ou;
194 1.1 ad syscallarg(fd_set *) ex;
195 1.1 ad syscallarg(struct timeval *) tv;
196 1.1 ad } */
197 1.14 christos struct timeval atv;
198 1.14 christos struct timespec ats, *ts = NULL;
199 1.1 ad int error;
200 1.1 ad
201 1.1 ad if (SCARG(uap, tv)) {
202 1.14 christos error = copyin(SCARG(uap, tv), (void *)&atv, sizeof(atv));
203 1.1 ad if (error)
204 1.1 ad return error;
205 1.14 christos TIMEVAL_TO_TIMESPEC(&atv, &ats);
206 1.14 christos ts = &ats;
207 1.1 ad }
208 1.1 ad
209 1.1 ad return selcommon(l, retval, SCARG(uap, nd), SCARG(uap, in),
210 1.14 christos SCARG(uap, ou), SCARG(uap, ex), ts, NULL);
211 1.1 ad }
212 1.1 ad
213 1.17 rmind /*
214 1.17 rmind * sel_do_scan: common code to perform the scan on descriptors.
215 1.17 rmind */
216 1.17 rmind static int
217 1.17 rmind sel_do_scan(void *fds, u_int nfds, struct timespec *ts, sigset_t *mask,
218 1.17 rmind register_t *retval, int selpoll)
219 1.1 ad {
220 1.17 rmind lwp_t * const l = curlwp;
221 1.1 ad proc_t * const p = l->l_proc;
222 1.1 ad selcpu_t *sc;
223 1.13 ad kmutex_t *lock;
224 1.17 rmind sigset_t oldmask;
225 1.17 rmind struct timespec sleepts;
226 1.17 rmind int error, timo;
227 1.1 ad
228 1.1 ad timo = 0;
229 1.14 christos if (ts && inittimeleft(ts, &sleepts) == -1) {
230 1.17 rmind return EINVAL;
231 1.1 ad }
232 1.1 ad
233 1.17 rmind if (__predict_false(mask)) {
234 1.1 ad sigminusset(&sigcantmask, mask);
235 1.5 ad mutex_enter(p->p_lock);
236 1.1 ad oldmask = l->l_sigmask;
237 1.1 ad l->l_sigmask = *mask;
238 1.5 ad mutex_exit(p->p_lock);
239 1.17 rmind } else {
240 1.17 rmind /* XXXgcc */
241 1.17 rmind oldmask = l->l_sigmask;
242 1.17 rmind }
243 1.1 ad
244 1.1 ad sc = curcpu()->ci_data.cpu_selcpu;
245 1.13 ad lock = sc->sc_lock;
246 1.1 ad l->l_selcpu = sc;
247 1.1 ad SLIST_INIT(&l->l_selwait);
248 1.1 ad for (;;) {
249 1.17 rmind int ncoll;
250 1.17 rmind
251 1.1 ad /*
252 1.17 rmind * No need to lock. If this is overwritten by another value
253 1.17 rmind * while scanning, we will retry below. We only need to see
254 1.17 rmind * exact state from the descriptors that we are about to poll,
255 1.17 rmind * and lock activity resulting from fo_poll is enough to
256 1.17 rmind * provide an up to date value for new polling activity.
257 1.1 ad */
258 1.17 rmind l->l_selflag = SEL_SCANNING;
259 1.1 ad ncoll = sc->sc_ncoll;
260 1.1 ad
261 1.17 rmind if (selpoll) {
262 1.17 rmind error = selscan((char *)fds, nfds, retval);
263 1.17 rmind } else {
264 1.17 rmind error = pollscan((struct pollfd *)fds, nfds, retval);
265 1.17 rmind }
266 1.1 ad
267 1.1 ad if (error || *retval)
268 1.1 ad break;
269 1.14 christos if (ts && (timo = gettimeleft(ts, &sleepts)) <= 0)
270 1.1 ad break;
271 1.13 ad mutex_spin_enter(lock);
272 1.1 ad if (l->l_selflag != SEL_SCANNING || sc->sc_ncoll != ncoll) {
273 1.13 ad mutex_spin_exit(lock);
274 1.1 ad continue;
275 1.1 ad }
276 1.1 ad l->l_selflag = SEL_BLOCKING;
277 1.7 ad l->l_kpriority = true;
278 1.13 ad sleepq_enter(&sc->sc_sleepq, l, lock);
279 1.1 ad sleepq_enqueue(&sc->sc_sleepq, sc, "select", &select_sobj);
280 1.1 ad error = sleepq_block(timo, true);
281 1.1 ad if (error != 0)
282 1.1 ad break;
283 1.1 ad }
284 1.1 ad selclear();
285 1.1 ad
286 1.17 rmind if (__predict_false(mask)) {
287 1.5 ad mutex_enter(p->p_lock);
288 1.1 ad l->l_sigmask = oldmask;
289 1.5 ad mutex_exit(p->p_lock);
290 1.1 ad }
291 1.17 rmind return error;
292 1.17 rmind }
293 1.17 rmind
294 1.17 rmind int
295 1.17 rmind selcommon(lwp_t *l, register_t *retval, int nd, fd_set *u_in,
296 1.17 rmind fd_set *u_ou, fd_set *u_ex, struct timespec *ts, sigset_t *mask)
297 1.17 rmind {
298 1.17 rmind char smallbits[howmany(FD_SETSIZE, NFDBITS) *
299 1.17 rmind sizeof(fd_mask) * 6];
300 1.17 rmind proc_t * const p = l->l_proc;
301 1.17 rmind char *bits;
302 1.17 rmind int error, nf;
303 1.17 rmind size_t ni;
304 1.17 rmind
305 1.17 rmind if (nd < 0)
306 1.17 rmind return (EINVAL);
307 1.17 rmind nf = p->p_fd->fd_dt->dt_nfiles;
308 1.17 rmind if (nd > nf) {
309 1.17 rmind /* forgiving; slightly wrong */
310 1.17 rmind nd = nf;
311 1.17 rmind }
312 1.17 rmind ni = howmany(nd, NFDBITS) * sizeof(fd_mask);
313 1.17 rmind if (ni * 6 > sizeof(smallbits)) {
314 1.17 rmind bits = kmem_alloc(ni * 6, KM_SLEEP);
315 1.17 rmind if (bits == NULL)
316 1.17 rmind return ENOMEM;
317 1.17 rmind } else
318 1.17 rmind bits = smallbits;
319 1.17 rmind
320 1.17 rmind #define getbits(name, x) \
321 1.17 rmind if (u_ ## name) { \
322 1.17 rmind error = copyin(u_ ## name, bits + ni * x, ni); \
323 1.17 rmind if (error) \
324 1.17 rmind goto done; \
325 1.17 rmind } else \
326 1.17 rmind memset(bits + ni * x, 0, ni);
327 1.17 rmind getbits(in, 0);
328 1.17 rmind getbits(ou, 1);
329 1.17 rmind getbits(ex, 2);
330 1.17 rmind #undef getbits
331 1.1 ad
332 1.17 rmind error = sel_do_scan(bits, nd, ts, mask, retval, 1);
333 1.1 ad done:
334 1.1 ad /* select is not restarted after signals... */
335 1.1 ad if (error == ERESTART)
336 1.1 ad error = EINTR;
337 1.1 ad if (error == EWOULDBLOCK)
338 1.1 ad error = 0;
339 1.1 ad if (error == 0 && u_in != NULL)
340 1.1 ad error = copyout(bits + ni * 3, u_in, ni);
341 1.1 ad if (error == 0 && u_ou != NULL)
342 1.1 ad error = copyout(bits + ni * 4, u_ou, ni);
343 1.1 ad if (error == 0 && u_ex != NULL)
344 1.1 ad error = copyout(bits + ni * 5, u_ex, ni);
345 1.1 ad if (bits != smallbits)
346 1.1 ad kmem_free(bits, ni * 6);
347 1.1 ad return (error);
348 1.1 ad }
349 1.1 ad
350 1.17 rmind static int
351 1.17 rmind selscan(char *bits, u_int nfd, register_t *retval)
352 1.1 ad {
353 1.1 ad static const int flag[3] = { POLLRDNORM | POLLHUP | POLLERR,
354 1.1 ad POLLWRNORM | POLLHUP | POLLERR,
355 1.1 ad POLLRDBAND };
356 1.17 rmind fd_mask *ibitp, *obitp;
357 1.17 rmind int msk, i, j, fd, ni, n;
358 1.1 ad fd_mask ibits, obits;
359 1.1 ad file_t *fp;
360 1.1 ad
361 1.17 rmind ni = howmany(nfd, NFDBITS) * sizeof(fd_mask);
362 1.17 rmind ibitp = (fd_mask *)(bits + ni * 0);
363 1.17 rmind obitp = (fd_mask *)(bits + ni * 3);
364 1.1 ad n = 0;
365 1.17 rmind
366 1.1 ad for (msk = 0; msk < 3; msk++) {
367 1.1 ad for (i = 0; i < nfd; i += NFDBITS) {
368 1.1 ad ibits = *ibitp++;
369 1.1 ad obits = 0;
370 1.1 ad while ((j = ffs(ibits)) && (fd = i + --j) < nfd) {
371 1.1 ad ibits &= ~(1 << j);
372 1.1 ad if ((fp = fd_getfile(fd)) == NULL)
373 1.1 ad return (EBADF);
374 1.1 ad if ((*fp->f_ops->fo_poll)(fp, flag[msk])) {
375 1.1 ad obits |= (1 << j);
376 1.1 ad n++;
377 1.1 ad }
378 1.1 ad fd_putfile(fd);
379 1.1 ad }
380 1.1 ad *obitp++ = obits;
381 1.1 ad }
382 1.1 ad }
383 1.1 ad *retval = n;
384 1.1 ad return (0);
385 1.1 ad }
386 1.1 ad
387 1.1 ad /*
388 1.1 ad * Poll system call.
389 1.1 ad */
390 1.1 ad int
391 1.1 ad sys_poll(struct lwp *l, const struct sys_poll_args *uap, register_t *retval)
392 1.1 ad {
393 1.1 ad /* {
394 1.1 ad syscallarg(struct pollfd *) fds;
395 1.1 ad syscallarg(u_int) nfds;
396 1.1 ad syscallarg(int) timeout;
397 1.1 ad } */
398 1.14 christos struct timespec ats, *ts = NULL;
399 1.1 ad
400 1.1 ad if (SCARG(uap, timeout) != INFTIM) {
401 1.14 christos ats.tv_sec = SCARG(uap, timeout) / 1000;
402 1.14 christos ats.tv_nsec = (SCARG(uap, timeout) % 1000) * 1000000;
403 1.14 christos ts = &ats;
404 1.1 ad }
405 1.1 ad
406 1.1 ad return pollcommon(l, retval, SCARG(uap, fds), SCARG(uap, nfds),
407 1.14 christos ts, NULL);
408 1.1 ad }
409 1.1 ad
410 1.1 ad /*
411 1.1 ad * Poll system call.
412 1.1 ad */
413 1.1 ad int
414 1.12 christos sys___pollts50(struct lwp *l, const struct sys___pollts50_args *uap,
415 1.12 christos register_t *retval)
416 1.1 ad {
417 1.1 ad /* {
418 1.1 ad syscallarg(struct pollfd *) fds;
419 1.1 ad syscallarg(u_int) nfds;
420 1.1 ad syscallarg(const struct timespec *) ts;
421 1.1 ad syscallarg(const sigset_t *) mask;
422 1.1 ad } */
423 1.14 christos struct timespec ats, *ts = NULL;
424 1.1 ad sigset_t amask, *mask = NULL;
425 1.1 ad int error;
426 1.1 ad
427 1.1 ad if (SCARG(uap, ts)) {
428 1.1 ad error = copyin(SCARG(uap, ts), &ats, sizeof(ats));
429 1.1 ad if (error)
430 1.1 ad return error;
431 1.14 christos ts = &ats;
432 1.1 ad }
433 1.1 ad if (SCARG(uap, mask)) {
434 1.1 ad error = copyin(SCARG(uap, mask), &amask, sizeof(amask));
435 1.1 ad if (error)
436 1.1 ad return error;
437 1.1 ad mask = &amask;
438 1.1 ad }
439 1.1 ad
440 1.1 ad return pollcommon(l, retval, SCARG(uap, fds), SCARG(uap, nfds),
441 1.14 christos ts, mask);
442 1.1 ad }
443 1.1 ad
444 1.1 ad int
445 1.14 christos pollcommon(lwp_t *l, register_t *retval, struct pollfd *u_fds, u_int nfds,
446 1.14 christos struct timespec *ts, sigset_t *mask)
447 1.1 ad {
448 1.11 yamt struct pollfd smallfds[32];
449 1.11 yamt struct pollfd *fds;
450 1.1 ad proc_t * const p = l->l_proc;
451 1.17 rmind int error;
452 1.15 ad size_t ni, nf;
453 1.1 ad
454 1.15 ad nf = p->p_fd->fd_dt->dt_nfiles;
455 1.15 ad if (nfds > nf) {
456 1.1 ad /* forgiving; slightly wrong */
457 1.15 ad nfds = nf;
458 1.1 ad }
459 1.1 ad ni = nfds * sizeof(struct pollfd);
460 1.11 yamt if (ni > sizeof(smallfds)) {
461 1.11 yamt fds = kmem_alloc(ni, KM_SLEEP);
462 1.11 yamt if (fds == NULL)
463 1.9 rmind return ENOMEM;
464 1.9 rmind } else
465 1.11 yamt fds = smallfds;
466 1.1 ad
467 1.11 yamt error = copyin(u_fds, fds, ni);
468 1.1 ad if (error)
469 1.1 ad goto done;
470 1.1 ad
471 1.17 rmind error = sel_do_scan(fds, nfds, ts, mask, retval, 0);
472 1.1 ad done:
473 1.1 ad /* poll is not restarted after signals... */
474 1.1 ad if (error == ERESTART)
475 1.1 ad error = EINTR;
476 1.1 ad if (error == EWOULDBLOCK)
477 1.1 ad error = 0;
478 1.1 ad if (error == 0)
479 1.11 yamt error = copyout(fds, u_fds, ni);
480 1.11 yamt if (fds != smallfds)
481 1.11 yamt kmem_free(fds, ni);
482 1.1 ad return (error);
483 1.1 ad }
484 1.1 ad
485 1.17 rmind static int
486 1.17 rmind pollscan(struct pollfd *fds, u_int nfd, register_t *retval)
487 1.1 ad {
488 1.1 ad int i, n;
489 1.1 ad file_t *fp;
490 1.1 ad
491 1.1 ad n = 0;
492 1.1 ad for (i = 0; i < nfd; i++, fds++) {
493 1.1 ad if (fds->fd < 0) {
494 1.1 ad fds->revents = 0;
495 1.1 ad } else if ((fp = fd_getfile(fds->fd)) == NULL) {
496 1.1 ad fds->revents = POLLNVAL;
497 1.1 ad n++;
498 1.1 ad } else {
499 1.1 ad fds->revents = (*fp->f_ops->fo_poll)(fp,
500 1.1 ad fds->events | POLLERR | POLLHUP);
501 1.1 ad if (fds->revents != 0)
502 1.1 ad n++;
503 1.1 ad fd_putfile(fds->fd);
504 1.1 ad }
505 1.1 ad }
506 1.1 ad *retval = n;
507 1.1 ad return (0);
508 1.1 ad }
509 1.1 ad
510 1.1 ad /*ARGSUSED*/
511 1.1 ad int
512 1.1 ad seltrue(dev_t dev, int events, lwp_t *l)
513 1.1 ad {
514 1.1 ad
515 1.1 ad return (events & (POLLIN | POLLOUT | POLLRDNORM | POLLWRNORM));
516 1.1 ad }
517 1.1 ad
518 1.1 ad /*
519 1.1 ad * Record a select request. Concurrency issues:
520 1.1 ad *
521 1.1 ad * The caller holds the same lock across calls to selrecord() and
522 1.4 yamt * selnotify(), so we don't need to consider a concurrent wakeup
523 1.1 ad * while in this routine.
524 1.1 ad *
525 1.1 ad * The only activity we need to guard against is selclear(), called by
526 1.17 rmind * another thread that is exiting sel_do_scan().
527 1.1 ad * `sel_lwp' can only become non-NULL while the caller's lock is held,
528 1.1 ad * so it cannot become non-NULL due to a change made by another thread
529 1.1 ad * while we are in this routine. It can only become _NULL_ due to a
530 1.1 ad * call to selclear().
531 1.1 ad *
532 1.1 ad * If it is non-NULL and != selector there is the potential for
533 1.1 ad * selclear() to be called by another thread. If either of those
534 1.1 ad * conditions are true, we're not interested in touching the `named
535 1.1 ad * waiter' part of the selinfo record because we need to record a
536 1.1 ad * collision. Hence there is no need for additional locking in this
537 1.1 ad * routine.
538 1.1 ad */
539 1.1 ad void
540 1.1 ad selrecord(lwp_t *selector, struct selinfo *sip)
541 1.1 ad {
542 1.1 ad selcpu_t *sc;
543 1.1 ad lwp_t *other;
544 1.1 ad
545 1.1 ad KASSERT(selector == curlwp);
546 1.1 ad
547 1.1 ad sc = selector->l_selcpu;
548 1.1 ad other = sip->sel_lwp;
549 1.1 ad
550 1.1 ad if (other == selector) {
551 1.1 ad /* `selector' has already claimed it. */
552 1.1 ad KASSERT(sip->sel_cpu = sc);
553 1.1 ad } else if (other == NULL) {
554 1.1 ad /*
555 1.1 ad * First named waiter, although there may be unnamed
556 1.1 ad * waiters (collisions). Issue a memory barrier to
557 1.1 ad * ensure that we access sel_lwp (above) before other
558 1.1 ad * fields - this guards against a call to selclear().
559 1.1 ad */
560 1.1 ad membar_enter();
561 1.1 ad sip->sel_lwp = selector;
562 1.1 ad SLIST_INSERT_HEAD(&selector->l_selwait, sip, sel_chain);
563 1.1 ad /* Replace selinfo's lock with our chosen CPU's lock. */
564 1.1 ad sip->sel_cpu = sc;
565 1.1 ad } else {
566 1.1 ad /* Multiple waiters: record a collision. */
567 1.1 ad sip->sel_collision |= sc->sc_mask;
568 1.1 ad KASSERT(sip->sel_cpu != NULL);
569 1.1 ad }
570 1.1 ad }
571 1.1 ad
572 1.1 ad /*
573 1.1 ad * Do a wakeup when a selectable event occurs. Concurrency issues:
574 1.1 ad *
575 1.1 ad * As per selrecord(), the caller's object lock is held. If there
576 1.1 ad * is a named waiter, we must acquire the associated selcpu's lock
577 1.1 ad * in order to synchronize with selclear() and pollers going to sleep
578 1.17 rmind * in sel_do_scan().
579 1.1 ad *
580 1.1 ad * sip->sel_cpu cannot change at this point, as it is only changed
581 1.1 ad * in selrecord(), and concurrent calls to selrecord() are locked
582 1.1 ad * out by the caller.
583 1.1 ad */
584 1.1 ad void
585 1.1 ad selnotify(struct selinfo *sip, int events, long knhint)
586 1.1 ad {
587 1.1 ad selcpu_t *sc;
588 1.1 ad uint32_t mask;
589 1.16 rmind int index, oflag;
590 1.1 ad lwp_t *l;
591 1.13 ad kmutex_t *lock;
592 1.1 ad
593 1.1 ad KNOTE(&sip->sel_klist, knhint);
594 1.1 ad
595 1.1 ad if (sip->sel_lwp != NULL) {
596 1.1 ad /* One named LWP is waiting. */
597 1.1 ad sc = sip->sel_cpu;
598 1.13 ad lock = sc->sc_lock;
599 1.13 ad mutex_spin_enter(lock);
600 1.1 ad /* Still there? */
601 1.1 ad if (sip->sel_lwp != NULL) {
602 1.1 ad l = sip->sel_lwp;
603 1.1 ad /*
604 1.1 ad * If thread is sleeping, wake it up. If it's not
605 1.1 ad * yet asleep, it will notice the change in state
606 1.1 ad * and will re-poll the descriptors.
607 1.1 ad */
608 1.1 ad oflag = l->l_selflag;
609 1.1 ad l->l_selflag = SEL_RESET;
610 1.13 ad if (oflag == SEL_BLOCKING && l->l_mutex == lock) {
611 1.1 ad KASSERT(l->l_wchan == sc);
612 1.16 rmind sleepq_unsleep(l, false);
613 1.1 ad }
614 1.1 ad }
615 1.13 ad mutex_spin_exit(lock);
616 1.1 ad }
617 1.1 ad
618 1.1 ad if ((mask = sip->sel_collision) != 0) {
619 1.1 ad /*
620 1.1 ad * There was a collision (multiple waiters): we must
621 1.1 ad * inform all potentially interested waiters.
622 1.1 ad */
623 1.1 ad sip->sel_collision = 0;
624 1.3 ad do {
625 1.1 ad index = ffs(mask) - 1;
626 1.1 ad mask &= ~(1 << index);
627 1.10 ad sc = cpu_lookup(index)->ci_data.cpu_selcpu;
628 1.13 ad lock = sc->sc_lock;
629 1.13 ad mutex_spin_enter(lock);
630 1.1 ad sc->sc_ncoll++;
631 1.13 ad sleepq_wake(&sc->sc_sleepq, sc, (u_int)-1, lock);
632 1.3 ad } while (__predict_false(mask != 0));
633 1.1 ad }
634 1.1 ad }
635 1.1 ad
636 1.1 ad /*
637 1.1 ad * Remove an LWP from all objects that it is waiting for. Concurrency
638 1.1 ad * issues:
639 1.1 ad *
640 1.1 ad * The object owner's (e.g. device driver) lock is not held here. Calls
641 1.1 ad * can be made to selrecord() and we do not synchronize against those
642 1.1 ad * directly using locks. However, we use `sel_lwp' to lock out changes.
643 1.1 ad * Before clearing it we must use memory barriers to ensure that we can
644 1.1 ad * safely traverse the list of selinfo records.
645 1.1 ad */
646 1.1 ad static void
647 1.1 ad selclear(void)
648 1.1 ad {
649 1.1 ad struct selinfo *sip, *next;
650 1.1 ad selcpu_t *sc;
651 1.1 ad lwp_t *l;
652 1.13 ad kmutex_t *lock;
653 1.1 ad
654 1.1 ad l = curlwp;
655 1.1 ad sc = l->l_selcpu;
656 1.13 ad lock = sc->sc_lock;
657 1.1 ad
658 1.13 ad mutex_spin_enter(lock);
659 1.1 ad for (sip = SLIST_FIRST(&l->l_selwait); sip != NULL; sip = next) {
660 1.1 ad KASSERT(sip->sel_lwp == l);
661 1.1 ad KASSERT(sip->sel_cpu == l->l_selcpu);
662 1.1 ad /*
663 1.1 ad * Read link to next selinfo record, if any.
664 1.1 ad * It's no longer safe to touch `sip' after clearing
665 1.1 ad * `sel_lwp', so ensure that the read of `sel_chain'
666 1.1 ad * completes before the clearing of sel_lwp becomes
667 1.1 ad * globally visible.
668 1.1 ad */
669 1.1 ad next = SLIST_NEXT(sip, sel_chain);
670 1.1 ad membar_exit();
671 1.1 ad /* Release the record for another named waiter to use. */
672 1.1 ad sip->sel_lwp = NULL;
673 1.1 ad }
674 1.13 ad mutex_spin_exit(lock);
675 1.1 ad }
676 1.1 ad
677 1.1 ad /*
678 1.1 ad * Initialize the select/poll system calls. Called once for each
679 1.1 ad * CPU in the system, as they are attached.
680 1.1 ad */
681 1.1 ad void
682 1.1 ad selsysinit(struct cpu_info *ci)
683 1.1 ad {
684 1.1 ad selcpu_t *sc;
685 1.1 ad
686 1.2 ad sc = kmem_alloc(roundup2(sizeof(selcpu_t), coherency_unit) +
687 1.2 ad coherency_unit, KM_SLEEP);
688 1.2 ad sc = (void *)roundup2((uintptr_t)sc, coherency_unit);
689 1.13 ad sc->sc_lock = mutex_obj_alloc(MUTEX_DEFAULT, IPL_SCHED);
690 1.8 ad sleepq_init(&sc->sc_sleepq);
691 1.1 ad sc->sc_ncoll = 0;
692 1.1 ad sc->sc_mask = (1 << cpu_index(ci));
693 1.1 ad ci->ci_data.cpu_selcpu = sc;
694 1.1 ad }
695 1.1 ad
696 1.1 ad /*
697 1.1 ad * Initialize a selinfo record.
698 1.1 ad */
699 1.1 ad void
700 1.1 ad selinit(struct selinfo *sip)
701 1.1 ad {
702 1.1 ad
703 1.1 ad memset(sip, 0, sizeof(*sip));
704 1.1 ad }
705 1.1 ad
706 1.1 ad /*
707 1.1 ad * Destroy a selinfo record. The owning object must not gain new
708 1.1 ad * references while this is in progress: all activity on the record
709 1.1 ad * must be stopped.
710 1.1 ad *
711 1.1 ad * Concurrency issues: we only need guard against a call to selclear()
712 1.17 rmind * by a thread exiting sel_do_scan(). The caller has prevented further
713 1.17 rmind * references being made to the selinfo record via selrecord(), and it
714 1.17 rmind * won't call selwakeup() again.
715 1.1 ad */
716 1.1 ad void
717 1.1 ad seldestroy(struct selinfo *sip)
718 1.1 ad {
719 1.1 ad selcpu_t *sc;
720 1.13 ad kmutex_t *lock;
721 1.1 ad lwp_t *l;
722 1.1 ad
723 1.1 ad if (sip->sel_lwp == NULL)
724 1.1 ad return;
725 1.1 ad
726 1.1 ad /*
727 1.1 ad * Lock out selclear(). The selcpu pointer can't change while
728 1.1 ad * we are here since it is only ever changed in selrecord(),
729 1.1 ad * and that will not be entered again for this record because
730 1.1 ad * it is dying.
731 1.1 ad */
732 1.1 ad KASSERT(sip->sel_cpu != NULL);
733 1.1 ad sc = sip->sel_cpu;
734 1.13 ad lock = sc->sc_lock;
735 1.13 ad mutex_spin_enter(lock);
736 1.1 ad if ((l = sip->sel_lwp) != NULL) {
737 1.1 ad /*
738 1.1 ad * This should rarely happen, so although SLIST_REMOVE()
739 1.1 ad * is slow, using it here is not a problem.
740 1.1 ad */
741 1.1 ad KASSERT(l->l_selcpu == sc);
742 1.1 ad SLIST_REMOVE(&l->l_selwait, sip, selinfo, sel_chain);
743 1.1 ad sip->sel_lwp = NULL;
744 1.1 ad }
745 1.13 ad mutex_spin_exit(lock);
746 1.1 ad }
747 1.1 ad
748 1.1 ad int
749 1.14 christos pollsock(struct socket *so, const struct timespec *tsp, int events)
750 1.1 ad {
751 1.1 ad int ncoll, error, timo;
752 1.14 christos struct timespec sleepts, ts;
753 1.1 ad selcpu_t *sc;
754 1.1 ad lwp_t *l;
755 1.13 ad kmutex_t *lock;
756 1.1 ad
757 1.1 ad timo = 0;
758 1.14 christos if (tsp != NULL) {
759 1.14 christos ts = *tsp;
760 1.14 christos if (inittimeleft(&ts, &sleepts) == -1)
761 1.1 ad return EINVAL;
762 1.1 ad }
763 1.1 ad
764 1.1 ad l = curlwp;
765 1.1 ad sc = l->l_cpu->ci_data.cpu_selcpu;
766 1.13 ad lock = sc->sc_lock;
767 1.1 ad l->l_selcpu = sc;
768 1.1 ad SLIST_INIT(&l->l_selwait);
769 1.1 ad error = 0;
770 1.1 ad for (;;) {
771 1.1 ad /*
772 1.1 ad * No need to lock. If this is overwritten by another
773 1.1 ad * value while scanning, we will retry below. We only
774 1.1 ad * need to see exact state from the descriptors that
775 1.1 ad * we are about to poll, and lock activity resulting
776 1.1 ad * from fo_poll is enough to provide an up to date value
777 1.1 ad * for new polling activity.
778 1.1 ad */
779 1.1 ad ncoll = sc->sc_ncoll;
780 1.1 ad l->l_selflag = SEL_SCANNING;
781 1.1 ad if (sopoll(so, events) != 0)
782 1.1 ad break;
783 1.14 christos if (tsp && (timo = gettimeleft(&ts, &sleepts)) <= 0)
784 1.1 ad break;
785 1.13 ad mutex_spin_enter(lock);
786 1.1 ad if (l->l_selflag != SEL_SCANNING || sc->sc_ncoll != ncoll) {
787 1.13 ad mutex_spin_exit(lock);
788 1.1 ad continue;
789 1.1 ad }
790 1.1 ad l->l_selflag = SEL_BLOCKING;
791 1.13 ad sleepq_enter(&sc->sc_sleepq, l, lock);
792 1.1 ad sleepq_enqueue(&sc->sc_sleepq, sc, "pollsock", &select_sobj);
793 1.1 ad error = sleepq_block(timo, true);
794 1.1 ad if (error != 0)
795 1.1 ad break;
796 1.1 ad }
797 1.1 ad selclear();
798 1.1 ad /* poll is not restarted after signals... */
799 1.1 ad if (error == ERESTART)
800 1.1 ad error = EINTR;
801 1.1 ad if (error == EWOULDBLOCK)
802 1.1 ad error = 0;
803 1.1 ad return (error);
804 1.1 ad }
805