blob: 1a0bee04ef8c0a458685809f4df0858aa31e6fae [file] [log] [blame]
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -08001/*
2 * linux/kernel/time/tick-broadcast.c
3 *
4 * This file contains functions which emulate a local clock-event
5 * device via a broadcast event source.
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>
Russell Kingd7b90682008-04-17 07:46:24 +020017#include <linux/interrupt.h>
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080018#include <linux/percpu.h>
19#include <linux/profile.h>
20#include <linux/sched.h>
Mark Rutland12ad1002013-01-14 17:05:22 +000021#include <linux/smp.h>
Thomas Gleixnerccf33d62013-04-25 20:31:49 +000022#include <linux/module.h>
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080023
24#include "tick-internal.h"
25
26/*
27 * Broadcast support for broken x86 hardware, where the local apic
28 * timer stops in C3 state.
29 */
30
Dmitri Vorobieva52f5c52009-05-01 13:10:21 -070031static struct tick_device tick_broadcast_device;
Thomas Gleixnerb352bc12013-03-05 14:25:32 +010032static cpumask_var_t tick_broadcast_mask;
Thomas Gleixner07bd1172013-07-01 22:14:10 +020033static cpumask_var_t tick_broadcast_on;
Thomas Gleixnerb352bc12013-03-05 14:25:32 +010034static cpumask_var_t tmpmask;
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +010035static DEFINE_RAW_SPINLOCK(tick_broadcast_lock);
Thomas Gleixner592a4382015-04-03 02:01:10 +020036static int tick_broadcast_forced;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080037
Thomas Gleixner5590a532007-07-21 04:37:35 -070038#ifdef CONFIG_TICK_ONESHOT
39static void tick_broadcast_clear_oneshot(int cpu);
Thomas Gleixner080873c2015-03-25 13:09:55 +010040static void tick_resume_broadcast_oneshot(struct clock_event_device *bc);
Thomas Gleixner5590a532007-07-21 04:37:35 -070041#else
42static inline void tick_broadcast_clear_oneshot(int cpu) { }
Thomas Gleixner080873c2015-03-25 13:09:55 +010043static inline void tick_resume_broadcast_oneshot(struct clock_event_device *bc) { }
Thomas Gleixner5590a532007-07-21 04:37:35 -070044#endif
45
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080046/*
Ingo Molnar289f4802007-02-16 01:28:15 -080047 * Debugging: see timer_list.c
48 */
49struct tick_device *tick_get_broadcast_device(void)
50{
51 return &tick_broadcast_device;
52}
53
Rusty Russell6b954822009-01-01 10:12:25 +103054struct cpumask *tick_get_broadcast_mask(void)
Ingo Molnar289f4802007-02-16 01:28:15 -080055{
Thomas Gleixnerb352bc12013-03-05 14:25:32 +010056 return tick_broadcast_mask;
Ingo Molnar289f4802007-02-16 01:28:15 -080057}
58
59/*
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080060 * Start the device in periodic mode
61 */
62static void tick_broadcast_start_periodic(struct clock_event_device *bc)
63{
Thomas Gleixner18de5bc2007-07-21 04:37:34 -070064 if (bc)
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080065 tick_setup_periodic(bc, 1);
66}
67
68/*
69 * Check, if the device can be utilized as broadcast device:
70 */
Thomas Gleixner45cb8e02013-04-25 20:31:50 +000071static bool tick_check_broadcast_device(struct clock_event_device *curdev,
72 struct clock_event_device *newdev)
73{
74 if ((newdev->features & CLOCK_EVT_FEAT_DUMMY) ||
Soren Brinkmann245a3492013-09-18 11:48:37 -070075 (newdev->features & CLOCK_EVT_FEAT_PERCPU) ||
Thomas Gleixner45cb8e02013-04-25 20:31:50 +000076 (newdev->features & CLOCK_EVT_FEAT_C3STOP))
77 return false;
78
79 if (tick_broadcast_device.mode == TICKDEV_MODE_ONESHOT &&
80 !(newdev->features & CLOCK_EVT_FEAT_ONESHOT))
81 return false;
82
83 return !curdev || newdev->rating > curdev->rating;
84}
85
86/*
87 * Conditionally install/replace broadcast device
88 */
Thomas Gleixner7172a2862013-04-25 20:31:47 +000089void tick_install_broadcast_device(struct clock_event_device *dev)
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080090{
Thomas Gleixner6f7a05d2013-04-25 11:45:53 +020091 struct clock_event_device *cur = tick_broadcast_device.evtdev;
92
Thomas Gleixner45cb8e02013-04-25 20:31:50 +000093 if (!tick_check_broadcast_device(cur, dev))
Thomas Gleixner7172a2862013-04-25 20:31:47 +000094 return;
Thomas Gleixner45cb8e02013-04-25 20:31:50 +000095
Thomas Gleixnerccf33d62013-04-25 20:31:49 +000096 if (!try_module_get(dev->owner))
97 return;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -080098
Thomas Gleixner45cb8e02013-04-25 20:31:50 +000099 clockevents_exchange_device(cur, dev);
Thomas Gleixner6f7a05d2013-04-25 11:45:53 +0200100 if (cur)
101 cur->event_handler = clockevents_handle_noop;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800102 tick_broadcast_device.evtdev = dev;
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100103 if (!cpumask_empty(tick_broadcast_mask))
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800104 tick_broadcast_start_periodic(dev);
Stephen Boydc038c1c2013-04-17 10:26:06 -0700105 /*
106 * Inform all cpus about this. We might be in a situation
107 * where we did not switch to oneshot mode because the per cpu
108 * devices are affected by CLOCK_EVT_FEAT_C3STOP and the lack
109 * of a oneshot capable broadcast device. Without that
110 * notification the systems stays stuck in periodic mode
111 * forever.
112 */
113 if (dev->features & CLOCK_EVT_FEAT_ONESHOT)
114 tick_clock_notify();
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800115}
116
117/*
118 * Check, if the device is the broadcast device
119 */
120int tick_is_broadcast_device(struct clock_event_device *dev)
121{
122 return (dev && tick_broadcast_device.evtdev == dev);
123}
124
Thomas Gleixner627ee792014-02-03 14:34:31 -0800125int tick_broadcast_update_freq(struct clock_event_device *dev, u32 freq)
126{
127 int ret = -ENODEV;
128
129 if (tick_is_broadcast_device(dev)) {
130 raw_spin_lock(&tick_broadcast_lock);
131 ret = __clockevents_update_freq(dev, freq);
132 raw_spin_unlock(&tick_broadcast_lock);
133 }
134 return ret;
135}
136
137
Mark Rutland12ad1002013-01-14 17:05:22 +0000138static void err_broadcast(const struct cpumask *mask)
139{
140 pr_crit_once("Failed to broadcast timer tick. Some CPUs may be unresponsive.\n");
141}
142
Mark Rutland5d1d9a22013-02-08 15:24:07 +0000143static void tick_device_setup_broadcast_func(struct clock_event_device *dev)
144{
145 if (!dev->broadcast)
146 dev->broadcast = tick_broadcast;
147 if (!dev->broadcast) {
148 pr_warn_once("%s depends on broadcast, but no broadcast function available\n",
149 dev->name);
150 dev->broadcast = err_broadcast;
151 }
152}
153
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800154/*
155 * Check, if the device is disfunctional and a place holder, which
156 * needs to be handled by the broadcast device.
157 */
158int tick_device_uses_broadcast(struct clock_event_device *dev, int cpu)
159{
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200160 struct clock_event_device *bc = tick_broadcast_device.evtdev;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800161 unsigned long flags;
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200162 int ret;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800163
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100164 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800165
166 /*
167 * Devices might be registered with both periodic and oneshot
168 * mode disabled. This signals, that the device needs to be
169 * operated from the broadcast device and is a placeholder for
170 * the cpu local device.
171 */
172 if (!tick_device_is_functional(dev)) {
173 dev->event_handler = tick_handle_periodic;
Mark Rutland5d1d9a22013-02-08 15:24:07 +0000174 tick_device_setup_broadcast_func(dev);
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100175 cpumask_set_cpu(cpu, tick_broadcast_mask);
Stephen Boyda272dcc2013-07-11 07:00:59 -0700176 if (tick_broadcast_device.mode == TICKDEV_MODE_PERIODIC)
177 tick_broadcast_start_periodic(bc);
178 else
179 tick_broadcast_setup_oneshot(bc);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800180 ret = 1;
Thomas Gleixner5590a532007-07-21 04:37:35 -0700181 } else {
182 /*
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200183 * Clear the broadcast bit for this cpu if the
184 * device is not power state affected.
Thomas Gleixner5590a532007-07-21 04:37:35 -0700185 */
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200186 if (!(dev->features & CLOCK_EVT_FEAT_C3STOP))
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100187 cpumask_clear_cpu(cpu, tick_broadcast_mask);
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200188 else
Mark Rutland5d1d9a22013-02-08 15:24:07 +0000189 tick_device_setup_broadcast_func(dev);
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200190
191 /*
192 * Clear the broadcast bit if the CPU is not in
193 * periodic broadcast on state.
194 */
195 if (!cpumask_test_cpu(cpu, tick_broadcast_on))
196 cpumask_clear_cpu(cpu, tick_broadcast_mask);
197
198 switch (tick_broadcast_device.mode) {
199 case TICKDEV_MODE_ONESHOT:
200 /*
201 * If the system is in oneshot mode we can
202 * unconditionally clear the oneshot mask bit,
203 * because the CPU is running and therefore
204 * not in an idle state which causes the power
205 * state affected device to stop. Let the
206 * caller initialize the device.
207 */
208 tick_broadcast_clear_oneshot(cpu);
209 ret = 0;
210 break;
211
212 case TICKDEV_MODE_PERIODIC:
213 /*
214 * If the system is in periodic mode, check
215 * whether the broadcast device can be
216 * switched off now.
217 */
218 if (cpumask_empty(tick_broadcast_mask) && bc)
219 clockevents_shutdown(bc);
220 /*
221 * If we kept the cpu in the broadcast mask,
222 * tell the caller to leave the per cpu device
223 * in shutdown state. The periodic interrupt
224 * is delivered by the broadcast device.
225 */
226 ret = cpumask_test_cpu(cpu, tick_broadcast_mask);
227 break;
228 default:
229 /* Nothing to do */
230 ret = 0;
231 break;
Thomas Gleixner5590a532007-07-21 04:37:35 -0700232 }
233 }
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100234 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800235 return ret;
236}
237
Mark Rutland12572db2013-01-14 17:05:21 +0000238#ifdef CONFIG_GENERIC_CLOCKEVENTS_BROADCAST
239int tick_receive_broadcast(void)
240{
241 struct tick_device *td = this_cpu_ptr(&tick_cpu_device);
242 struct clock_event_device *evt = td->evtdev;
243
244 if (!evt)
245 return -ENODEV;
246
247 if (!evt->event_handler)
248 return -EINVAL;
249
250 evt->event_handler(evt);
251 return 0;
252}
253#endif
254
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800255/*
Rusty Russell6b954822009-01-01 10:12:25 +1030256 * Broadcast the event to the cpus, which are set in the mask (mangled).
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800257 */
Rusty Russell6b954822009-01-01 10:12:25 +1030258static void tick_do_broadcast(struct cpumask *mask)
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800259{
Thomas Gleixner186e3cb2008-01-30 13:30:01 +0100260 int cpu = smp_processor_id();
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800261 struct tick_device *td;
262
263 /*
264 * Check, if the current cpu is in the mask
265 */
Rusty Russell6b954822009-01-01 10:12:25 +1030266 if (cpumask_test_cpu(cpu, mask)) {
267 cpumask_clear_cpu(cpu, mask);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800268 td = &per_cpu(tick_cpu_device, cpu);
269 td->evtdev->event_handler(td->evtdev);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800270 }
271
Rusty Russell6b954822009-01-01 10:12:25 +1030272 if (!cpumask_empty(mask)) {
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800273 /*
274 * It might be necessary to actually check whether the devices
275 * have different broadcast functions. For now, just use the
276 * one of the first device. This works as long as we have this
277 * misfeature only on x86 (lapic)
278 */
Rusty Russell6b954822009-01-01 10:12:25 +1030279 td = &per_cpu(tick_cpu_device, cpumask_first(mask));
280 td->evtdev->broadcast(mask);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800281 }
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800282}
283
284/*
285 * Periodic broadcast:
286 * - invoke the broadcast handlers
287 */
288static void tick_do_periodic_broadcast(void)
289{
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100290 cpumask_and(tmpmask, cpu_online_mask, tick_broadcast_mask);
291 tick_do_broadcast(tmpmask);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800292}
293
294/*
295 * Event handler for periodic broadcast ticks
296 */
297static void tick_handle_periodic_broadcast(struct clock_event_device *dev)
298{
Thomas Gleixnerd4496b32008-09-03 21:36:57 +0000299 ktime_t next;
300
Thomas Gleixner627ee792014-02-03 14:34:31 -0800301 raw_spin_lock(&tick_broadcast_lock);
302
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800303 tick_do_periodic_broadcast();
304
305 /*
306 * The device is in periodic mode. No reprogramming necessary:
307 */
Viresh Kumar77e32c82015-02-27 17:21:33 +0530308 if (dev->state == CLOCK_EVT_STATE_PERIODIC)
Thomas Gleixner627ee792014-02-03 14:34:31 -0800309 goto unlock;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800310
311 /*
312 * Setup the next period for devices, which do not have
Thomas Gleixnerd4496b32008-09-03 21:36:57 +0000313 * periodic mode. We read dev->next_event first and add to it
Uwe Kleine-König698f9312010-07-02 20:41:51 +0200314 * when the event already expired. clockevents_program_event()
Thomas Gleixnerd4496b32008-09-03 21:36:57 +0000315 * sets dev->next_event only when the event is really
316 * programmed to the device.
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800317 */
Thomas Gleixnerd4496b32008-09-03 21:36:57 +0000318 for (next = dev->next_event; ;) {
319 next = ktime_add(next, tick_period);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800320
Martin Schwidefskyd1748302011-08-23 15:29:42 +0200321 if (!clockevents_program_event(dev, next, false))
Thomas Gleixner627ee792014-02-03 14:34:31 -0800322 goto unlock;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800323 tick_do_periodic_broadcast();
324 }
Thomas Gleixner627ee792014-02-03 14:34:31 -0800325unlock:
326 raw_spin_unlock(&tick_broadcast_lock);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800327}
328
Thomas Gleixner592a4382015-04-03 02:01:10 +0200329/**
330 * tick_broadcast_control - Enable/disable or force broadcast mode
331 * @mode: The selected broadcast mode
332 *
333 * Called when the system enters a state where affected tick devices
334 * might stop. Note: TICK_BROADCAST_FORCE cannot be undone.
335 *
336 * Called with interrupts disabled, so clockevents_lock is not
337 * required here because the local clock event device cannot go away
338 * under us.
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800339 */
Thomas Gleixner592a4382015-04-03 02:01:10 +0200340void tick_broadcast_control(enum tick_broadcast_mode mode)
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800341{
342 struct clock_event_device *bc, *dev;
343 struct tick_device *td;
Thomas Gleixner9c17bcd2008-09-03 21:37:08 +0000344 int cpu, bc_stopped;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800345
Thomas Gleixner592a4382015-04-03 02:01:10 +0200346 td = this_cpu_ptr(&tick_cpu_device);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800347 dev = td->evtdev;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800348
349 /*
Thomas Gleixner1595f452007-10-14 22:57:45 +0200350 * Is the device not affected by the powerstate ?
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800351 */
Thomas Gleixner1595f452007-10-14 22:57:45 +0200352 if (!dev || !(dev->features & CLOCK_EVT_FEAT_C3STOP))
Thomas Gleixner592a4382015-04-03 02:01:10 +0200353 return;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800354
Thomas Gleixner3dfbc882007-10-17 18:04:32 +0200355 if (!tick_device_is_functional(dev))
Thomas Gleixner592a4382015-04-03 02:01:10 +0200356 return;
Thomas Gleixner1595f452007-10-14 22:57:45 +0200357
Thomas Gleixner592a4382015-04-03 02:01:10 +0200358 raw_spin_lock(&tick_broadcast_lock);
359 cpu = smp_processor_id();
360 bc = tick_broadcast_device.evtdev;
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100361 bc_stopped = cpumask_empty(tick_broadcast_mask);
Thomas Gleixner9c17bcd2008-09-03 21:37:08 +0000362
Thomas Gleixner592a4382015-04-03 02:01:10 +0200363 switch (mode) {
364 case TICK_BROADCAST_FORCE:
365 tick_broadcast_forced = 1;
366 case TICK_BROADCAST_ON:
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200367 cpumask_set_cpu(cpu, tick_broadcast_on);
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100368 if (!cpumask_test_and_set_cpu(cpu, tick_broadcast_mask)) {
Thomas Gleixner07454bf2008-10-04 10:51:07 +0200369 if (tick_broadcast_device.mode ==
370 TICKDEV_MODE_PERIODIC)
Thomas Gleixner2344abb2008-09-16 11:32:50 -0700371 clockevents_shutdown(dev);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800372 }
Thomas Gleixner1595f452007-10-14 22:57:45 +0200373 break;
Thomas Gleixner592a4382015-04-03 02:01:10 +0200374
375 case TICK_BROADCAST_OFF:
376 if (tick_broadcast_forced)
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200377 break;
378 cpumask_clear_cpu(cpu, tick_broadcast_on);
379 if (!tick_device_is_functional(dev))
380 break;
381 if (cpumask_test_and_clear_cpu(cpu, tick_broadcast_mask)) {
Thomas Gleixner07454bf2008-10-04 10:51:07 +0200382 if (tick_broadcast_device.mode ==
383 TICKDEV_MODE_PERIODIC)
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800384 tick_setup_periodic(dev, 0);
385 }
Thomas Gleixner1595f452007-10-14 22:57:45 +0200386 break;
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800387 }
388
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100389 if (cpumask_empty(tick_broadcast_mask)) {
Thomas Gleixner9c17bcd2008-09-03 21:37:08 +0000390 if (!bc_stopped)
Thomas Gleixner2344abb2008-09-16 11:32:50 -0700391 clockevents_shutdown(bc);
Thomas Gleixner9c17bcd2008-09-03 21:37:08 +0000392 } else if (bc_stopped) {
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800393 if (tick_broadcast_device.mode == TICKDEV_MODE_PERIODIC)
394 tick_broadcast_start_periodic(bc);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800395 else
396 tick_broadcast_setup_oneshot(bc);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800397 }
Thomas Gleixner592a4382015-04-03 02:01:10 +0200398 raw_spin_unlock(&tick_broadcast_lock);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800399}
Thomas Gleixner592a4382015-04-03 02:01:10 +0200400EXPORT_SYMBOL_GPL(tick_broadcast_control);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800401
402/*
403 * Set the periodic handler depending on broadcast on/off
404 */
405void tick_set_periodic_handler(struct clock_event_device *dev, int broadcast)
406{
407 if (!broadcast)
408 dev->event_handler = tick_handle_periodic;
409 else
410 dev->event_handler = tick_handle_periodic_broadcast;
411}
412
413/*
414 * Remove a CPU from broadcasting
415 */
416void tick_shutdown_broadcast(unsigned int *cpup)
417{
418 struct clock_event_device *bc;
419 unsigned long flags;
420 unsigned int cpu = *cpup;
421
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100422 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800423
424 bc = tick_broadcast_device.evtdev;
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100425 cpumask_clear_cpu(cpu, tick_broadcast_mask);
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200426 cpumask_clear_cpu(cpu, tick_broadcast_on);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800427
428 if (tick_broadcast_device.mode == TICKDEV_MODE_PERIODIC) {
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100429 if (bc && cpumask_empty(tick_broadcast_mask))
Thomas Gleixner2344abb2008-09-16 11:32:50 -0700430 clockevents_shutdown(bc);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800431 }
432
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100433 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Thomas Gleixnerf8381cb2007-02-16 01:28:02 -0800434}
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800435
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100436void tick_suspend_broadcast(void)
437{
438 struct clock_event_device *bc;
439 unsigned long flags;
440
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100441 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100442
443 bc = tick_broadcast_device.evtdev;
Thomas Gleixner18de5bc2007-07-21 04:37:34 -0700444 if (bc)
Thomas Gleixner2344abb2008-09-16 11:32:50 -0700445 clockevents_shutdown(bc);
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100446
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100447 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100448}
449
Thomas Gleixnerf46481d2015-03-25 13:11:04 +0100450/*
451 * This is called from tick_resume_local() on a resuming CPU. That's
452 * called from the core resume function, tick_unfreeze() and the magic XEN
453 * resume hackery.
454 *
455 * In none of these cases the broadcast device mode can change and the
456 * bit of the resuming CPU in the broadcast mask is safe as well.
457 */
458bool tick_resume_check_broadcast(void)
459{
460 if (tick_broadcast_device.mode == TICKDEV_MODE_ONESHOT)
461 return false;
462 else
463 return cpumask_test_cpu(smp_processor_id(), tick_broadcast_mask);
464}
465
466void tick_resume_broadcast(void)
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100467{
468 struct clock_event_device *bc;
469 unsigned long flags;
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100470
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100471 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100472
473 bc = tick_broadcast_device.evtdev;
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100474
Thomas Gleixnercd05a1f2007-03-17 00:25:52 +0100475 if (bc) {
Viresh Kumar554ef382015-02-27 17:21:32 +0530476 clockevents_tick_resume(bc);
Thomas Gleixner18de5bc2007-07-21 04:37:34 -0700477
Thomas Gleixnercd05a1f2007-03-17 00:25:52 +0100478 switch (tick_broadcast_device.mode) {
479 case TICKDEV_MODE_PERIODIC:
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100480 if (!cpumask_empty(tick_broadcast_mask))
Thomas Gleixnercd05a1f2007-03-17 00:25:52 +0100481 tick_broadcast_start_periodic(bc);
Thomas Gleixnercd05a1f2007-03-17 00:25:52 +0100482 break;
483 case TICKDEV_MODE_ONESHOT:
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100484 if (!cpumask_empty(tick_broadcast_mask))
Thomas Gleixner080873c2015-03-25 13:09:55 +0100485 tick_resume_broadcast_oneshot(bc);
Thomas Gleixnercd05a1f2007-03-17 00:25:52 +0100486 break;
487 }
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100488 }
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100489 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Thomas Gleixner6321dd62007-03-06 08:25:42 +0100490}
491
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800492#ifdef CONFIG_TICK_ONESHOT
493
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100494static cpumask_var_t tick_broadcast_oneshot_mask;
Thomas Gleixner26517f32013-03-06 11:18:35 +0000495static cpumask_var_t tick_broadcast_pending_mask;
Thomas Gleixner989dcb62013-03-06 11:18:35 +0000496static cpumask_var_t tick_broadcast_force_mask;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800497
Ingo Molnar289f4802007-02-16 01:28:15 -0800498/*
Rusty Russell6b954822009-01-01 10:12:25 +1030499 * Exposed for debugging: see timer_list.c
Ingo Molnar289f4802007-02-16 01:28:15 -0800500 */
Rusty Russell6b954822009-01-01 10:12:25 +1030501struct cpumask *tick_get_broadcast_oneshot_mask(void)
Ingo Molnar289f4802007-02-16 01:28:15 -0800502{
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100503 return tick_broadcast_oneshot_mask;
Ingo Molnar289f4802007-02-16 01:28:15 -0800504}
505
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100506/*
Thomas Gleixnereaa907c2013-03-06 11:18:36 +0000507 * Called before going idle with interrupts disabled. Checks whether a
508 * broadcast event from the other core is about to happen. We detected
509 * that in tick_broadcast_oneshot_control(). The callsite can use this
510 * to avoid a deep idle transition as we are about to get the
511 * broadcast IPI right away.
512 */
513int tick_check_broadcast_expired(void)
514{
515 return cpumask_test_cpu(smp_processor_id(), tick_broadcast_force_mask);
516}
517
518/*
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100519 * Set broadcast interrupt affinity
520 */
521static void tick_broadcast_set_affinity(struct clock_event_device *bc,
522 const struct cpumask *cpumask)
523{
524 if (!(bc->features & CLOCK_EVT_FEAT_DYNIRQ))
525 return;
526
527 if (cpumask_equal(bc->cpumask, cpumask))
528 return;
529
530 bc->cpumask = cpumask;
531 irq_set_affinity(bc->irq, bc->cpumask);
532}
533
534static int tick_broadcast_set_event(struct clock_event_device *bc, int cpu,
Daniel Lezcanof9ae39d2013-03-02 11:10:10 +0100535 ktime_t expires, int force)
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800536{
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100537 int ret;
538
Viresh Kumar77e32c82015-02-27 17:21:33 +0530539 if (bc->state != CLOCK_EVT_STATE_ONESHOT)
540 clockevents_set_state(bc, CLOCK_EVT_STATE_ONESHOT);
Thomas Gleixnerb9a6a2352012-04-18 17:31:58 +0200541
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100542 ret = clockevents_program_event(bc, expires, force);
543 if (!ret)
544 tick_broadcast_set_affinity(bc, cpumask_of(cpu));
545 return ret;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800546}
547
Thomas Gleixner080873c2015-03-25 13:09:55 +0100548static void tick_resume_broadcast_oneshot(struct clock_event_device *bc)
Thomas Gleixnercd05a1f2007-03-17 00:25:52 +0100549{
Viresh Kumar77e32c82015-02-27 17:21:33 +0530550 clockevents_set_state(bc, CLOCK_EVT_STATE_ONESHOT);
Thomas Gleixnercd05a1f2007-03-17 00:25:52 +0100551}
552
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800553/*
Thomas Gleixnerfb02fbc2008-10-17 10:01:23 +0200554 * Called from irq_enter() when idle was interrupted to reenable the
555 * per cpu device.
556 */
Frederic Weisbeckere8fcaa52013-08-07 22:28:01 +0200557void tick_check_oneshot_broadcast_this_cpu(void)
Thomas Gleixnerfb02fbc2008-10-17 10:01:23 +0200558{
Frederic Weisbeckere8fcaa52013-08-07 22:28:01 +0200559 if (cpumask_test_cpu(smp_processor_id(), tick_broadcast_oneshot_mask)) {
Christoph Lameter22127e92014-08-17 12:30:25 -0500560 struct tick_device *td = this_cpu_ptr(&tick_cpu_device);
Thomas Gleixnerfb02fbc2008-10-17 10:01:23 +0200561
Thomas Gleixner1f73a982013-07-01 22:14:10 +0200562 /*
563 * We might be in the middle of switching over from
564 * periodic to oneshot. If the CPU has not yet
565 * switched over, leave the device alone.
566 */
567 if (td->mode == TICKDEV_MODE_ONESHOT) {
Viresh Kumar77e32c82015-02-27 17:21:33 +0530568 clockevents_set_state(td->evtdev,
569 CLOCK_EVT_STATE_ONESHOT);
Thomas Gleixner1f73a982013-07-01 22:14:10 +0200570 }
Thomas Gleixnerfb02fbc2008-10-17 10:01:23 +0200571 }
572}
573
574/*
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800575 * Handle oneshot mode broadcasting
576 */
577static void tick_handle_oneshot_broadcast(struct clock_event_device *dev)
578{
579 struct tick_device *td;
Thomas Gleixnercdc6f272007-12-18 18:05:58 +0100580 ktime_t now, next_event;
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100581 int cpu, next_cpu = 0;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800582
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100583 raw_spin_lock(&tick_broadcast_lock);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800584again:
585 dev->next_event.tv64 = KTIME_MAX;
Thomas Gleixnercdc6f272007-12-18 18:05:58 +0100586 next_event.tv64 = KTIME_MAX;
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100587 cpumask_clear(tmpmask);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800588 now = ktime_get();
589 /* Find all expired events */
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100590 for_each_cpu(cpu, tick_broadcast_oneshot_mask) {
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800591 td = &per_cpu(tick_cpu_device, cpu);
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100592 if (td->evtdev->next_event.tv64 <= now.tv64) {
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100593 cpumask_set_cpu(cpu, tmpmask);
Thomas Gleixner26517f32013-03-06 11:18:35 +0000594 /*
595 * Mark the remote cpu in the pending mask, so
596 * it can avoid reprogramming the cpu local
597 * timer in tick_broadcast_oneshot_control().
598 */
599 cpumask_set_cpu(cpu, tick_broadcast_pending_mask);
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100600 } else if (td->evtdev->next_event.tv64 < next_event.tv64) {
Thomas Gleixnercdc6f272007-12-18 18:05:58 +0100601 next_event.tv64 = td->evtdev->next_event.tv64;
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100602 next_cpu = cpu;
603 }
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800604 }
605
Thomas Gleixner2938d272013-05-28 09:33:01 +0200606 /*
607 * Remove the current cpu from the pending mask. The event is
608 * delivered immediately in tick_do_broadcast() !
609 */
610 cpumask_clear_cpu(smp_processor_id(), tick_broadcast_pending_mask);
611
Thomas Gleixner989dcb62013-03-06 11:18:35 +0000612 /* Take care of enforced broadcast requests */
613 cpumask_or(tmpmask, tmpmask, tick_broadcast_force_mask);
614 cpumask_clear(tick_broadcast_force_mask);
615
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800616 /*
Thomas Gleixnerc9b5a262013-06-26 12:17:32 +0200617 * Sanity check. Catch the case where we try to broadcast to
618 * offline cpus.
619 */
620 if (WARN_ON_ONCE(!cpumask_subset(tmpmask, cpu_online_mask)))
621 cpumask_and(tmpmask, tmpmask, cpu_online_mask);
622
623 /*
Thomas Gleixnercdc6f272007-12-18 18:05:58 +0100624 * Wakeup the cpus which have an expired event.
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800625 */
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100626 tick_do_broadcast(tmpmask);
Thomas Gleixnercdc6f272007-12-18 18:05:58 +0100627
628 /*
629 * Two reasons for reprogram:
630 *
631 * - The global event did not expire any CPU local
632 * events. This happens in dyntick mode, as the maximum PIT
633 * delta is quite small.
634 *
635 * - There are pending events on sleeping CPUs which were not
636 * in the event mask
637 */
638 if (next_event.tv64 != KTIME_MAX) {
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800639 /*
Thomas Gleixnercdc6f272007-12-18 18:05:58 +0100640 * Rearm the broadcast device. If event expired,
641 * repeat the above
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800642 */
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100643 if (tick_broadcast_set_event(dev, next_cpu, next_event, 0))
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800644 goto again;
645 }
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100646 raw_spin_unlock(&tick_broadcast_lock);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800647}
648
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530649static int broadcast_needs_cpu(struct clock_event_device *bc, int cpu)
650{
651 if (!(bc->features & CLOCK_EVT_FEAT_HRTIMER))
652 return 0;
653 if (bc->next_event.tv64 == KTIME_MAX)
654 return 0;
655 return bc->bound_on == cpu ? -EBUSY : 0;
656}
657
658static void broadcast_shutdown_local(struct clock_event_device *bc,
659 struct clock_event_device *dev)
660{
661 /*
662 * For hrtimer based broadcasting we cannot shutdown the cpu
663 * local device if our own event is the first one to expire or
664 * if we own the broadcast timer.
665 */
666 if (bc->features & CLOCK_EVT_FEAT_HRTIMER) {
667 if (broadcast_needs_cpu(bc, smp_processor_id()))
668 return;
669 if (dev->next_event.tv64 < bc->next_event.tv64)
670 return;
671 }
Viresh Kumar77e32c82015-02-27 17:21:33 +0530672 clockevents_set_state(dev, CLOCK_EVT_STATE_SHUTDOWN);
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530673}
674
Preeti U Murthy345527b2015-03-30 14:59:19 +0530675void hotplug_cpu__broadcast_tick_pull(int deadcpu)
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530676{
Preeti U Murthy345527b2015-03-30 14:59:19 +0530677 struct clock_event_device *bc;
678 unsigned long flags;
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530679
Preeti U Murthy345527b2015-03-30 14:59:19 +0530680 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
681 bc = tick_broadcast_device.evtdev;
682
683 if (bc && broadcast_needs_cpu(bc, deadcpu)) {
684 /* This moves the broadcast assignment to this CPU: */
685 clockevents_program_event(bc, bc->next_event, 1);
686 }
687 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530688}
689
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800690/*
691 * Powerstate information: The system enters/leaves a state, where
692 * affected devices might stop
Preeti U Murthyda7e6f42014-02-07 13:36:06 +0530693 * Returns 0 on success, -EBUSY if the cpu is used to broadcast wakeups.
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800694 */
Preeti U Murthyda7e6f42014-02-07 13:36:06 +0530695int tick_broadcast_oneshot_control(unsigned long reason)
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800696{
697 struct clock_event_device *bc, *dev;
698 struct tick_device *td;
699 unsigned long flags;
Thomas Gleixner989dcb62013-03-06 11:18:35 +0000700 ktime_t now;
Preeti U Murthyda7e6f42014-02-07 13:36:06 +0530701 int cpu, ret = 0;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800702
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800703 /*
704 * Periodic mode does not care about the enter/exit of power
705 * states
706 */
707 if (tick_broadcast_device.mode == TICKDEV_MODE_PERIODIC)
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530708 return 0;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800709
Andi Kleen7372b0b2011-05-04 15:09:27 -0700710 /*
711 * We are called with preemtion disabled from the depth of the
712 * idle code, so we can't be moved away.
713 */
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800714 cpu = smp_processor_id();
715 td = &per_cpu(tick_cpu_device, cpu);
716 dev = td->evtdev;
717
718 if (!(dev->features & CLOCK_EVT_FEAT_C3STOP))
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530719 return 0;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800720
Andi Kleen7372b0b2011-05-04 15:09:27 -0700721 bc = tick_broadcast_device.evtdev;
722
723 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800724 if (reason == CLOCK_EVT_NOTIFY_BROADCAST_ENTER) {
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100725 if (!cpumask_test_and_set_cpu(cpu, tick_broadcast_oneshot_mask)) {
Thomas Gleixner2938d272013-05-28 09:33:01 +0200726 WARN_ON_ONCE(cpumask_test_cpu(cpu, tick_broadcast_pending_mask));
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530727 broadcast_shutdown_local(bc, dev);
Thomas Gleixner989dcb62013-03-06 11:18:35 +0000728 /*
729 * We only reprogram the broadcast timer if we
730 * did not mark ourself in the force mask and
731 * if the cpu local event is earlier than the
732 * broadcast event. If the current CPU is in
733 * the force mask, then we are going to be
734 * woken by the IPI right away.
735 */
736 if (!cpumask_test_cpu(cpu, tick_broadcast_force_mask) &&
737 dev->next_event.tv64 < bc->next_event.tv64)
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100738 tick_broadcast_set_event(bc, cpu, dev->next_event, 1);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800739 }
Preeti U Murthy5d1638a2014-02-07 13:36:32 +0530740 /*
741 * If the current CPU owns the hrtimer broadcast
742 * mechanism, it cannot go deep idle and we remove the
743 * CPU from the broadcast mask. We don't have to go
744 * through the EXIT path as the local timer is not
745 * shutdown.
746 */
747 ret = broadcast_needs_cpu(bc, cpu);
748 if (ret)
749 cpumask_clear_cpu(cpu, tick_broadcast_oneshot_mask);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800750 } else {
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100751 if (cpumask_test_and_clear_cpu(cpu, tick_broadcast_oneshot_mask)) {
Viresh Kumar77e32c82015-02-27 17:21:33 +0530752 clockevents_set_state(dev, CLOCK_EVT_STATE_ONESHOT);
Thomas Gleixner26517f32013-03-06 11:18:35 +0000753 /*
754 * The cpu which was handling the broadcast
755 * timer marked this cpu in the broadcast
756 * pending mask and fired the broadcast
757 * IPI. So we are going to handle the expired
758 * event anyway via the broadcast IPI
759 * handler. No need to reprogram the timer
760 * with an already expired event.
761 */
762 if (cpumask_test_and_clear_cpu(cpu,
763 tick_broadcast_pending_mask))
764 goto out;
765
Thomas Gleixner989dcb62013-03-06 11:18:35 +0000766 /*
Daniel Lezcanoea8deb82013-06-17 18:15:35 +0200767 * Bail out if there is no next event.
768 */
769 if (dev->next_event.tv64 == KTIME_MAX)
770 goto out;
771 /*
Thomas Gleixner989dcb62013-03-06 11:18:35 +0000772 * If the pending bit is not set, then we are
773 * either the CPU handling the broadcast
774 * interrupt or we got woken by something else.
775 *
776 * We are not longer in the broadcast mask, so
777 * if the cpu local expiry time is already
778 * reached, we would reprogram the cpu local
779 * timer with an already expired event.
780 *
781 * This can lead to a ping-pong when we return
782 * to idle and therefor rearm the broadcast
783 * timer before the cpu local timer was able
784 * to fire. This happens because the forced
785 * reprogramming makes sure that the event
786 * will happen in the future and depending on
787 * the min_delta setting this might be far
788 * enough out that the ping-pong starts.
789 *
790 * If the cpu local next_event has expired
791 * then we know that the broadcast timer
792 * next_event has expired as well and
793 * broadcast is about to be handled. So we
794 * avoid reprogramming and enforce that the
795 * broadcast handler, which did not run yet,
796 * will invoke the cpu local handler.
797 *
798 * We cannot call the handler directly from
799 * here, because we might be in a NOHZ phase
800 * and we did not go through the irq_enter()
801 * nohz fixups.
802 */
803 now = ktime_get();
804 if (dev->next_event.tv64 <= now.tv64) {
805 cpumask_set_cpu(cpu, tick_broadcast_force_mask);
806 goto out;
807 }
808 /*
809 * We got woken by something else. Reprogram
810 * the cpu local timer device.
811 */
Thomas Gleixner26517f32013-03-06 11:18:35 +0000812 tick_program_event(dev->next_event, 1);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800813 }
814 }
Thomas Gleixner26517f32013-03-06 11:18:35 +0000815out:
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100816 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Preeti U Murthyda7e6f42014-02-07 13:36:06 +0530817 return ret;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800818}
819
Thomas Gleixner5590a532007-07-21 04:37:35 -0700820/*
821 * Reset the one shot broadcast for a cpu
822 *
823 * Called with tick_broadcast_lock held
824 */
825static void tick_broadcast_clear_oneshot(int cpu)
826{
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100827 cpumask_clear_cpu(cpu, tick_broadcast_oneshot_mask);
Thomas Gleixnerdd5fd9b2014-02-11 14:35:40 +0100828 cpumask_clear_cpu(cpu, tick_broadcast_pending_mask);
Thomas Gleixner5590a532007-07-21 04:37:35 -0700829}
830
Rusty Russell6b954822009-01-01 10:12:25 +1030831static void tick_broadcast_init_next_event(struct cpumask *mask,
832 ktime_t expires)
Thomas Gleixner73007112008-09-06 03:01:45 +0200833{
834 struct tick_device *td;
835 int cpu;
836
Rusty Russell5db0e1e2009-01-01 10:12:29 +1030837 for_each_cpu(cpu, mask) {
Thomas Gleixner73007112008-09-06 03:01:45 +0200838 td = &per_cpu(tick_cpu_device, cpu);
839 if (td->evtdev)
840 td->evtdev->next_event = expires;
841 }
842}
843
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800844/**
Li Zefan8dce39c2007-11-05 14:51:10 -0800845 * tick_broadcast_setup_oneshot - setup the broadcast device
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800846 */
847void tick_broadcast_setup_oneshot(struct clock_event_device *bc)
848{
Thomas Gleixner07f4beb2011-05-16 11:07:48 +0200849 int cpu = smp_processor_id();
850
Thomas Gleixner9c17bcd2008-09-03 21:37:08 +0000851 /* Set it up only once ! */
852 if (bc->event_handler != tick_handle_oneshot_broadcast) {
Viresh Kumar77e32c82015-02-27 17:21:33 +0530853 int was_periodic = bc->state == CLOCK_EVT_STATE_PERIODIC;
Thomas Gleixner73007112008-09-06 03:01:45 +0200854
Thomas Gleixner9c17bcd2008-09-03 21:37:08 +0000855 bc->event_handler = tick_handle_oneshot_broadcast;
Thomas Gleixner73007112008-09-06 03:01:45 +0200856
Thomas Gleixner73007112008-09-06 03:01:45 +0200857 /*
858 * We must be careful here. There might be other CPUs
859 * waiting for periodic broadcast. We need to set the
860 * oneshot_mask bits for those and program the
861 * broadcast device to fire.
862 */
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100863 cpumask_copy(tmpmask, tick_broadcast_mask);
864 cpumask_clear_cpu(cpu, tmpmask);
865 cpumask_or(tick_broadcast_oneshot_mask,
866 tick_broadcast_oneshot_mask, tmpmask);
Thomas Gleixner73007112008-09-06 03:01:45 +0200867
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100868 if (was_periodic && !cpumask_empty(tmpmask)) {
Viresh Kumar77e32c82015-02-27 17:21:33 +0530869 clockevents_set_state(bc, CLOCK_EVT_STATE_ONESHOT);
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100870 tick_broadcast_init_next_event(tmpmask,
Rusty Russell6b954822009-01-01 10:12:25 +1030871 tick_next_period);
Daniel Lezcanod2348fb2013-03-02 11:10:11 +0100872 tick_broadcast_set_event(bc, cpu, tick_next_period, 1);
Thomas Gleixner73007112008-09-06 03:01:45 +0200873 } else
874 bc->next_event.tv64 = KTIME_MAX;
Thomas Gleixner07f4beb2011-05-16 11:07:48 +0200875 } else {
876 /*
877 * The first cpu which switches to oneshot mode sets
878 * the bit for all other cpus which are in the general
879 * (periodic) broadcast mask. So the bit is set and
880 * would prevent the first broadcast enter after this
881 * to program the bc device.
882 */
883 tick_broadcast_clear_oneshot(cpu);
Thomas Gleixner9c17bcd2008-09-03 21:37:08 +0000884 }
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800885}
886
887/*
888 * Select oneshot operating mode for the broadcast device
889 */
890void tick_broadcast_switch_to_oneshot(void)
891{
892 struct clock_event_device *bc;
893 unsigned long flags;
894
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100895 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
Suresh Siddhafa4da362012-04-09 15:41:44 -0700896
897 tick_broadcast_device.mode = TICKDEV_MODE_ONESHOT;
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800898 bc = tick_broadcast_device.evtdev;
899 if (bc)
900 tick_broadcast_setup_oneshot(bc);
Suresh Siddha77b0d602011-11-04 17:18:21 -0700901
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100902 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800903}
904
905
906/*
907 * Remove a dead CPU from broadcasting
908 */
909void tick_shutdown_broadcast_oneshot(unsigned int *cpup)
910{
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800911 unsigned long flags;
912 unsigned int cpu = *cpup;
913
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100914 raw_spin_lock_irqsave(&tick_broadcast_lock, flags);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800915
Thomas Gleixner31d9b392007-09-16 15:36:43 +0200916 /*
Thomas Gleixnerc9b5a262013-06-26 12:17:32 +0200917 * Clear the broadcast masks for the dead cpu, but do not stop
918 * the broadcast device!
Thomas Gleixner31d9b392007-09-16 15:36:43 +0200919 */
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100920 cpumask_clear_cpu(cpu, tick_broadcast_oneshot_mask);
Thomas Gleixnerc9b5a262013-06-26 12:17:32 +0200921 cpumask_clear_cpu(cpu, tick_broadcast_pending_mask);
922 cpumask_clear_cpu(cpu, tick_broadcast_force_mask);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800923
Thomas Gleixnerb5f91da2009-12-08 12:40:31 +0100924 raw_spin_unlock_irqrestore(&tick_broadcast_lock, flags);
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800925}
926
Thomas Gleixner27ce4cb2008-09-22 19:04:02 +0200927/*
928 * Check, whether the broadcast device is in one shot mode
929 */
930int tick_broadcast_oneshot_active(void)
931{
932 return tick_broadcast_device.mode == TICKDEV_MODE_ONESHOT;
933}
934
Thomas Gleixner3a142a02011-02-25 22:34:23 +0100935/*
936 * Check whether the broadcast device supports oneshot.
937 */
938bool tick_broadcast_oneshot_available(void)
939{
940 struct clock_event_device *bc = tick_broadcast_device.evtdev;
941
942 return bc ? bc->features & CLOCK_EVT_FEAT_ONESHOT : false;
943}
944
Thomas Gleixner79bf2bb2007-02-16 01:28:03 -0800945#endif
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100946
947void __init tick_broadcast_init(void)
948{
Thomas Gleixnerfbd44a62013-05-03 20:22:36 +0200949 zalloc_cpumask_var(&tick_broadcast_mask, GFP_NOWAIT);
Thomas Gleixner07bd1172013-07-01 22:14:10 +0200950 zalloc_cpumask_var(&tick_broadcast_on, GFP_NOWAIT);
Thomas Gleixnerfbd44a62013-05-03 20:22:36 +0200951 zalloc_cpumask_var(&tmpmask, GFP_NOWAIT);
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100952#ifdef CONFIG_TICK_ONESHOT
Thomas Gleixnerfbd44a62013-05-03 20:22:36 +0200953 zalloc_cpumask_var(&tick_broadcast_oneshot_mask, GFP_NOWAIT);
954 zalloc_cpumask_var(&tick_broadcast_pending_mask, GFP_NOWAIT);
955 zalloc_cpumask_var(&tick_broadcast_force_mask, GFP_NOWAIT);
Thomas Gleixnerb352bc12013-03-05 14:25:32 +0100956#endif
957}