hc
2024-08-14 865dc85cff0c170305dc18e865d2cb0b537a47ec
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
// SPDX-License-Identifier: GPL-2.0
/*
 * This file contains functions which manage high resolution tick
 * related events.
 *
 * Copyright(C) 2005-2006, Thomas Gleixner <tglx@linutronix.de>
 * Copyright(C) 2005-2007, Red Hat, Inc., Ingo Molnar
 * Copyright(C) 2006-2007, Timesys Corp., Thomas Gleixner
 */
#include <linux/cpu.h>
#include <linux/err.h>
#include <linux/hrtimer.h>
#include <linux/interrupt.h>
#include <linux/percpu.h>
#include <linux/profile.h>
#include <linux/sched.h>
 
#include "tick-internal.h"
 
/**
 * tick_program_event
 */
int tick_program_event(ktime_t expires, int force)
{
   struct clock_event_device *dev = __this_cpu_read(tick_cpu_device.evtdev);
 
   if (unlikely(expires == KTIME_MAX)) {
       /*
        * We don't need the clock event device any more, stop it.
        */
       clockevents_switch_state(dev, CLOCK_EVT_STATE_ONESHOT_STOPPED);
       dev->next_event = KTIME_MAX;
       return 0;
   }
 
   if (unlikely(clockevent_state_oneshot_stopped(dev))) {
       /*
        * We need the clock event again, configure it in ONESHOT mode
        * before using it.
        */
       clockevents_switch_state(dev, CLOCK_EVT_STATE_ONESHOT);
   }
 
   return clockevents_program_event(dev, expires, force);
}
 
/**
 * tick_resume_onshot - resume oneshot mode
 */
void tick_resume_oneshot(void)
{
   struct clock_event_device *dev = __this_cpu_read(tick_cpu_device.evtdev);
 
   clockevents_switch_state(dev, CLOCK_EVT_STATE_ONESHOT);
   clockevents_program_event(dev, ktime_get(), true);
}
 
/**
 * tick_setup_oneshot - setup the event device for oneshot mode (hres or nohz)
 */
void tick_setup_oneshot(struct clock_event_device *newdev,
           void (*handler)(struct clock_event_device *),
           ktime_t next_event)
{
   newdev->event_handler = handler;
   clockevents_switch_state(newdev, CLOCK_EVT_STATE_ONESHOT);
   clockevents_program_event(newdev, next_event, true);
}
 
/**
 * tick_switch_to_oneshot - switch to oneshot mode
 */
int tick_switch_to_oneshot(void (*handler)(struct clock_event_device *))
{
   struct tick_device *td = this_cpu_ptr(&tick_cpu_device);
   struct clock_event_device *dev = td->evtdev;
 
   if (!dev || !(dev->features & CLOCK_EVT_FEAT_ONESHOT) ||
           !tick_device_is_functional(dev)) {
 
       pr_info("Clockevents: could not switch to one-shot mode:");
       if (!dev) {
           pr_cont(" no tick device\n");
       } else {
           if (!tick_device_is_functional(dev))
               pr_cont(" %s is not functional.\n", dev->name);
           else
               pr_cont(" %s does not support one-shot mode.\n",
                   dev->name);
       }
       return -EINVAL;
   }
 
   td->mode = TICKDEV_MODE_ONESHOT;
   dev->event_handler = handler;
   clockevents_switch_state(dev, CLOCK_EVT_STATE_ONESHOT);
   tick_broadcast_switch_to_oneshot();
   return 0;
}
 
/**
 * tick_check_oneshot_mode - check whether the system is in oneshot mode
 *
 * returns 1 when either nohz or highres are enabled. otherwise 0.
 */
int tick_oneshot_mode_active(void)
{
   unsigned long flags;
   int ret;
 
   local_irq_save(flags);
   ret = __this_cpu_read(tick_cpu_device.mode) == TICKDEV_MODE_ONESHOT;
   local_irq_restore(flags);
 
   return ret;
}
 
#ifdef CONFIG_HIGH_RES_TIMERS
/**
 * tick_init_highres - switch to high resolution mode
 *
 * Called with interrupts disabled.
 */
int tick_init_highres(void)
{
   return tick_switch_to_oneshot(hrtimer_interrupt);
}
#endif