2 * Copyright (C) 2008, Broadcom Corporation
5 * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
6 * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
7 * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
8 * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
10 * $Id: time.c,v 1.9 2009/07/17 06:23:12 Exp $
12 #include <linux/config.h>
13 #include <linux/init.h>
14 #include <linux/kernel.h>
15 #include <linux/sched.h>
16 #include <linux/serial_reg.h>
17 #include <linux/interrupt.h>
18 #include <asm/addrspace.h>
34 /* Global SB handle */
35 extern si_t
*bcm947xx_sih
;
36 extern spinlock_t bcm947xx_sih_lock
;
39 #define sih bcm947xx_sih
40 #define sih_lock bcm947xx_sih_lock
42 #define WATCHDOG_MIN 3000 /* milliseconds */
43 extern int panic_timeout
;
44 static int watchdog
= 0;
45 extern int bcm947xx_cpu_clk
; //Tomato RAF features
48 static u8
*mcr
= NULL
;
49 #endif /* CONFIG_HWSIM */
52 bcm947xx_time_init(void)
58 * Use deterministic values for initial counter interrupt
59 * so that calibrate delay avoids encountering a counter wrap.
62 write_c0_compare(0xffff);
64 /* 5354 could run both on 200 & 240 Mhz -- use nvram setting */
65 if (sih
->chip
== BCM5354_CHIP_ID
&& nvram_match("clkfreq", "200"))
68 if (!(hz
= si_cpu_clock(sih
)))
71 bcm_chipname(sih
->chip
, cn
, 8);
72 printk("CPU: BCM%s rev %d pkg %d at %d MHz\n", cn
, sih
->chiprev
, sih
->chippkg
,
73 (hz
+ 500000) / 1000000);
74 bcm947xx_cpu_clk
= (hz
+ 500000) / 1000000; //Tomato RAF feature
76 /* Set MIPS counter frequency for fixed_rate_gettimeoffset() */
77 if (sih
->chip
== BCM5354_CHIP_ID
&&
78 strncmp(nvram_safe_get("hardware_version"), "WL520G", 6) == 0)
79 mips_hpt_frequency
= 100000000; // Fix WL520GUGC clock
81 mips_hpt_frequency
= hz
/ 2;
83 /* Set watchdog interval in ms */
84 watchdog
= simple_strtoul(nvram_safe_get("watchdog"), NULL
, 0);
86 /* Ensure at least WATCHDOG_MIN */
87 if ((watchdog
> 0) && (watchdog
< WATCHDOG_MIN
))
88 watchdog
= WATCHDOG_MIN
;
90 /* Set panic timeout in seconds */
91 panic_timeout
= watchdog
/ 1000;
94 #ifdef CONFIG_HND_BMIPS3300_PROF
95 extern bool hndprofiling
;
97 typedef u_int64_t sbprof_pc
;
99 typedef u_int32_t sbprof_pc
;
101 extern void sbprof_cpu_intr(sbprof_pc restartpc
);
102 #endif /* CONFIG_HND_BMIPS3300_PROF */
105 bcm947xx_timer_interrupt(int irq
, void *dev_id
)
107 #ifdef CONFIG_HND_BMIPS3300_PROF
109 * Are there any ExcCode or other mean(s) to determine what has caused
110 * the timer interrupt? For now simply stop the normal timer proc if
111 * count register is less than compare register.
114 sbprof_cpu_intr(read_c0_epc() +
115 ((read_c0_cause() >> (CAUSEB_BD
- 2)) & 4));
116 if (read_c0_count() < read_c0_compare())
117 return (IRQ_HANDLED
);
119 #endif /* CONFIG_HND_BMIPS3300_PROF */
121 /* Generic MIPS timer code */
122 timer_interrupt(irq
, dev_id
);
124 /* Set the watchdog timer to reset after the specified number of ms */
126 if (((si_t
*)sih
)->chip
== BCM5354_CHIP_ID
)
127 si_watchdog(sih
, WATCHDOG_CLOCK_5354
/ 1000 * watchdog
);
129 si_watchdog_ms(sih
, watchdog
);
133 (*((int *)0xa0000f1c))++;
135 /* Blink one of the LEDs in the external UART */
136 if (mcr
&& !(jiffies
% (HZ
/2)))
137 writeb(readb(mcr
) ^ UART_MCR_OUT2
, mcr
);
140 return (IRQ_HANDLED
);
143 static struct irqaction bcm947xx_timer_irqaction
= {
144 bcm947xx_timer_interrupt
,
155 plat_timer_setup(struct irqaction
*irq
)
157 /* Enable the timer interrupt */
158 setup_irq(7, &bcm947xx_timer_irqaction
);
161 #define CFE_UPDATE 1 // added by Chen-I for mac/regulation update
164 void bcm947xx_watchdog_disable(void)