1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/errno.h>
14#include <linux/module.h>
15#include <linux/rtc.h>
16#include <linux/sched.h>
17#include <linux/sched_clock.h>
18#include <linux/kernel.h>
19#include <linux/param.h>
20#include <linux/string.h>
21#include <linux/mm.h>
22#include <linux/interrupt.h>
23#include <linux/time.h>
24#include <linux/init.h>
25#include <linux/smp.h>
26#include <linux/profile.h>
27#include <linux/clocksource.h>
28#include <linux/platform_device.h>
29#include <linux/ftrace.h>
30
31#include <linux/uaccess.h>
32#include <asm/io.h>
33#include <asm/irq.h>
34#include <asm/page.h>
35#include <asm/param.h>
36#include <asm/pdc.h>
37#include <asm/led.h>
38
39#include <linux/timex.h>
40
41static unsigned long clocktick __read_mostly;
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60irqreturn_t __irq_entry timer_interrupt(int irq, void *dev_id)
61{
62 unsigned long now;
63 unsigned long next_tick;
64 unsigned long ticks_elapsed = 0;
65 unsigned int cpu = smp_processor_id();
66 struct cpuinfo_parisc *cpuinfo = &per_cpu(cpu_data, cpu);
67
68
69 unsigned long cpt = clocktick;
70
71 profile_tick(CPU_PROFILING);
72
73
74 next_tick = cpuinfo->it_value;
75
76
77 do {
78 ++ticks_elapsed;
79 next_tick += cpt;
80 now = mfctl(16);
81 } while (next_tick - now > cpt);
82
83
84 cpuinfo->it_value = next_tick;
85
86
87 if (cpu == 0)
88 xtime_update(ticks_elapsed);
89
90 update_process_times(user_mode(get_irq_regs()));
91
92
93
94
95
96
97
98
99
100
101
102
103
104 while (next_tick - mfctl(16) > cpt)
105 next_tick += cpt;
106
107
108
109
110
111
112
113 if (next_tick - mfctl(16) <= 500)
114 next_tick += cpt;
115 mtctl(next_tick, 16);
116
117 return IRQ_HANDLED;
118}
119
120
121unsigned long profile_pc(struct pt_regs *regs)
122{
123 unsigned long pc = instruction_pointer(regs);
124
125 if (regs->gr[0] & PSW_N)
126 pc -= 4;
127
128#ifdef CONFIG_SMP
129 if (in_lock_functions(pc))
130 pc = regs->gr[2];
131#endif
132
133 return pc;
134}
135EXPORT_SYMBOL(profile_pc);
136
137
138
139
140static u64 notrace read_cr16(struct clocksource *cs)
141{
142 return get_cycles();
143}
144
145static struct clocksource clocksource_cr16 = {
146 .name = "cr16",
147 .rating = 300,
148 .read = read_cr16,
149 .mask = CLOCKSOURCE_MASK(BITS_PER_LONG),
150 .flags = CLOCK_SOURCE_IS_CONTINUOUS,
151};
152
153void __init start_cpu_itimer(void)
154{
155 unsigned int cpu = smp_processor_id();
156 unsigned long next_tick = mfctl(16) + clocktick;
157
158 mtctl(next_tick, 16);
159
160 per_cpu(cpu_data, cpu).it_value = next_tick;
161}
162
163#if IS_ENABLED(CONFIG_RTC_DRV_GENERIC)
164static int rtc_generic_get_time(struct device *dev, struct rtc_time *tm)
165{
166 struct pdc_tod tod_data;
167
168 memset(tm, 0, sizeof(*tm));
169 if (pdc_tod_read(&tod_data) < 0)
170 return -EOPNOTSUPP;
171
172
173 rtc_time64_to_tm(tod_data.tod_sec, tm);
174 return rtc_valid_tm(tm);
175}
176
177static int rtc_generic_set_time(struct device *dev, struct rtc_time *tm)
178{
179 time64_t secs = rtc_tm_to_time64(tm);
180
181 if (pdc_tod_set(secs, 0) < 0)
182 return -EOPNOTSUPP;
183
184 return 0;
185}
186
187static const struct rtc_class_ops rtc_generic_ops = {
188 .read_time = rtc_generic_get_time,
189 .set_time = rtc_generic_set_time,
190};
191
192static int __init rtc_init(void)
193{
194 struct platform_device *pdev;
195
196 pdev = platform_device_register_data(NULL, "rtc-generic", -1,
197 &rtc_generic_ops,
198 sizeof(rtc_generic_ops));
199
200 return PTR_ERR_OR_ZERO(pdev);
201}
202device_initcall(rtc_init);
203#endif
204
205void read_persistent_clock(struct timespec *ts)
206{
207 static struct pdc_tod tod_data;
208 if (pdc_tod_read(&tod_data) == 0) {
209 ts->tv_sec = tod_data.tod_sec;
210 ts->tv_nsec = tod_data.tod_usec * 1000;
211 } else {
212 printk(KERN_ERR "Error reading tod clock\n");
213 ts->tv_sec = 0;
214 ts->tv_nsec = 0;
215 }
216}
217
218
219static u64 notrace read_cr16_sched_clock(void)
220{
221 return get_cycles();
222}
223
224
225
226
227
228
229void __init time_init(void)
230{
231 unsigned long cr16_hz;
232
233 clocktick = (100 * PAGE0->mem_10msec) / HZ;
234 start_cpu_itimer();
235
236 cr16_hz = 100 * PAGE0->mem_10msec;
237
238
239 sched_clock_register(read_cr16_sched_clock, BITS_PER_LONG, cr16_hz);
240}
241
242static int __init init_cr16_clocksource(void)
243{
244
245
246
247
248 if (num_online_cpus() > 1) {
249 clocksource_cr16.flags = CLOCK_SOURCE_UNSTABLE;
250 clocksource_cr16.rating = 0;
251 }
252
253
254 clocksource_register_hz(&clocksource_cr16,
255 100 * PAGE0->mem_10msec);
256
257 return 0;
258}
259
260device_initcall(init_cr16_clocksource);
261