git.sur5r.net Git - u-boot/blob - arch/powerpc/lib/interrupts.c

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