arch/powerpc/lib/interrupts.c

   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 <irq_func.h>
  12 #include <asm/processor.h>
  13 #include <watchdog.h>
  14 #ifdef CONFIG_LED_STATUS
  15 #include <status_led.h>
  16 #endif
  17 #include <asm/ptrace.h>
  18
  19 #ifndef CONFIG_MPC83XX_TIMER
  20 #ifndef CONFIG_SYS_WATCHDOG_FREQ
  21 #define CONFIG_SYS_WATCHDOG_FREQ (CONFIG_SYS_HZ / 2)
  22 #endif
  23
  24 static unsigned decrementer_count; /* count value for 1e6/HZ microseconds */
  25
  26 static __inline__ unsigned long get_dec (void)
  27 {
  28         unsigned long val;
  29
  30         asm volatile ("mfdec %0":"=r" (val):);
  31
  32         return val;
  33 }
  34
  35
  36 static __inline__ void set_dec (unsigned long val)
  37 {
  38         if (val)
  39                 asm volatile ("mtdec %0"::"r" (val));
  40 }
  41 #endif /* !CONFIG_MPC83XX_TIMER */
  42
  43 void enable_interrupts(void)
  44 {
  45         set_msr (get_msr () | MSR_EE);
  46 }
  47
  48 /* returns flag if MSR_EE was set before */
  49 int disable_interrupts(void)
  50 {
  51         ulong msr = get_msr ();
  52
  53         set_msr (msr & ~MSR_EE);
  54         return ((msr & MSR_EE) != 0);
  55 }
  56
  57 #ifndef CONFIG_MPC83XX_TIMER
  58 int interrupt_init(void)
  59 {
  60         /* call cpu specific function from $(CPU)/interrupts.c */
  61         interrupt_init_cpu (&decrementer_count);
  62
  63         set_dec (decrementer_count);
  64
  65         set_msr (get_msr () | MSR_EE);
  66
  67         return (0);
  68 }
  69
  70 static volatile ulong timestamp = 0;
  71
  72 void timer_interrupt(struct pt_regs *regs)
  73 {
  74         /* call cpu specific function from $(CPU)/interrupts.c */
  75         timer_interrupt_cpu (regs);
  76
  77         /* Restore Decrementer Count */
  78         set_dec (decrementer_count);
  79
  80         timestamp++;
  81
  82 #if defined(CONFIG_WATCHDOG) || defined (CONFIG_HW_WATCHDOG)
  83         if ((timestamp % (CONFIG_SYS_WATCHDOG_FREQ)) == 0)
  84                 WATCHDOG_RESET ();
  85 #endif    /* CONFIG_WATCHDOG || CONFIG_HW_WATCHDOG */
  86
  87 #ifdef CONFIG_LED_STATUS
  88         status_led_tick(timestamp);
  89 #endif /* CONFIG_LED_STATUS */
  90 }
  91
  92 ulong get_timer (ulong base)
  93 {
  94         return (timestamp - base);
  95 }
  96 #endif /* !CONFIG_MPC83XX_TIMER */