1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * (C) Copyright 2000-2002 4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de. 5 * 6 * (C) Copyright 2003 7 * Gleb Natapov <gnatapov@mrv.com> 8 */ 9 10 #include <common.h> 11 #include <asm/processor.h> 12 #include <watchdog.h> 13 #ifdef CONFIG_LED_STATUS 14 #include <status_led.h> 15 #endif 16 17 #ifdef CONFIG_SHOW_ACTIVITY 18 void board_show_activity (ulong) __attribute__((weak, alias("__board_show_activity"))); 19 __board_show_activity(ulong dummy)20void __board_show_activity (ulong dummy) 21 { 22 return; 23 } 24 #endif /* CONFIG_SHOW_ACTIVITY */ 25 26 #ifndef CONFIG_SYS_WATCHDOG_FREQ 27 #define CONFIG_SYS_WATCHDOG_FREQ (CONFIG_SYS_HZ / 2) 28 #endif 29 30 static unsigned decrementer_count; /* count value for 1e6/HZ microseconds */ 31 get_dec(void)32static __inline__ unsigned long get_dec (void) 33 { 34 unsigned long val; 35 36 asm volatile ("mfdec %0":"=r" (val):); 37 38 return val; 39 } 40 41 set_dec(unsigned long val)42static __inline__ void set_dec (unsigned long val) 43 { 44 if (val) 45 asm volatile ("mtdec %0"::"r" (val)); 46 } 47 48 enable_interrupts(void)49void enable_interrupts (void) 50 { 51 set_msr (get_msr () | MSR_EE); 52 } 53 54 /* returns flag if MSR_EE was set before */ disable_interrupts(void)55int disable_interrupts (void) 56 { 57 ulong msr = get_msr (); 58 59 set_msr (msr & ~MSR_EE); 60 return ((msr & MSR_EE) != 0); 61 } 62 interrupt_init(void)63int interrupt_init (void) 64 { 65 /* call cpu specific function from $(CPU)/interrupts.c */ 66 interrupt_init_cpu (&decrementer_count); 67 68 set_dec (decrementer_count); 69 70 set_msr (get_msr () | MSR_EE); 71 72 return (0); 73 } 74 75 static volatile ulong timestamp = 0; 76 timer_interrupt(struct pt_regs * regs)77void timer_interrupt (struct pt_regs *regs) 78 { 79 /* call cpu specific function from $(CPU)/interrupts.c */ 80 timer_interrupt_cpu (regs); 81 82 /* Restore Decrementer Count */ 83 set_dec (decrementer_count); 84 85 timestamp++; 86 87 #if defined(CONFIG_WATCHDOG) || defined (CONFIG_HW_WATCHDOG) 88 if ((timestamp % (CONFIG_SYS_WATCHDOG_FREQ)) == 0) 89 WATCHDOG_RESET (); 90 #endif /* CONFIG_WATCHDOG || CONFIG_HW_WATCHDOG */ 91 92 #ifdef CONFIG_LED_STATUS 93 status_led_tick (timestamp); 94 #endif /* CONFIG_LED_STATUS */ 95 96 #ifdef CONFIG_SHOW_ACTIVITY 97 board_show_activity (timestamp); 98 #endif /* CONFIG_SHOW_ACTIVITY */ 99 } 100 get_timer(ulong base)101ulong get_timer (ulong base) 102 { 103 return (timestamp - base); 104 } 105