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#include <linux/init.h>
36
37#include <asm/time.h>
38#include <asm/cpu-features.h>
39
40#include <asm/netlogic/interrupt.h>
41#include <asm/netlogic/common.h>
42#include <asm/netlogic/haldefs.h>
43
44#if defined(CONFIG_CPU_XLP)
45#include <asm/netlogic/xlp-hal/iomap.h>
46#include <asm/netlogic/xlp-hal/xlp.h>
47#include <asm/netlogic/xlp-hal/sys.h>
48#include <asm/netlogic/xlp-hal/pic.h>
49#elif defined(CONFIG_CPU_XLR)
50#include <asm/netlogic/xlr/iomap.h>
51#include <asm/netlogic/xlr/pic.h>
52#include <asm/netlogic/xlr/xlr.h>
53#else
54#error "Unknown CPU"
55#endif
56
57unsigned int get_c0_compare_int(void)
58{
59 return IRQ_TIMER;
60}
61
62static u64 nlm_get_pic_timer(struct clocksource *cs)
63{
64 uint64_t picbase = nlm_get_node(0)->picbase;
65
66 return ~nlm_pic_read_timer(picbase, PIC_CLOCK_TIMER);
67}
68
69static u64 nlm_get_pic_timer32(struct clocksource *cs)
70{
71 uint64_t picbase = nlm_get_node(0)->picbase;
72
73 return ~nlm_pic_read_timer32(picbase, PIC_CLOCK_TIMER);
74}
75
76static struct clocksource csrc_pic = {
77 .name = "PIC",
78 .flags = CLOCK_SOURCE_IS_CONTINUOUS,
79};
80
81static void nlm_init_pic_timer(void)
82{
83 uint64_t picbase = nlm_get_node(0)->picbase;
84 u32 picfreq;
85
86 nlm_pic_set_timer(picbase, PIC_CLOCK_TIMER, ~0ULL, 0, 0);
87 if (current_cpu_data.cputype == CPU_XLR) {
88 csrc_pic.mask = CLOCKSOURCE_MASK(32);
89 csrc_pic.read = nlm_get_pic_timer32;
90 } else {
91 csrc_pic.mask = CLOCKSOURCE_MASK(64);
92 csrc_pic.read = nlm_get_pic_timer;
93 }
94 csrc_pic.rating = 1000;
95 picfreq = pic_timer_freq();
96 clocksource_register_hz(&csrc_pic, picfreq);
97 pr_info("PIC clock source added, frequency %d\n", picfreq);
98}
99
100void __init plat_time_init(void)
101{
102 nlm_init_pic_timer();
103 mips_hpt_frequency = nlm_get_cpu_frequency();
104 if (current_cpu_type() == CPU_XLR)
105 preset_lpj = mips_hpt_frequency / (3 * HZ);
106 else
107 preset_lpj = mips_hpt_frequency / (2 * HZ);
108 pr_info("MIPS counter frequency [%ld]\n",
109 (unsigned long)mips_hpt_frequency);
110}
111