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 static __inline__ void set_dec(unsigned long val)
  68 {
  69         if (val)
  70                 asm volatile ("mtdec %0"::"r" (val));
  71 }
  72
  73 /* interrupt is not supported yet */
  74 int interrupt_init_cpu(unsigned *decrementer_count)
  75 {
  76         return 0;
  77 }
  78
  79 int interrupt_init(void)
  80 {
  81         int ret;
  82
  83         /* call cpu specific function from $(CPU)/interrupts.c */
  84         ret = interrupt_init_cpu(&decrementer_count);
  85
  86         if (ret)
  87                 return ret;
  88
  89         decrementer_count = get_tbclk() / CFG_HZ;
  90         debug("interrupt init: tbclk() = %d MHz, decrementer_count = %d\n",
  91               (get_tbclk() / 1000000),
  92               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",
  99               get_msr(),
 100               get_dec());
 101
 102         return 0;
 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 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 timer_interrupt_cpu(struct pt_regs *regs)
 130 {
 131         /* nothing to do here */
 132 }
 133
 134 void timer_interrupt(struct pt_regs *regs)
 135 {
 136         /* call cpu specific function from $(CPU)/interrupts.c */
 137         timer_interrupt_cpu(regs);
 138
 139         timestamp++;
 140
 141         ppcDcbf(&timestamp);
 142
 143         /* Restore Decrementer Count */
 144         set_dec(decrementer_count);
 145
 146 #if defined(CONFIG_WATCHDOG) || defined (CONFIG_HW_WATCHDOG)
 147         if ((timestamp % (CFG_WATCHDOG_FREQ)) == 0)
 148                 WATCHDOG_RESET();
 149 #endif /* CONFIG_WATCHDOG || CONFIG_HW_WATCHDOG */
 150
 151 #ifdef CONFIG_STATUS_LED
 152         status_led_tick(timestamp);
 153 #endif /* CONFIG_STATUS_LED */
 154
 155 #ifdef CONFIG_SHOW_ACTIVITY
 156         board_show_activity(timestamp);
 157 #endif /* CONFIG_SHOW_ACTIVITY */
 158
 159 }
 160
 161 void reset_timer(void)
 162 {
 163         timestamp = 0;
 164 }
 165
 166 ulong get_timer(ulong base)
 167 {
 168         return timestamp - base;
 169 }
 170
 171 void set_timer(ulong t)
 172 {
 173         timestamp = t;
 174 }
 175
 176 /*
 177  * Install and free a interrupt handler. Not implemented yet.
 178  */
 179
 180 void irq_install_handler(int vec, interrupt_handler_t *handler, void *arg)
 181 {
 182 }
 183
 184 void irq_free_handler(int vec)
 185 {
 186 }
 187
 188 /*
 189  * irqinfo - print information about PCI devices,not implemented.
 190  */
 191 int do_irqinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 192 {
 193         printf("\nInterrupt-unsupported:\n");
 194
 195         return 0;
 196 }
 197
 198 /*
 199  * Handle external interrupts
 200  */
 201 void external_interrupt(struct pt_regs *regs)
 202 {
 203         puts("external_interrupt (oops!)\n");
 204 }