]> CyberLeo.Net >> Repos - FreeBSD/releng/10.0.git/blob - sys/cddl/dev/cyclic/cyclic.c
- Copy stable/10 (r259064) to releng/10.0 as part of the
[FreeBSD/releng/10.0.git] / sys / cddl / dev / cyclic / cyclic.c
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License, Version 1.0 only
6  * (the "License").  You may not use this file except in compliance
7  * with the License.
8  *
9  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10  * or http://www.opensolaris.org/os/licensing.
11  * See the License for the specific language governing permissions
12  * and limitations under the License.
13  *
14  * When distributing Covered Code, include this CDDL HEADER in each
15  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16  * If applicable, add the following below this CDDL HEADER, with the
17  * fields enclosed by brackets "[]" replaced with your own identifying
18  * information: Portions Copyright [yyyy] [name of copyright owner]
19  *
20  * CDDL HEADER END
21  *
22  * Portions Copyright 2008 John Birrell <jb@freebsd.org>
23  *
24  * $FreeBSD$
25  *
26  * This is a simplified version of the cyclic timer subsystem from
27  * OpenSolaris. In the FreeBSD version, we don't use interrupt levels.
28  */
29
30 /*
31  * Copyright 2004 Sun Microsystems, Inc.  All rights reserved.
32  * Use is subject to license terms.
33  */
34
35 /*
36  *  The Cyclic Subsystem
37  *  --------------------
38  *
39  *  Prehistory
40  *
41  *  Historically, most computer architectures have specified interval-based
42  *  timer parts (e.g. SPARCstation's counter/timer; Intel's i8254).  While
43  *  these parts deal in relative (i.e. not absolute) time values, they are
44  *  typically used by the operating system to implement the abstraction of
45  *  absolute time.  As a result, these parts cannot typically be reprogrammed
46  *  without introducing error in the system's notion of time.
47  *
48  *  Starting in about 1994, chip architectures began specifying high resolution
49  *  timestamp registers.  As of this writing (1999), all major chip families
50  *  (UltraSPARC, PentiumPro, MIPS, PowerPC, Alpha) have high resolution
51  *  timestamp registers, and two (UltraSPARC and MIPS) have added the capacity
52  *  to interrupt based on timestamp values.  These timestamp-compare registers
53  *  present a time-based interrupt source which can be reprogrammed arbitrarily
54  *  often without introducing error.  Given the low cost of implementing such a
55  *  timestamp-compare register (and the tangible benefit of eliminating
56  *  discrete timer parts), it is reasonable to expect that future chip
57  *  architectures will adopt this feature.
58  *
59  *  The cyclic subsystem has been designed to take advantage of chip
60  *  architectures with the capacity to interrupt based on absolute, high
61  *  resolution values of time.
62  *
63  *  Subsystem Overview
64  *
65  *  The cyclic subsystem is a low-level kernel subsystem designed to provide
66  *  arbitrarily high resolution, per-CPU interval timers (to avoid colliding
67  *  with existing terms, we dub such an interval timer a "cyclic").
68  *  Alternatively, a cyclic may be specified to be "omnipresent", denoting
69  *  firing on all online CPUs.
70  *
71  *  Cyclic Subsystem Interface Overview
72  *  -----------------------------------
73  *
74  *  The cyclic subsystem has interfaces with the kernel at-large, with other
75  *  kernel subsystems (e.g. the processor management subsystem, the checkpoint
76  *  resume subsystem) and with the platform (the cyclic backend).  Each
77  *  of these interfaces is given a brief synopsis here, and is described
78  *  in full above the interface's implementation.
79  *
80  *  The following diagram displays the cyclic subsystem's interfaces to
81  *  other kernel components.  The arrows denote a "calls" relationship, with
82  *  the large arrow indicating the cyclic subsystem's consumer interface.
83  *  Each arrow is labeled with the section in which the corresponding
84  *  interface is described.
85  *
86  *           Kernel at-large consumers
87  *           -----------++------------
88  *                      ||
89  *                      ||
90  *                     _||_
91  *                     \  /
92  *                      \/
93  *            +---------------------+
94  *            |                     |
95  *            |  Cyclic subsystem   |<-----------  Other kernel subsystems
96  *            |                     |
97  *            +---------------------+
98  *                   ^       |
99  *                   |       |
100  *                   |       |
101  *                   |       v
102  *            +---------------------+
103  *            |                     |
104  *            |   Cyclic backend    |
105  *            | (platform specific) |
106  *            |                     |
107  *            +---------------------+
108  *
109  *
110  *  Kernel At-Large Interfaces
111  *
112  *      cyclic_add()         <-- Creates a cyclic
113  *      cyclic_add_omni()    <-- Creates an omnipresent cyclic
114  *      cyclic_remove()      <-- Removes a cyclic
115  *
116  *  Backend Interfaces
117  *
118  *      cyclic_init()        <-- Initializes the cyclic subsystem
119  *      cyclic_fire()        <-- Interrupt entry point
120  *
121  *  The backend-supplied interfaces (through the cyc_backend structure) are
122  *  documented in detail in <sys/cyclic_impl.h>
123  *
124  *
125  *  Cyclic Subsystem Implementation Overview
126  *  ----------------------------------------
127  *
128  *  The cyclic subsystem is designed to minimize interference between cyclics
129  *  on different CPUs.  Thus, all of the cyclic subsystem's data structures
130  *  hang off of a per-CPU structure, cyc_cpu.
131  *
132  *  Each cyc_cpu has a power-of-two sized array of cyclic structures (the
133  *  cyp_cyclics member of the cyc_cpu structure).  If cyclic_add() is called
134  *  and there does not exist a free slot in the cyp_cyclics array, the size of
135  *  the array will be doubled.  The array will never shrink.  Cyclics are
136  *  referred to by their index in the cyp_cyclics array, which is of type
137  *  cyc_index_t.
138  *
139  *  The cyclics are kept sorted by expiration time in the cyc_cpu's heap.  The
140  *  heap is keyed by cyclic expiration time, with parents expiring earlier
141  *  than their children.
142  *
143  *  Heap Management
144  *
145  *  The heap is managed primarily by cyclic_fire().  Upon entry, cyclic_fire()
146  *  compares the root cyclic's expiration time to the current time.  If the
147  *  expiration time is in the past, cyclic_expire() is called on the root
148  *  cyclic.  Upon return from cyclic_expire(), the cyclic's new expiration time
149  *  is derived by adding its interval to its old expiration time, and a
150  *  downheap operation is performed.  After the downheap, cyclic_fire()
151  *  examines the (potentially changed) root cyclic, repeating the
152  *  cyclic_expire()/add interval/cyclic_downheap() sequence until the root
153  *  cyclic has an expiration time in the future.  This expiration time
154  *  (guaranteed to be the earliest in the heap) is then communicated to the
155  *  backend via cyb_reprogram.  Optimal backends will next call cyclic_fire()
156  *  shortly after the root cyclic's expiration time.
157  *
158  *  To allow efficient, deterministic downheap operations, we implement the
159  *  heap as an array (the cyp_heap member of the cyc_cpu structure), with each
160  *  element containing an index into the CPU's cyp_cyclics array.
161  *
162  *  The heap is laid out in the array according to the following:
163  *
164  *   1.  The root of the heap is always in the 0th element of the heap array
165  *   2.  The left and right children of the nth element are element
166  *       (((n + 1) << 1) - 1) and element ((n + 1) << 1), respectively.
167  *
168  *  This layout is standard (see, e.g., Cormen's "Algorithms"); the proof
169  *  that these constraints correctly lay out a heap (or indeed, any binary
170  *  tree) is trivial and left to the reader.
171  *
172  *  To see the heap by example, assume our cyclics array has the following
173  *  members (at time t):
174  *
175  *            cy_handler                          cy_expire
176  *            ---------------------------------------------
177  *     [ 0]   clock()                            t+10000000
178  *     [ 1]   deadman()                        t+1000000000
179  *     [ 2]   clock_highres_fire()                    t+100
180  *     [ 3]   clock_highres_fire()                   t+1000
181  *     [ 4]   clock_highres_fire()                    t+500
182  *     [ 5]   (free)                                     --
183  *     [ 6]   (free)                                     --
184  *     [ 7]   (free)                                     --
185  *
186  *  The heap array could be:
187  *
188  *                [0]   [1]   [2]   [3]   [4]   [5]   [6]   [7]
189  *              +-----+-----+-----+-----+-----+-----+-----+-----+
190  *              |     |     |     |     |     |     |     |     |
191  *              |  2  |  3  |  4  |  0  |  1  |  x  |  x  |  x  |
192  *              |     |     |     |     |     |     |     |     |
193  *              +-----+-----+-----+-----+-----+-----+-----+-----+
194  *
195  *  Graphically, this array corresponds to the following (excuse the ASCII art):
196  *
197  *                                       2
198  *                                       |
199  *                    +------------------+------------------+
200  *                    3                                     4
201  *                    |
202  *          +---------+--------+
203  *          0                  1
204  *
205  *  Note that the heap is laid out by layer:  all nodes at a given depth are
206  *  stored in consecutive elements of the array.  Moreover, layers of
207  *  consecutive depths are in adjacent element ranges.  This property
208  *  guarantees high locality of reference during downheap operations.
209  *  Specifically, we are guaranteed that we can downheap to a depth of
210  *
211  *      lg (cache_line_size / sizeof (cyc_index_t))
212  *
213  *  nodes with at most one cache miss.  On UltraSPARC (64 byte e-cache line
214  *  size), this corresponds to a depth of four nodes.  Thus, if there are
215  *  fewer than sixteen cyclics in the heap, downheaps on UltraSPARC miss at
216  *  most once in the e-cache.
217  *
218  *  Downheaps are required to compare siblings as they proceed down the
219  *  heap.  For downheaps proceeding beyond the one-cache-miss depth, every
220  *  access to a left child could potentially miss in the cache.  However,
221  *  if we assume
222  *
223  *      (cache_line_size / sizeof (cyc_index_t)) > 2,
224  *
225  *  then all siblings are guaranteed to be on the same cache line.  Thus, the
226  *  miss on the left child will guarantee a hit on the right child; downheaps
227  *  will incur at most one cache miss per layer beyond the one-cache-miss
228  *  depth.  The total number of cache misses for heap management during a
229  *  downheap operation is thus bounded by
230  *
231  *      lg (n) - lg (cache_line_size / sizeof (cyc_index_t))
232  *
233  *  Traditional pointer-based heaps are implemented without regard to
234  *  locality.  Downheaps can thus incur two cache misses per layer (one for
235  *  each child), but at most one cache miss at the root.  This yields a bound
236  *  of
237  *
238  *      2 * lg (n) - 1
239  *
240  *  on the total cache misses.
241  *
242  *  This difference may seem theoretically trivial (the difference is, after
243  *  all, constant), but can become substantial in practice -- especially for
244  *  caches with very large cache lines and high miss penalties (e.g. TLBs).
245  *
246  *  Heaps must always be full, balanced trees.  Heap management must therefore
247  *  track the next point-of-insertion into the heap.  In pointer-based heaps,
248  *  recomputing this point takes O(lg (n)).  Given the layout of the
249  *  array-based implementation, however, the next point-of-insertion is
250  *  always:
251  *
252  *      heap[number_of_elements]
253  *
254  *  We exploit this property by implementing the free-list in the usused
255  *  heap elements.  Heap insertion, therefore, consists only of filling in
256  *  the cyclic at cyp_cyclics[cyp_heap[number_of_elements]], incrementing
257  *  the number of elements, and performing an upheap.  Heap deletion consists
258  *  of decrementing the number of elements, swapping the to-be-deleted element
259  *  with the element at cyp_heap[number_of_elements], and downheaping.
260  *
261  *  Filling in more details in our earlier example:
262  *
263  *                                               +--- free list head
264  *                                               |
265  *                                               V
266  *
267  *                [0]   [1]   [2]   [3]   [4]   [5]   [6]   [7]
268  *              +-----+-----+-----+-----+-----+-----+-----+-----+
269  *              |     |     |     |     |     |     |     |     |
270  *              |  2  |  3  |  4  |  0  |  1  |  5  |  6  |  7  |
271  *              |     |     |     |     |     |     |     |     |
272  *              +-----+-----+-----+-----+-----+-----+-----+-----+
273  *
274  *  To insert into this heap, we would just need to fill in the cyclic at
275  *  cyp_cyclics[5], bump the number of elements (from 5 to 6) and perform
276  *  an upheap.
277  *
278  *  If we wanted to remove, say, cyp_cyclics[3], we would first scan for it
279  *  in the cyp_heap, and discover it at cyp_heap[1].  We would then decrement
280  *  the number of elements (from 5 to 4), swap cyp_heap[1] with cyp_heap[4],
281  *  and perform a downheap from cyp_heap[1].  The linear scan is required
282  *  because the cyclic does not keep a backpointer into the heap.  This makes
283  *  heap manipulation (e.g. downheaps) faster at the expense of removal
284  *  operations.
285  *
286  *  Expiry processing
287  *
288  *  As alluded to above, cyclic_expire() is called by cyclic_fire() to expire
289  *  a cyclic.  Cyclic subsystem consumers are guaranteed that for an arbitrary
290  *  time t in the future, their cyclic handler will have been called
291  *  (t - cyt_when) / cyt_interval times. cyclic_expire() simply needs to call
292  *  the handler.
293  *
294  *  Resizing
295  *
296  *  All of the discussion thus far has assumed a static number of cyclics.
297  *  Obviously, static limitations are not practical; we need the capacity
298  *  to resize our data structures dynamically.
299  *
300  *  We resize our data structures lazily, and only on a per-CPU basis.
301  *  The size of the data structures always doubles and never shrinks.  We
302  *  serialize adds (and thus resizes) on cpu_lock; we never need to deal
303  *  with concurrent resizes.  Resizes should be rare; they may induce jitter
304  *  on the CPU being resized, but should not affect cyclic operation on other
305  *  CPUs.
306  *
307  *  Three key cyc_cpu data structures need to be resized:  the cyclics array,
308  *  nad the heap array.  Resizing is relatively straightforward:
309  *
310  *    1.  The new, larger arrays are allocated in cyclic_expand() (called
311  *        from cyclic_add()).
312  *    2.  The contents of the old arrays are copied into the new arrays.
313  *    3.  The old cyclics array is bzero()'d
314  *    4.  The pointers are updated.
315  *
316  *  Removals
317  *
318  *  Cyclic removals should be rare.  To simplify the implementation (and to
319  *  allow optimization for the cyclic_fire()/cyclic_expire()
320  *  path), we force removals and adds to serialize on cpu_lock.
321  *
322  */
323 #include <sys/cdefs.h>
324 #include <sys/param.h>
325 #include <sys/conf.h>
326 #include <sys/kernel.h>
327 #include <sys/lock.h>
328 #include <sys/sx.h>
329 #include <sys/cyclic_impl.h>
330 #include <sys/module.h>
331 #include <sys/systm.h>
332 #include <sys/atomic.h>
333 #include <sys/kmem.h>
334 #include <sys/cmn_err.h>
335 #include <sys/dtrace_bsd.h>
336 #include <machine/cpu.h>
337
338 static kmem_cache_t *cyclic_id_cache;
339 static cyc_id_t *cyclic_id_head;
340 static cyc_backend_t cyclic_backend;
341
342 static MALLOC_DEFINE(M_CYCLIC, "cyclic", "Cyclic timer subsystem");
343
344 static __inline hrtime_t
345 cyc_gethrtime(void)
346 {
347         struct bintime bt;
348
349         binuptime(&bt);
350         return ((hrtime_t)bt.sec * NANOSEC +
351             (((uint64_t)NANOSEC * (uint32_t)(bt.frac >> 32)) >> 32));
352 }
353
354 /*
355  * Returns 1 if the upheap propagated to the root, 0 if it did not.  This
356  * allows the caller to reprogram the backend only when the root has been
357  * modified.
358  */
359 static int
360 cyclic_upheap(cyc_cpu_t *cpu, cyc_index_t ndx)
361 {
362         cyclic_t *cyclics;
363         cyc_index_t *heap;
364         cyc_index_t heap_parent, heap_current = ndx;
365         cyc_index_t parent, current;
366
367         if (heap_current == 0)
368                 return (1);
369
370         heap = cpu->cyp_heap;
371         cyclics = cpu->cyp_cyclics;
372         heap_parent = CYC_HEAP_PARENT(heap_current);
373
374         for (;;) {
375                 current = heap[heap_current];
376                 parent = heap[heap_parent];
377
378                 /*
379                  * We have an expiration time later than our parent; we're
380                  * done.
381                  */
382                 if (cyclics[current].cy_expire >= cyclics[parent].cy_expire)
383                         return (0);
384
385                 /*
386                  * We need to swap with our parent, and continue up the heap.
387                  */
388                 heap[heap_parent] = current;
389                 heap[heap_current] = parent;
390
391                 /*
392                  * If we just reached the root, we're done.
393                  */
394                 if (heap_parent == 0)
395                         return (1);
396
397                 heap_current = heap_parent;
398                 heap_parent = CYC_HEAP_PARENT(heap_current);
399         }
400 }
401
402 static void
403 cyclic_downheap(cyc_cpu_t *cpu, cyc_index_t ndx)
404 {
405         cyclic_t *cyclics = cpu->cyp_cyclics;
406         cyc_index_t *heap = cpu->cyp_heap;
407
408         cyc_index_t heap_left, heap_right, heap_me = ndx;
409         cyc_index_t left, right, me;
410         cyc_index_t nelems = cpu->cyp_nelems;
411
412         for (;;) {
413                 /*
414                  * If we don't have a left child (i.e., we're a leaf), we're
415                  * done.
416                  */
417                 if ((heap_left = CYC_HEAP_LEFT(heap_me)) >= nelems)
418                         return;
419
420                 left = heap[heap_left];
421                 me = heap[heap_me];
422
423                 heap_right = CYC_HEAP_RIGHT(heap_me);
424
425                 /*
426                  * Even if we don't have a right child, we still need to compare
427                  * our expiration time against that of our left child.
428                  */
429                 if (heap_right >= nelems)
430                         goto comp_left;
431
432                 right = heap[heap_right];
433
434                 /*
435                  * We have both a left and a right child.  We need to compare
436                  * the expiration times of the children to determine which
437                  * expires earlier.
438                  */
439                 if (cyclics[right].cy_expire < cyclics[left].cy_expire) {
440                         /*
441                          * Our right child is the earlier of our children.
442                          * We'll now compare our expiration time to its; if
443                          * ours is the earlier, we're done.
444                          */
445                         if (cyclics[me].cy_expire <= cyclics[right].cy_expire)
446                                 return;
447
448                         /*
449                          * Our right child expires earlier than we do; swap
450                          * with our right child, and descend right.
451                          */
452                         heap[heap_right] = me;
453                         heap[heap_me] = right;
454                         heap_me = heap_right;
455                         continue;
456                 }
457
458 comp_left:
459                 /*
460                  * Our left child is the earlier of our children (or we have
461                  * no right child).  We'll now compare our expiration time
462                  * to its; if ours is the earlier, we're done.
463                  */
464                 if (cyclics[me].cy_expire <= cyclics[left].cy_expire)
465                         return;
466
467                 /*
468                  * Our left child expires earlier than we do; swap with our
469                  * left child, and descend left.
470                  */
471                 heap[heap_left] = me;
472                 heap[heap_me] = left;
473                 heap_me = heap_left;
474         }
475 }
476
477 static void
478 cyclic_expire(cyc_cpu_t *cpu, cyc_index_t ndx, cyclic_t *cyclic)
479 {
480         cyc_func_t handler = cyclic->cy_handler;
481         void *arg = cyclic->cy_arg;
482
483         (*handler)(arg);
484 }
485
486 /*
487  *  cyclic_fire(cpu_t *)
488  *
489  *  Overview
490  *
491  *    cyclic_fire() is the cyclic subsystem's interrupt handler.
492  *    Called by the cyclic backend.
493  *
494  *  Arguments and notes
495  *
496  *    The only argument is the CPU on which the interrupt is executing;
497  *    backends must call into cyclic_fire() on the specified CPU.
498  *
499  *    cyclic_fire() may be called spuriously without ill effect.  Optimal
500  *    backends will call into cyclic_fire() at or shortly after the time
501  *    requested via cyb_reprogram().  However, calling cyclic_fire()
502  *    arbitrarily late will only manifest latency bubbles; the correctness
503  *    of the cyclic subsystem does not rely on the timeliness of the backend.
504  *
505  *    cyclic_fire() is wait-free; it will not block or spin.
506  *
507  *  Return values
508  *
509  *    None.
510  *
511  */
512 static void
513 cyclic_fire(cpu_t *c)
514 {
515         cyc_cpu_t *cpu = c->cpu_cyclic;
516         cyc_backend_t *be = cpu->cyp_backend;
517         cyc_index_t *heap = cpu->cyp_heap;
518         cyclic_t *cyclic, *cyclics = cpu->cyp_cyclics;
519         void *arg = be->cyb_arg;
520         hrtime_t now = cyc_gethrtime();
521         hrtime_t exp;
522
523         if (cpu->cyp_nelems == 0) {
524                 /* This is a spurious fire. */
525                 return;
526         }
527
528         for (;;) {
529                 cyc_index_t ndx = heap[0];
530
531                 cyclic = &cyclics[ndx];
532
533                 ASSERT(!(cyclic->cy_flags & CYF_FREE));
534
535                 if ((exp = cyclic->cy_expire) > now)
536                         break;
537
538                 cyclic_expire(cpu, ndx, cyclic);
539
540                 /*
541                  * If this cyclic will be set to next expire in the distant
542                  * past, we have one of two situations:
543                  *
544                  *   a) This is the first firing of a cyclic which had
545                  *      cy_expire set to 0.
546                  *
547                  *   b) We are tragically late for a cyclic -- most likely
548                  *      due to being in the debugger.
549                  *
550                  * In either case, we set the new expiration time to be the
551                  * the next interval boundary.  This assures that the
552                  * expiration time modulo the interval is invariant.
553                  *
554                  * We arbitrarily define "distant" to be one second (one second
555                  * is chosen because it's shorter than any foray to the
556                  * debugger while still being longer than any legitimate
557                  * stretch).
558                  */
559                 exp += cyclic->cy_interval;
560
561                 if (now - exp > NANOSEC) {
562                         hrtime_t interval = cyclic->cy_interval;
563
564                         exp += ((now - exp) / interval + 1) * interval;
565                 }
566
567                 cyclic->cy_expire = exp;
568                 cyclic_downheap(cpu, 0);
569         }
570
571         /*
572          * Now we have a cyclic in the root slot which isn't in the past;
573          * reprogram the interrupt source.
574          */
575         be->cyb_reprogram(arg, exp);
576 }
577
578 static void
579 cyclic_expand_xcall(cyc_xcallarg_t *arg)
580 {
581         cyc_cpu_t *cpu = arg->cyx_cpu;
582         cyc_index_t new_size = arg->cyx_size, size = cpu->cyp_size, i;
583         cyc_index_t *new_heap = arg->cyx_heap;
584         cyclic_t *cyclics = cpu->cyp_cyclics, *new_cyclics = arg->cyx_cyclics;
585
586         /* Disable preemption and interrupts. */
587         mtx_lock_spin(&cpu->cyp_mtx);
588
589         /*
590          * Assert that the new size is a power of 2.
591          */
592         ASSERT((new_size & (new_size - 1)) == 0);
593         ASSERT(new_size == (size << 1));
594         ASSERT(cpu->cyp_heap != NULL && cpu->cyp_cyclics != NULL);
595
596         bcopy(cpu->cyp_heap, new_heap, sizeof (cyc_index_t) * size);
597         bcopy(cyclics, new_cyclics, sizeof (cyclic_t) * size);
598
599         /*
600          * Set up the free list, and set all of the new cyclics to be CYF_FREE.
601          */
602         for (i = size; i < new_size; i++) {
603                 new_heap[i] = i;
604                 new_cyclics[i].cy_flags = CYF_FREE;
605         }
606
607         /*
608          * We can go ahead and plow the value of cyp_heap and cyp_cyclics;
609          * cyclic_expand() has kept a copy.
610          */
611         cpu->cyp_heap = new_heap;
612         cpu->cyp_cyclics = new_cyclics;
613         cpu->cyp_size = new_size;
614         mtx_unlock_spin(&cpu->cyp_mtx);
615 }
616
617 /*
618  * cyclic_expand() will cross call onto the CPU to perform the actual
619  * expand operation.
620  */
621 static void
622 cyclic_expand(cyc_cpu_t *cpu)
623 {
624         cyc_index_t new_size, old_size;
625         cyc_index_t *new_heap, *old_heap;
626         cyclic_t *new_cyclics, *old_cyclics;
627         cyc_xcallarg_t arg;
628         cyc_backend_t *be = cpu->cyp_backend;
629
630         ASSERT(MUTEX_HELD(&cpu_lock));
631
632         old_heap = cpu->cyp_heap;
633         old_cyclics = cpu->cyp_cyclics;
634
635         if ((new_size = ((old_size = cpu->cyp_size) << 1)) == 0) {
636                 new_size = CY_DEFAULT_PERCPU;
637                 ASSERT(old_heap == NULL && old_cyclics == NULL);
638         }
639
640         /*
641          * Check that the new_size is a power of 2.
642          */
643         ASSERT(((new_size - 1) & new_size) == 0);
644
645         new_heap = malloc(sizeof(cyc_index_t) * new_size, M_CYCLIC, M_WAITOK);
646         new_cyclics = malloc(sizeof(cyclic_t) * new_size, M_CYCLIC, M_ZERO | M_WAITOK);
647
648         arg.cyx_cpu = cpu;
649         arg.cyx_heap = new_heap;
650         arg.cyx_cyclics = new_cyclics;
651         arg.cyx_size = new_size;
652
653         be->cyb_xcall(be->cyb_arg, cpu->cyp_cpu,
654             (cyc_func_t)cyclic_expand_xcall, &arg);
655
656         if (old_cyclics != NULL) {
657                 ASSERT(old_heap != NULL);
658                 ASSERT(old_size != 0);
659                 free(old_cyclics, M_CYCLIC);
660                 free(old_heap, M_CYCLIC);
661         }
662 }
663
664 static void
665 cyclic_add_xcall(cyc_xcallarg_t *arg)
666 {
667         cyc_cpu_t *cpu = arg->cyx_cpu;
668         cyc_handler_t *hdlr = arg->cyx_hdlr;
669         cyc_time_t *when = arg->cyx_when;
670         cyc_backend_t *be = cpu->cyp_backend;
671         cyc_index_t ndx, nelems;
672         cyb_arg_t bar = be->cyb_arg;
673         cyclic_t *cyclic;
674
675         ASSERT(cpu->cyp_nelems < cpu->cyp_size);
676
677         /* Disable preemption and interrupts. */
678         mtx_lock_spin(&cpu->cyp_mtx);
679         nelems = cpu->cyp_nelems++;
680
681         if (nelems == 0) {
682                 /*
683                  * If this is the first element, we need to enable the
684                  * backend on this CPU.
685                  */
686                 be->cyb_enable(bar);
687         }
688
689         ndx = cpu->cyp_heap[nelems];
690         cyclic = &cpu->cyp_cyclics[ndx];
691
692         ASSERT(cyclic->cy_flags == CYF_FREE);
693         cyclic->cy_interval = when->cyt_interval;
694
695         if (when->cyt_when == 0) {
696                 /*
697                  * If a start time hasn't been explicitly specified, we'll
698                  * start on the next interval boundary.
699                  */
700                 cyclic->cy_expire = (cyc_gethrtime() / cyclic->cy_interval + 1) *
701                     cyclic->cy_interval;
702         } else {
703                 cyclic->cy_expire = when->cyt_when;
704         }
705
706         cyclic->cy_handler = hdlr->cyh_func;
707         cyclic->cy_arg = hdlr->cyh_arg;
708         cyclic->cy_flags = arg->cyx_flags;
709
710         if (cyclic_upheap(cpu, nelems)) {
711                 hrtime_t exp = cyclic->cy_expire;
712
713                 /*
714                  * If our upheap propagated to the root, we need to
715                  * reprogram the interrupt source.
716                  */
717                 be->cyb_reprogram(bar, exp);
718         }
719         mtx_unlock_spin(&cpu->cyp_mtx);
720
721         arg->cyx_ndx = ndx;
722 }
723
724 static cyc_index_t
725 cyclic_add_here(cyc_cpu_t *cpu, cyc_handler_t *hdlr,
726     cyc_time_t *when, uint16_t flags)
727 {
728         cyc_backend_t *be = cpu->cyp_backend;
729         cyb_arg_t bar = be->cyb_arg;
730         cyc_xcallarg_t arg;
731
732         ASSERT(MUTEX_HELD(&cpu_lock));
733         ASSERT(!(cpu->cyp_cpu->cpu_flags & CPU_OFFLINE));
734         ASSERT(when->cyt_when >= 0 && when->cyt_interval > 0);
735
736         if (cpu->cyp_nelems == cpu->cyp_size) {
737                 /*
738                  * This is expensive; it will cross call onto the other
739                  * CPU to perform the expansion.
740                  */
741                 cyclic_expand(cpu);
742                 ASSERT(cpu->cyp_nelems < cpu->cyp_size);
743         }
744
745         /*
746          * By now, we know that we're going to be able to successfully
747          * perform the add.  Now cross call over to the CPU of interest to
748          * actually add our cyclic.
749          */
750         arg.cyx_cpu = cpu;
751         arg.cyx_hdlr = hdlr;
752         arg.cyx_when = when;
753         arg.cyx_flags = flags;
754
755         be->cyb_xcall(bar, cpu->cyp_cpu, (cyc_func_t)cyclic_add_xcall, &arg);
756
757         return (arg.cyx_ndx);
758 }
759
760 static void
761 cyclic_remove_xcall(cyc_xcallarg_t *arg)
762 {
763         cyc_cpu_t *cpu = arg->cyx_cpu;
764         cyc_backend_t *be = cpu->cyp_backend;
765         cyb_arg_t bar = be->cyb_arg;
766         cyc_index_t ndx = arg->cyx_ndx, nelems = cpu->cyp_nelems, i;
767         cyc_index_t *heap = cpu->cyp_heap, last;
768         cyclic_t *cyclic;
769
770         ASSERT(nelems > 0);
771
772         /* Disable preemption and interrupts. */
773         mtx_lock_spin(&cpu->cyp_mtx);
774         cyclic = &cpu->cyp_cyclics[ndx];
775
776         /*
777          * Grab the current expiration time.  If this cyclic is being
778          * removed as part of a juggling operation, the expiration time
779          * will be used when the cyclic is added to the new CPU.
780          */
781         if (arg->cyx_when != NULL) {
782                 arg->cyx_when->cyt_when = cyclic->cy_expire;
783                 arg->cyx_when->cyt_interval = cyclic->cy_interval;
784         }
785
786         /*
787          * Now set the flags to CYF_FREE.  We don't need a membar_enter()
788          * between zeroing pend and setting the flags because we're at
789          * CY_HIGH_LEVEL (that is, the zeroing of pend and the setting
790          * of cy_flags appear atomic to softints).
791          */
792         cyclic->cy_flags = CYF_FREE;
793
794         for (i = 0; i < nelems; i++) {
795                 if (heap[i] == ndx)
796                         break;
797         }
798
799         if (i == nelems)
800                 panic("attempt to remove non-existent cyclic");
801
802         cpu->cyp_nelems = --nelems;
803
804         if (nelems == 0) {
805                 /*
806                  * If we just removed the last element, then we need to
807                  * disable the backend on this CPU.
808                  */
809                 be->cyb_disable(bar);
810         }
811
812         if (i == nelems) {
813                 /*
814                  * If we just removed the last element of the heap, then
815                  * we don't have to downheap.
816                  */
817                 goto out;
818         }
819
820         /*
821          * Swap the last element of the heap with the one we want to
822          * remove, and downheap (this has the implicit effect of putting
823          * the newly freed element on the free list).
824          */
825         heap[i] = (last = heap[nelems]);
826         heap[nelems] = ndx;
827
828         if (i == 0) {
829                 cyclic_downheap(cpu, 0);
830         } else {
831                 if (cyclic_upheap(cpu, i) == 0) {
832                         /*
833                          * The upheap didn't propagate to the root; if it
834                          * didn't propagate at all, we need to downheap.
835                          */
836                         if (heap[i] == last) {
837                                 cyclic_downheap(cpu, i);
838                         }
839                         goto out;
840                 }
841         }
842
843         /*
844          * We're here because we changed the root; we need to reprogram
845          * the clock source.
846          */
847         cyclic = &cpu->cyp_cyclics[heap[0]];
848
849         ASSERT(nelems != 0);
850         be->cyb_reprogram(bar, cyclic->cy_expire);
851 out:
852         mtx_unlock_spin(&cpu->cyp_mtx);
853 }
854
855 static int
856 cyclic_remove_here(cyc_cpu_t *cpu, cyc_index_t ndx, cyc_time_t *when, int wait)
857 {
858         cyc_backend_t *be = cpu->cyp_backend;
859         cyc_xcallarg_t arg;
860
861         ASSERT(MUTEX_HELD(&cpu_lock));
862         ASSERT(wait == CY_WAIT || wait == CY_NOWAIT);
863
864         arg.cyx_ndx = ndx;
865         arg.cyx_cpu = cpu;
866         arg.cyx_when = when;
867         arg.cyx_wait = wait;
868
869         be->cyb_xcall(be->cyb_arg, cpu->cyp_cpu,
870             (cyc_func_t)cyclic_remove_xcall, &arg);
871
872         return (1);
873 }
874
875 static void
876 cyclic_configure(cpu_t *c)
877 {
878         cyc_cpu_t *cpu = malloc(sizeof(cyc_cpu_t), M_CYCLIC, M_ZERO | M_WAITOK);
879         cyc_backend_t *nbe = malloc(sizeof(cyc_backend_t), M_CYCLIC, M_ZERO | M_WAITOK);
880
881         ASSERT(MUTEX_HELD(&cpu_lock));
882
883         if (cyclic_id_cache == NULL)
884                 cyclic_id_cache = kmem_cache_create("cyclic_id_cache",
885                     sizeof (cyc_id_t), 0, NULL, NULL, NULL, NULL, NULL, 0);
886
887         cpu->cyp_cpu = c;
888
889         cpu->cyp_size = 1;
890         cpu->cyp_heap = malloc(sizeof(cyc_index_t), M_CYCLIC, M_ZERO | M_WAITOK);
891         cpu->cyp_cyclics = malloc(sizeof(cyclic_t), M_CYCLIC, M_ZERO | M_WAITOK);
892         cpu->cyp_cyclics->cy_flags = CYF_FREE;
893
894         mtx_init(&cpu->cyp_mtx, "cyclic cpu", NULL, MTX_SPIN);
895
896         /*
897          * Setup the backend for this CPU.
898          */
899         bcopy(&cyclic_backend, nbe, sizeof (cyc_backend_t));
900         if (nbe->cyb_configure != NULL)
901                 nbe->cyb_arg = nbe->cyb_configure(c);
902         cpu->cyp_backend = nbe;
903
904         /*
905          * On platforms where stray interrupts may be taken during startup,
906          * the CPU's cpu_cyclic pointer serves as an indicator that the
907          * cyclic subsystem for this CPU is prepared to field interrupts.
908          */
909         membar_producer();
910
911         c->cpu_cyclic = cpu;
912 }
913
914 static void
915 cyclic_unconfigure(cpu_t *c)
916 {
917         cyc_cpu_t *cpu = c->cpu_cyclic;
918         cyc_backend_t *be = cpu->cyp_backend;
919         cyb_arg_t bar = be->cyb_arg;
920
921         ASSERT(MUTEX_HELD(&cpu_lock));
922
923         c->cpu_cyclic = NULL;
924
925         /*
926          * Let the backend know that the CPU is being yanked, and free up
927          * the backend structure.
928          */
929         if (be->cyb_unconfigure != NULL)
930                 be->cyb_unconfigure(bar);
931         free(be, M_CYCLIC);
932         cpu->cyp_backend = NULL;
933
934         mtx_destroy(&cpu->cyp_mtx);
935
936         /* Finally, clean up our remaining dynamic structures. */
937         free(cpu->cyp_cyclics, M_CYCLIC);
938         free(cpu->cyp_heap, M_CYCLIC);
939         free(cpu, M_CYCLIC);
940 }
941
942 static void
943 cyclic_omni_start(cyc_id_t *idp, cyc_cpu_t *cpu)
944 {
945         cyc_omni_handler_t *omni = &idp->cyi_omni_hdlr;
946         cyc_omni_cpu_t *ocpu = malloc(sizeof(cyc_omni_cpu_t), M_CYCLIC , M_WAITOK);
947         cyc_handler_t hdlr;
948         cyc_time_t when;
949
950         ASSERT(MUTEX_HELD(&cpu_lock));
951         ASSERT(idp->cyi_cpu == NULL);
952
953         hdlr.cyh_func = NULL;
954         hdlr.cyh_arg = NULL;
955
956         when.cyt_when = 0;
957         when.cyt_interval = 0;
958
959         omni->cyo_online(omni->cyo_arg, cpu->cyp_cpu, &hdlr, &when);
960
961         ASSERT(hdlr.cyh_func != NULL);
962         ASSERT(when.cyt_when >= 0 && when.cyt_interval > 0);
963
964         ocpu->cyo_cpu = cpu;
965         ocpu->cyo_arg = hdlr.cyh_arg;
966         ocpu->cyo_ndx = cyclic_add_here(cpu, &hdlr, &when, 0);
967         ocpu->cyo_next = idp->cyi_omni_list;
968         idp->cyi_omni_list = ocpu;
969 }
970
971 static void
972 cyclic_omni_stop(cyc_id_t *idp, cyc_cpu_t *cpu)
973 {
974         cyc_omni_handler_t *omni = &idp->cyi_omni_hdlr;
975         cyc_omni_cpu_t *ocpu = idp->cyi_omni_list, *prev = NULL;
976
977         ASSERT(MUTEX_HELD(&cpu_lock));
978         ASSERT(idp->cyi_cpu == NULL);
979         ASSERT(ocpu != NULL);
980
981         while (ocpu != NULL && ocpu->cyo_cpu != cpu) {
982                 prev = ocpu;
983                 ocpu = ocpu->cyo_next;
984         }
985
986         /*
987          * We _must_ have found an cyc_omni_cpu which corresponds to this
988          * CPU -- the definition of an omnipresent cyclic is that it runs
989          * on all online CPUs.
990          */
991         ASSERT(ocpu != NULL);
992
993         if (prev == NULL) {
994                 idp->cyi_omni_list = ocpu->cyo_next;
995         } else {
996                 prev->cyo_next = ocpu->cyo_next;
997         }
998
999         (void) cyclic_remove_here(ocpu->cyo_cpu, ocpu->cyo_ndx, NULL, CY_WAIT);
1000
1001         /*
1002          * The cyclic has been removed from this CPU; time to call the
1003          * omnipresent offline handler.
1004          */
1005         if (omni->cyo_offline != NULL)
1006                 omni->cyo_offline(omni->cyo_arg, cpu->cyp_cpu, ocpu->cyo_arg);
1007
1008         free(ocpu, M_CYCLIC);
1009 }
1010
1011 static cyc_id_t *
1012 cyclic_new_id(void)
1013 {
1014         cyc_id_t *idp;
1015
1016         ASSERT(MUTEX_HELD(&cpu_lock));
1017
1018         idp = kmem_cache_alloc(cyclic_id_cache, KM_SLEEP);
1019
1020         /*
1021          * The cyi_cpu field of the cyc_id_t structure tracks the CPU
1022          * associated with the cyclic.  If and only if this field is NULL, the
1023          * cyc_id_t is an omnipresent cyclic.  Note that cyi_omni_list may be
1024          * NULL for an omnipresent cyclic while the cyclic is being created
1025          * or destroyed.
1026          */
1027         idp->cyi_cpu = NULL;
1028         idp->cyi_ndx = 0;
1029
1030         idp->cyi_next = cyclic_id_head;
1031         idp->cyi_prev = NULL;
1032         idp->cyi_omni_list = NULL;
1033
1034         if (cyclic_id_head != NULL) {
1035                 ASSERT(cyclic_id_head->cyi_prev == NULL);
1036                 cyclic_id_head->cyi_prev = idp;
1037         }
1038
1039         cyclic_id_head = idp;
1040
1041         return (idp);
1042 }
1043
1044 /*
1045  *  cyclic_id_t cyclic_add(cyc_handler_t *, cyc_time_t *)
1046  *
1047  *  Overview
1048  *
1049  *    cyclic_add() will create an unbound cyclic with the specified handler and
1050  *    interval.  The cyclic will run on a CPU which both has interrupts enabled
1051  *    and is in the system CPU partition.
1052  *
1053  *  Arguments and notes
1054  *
1055  *    As its first argument, cyclic_add() takes a cyc_handler, which has the
1056  *    following members:
1057  *
1058  *      cyc_func_t cyh_func    <-- Cyclic handler
1059  *      void *cyh_arg          <-- Argument to cyclic handler
1060  *
1061  *    In addition to a cyc_handler, cyclic_add() takes a cyc_time, which
1062  *    has the following members:
1063  *
1064  *       hrtime_t cyt_when     <-- Absolute time, in nanoseconds since boot, at
1065  *                                 which to start firing
1066  *       hrtime_t cyt_interval <-- Length of interval, in nanoseconds
1067  *
1068  *    gethrtime() is the time source for nanoseconds since boot.  If cyt_when
1069  *    is set to 0, the cyclic will start to fire when cyt_interval next
1070  *    divides the number of nanoseconds since boot.
1071  *
1072  *    The cyt_interval field _must_ be filled in by the caller; one-shots are
1073  *    _not_ explicitly supported by the cyclic subsystem (cyclic_add() will
1074  *    assert that cyt_interval is non-zero).  The maximum value for either
1075  *    field is INT64_MAX; the caller is responsible for assuring that
1076  *    cyt_when + cyt_interval <= INT64_MAX.  Neither field may be negative.
1077  *
1078  *    For an arbitrary time t in the future, the cyclic handler is guaranteed
1079  *    to have been called (t - cyt_when) / cyt_interval times.  This will
1080  *    be true even if interrupts have been disabled for periods greater than
1081  *    cyt_interval nanoseconds.  In order to compensate for such periods,
1082  *    the cyclic handler may be called a finite number of times with an
1083  *    arbitrarily small interval.
1084  *
1085  *    The cyclic subsystem will not enforce any lower bound on the interval;
1086  *    if the interval is less than the time required to process an interrupt,
1087  *    the CPU will wedge.  It's the responsibility of the caller to assure that
1088  *    either the value of the interval is sane, or that its caller has
1089  *    sufficient privilege to deny service (i.e. its caller is root).
1090  *
1091  *  Return value
1092  *
1093  *    cyclic_add() returns a cyclic_id_t, which is guaranteed to be a value
1094  *    other than CYCLIC_NONE.  cyclic_add() cannot fail.
1095  *
1096  *  Caller's context
1097  *
1098  *    cpu_lock must be held by the caller, and the caller must not be in
1099  *    interrupt context.  cyclic_add() will perform a KM_SLEEP kernel
1100  *    memory allocation, so the usual rules (e.g. p_lock cannot be held)
1101  *    apply.  A cyclic may be added even in the presence of CPUs that have
1102  *    not been configured with respect to the cyclic subsystem, but only
1103  *    configured CPUs will be eligible to run the new cyclic.
1104  *
1105  *  Cyclic handler's context
1106  *
1107  *    Cyclic handlers will be executed in the interrupt context corresponding
1108  *    to the specified level (i.e. either high, lock or low level).  The
1109  *    usual context rules apply.
1110  *
1111  *    A cyclic handler may not grab ANY locks held by the caller of any of
1112  *    cyclic_add() or cyclic_remove(); the implementation of these functions
1113  *    may require blocking on cyclic handler completion.
1114  *    Moreover, cyclic handlers may not make any call back into the cyclic
1115  *    subsystem.
1116  */
1117 cyclic_id_t
1118 cyclic_add(cyc_handler_t *hdlr, cyc_time_t *when)
1119 {
1120         cyc_id_t *idp = cyclic_new_id();
1121         solaris_cpu_t *c = &solaris_cpu[curcpu];
1122
1123         ASSERT(MUTEX_HELD(&cpu_lock));
1124         ASSERT(when->cyt_when >= 0 && when->cyt_interval > 0);
1125
1126         idp->cyi_cpu = c->cpu_cyclic;
1127         idp->cyi_ndx = cyclic_add_here(idp->cyi_cpu, hdlr, when, 0);
1128
1129         return ((uintptr_t)idp);
1130 }
1131
1132 /*
1133  *  cyclic_id_t cyclic_add_omni(cyc_omni_handler_t *)
1134  *
1135  *  Overview
1136  *
1137  *    cyclic_add_omni() will create an omnipresent cyclic with the specified
1138  *    online and offline handlers.  Omnipresent cyclics run on all online
1139  *    CPUs, including CPUs which have unbound interrupts disabled.
1140  *
1141  *  Arguments
1142  *
1143  *    As its only argument, cyclic_add_omni() takes a cyc_omni_handler, which
1144  *    has the following members:
1145  *
1146  *      void (*cyo_online)()   <-- Online handler
1147  *      void (*cyo_offline)()  <-- Offline handler
1148  *      void *cyo_arg          <-- Argument to be passed to on/offline handlers
1149  *
1150  *  Online handler
1151  *
1152  *    The cyo_online member is a pointer to a function which has the following
1153  *    four arguments:
1154  *
1155  *      void *                 <-- Argument (cyo_arg)
1156  *      cpu_t *                <-- Pointer to CPU about to be onlined
1157  *      cyc_handler_t *        <-- Pointer to cyc_handler_t; must be filled in
1158  *                                 by omni online handler
1159  *      cyc_time_t *           <-- Pointer to cyc_time_t; must be filled in by
1160  *                                 omni online handler
1161  *
1162  *    The omni cyclic online handler is always called _before_ the omni
1163  *    cyclic begins to fire on the specified CPU.  As the above argument
1164  *    description implies, the online handler must fill in the two structures
1165  *    passed to it:  the cyc_handler_t and the cyc_time_t.  These are the
1166  *    same two structures passed to cyclic_add(), outlined above.  This
1167  *    allows the omni cyclic to have maximum flexibility; different CPUs may
1168  *    optionally
1169  *
1170  *      (a)  have different intervals
1171  *      (b)  be explicitly in or out of phase with one another
1172  *      (c)  have different handlers
1173  *      (d)  have different handler arguments
1174  *      (e)  fire at different levels
1175  *
1176  *    Of these, (e) seems somewhat dubious, but is nonetheless allowed.
1177  *
1178  *    The omni online handler is called in the same context as cyclic_add(),
1179  *    and has the same liberties:  omni online handlers may perform KM_SLEEP
1180  *    kernel memory allocations, and may grab locks which are also acquired
1181  *    by cyclic handlers.  However, omni cyclic online handlers may _not_
1182  *    call back into the cyclic subsystem, and should be generally careful
1183  *    about calling into arbitrary kernel subsystems.
1184  *
1185  *  Offline handler
1186  *
1187  *    The cyo_offline member is a pointer to a function which has the following
1188  *    three arguments:
1189  *
1190  *      void *                 <-- Argument (cyo_arg)
1191  *      cpu_t *                <-- Pointer to CPU about to be offlined
1192  *      void *                 <-- CPU's cyclic argument (that is, value
1193  *                                 to which cyh_arg member of the cyc_handler_t
1194  *                                 was set in the omni online handler)
1195  *
1196  *    The omni cyclic offline handler is always called _after_ the omni
1197  *    cyclic has ceased firing on the specified CPU.  Its purpose is to
1198  *    allow cleanup of any resources dynamically allocated in the omni cyclic
1199  *    online handler.  The context of the offline handler is identical to
1200  *    that of the online handler; the same constraints and liberties apply.
1201  *
1202  *    The offline handler is optional; it may be NULL.
1203  *
1204  *  Return value
1205  *
1206  *    cyclic_add_omni() returns a cyclic_id_t, which is guaranteed to be a
1207  *    value other than CYCLIC_NONE.  cyclic_add_omni() cannot fail.
1208  *
1209  *  Caller's context
1210  *
1211  *    The caller's context is identical to that of cyclic_add(), specified
1212  *    above.
1213  */
1214 cyclic_id_t
1215 cyclic_add_omni(cyc_omni_handler_t *omni)
1216 {
1217         cyc_id_t *idp = cyclic_new_id();
1218         cyc_cpu_t *cpu;
1219         cpu_t *c;
1220         int i;
1221
1222         ASSERT(MUTEX_HELD(&cpu_lock));
1223         ASSERT(omni != NULL && omni->cyo_online != NULL);
1224
1225         idp->cyi_omni_hdlr = *omni;
1226
1227         CPU_FOREACH(i) {
1228                 c = &solaris_cpu[i];
1229                 if ((cpu = c->cpu_cyclic) == NULL)
1230                         continue;
1231                 cyclic_omni_start(idp, cpu);
1232         }
1233
1234         /*
1235          * We must have found at least one online CPU on which to run
1236          * this cyclic.
1237          */
1238         ASSERT(idp->cyi_omni_list != NULL);
1239         ASSERT(idp->cyi_cpu == NULL);
1240
1241         return ((uintptr_t)idp);
1242 }
1243
1244 /*
1245  *  void cyclic_remove(cyclic_id_t)
1246  *
1247  *  Overview
1248  *
1249  *    cyclic_remove() will remove the specified cyclic from the system.
1250  *
1251  *  Arguments and notes
1252  *
1253  *    The only argument is a cyclic_id returned from either cyclic_add() or
1254  *    cyclic_add_omni().
1255  *
1256  *    By the time cyclic_remove() returns, the caller is guaranteed that the
1257  *    removed cyclic handler has completed execution (this is the same
1258  *    semantic that untimeout() provides).  As a result, cyclic_remove() may
1259  *    need to block, waiting for the removed cyclic to complete execution.
1260  *    This leads to an important constraint on the caller:  no lock may be
1261  *    held across cyclic_remove() that also may be acquired by a cyclic
1262  *    handler.
1263  *
1264  *  Return value
1265  *
1266  *    None; cyclic_remove() always succeeds.
1267  *
1268  *  Caller's context
1269  *
1270  *    cpu_lock must be held by the caller, and the caller must not be in
1271  *    interrupt context.  The caller may not hold any locks which are also
1272  *    grabbed by any cyclic handler.  See "Arguments and notes", above.
1273  */
1274 void
1275 cyclic_remove(cyclic_id_t id)
1276 {
1277         cyc_id_t *idp = (cyc_id_t *)id;
1278         cyc_id_t *prev = idp->cyi_prev, *next = idp->cyi_next;
1279         cyc_cpu_t *cpu = idp->cyi_cpu;
1280
1281         ASSERT(MUTEX_HELD(&cpu_lock));
1282
1283         if (cpu != NULL) {
1284                 (void) cyclic_remove_here(cpu, idp->cyi_ndx, NULL, CY_WAIT);
1285         } else {
1286                 ASSERT(idp->cyi_omni_list != NULL);
1287                 while (idp->cyi_omni_list != NULL)
1288                         cyclic_omni_stop(idp, idp->cyi_omni_list->cyo_cpu);
1289         }
1290
1291         if (prev != NULL) {
1292                 ASSERT(cyclic_id_head != idp);
1293                 prev->cyi_next = next;
1294         } else {
1295                 ASSERT(cyclic_id_head == idp);
1296                 cyclic_id_head = next;
1297         }
1298
1299         if (next != NULL)
1300                 next->cyi_prev = prev;
1301
1302         kmem_cache_free(cyclic_id_cache, idp);
1303 }
1304
1305 static void
1306 cyclic_init(cyc_backend_t *be)
1307 {
1308         ASSERT(MUTEX_HELD(&cpu_lock));
1309
1310         /*
1311          * Copy the passed cyc_backend into the backend template.  This must
1312          * be done before the CPU can be configured.
1313          */
1314         bcopy(be, &cyclic_backend, sizeof (cyc_backend_t));
1315
1316         cyclic_configure(&solaris_cpu[curcpu]);
1317 }
1318
1319 /*
1320  * It is assumed that cyclic_mp_init() is called some time after cyclic
1321  * init (and therefore, after cpu0 has been initialized).  We grab cpu_lock,
1322  * find the already initialized CPU, and initialize every other CPU with the
1323  * same backend.
1324  */
1325 static void
1326 cyclic_mp_init(void)
1327 {
1328         cpu_t *c;
1329         int i;
1330
1331         mutex_enter(&cpu_lock);
1332
1333         CPU_FOREACH(i) {
1334                 c = &solaris_cpu[i];
1335                 if (c->cpu_cyclic == NULL)
1336                         cyclic_configure(c);
1337         }
1338
1339         mutex_exit(&cpu_lock);
1340 }
1341
1342 static void
1343 cyclic_uninit(void)
1344 {
1345         cpu_t *c;
1346         int id;
1347
1348         CPU_FOREACH(id) {
1349                 c = &solaris_cpu[id];
1350                 if (c->cpu_cyclic == NULL)
1351                         continue;
1352                 cyclic_unconfigure(c);
1353         }
1354
1355         if (cyclic_id_cache != NULL)
1356                 kmem_cache_destroy(cyclic_id_cache);
1357 }
1358
1359 #include "cyclic_machdep.c"
1360
1361 /*
1362  *  Cyclic subsystem initialisation.
1363  */
1364 static void
1365 cyclic_load(void *dummy)
1366 {
1367         mutex_enter(&cpu_lock);
1368
1369         /* Initialise the machine-dependent backend. */
1370         cyclic_machdep_init();
1371
1372         mutex_exit(&cpu_lock);
1373 }
1374
1375 SYSINIT(cyclic_register, SI_SUB_CYCLIC, SI_ORDER_SECOND, cyclic_load, NULL);
1376
1377 static void
1378 cyclic_unload(void)
1379 {
1380         mutex_enter(&cpu_lock);
1381
1382         /* Uninitialise the machine-dependent backend. */
1383         cyclic_machdep_uninit();
1384
1385         mutex_exit(&cpu_lock);
1386 }
1387
1388 SYSUNINIT(cyclic_unregister, SI_SUB_CYCLIC, SI_ORDER_SECOND, cyclic_unload, NULL);
1389
1390 /* ARGSUSED */
1391 static int
1392 cyclic_modevent(module_t mod __unused, int type, void *data __unused)
1393 {
1394         int error = 0;
1395
1396         switch (type) {
1397         case MOD_LOAD:
1398                 break;
1399
1400         case MOD_UNLOAD:
1401                 break;
1402
1403         case MOD_SHUTDOWN:
1404                 break;
1405
1406         default:
1407                 error = EOPNOTSUPP;
1408                 break;
1409
1410         }
1411         return (error);
1412 }
1413
1414 DEV_MODULE(cyclic, cyclic_modevent, NULL);
1415 MODULE_VERSION(cyclic, 1);
1416 MODULE_DEPEND(cyclic, opensolaris, 1, 1, 1);