Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net-2.6
[linux-2.6] / kernel / time / tick-oneshot.c
1 /*
2  * linux/kernel/time/tick-oneshot.c
3  *
4  * This file contains functions which manage high resolution tick
5  * related events.
6  *
7  * Copyright(C) 2005-2006, Thomas Gleixner <tglx@linutronix.de>
8  * Copyright(C) 2005-2007, Red Hat, Inc., Ingo Molnar
9  * Copyright(C) 2006-2007, Timesys Corp., Thomas Gleixner
10  *
11  * This code is licenced under the GPL version 2. For details see
12  * kernel-base/COPYING.
13  */
14 #include <linux/cpu.h>
15 #include <linux/err.h>
16 #include <linux/hrtimer.h>
17 #include <linux/interrupt.h>
18 #include <linux/percpu.h>
19 #include <linux/profile.h>
20 #include <linux/sched.h>
21 #include <linux/tick.h>
22
23 #include "tick-internal.h"
24
25 /**
26  * tick_program_event internal worker function
27  */
28 int tick_dev_program_event(struct clock_event_device *dev, ktime_t expires,
29                            int force)
30 {
31         ktime_t now = ktime_get();
32         int i;
33
34         for (i = 0;;) {
35                 int ret = clockevents_program_event(dev, expires, now);
36
37                 if (!ret || !force)
38                         return ret;
39
40                 /*
41                  * We tried 2 times to program the device with the given
42                  * min_delta_ns. If that's not working then we double it
43                  * and emit a warning.
44                  */
45                 if (++i > 2) {
46                         printk(KERN_WARNING "CE: __tick_program_event of %s is "
47                                "stuck %llx %llx\n", dev->name ? dev->name : "?",
48                                now.tv64, expires.tv64);
49                         printk(KERN_WARNING
50                                "CE: increasing min_delta_ns %ld to %ld nsec\n",
51                                dev->min_delta_ns, dev->min_delta_ns << 1);
52                         WARN_ON(1);
53
54                         /* Double the min. delta and try again */
55                         if (!dev->min_delta_ns)
56                                 dev->min_delta_ns = 5000;
57                         else
58                                 dev->min_delta_ns <<= 1;
59                         i = 0;
60                 }
61
62                 now = ktime_get();
63                 expires = ktime_add_ns(now, dev->min_delta_ns);
64         }
65 }
66
67 /**
68  * tick_program_event
69  */
70 int tick_program_event(ktime_t expires, int force)
71 {
72         struct clock_event_device *dev = __get_cpu_var(tick_cpu_device).evtdev;
73
74         return tick_dev_program_event(dev, expires, force);
75 }
76
77 /**
78  * tick_resume_onshot - resume oneshot mode
79  */
80 void tick_resume_oneshot(void)
81 {
82         struct tick_device *td = &__get_cpu_var(tick_cpu_device);
83         struct clock_event_device *dev = td->evtdev;
84
85         clockevents_set_mode(dev, CLOCK_EVT_MODE_ONESHOT);
86         tick_program_event(ktime_get(), 1);
87 }
88
89 /**
90  * tick_setup_oneshot - setup the event device for oneshot mode (hres or nohz)
91  */
92 void tick_setup_oneshot(struct clock_event_device *newdev,
93                         void (*handler)(struct clock_event_device *),
94                         ktime_t next_event)
95 {
96         newdev->event_handler = handler;
97         clockevents_set_mode(newdev, CLOCK_EVT_MODE_ONESHOT);
98         tick_dev_program_event(newdev, next_event, 1);
99 }
100
101 /**
102  * tick_switch_to_oneshot - switch to oneshot mode
103  */
104 int tick_switch_to_oneshot(void (*handler)(struct clock_event_device *))
105 {
106         struct tick_device *td = &__get_cpu_var(tick_cpu_device);
107         struct clock_event_device *dev = td->evtdev;
108
109         if (!dev || !(dev->features & CLOCK_EVT_FEAT_ONESHOT) ||
110                     !tick_device_is_functional(dev)) {
111
112                 printk(KERN_INFO "Clockevents: "
113                        "could not switch to one-shot mode:");
114                 if (!dev) {
115                         printk(" no tick device\n");
116                 } else {
117                         if (!tick_device_is_functional(dev))
118                                 printk(" %s is not functional.\n", dev->name);
119                         else
120                                 printk(" %s does not support one-shot mode.\n",
121                                        dev->name);
122                 }
123                 return -EINVAL;
124         }
125
126         td->mode = TICKDEV_MODE_ONESHOT;
127         dev->event_handler = handler;
128         clockevents_set_mode(dev, CLOCK_EVT_MODE_ONESHOT);
129         tick_broadcast_switch_to_oneshot();
130         return 0;
131 }
132
133 #ifdef CONFIG_HIGH_RES_TIMERS
134 /**
135  * tick_init_highres - switch to high resolution mode
136  *
137  * Called with interrupts disabled.
138  */
139 int tick_init_highres(void)
140 {
141         return tick_switch_to_oneshot(hrtimer_interrupt);
142 }
143 #endif