cpu/mpc85xx/interrupts.c

   1 /*
   2  * (C) Copyright 2000-2002
   3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4  *
   5  * (C) Copyright 2002 (440 port)
   6  * Scott McNutt, Artesyn Communication Producs, smcnutt@artsyncp.com
   7  *
   8  * (C) Copyright 2003 Motorola Inc. (MPC85xx port)
   9  * Xianghua Xiao (X.Xiao@motorola.com)
  10  *
  11  * See file CREDITS for list of people who contributed to this
  12  * project.
  13  *
  14  * This program is free software; you can redistribute it and/or
  15  * modify it under the terms of the GNU General Public License as
  16  * published by the Free Software Foundation; either version 2 of
  17  * the License, or (at your option) any later version.
  18  *
  19  * This program is distributed in the hope that it will be useful,
  20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  22  * GNU General Public License for more details.
  23  *
  24  * You should have received a copy of the GNU General Public License
  25  * along with this program; if not, write to the Free Software
  26  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  27  * MA 02111-1307 USA
  28  */
  29
  30 #include <common.h>
  31 #include <watchdog.h>
  32 #include <command.h>
  33 #include <asm/processor.h>
  34 #include <ppc_asm.tmpl>
  35
  36 unsigned decrementer_count;             /* count value for 1e6/HZ microseconds */
  37
  38 static __inline__ unsigned long get_msr(void)
  39 {
  40         unsigned long msr;
  41
  42         asm volatile("mfmsr %0" : "=r" (msr) :);
  43         return msr;
  44 }
  45
  46 static __inline__ void set_msr(unsigned long msr)
  47 {
  48         asm volatile("mtmsr %0" : : "r" (msr));
  49         asm volatile("isync");
  50 }
  51
  52 static __inline__ unsigned long get_dec (void)
  53 {
  54         unsigned long val;
  55
  56         asm volatile ("mfdec %0":"=r" (val):);
  57
  58         return val;
  59 }
  60
  61
  62 static __inline__ void set_dec (unsigned long val)
  63 {
  64         if (val)
  65                 asm volatile ("mtdec %0"::"r" (val));
  66 }
  67
  68 void enable_interrupts (void)
  69 {
  70         set_msr (get_msr() | MSR_EE);
  71 }
  72
  73 /* returns flag if MSR_EE was set before */
  74 int disable_interrupts (void)
  75 {
  76         ulong msr = get_msr();
  77         set_msr (msr & ~MSR_EE);
  78         return ((msr & MSR_EE) != 0);
  79 }
  80
  81 int interrupt_init (void)
  82 {
  83         volatile immap_t *immr = (immap_t *)CFG_IMMR;
  84
  85         immr->im_pic.gcr = MPC85xx_PICGCR_RST;
  86         while (immr->im_pic.gcr & MPC85xx_PICGCR_RST);
  87         immr->im_pic.gcr = MPC85xx_PICGCR_M;
  88         decrementer_count = get_tbclk() / CFG_HZ;
  89         mtspr(SPRN_TCR, TCR_PIE);
  90         set_dec (decrementer_count);
  91         set_msr (get_msr () | MSR_EE);
  92         return (0);
  93 }
  94
  95 /*
  96  * Install and free a interrupt handler. Not implemented yet.
  97  */
  98
  99 void
 100 irq_install_handler(int vec, interrupt_handler_t *handler, void *arg)
 101 {
 102         return;
 103 }
 104
 105 void
 106 irq_free_handler(int vec)
 107 {
 108         return;
 109 }
 110
 111 /****************************************************************************/
 112
 113
 114 volatile ulong timestamp = 0;
 115
 116 /*
 117  * timer_interrupt - gets called when the decrementer overflows,
 118  * with interrupts disabled.
 119  * Trivial implementation - no need to be really accurate.
 120  */
 121 void timer_interrupt(struct pt_regs *regs)
 122 {
 123         timestamp++;
 124         set_dec (decrementer_count);
 125         mtspr(SPRN_TSR, TSR_PIS);
 126 #if defined(CONFIG_WATCHDOG)
 127         if ((timestamp % 1000) == 0)
 128                 reset_85xx_watchdog();
 129 #endif /* CONFIG_WATCHDOG */
 130 }
 131
 132 void reset_timer (void)
 133 {
 134         timestamp = 0;
 135 }
 136
 137 ulong get_timer (ulong base)
 138 {
 139         return (timestamp - base);
 140 }
 141
 142 void set_timer (ulong t)
 143 {
 144         timestamp = t;
 145 }
 146
 147 #if defined(CONFIG_CMD_IRQ)
 148
 149 /*******************************************************************************
 150  *
 151  * irqinfo - print information about PCI devices,not implemented.
 152  *
 153  */
 154 int
 155 do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 156 {
 157         printf ("\nInterrupt-unsupported:\n");
 158
 159         return 0;
 160 }
 161
 162 #endif