git.sur5r.net Git - u-boot/blob - cpu/mpc86xx/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  * (C) Copyright 2004 Freescale Semiconductor. (MPC86xx Port)
  12  * Jeff Brown
  13  * Srikanth Srinivasan (srikanth.srinivasan@freescale.com)
  14  *
  15  * See file CREDITS for list of people who contributed to this
  16  * project.
  17  *
  18  * This program is free software; you can redistribute it and/or
  19  * modify it under the terms of the GNU General Public License as
  20  * published by the Free Software Foundation; either version 2 of
  21  * the License, or (at your option) any later version.
  22  *
  23  * This program is distributed in the hope that it will be useful,
  24  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  25  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  26  * GNU General Public License for more details.
  27  *
  28  * You should have received a copy of the GNU General Public License
  29  * along with this program; if not, write to the Free Software
  30  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  31  * MA 02111-1307 USA
  32  */
  33
  34 #include <common.h>
  35 #include <mpc86xx.h>
  36 #include <command.h>
  37 #include <asm/processor.h>
  38 #include <ppc_asm.tmpl>
  39
  40 unsigned long decrementer_count;    /* count value for 1e6/HZ microseconds */
  41 unsigned long timestamp;
  42
  43
  44 static __inline__ unsigned long get_msr (void)
  45 {
  46         unsigned long msr;
  47
  48         asm volatile ("mfmsr %0":"=r" (msr):);
  49
  50         return msr;
  51 }
  52
  53 static __inline__ void set_msr (unsigned long msr)
  54 {
  55         asm volatile ("mtmsr %0"::"r" (msr));
  56 }
  57
  58 static __inline__ unsigned long get_dec (void)
  59 {
  60         unsigned long val;
  61
  62         asm volatile ("mfdec %0":"=r" (val):);
  63
  64         return val;
  65 }
  66
  67
  68 static __inline__ void set_dec (unsigned long val)
  69 {
  70         if (val)
  71                 asm volatile ("mtdec %0"::"r" (val));
  72 }
  73
  74 /* interrupt is not supported yet */
  75 int interrupt_init_cpu (unsigned *decrementer_count)
  76 {
  77         return 0;
  78 }
  79
  80
  81 int interrupt_init (void)
  82 {
  83         int ret;
  84
  85         /* call cpu specific function from $(CPU)/interrupts.c */
  86         ret = interrupt_init_cpu (&decrementer_count);
  87
  88         if (ret)
  89                 return ret;
  90
  91         decrementer_count = get_tbclk()/CFG_HZ;
  92         debug("interrupt init: tbclk() = %d MHz, decrementer_count = %d\n", (get_tbclk()/1000000), decrementer_count);
  93
  94         set_dec (decrementer_count);
  95
  96         set_msr (get_msr () | MSR_EE);
  97
  98         debug("MSR = 0x%08lx, Decrementer reg = 0x%08lx\n", get_msr(), get_dec());
  99
 100         return 0;
 101 }
 102
 103
 104 void enable_interrupts (void)
 105 {
 106         set_msr (get_msr () | MSR_EE);
 107 }
 108
 109 /* returns flag if MSR_EE was set before */
 110 int disable_interrupts (void)
 111 {
 112         ulong msr = get_msr ();
 113
 114         set_msr (msr & ~MSR_EE);
 115         return (msr & MSR_EE) != 0;
 116 }
 117
 118
 119 void increment_timestamp(void)
 120 {
 121         timestamp++;
 122 }
 123
 124 /*
 125  * timer_interrupt - gets called when the decrementer overflows,
 126  * with interrupts disabled.
 127  * Trivial implementation - no need to be really accurate.
 128  */
 129 void
 130 timer_interrupt_cpu (struct pt_regs *regs)
 131 {
 132         /* nothing to do here */
 133 }
 134
 135
 136 void timer_interrupt (struct pt_regs *regs)
 137 {
 138         /* call cpu specific function from $(CPU)/interrupts.c */
 139         timer_interrupt_cpu (regs);
 140
 141         timestamp++;
 142
 143         ppcDcbf(&timestamp);
 144
 145         /* Restore Decrementer Count */
 146         set_dec (decrementer_count);
 147
 148 #if defined(CONFIG_WATCHDOG) || defined (CONFIG_HW_WATCHDOG)
 149         if ((timestamp % (CFG_WATCHDOG_FREQ)) == 0)
 150                 WATCHDOG_RESET ();
 151 #endif    /* CONFIG_WATCHDOG || CONFIG_HW_WATCHDOG */
 152
 153 #ifdef CONFIG_STATUS_LED
 154         status_led_tick (timestamp);
 155 #endif /* CONFIG_STATUS_LED */
 156
 157 #ifdef CONFIG_SHOW_ACTIVITY
 158         board_show_activity (timestamp);
 159 #endif /* CONFIG_SHOW_ACTIVITY */
 160
 161
 162 }
 163
 164 void reset_timer (void)
 165 {
 166         timestamp = 0;
 167 }
 168
 169 ulong get_timer (ulong base)
 170 {
 171         return timestamp - base;
 172 }
 173
 174 void set_timer (ulong t)
 175 {
 176         timestamp = t;
 177 }
 178
 179 /*
 180  * Install and free a interrupt handler. Not implemented yet.
 181  */
 182
 183 void
 184 irq_install_handler(int vec, interrupt_handler_t *handler, void *arg)
 185 {
 186 }
 187
 188 void
 189 irq_free_handler(int vec)
 190 {
 191 }
 192
 193
 194 /*
 195  * irqinfo - print information about PCI devices,not implemented.
 196  */
 197 int
 198 do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 199 {
 200         printf ("\nInterrupt-unsupported:\n");
 201
 202         return 0;
 203 }
 204
 205 /*
 206  * Handle external interrupts
 207  */
 208 void
 209 external_interrupt(struct pt_regs *regs)
 210 {
 211         puts("external_interrupt (oops!)\n");
 212 }
 213
 214
 215
 216
 217
 218