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 (Jeffrey@freescale.com)
  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
  42
  43 unsigned long timestamp;
  44
  45 static __inline__ unsigned long get_msr (void)
  46 {
  47         unsigned long msr;
  48
  49         asm volatile ("mfmsr %0":"=r" (msr):);
  50
  51         return msr;
  52 }
  53
  54 static __inline__ void set_msr (unsigned long msr)
  55 {
  56         asm volatile ("mtmsr %0"::"r" (msr));
  57 }
  58
  59 static __inline__ unsigned long get_dec (void)
  60 {
  61         unsigned long val;
  62
  63         asm volatile ("mfdec %0":"=r" (val):);
  64
  65         return val;
  66 }
  67
  68
  69 static __inline__ void set_dec (unsigned long val)
  70 {
  71         if (val)
  72                 asm volatile ("mtdec %0"::"r" (val));
  73 }
  74
  75 /* interrupt is not supported yet */
  76 int interrupt_init_cpu (unsigned *decrementer_count)
  77 {
  78    return (0);
  79 }
  80
  81
  82 int interrupt_init (void)
  83 {
  84         int ret;
  85
  86         /* call cpu specific function from $(CPU)/interrupts.c */
  87         ret = interrupt_init_cpu (&decrementer_count);
  88
  89         if (ret)
  90                 return ret;
  91
  92         decrementer_count = get_tbclk()/CFG_HZ;
  93         debug("interrupt init: tbclk() = %d MHz, decrementer_count = %d\n", (get_tbclk()/1000000), decrementer_count);
  94
  95         set_dec (decrementer_count);
  96
  97         set_msr (get_msr () | MSR_EE);
  98
  99         debug("MSR = 0x%08lx, Decrementer reg = 0x%08lx\n", get_msr(), get_dec());
 100
 101         return (0);
 102 }
 103
 104
 105 void enable_interrupts (void)
 106 {
 107         set_msr (get_msr () | MSR_EE);
 108 }
 109
 110 /* returns flag if MSR_EE was set before */
 111 int disable_interrupts (void)
 112 {
 113         ulong msr = get_msr ();
 114
 115         set_msr (msr & ~MSR_EE);
 116         return ((msr & MSR_EE) != 0);
 117 }
 118
 119
 120 void increment_timestamp(void)
 121 {
 122    timestamp++;
 123 }
 124
 125 /*
 126  * timer_interrupt - gets called when the decrementer overflows,
 127  * with interrupts disabled.
 128  * Trivial implementation - no need to be really accurate.
 129  */
 130 void
 131 timer_interrupt_cpu (struct pt_regs *regs)
 132 {
 133         /* nothing to do here */
 134         return;
 135 }
 136
 137
 138 void timer_interrupt (struct pt_regs *regs)
 139 {
 140    /* call cpu specific function from $(CPU)/interrupts.c */
 141    timer_interrupt_cpu (regs);
 142
 143    timestamp++;
 144
 145    ppcDcbf(&timestamp);
 146
 147    /* Restore Decrementer Count */
 148    set_dec (decrementer_count);
 149
 150 #if defined(CONFIG_WATCHDOG) || defined (CONFIG_HW_WATCHDOG)
 151         if ((timestamp % (CFG_WATCHDOG_FREQ)) == 0)
 152                 WATCHDOG_RESET ();
 153 #endif    /* CONFIG_WATCHDOG || CONFIG_HW_WATCHDOG */
 154
 155 #ifdef CONFIG_STATUS_LED
 156         status_led_tick (timestamp);
 157 #endif /* CONFIG_STATUS_LED */
 158
 159 #ifdef CONFIG_SHOW_ACTIVITY
 160         board_show_activity (timestamp);
 161 #endif /* CONFIG_SHOW_ACTIVITY */
 162
 163
 164 }
 165
 166 void reset_timer (void)
 167 {
 168         timestamp = 0;
 169 }
 170
 171 ulong get_timer (ulong base)
 172 {
 173         return (timestamp - base);
 174 }
 175
 176 void set_timer (ulong t)
 177 {
 178    timestamp = t;
 179 }
 180
 181 /*
 182  * Install and free a interrupt handler. Not implemented yet.
 183  */
 184
 185 void
 186 irq_install_handler(int vec, interrupt_handler_t *handler, void *arg)
 187 {
 188         return;
 189 }
 190
 191 void
 192 irq_free_handler(int vec)
 193 {
 194         return;
 195 }
 196
 197
 198
 199 /*******************************************************************************
 200  *
 201  * irqinfo - print information about PCI devices,not implemented.
 202  *
 203  */
 204 int
 205 do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 206 {
 207         printf ("\nInterrupt-unsupported:\n");
 208
 209         return 0;
 210 }
 211
 212 /*
 213  * Handle external interrupts
 214  */
 215 void
 216 external_interrupt(struct pt_regs *regs)
 217 {
 218         puts("external_interrupt (oops!)\n");
 219 }
 220
 221
 222
 223
 224
 225