git.oblomov.eu Git - linux-2.6/blob - arch/sparc/kernel/sun4m_irq.c

   1 /*  sun4m_irq.c
   2  *  arch/sparc/kernel/sun4m_irq.c:
   3  *
   4  *  djhr: Hacked out of irq.c into a CPU dependent version.
   5  *
   6  *  Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
   7  *  Copyright (C) 1995 Miguel de Icaza (miguel@nuclecu.unam.mx)
   8  *  Copyright (C) 1995 Pete A. Zaitcev (zaitcev@yahoo.com)
   9  *  Copyright (C) 1996 Dave Redman (djhr@tadpole.co.uk)
  10  */
  11
  12 #include <linux/errno.h>
  13 #include <linux/linkage.h>
  14 #include <linux/kernel_stat.h>
  15 #include <linux/signal.h>
  16 #include <linux/sched.h>
  17 #include <linux/ptrace.h>
  18 #include <linux/smp.h>
  19 #include <linux/interrupt.h>
  20 #include <linux/slab.h>
  21 #include <linux/init.h>
  22 #include <linux/ioport.h>
  23
  24 #include <asm/ptrace.h>
  25 #include <asm/processor.h>
  26 #include <asm/system.h>
  27 #include <asm/psr.h>
  28 #include <asm/vaddrs.h>
  29 #include <asm/timer.h>
  30 #include <asm/openprom.h>
  31 #include <asm/oplib.h>
  32 #include <asm/traps.h>
  33 #include <asm/pgalloc.h>
  34 #include <asm/pgtable.h>
  35 #include <asm/smp.h>
  36 #include <asm/irq.h>
  37 #include <asm/io.h>
  38 #include <asm/sbus.h>
  39 #include <asm/cacheflush.h>
  40
  41 static unsigned long dummy;
  42
  43 struct sun4m_intregs *sun4m_interrupts;
  44 unsigned long *irq_rcvreg = &dummy;
  45
  46 /* These tables only apply for interrupts greater than 15..
  47  *
  48  * any intr value below 0x10 is considered to be a soft-int
  49  * this may be useful or it may not.. but that's how I've done it.
  50  * and it won't clash with what OBP is telling us about devices.
  51  *
  52  * take an encoded intr value and lookup if it's valid
  53  * then get the mask bits that match from irq_mask
  54  *
  55  * P3: Translation from irq 0x0d to mask 0x2000 is for MrCoffee.
  56  */
  57 static unsigned char irq_xlate[32] = {
  58     /*  0,  1,  2,  3,  4,  5,  6,  7,  8,  9,  a,  b,  c,  d,  e,  f */
  59         0,  0,  0,  0,  1,  0,  2,  0,  3,  0,  4,  5,  6, 14,  0,  7,
  60         0,  0,  8,  9,  0, 10,  0, 11,  0, 12,  0, 13,  0, 14,  0,  0
  61 };
  62
  63 static unsigned long irq_mask[] = {
  64         0,                                                /* illegal index */
  65         SUN4M_INT_SCSI,                                   /*  1 irq 4 */
  66         SUN4M_INT_ETHERNET,                               /*  2 irq 6 */
  67         SUN4M_INT_VIDEO,                                  /*  3 irq 8 */
  68         SUN4M_INT_REALTIME,                               /*  4 irq 10 */
  69         SUN4M_INT_FLOPPY,                                 /*  5 irq 11 */
  70         (SUN4M_INT_SERIAL | SUN4M_INT_KBDMS),             /*  6 irq 12 */
  71         SUN4M_INT_MODULE_ERR,                             /*  7 irq 15 */
  72         SUN4M_INT_SBUS(0),                                /*  8 irq 2 */
  73         SUN4M_INT_SBUS(1),                                /*  9 irq 3 */
  74         SUN4M_INT_SBUS(2),                                /* 10 irq 5 */
  75         SUN4M_INT_SBUS(3),                                /* 11 irq 7 */
  76         SUN4M_INT_SBUS(4),                                /* 12 irq 9 */
  77         SUN4M_INT_SBUS(5),                                /* 13 irq 11 */
  78         SUN4M_INT_SBUS(6)                                 /* 14 irq 13 */
  79 };
  80
  81 static int sun4m_pil_map[] = { 0, 2, 3, 5, 7, 9, 11, 13 };
  82
  83 unsigned int sun4m_sbint_to_irq(struct sbus_dev *sdev, unsigned int sbint)
  84 {
  85         if (sbint >= sizeof(sun4m_pil_map)) {
  86                 printk(KERN_ERR "%s: bogus SBINT %d\n", sdev->prom_name, sbint);
  87                 BUG();
  88         }
  89         return sun4m_pil_map[sbint] | 0x30;
  90 }
  91
  92 inline unsigned long sun4m_get_irqmask(unsigned int irq)
  93 {
  94         unsigned long mask;
  95
  96         if (irq > 0x20) {
  97                 /* OBIO/SBUS interrupts */
  98                 irq &= 0x1f;
  99                 mask = irq_mask[irq_xlate[irq]];
 100                 if (!mask)
 101                         printk("sun4m_get_irqmask: IRQ%d has no valid mask!\n",irq);
 102         } else {
 103                 /* Soft Interrupts will come here.
 104                  * Currently there is no way to trigger them but I'm sure
 105                  * something could be cooked up.
 106                  */
 107                 irq &= 0xf;
 108                 mask = SUN4M_SOFT_INT(irq);
 109         }
 110         return mask;
 111 }
 112
 113 static void sun4m_disable_irq(unsigned int irq_nr)
 114 {
 115         unsigned long mask, flags;
 116         int cpu = smp_processor_id();
 117
 118         mask = sun4m_get_irqmask(irq_nr);
 119         local_irq_save(flags);
 120         if (irq_nr > 15)
 121                 sun4m_interrupts->set = mask;
 122         else
 123                 sun4m_interrupts->cpu_intregs[cpu].set = mask;
 124         local_irq_restore(flags);
 125 }
 126
 127 static void sun4m_enable_irq(unsigned int irq_nr)
 128 {
 129         unsigned long mask, flags;
 130         int cpu = smp_processor_id();
 131
 132         /* Dreadful floppy hack. When we use 0x2b instead of
 133          * 0x0b the system blows (it starts to whistle!).
 134          * So we continue to use 0x0b. Fixme ASAP. --P3
 135          */
 136         if (irq_nr != 0x0b) {
 137                 mask = sun4m_get_irqmask(irq_nr);
 138                 local_irq_save(flags);
 139                 if (irq_nr > 15)
 140                         sun4m_interrupts->clear = mask;
 141                 else
 142                         sun4m_interrupts->cpu_intregs[cpu].clear = mask;
 143                 local_irq_restore(flags);
 144         } else {
 145                 local_irq_save(flags);
 146                 sun4m_interrupts->clear = SUN4M_INT_FLOPPY;
 147                 local_irq_restore(flags);
 148         }
 149 }
 150
 151 static unsigned long cpu_pil_to_imask[16] = {
 152 /*0*/   0x00000000,
 153 /*1*/   0x00000000,
 154 /*2*/   SUN4M_INT_SBUS(0) | SUN4M_INT_VME(0),
 155 /*3*/   SUN4M_INT_SBUS(1) | SUN4M_INT_VME(1),
 156 /*4*/   SUN4M_INT_SCSI,
 157 /*5*/   SUN4M_INT_SBUS(2) | SUN4M_INT_VME(2),
 158 /*6*/   SUN4M_INT_ETHERNET,
 159 /*7*/   SUN4M_INT_SBUS(3) | SUN4M_INT_VME(3),
 160 /*8*/   SUN4M_INT_VIDEO,
 161 /*9*/   SUN4M_INT_SBUS(4) | SUN4M_INT_VME(4) | SUN4M_INT_MODULE_ERR,
 162 /*10*/  SUN4M_INT_REALTIME,
 163 /*11*/  SUN4M_INT_SBUS(5) | SUN4M_INT_VME(5) | SUN4M_INT_FLOPPY,
 164 /*12*/  SUN4M_INT_SERIAL | SUN4M_INT_KBDMS,
 165 /*13*/  SUN4M_INT_AUDIO,
 166 /*14*/  SUN4M_INT_E14,
 167 /*15*/  0x00000000
 168 };
 169
 170 /* We assume the caller has disabled local interrupts when these are called,
 171  * or else very bizarre behavior will result.
 172  */
 173 static void sun4m_disable_pil_irq(unsigned int pil)
 174 {
 175         sun4m_interrupts->set = cpu_pil_to_imask[pil];
 176 }
 177
 178 static void sun4m_enable_pil_irq(unsigned int pil)
 179 {
 180         sun4m_interrupts->clear = cpu_pil_to_imask[pil];
 181 }
 182
 183 #ifdef CONFIG_SMP
 184 static void sun4m_send_ipi(int cpu, int level)
 185 {
 186         unsigned long mask;
 187
 188         mask = sun4m_get_irqmask(level);
 189         sun4m_interrupts->cpu_intregs[cpu].set = mask;
 190 }
 191
 192 static void sun4m_clear_ipi(int cpu, int level)
 193 {
 194         unsigned long mask;
 195
 196         mask = sun4m_get_irqmask(level);
 197         sun4m_interrupts->cpu_intregs[cpu].clear = mask;
 198 }
 199
 200 static void sun4m_set_udt(int cpu)
 201 {
 202         sun4m_interrupts->undirected_target = cpu;
 203 }
 204 #endif
 205
 206 #define OBIO_INTR       0x20
 207 #define TIMER_IRQ       (OBIO_INTR | 10)
 208 #define PROFILE_IRQ     (OBIO_INTR | 14)
 209
 210 struct sun4m_timer_regs *sun4m_timers;
 211 unsigned int lvl14_resolution = (((1000000/HZ) + 1) << 10);
 212
 213 static void sun4m_clear_clock_irq(void)
 214 {
 215         volatile unsigned int clear_intr;
 216         clear_intr = sun4m_timers->l10_timer_limit;
 217 }
 218
 219 static void sun4m_clear_profile_irq(int cpu)
 220 {
 221         volatile unsigned int clear;
 222
 223         clear = sun4m_timers->cpu_timers[cpu].l14_timer_limit;
 224 }
 225
 226 static void sun4m_load_profile_irq(int cpu, unsigned int limit)
 227 {
 228         sun4m_timers->cpu_timers[cpu].l14_timer_limit = limit;
 229 }
 230
 231 static void __init sun4m_init_timers(irq_handler_t counter_fn)
 232 {
 233         int reg_count, irq, cpu;
 234         struct linux_prom_registers cnt_regs[PROMREG_MAX];
 235         int obio_node, cnt_node;
 236         struct resource r;
 237
 238         cnt_node = 0;
 239         if((obio_node =
 240             prom_searchsiblings (prom_getchild(prom_root_node), "obio")) == 0 ||
 241            (obio_node = prom_getchild (obio_node)) == 0 ||
 242            (cnt_node = prom_searchsiblings (obio_node, "counter")) == 0) {
 243                 prom_printf("Cannot find /obio/counter node\n");
 244                 prom_halt();
 245         }
 246         reg_count = prom_getproperty(cnt_node, "reg",
 247                                      (void *) cnt_regs, sizeof(cnt_regs));
 248         reg_count = (reg_count/sizeof(struct linux_prom_registers));
 249
 250         /* Apply the obio ranges to the timer registers. */
 251         prom_apply_obio_ranges(cnt_regs, reg_count);
 252
 253         cnt_regs[4].phys_addr = cnt_regs[reg_count-1].phys_addr;
 254         cnt_regs[4].reg_size = cnt_regs[reg_count-1].reg_size;
 255         cnt_regs[4].which_io = cnt_regs[reg_count-1].which_io;
 256         for(obio_node = 1; obio_node < 4; obio_node++) {
 257                 cnt_regs[obio_node].phys_addr =
 258                         cnt_regs[obio_node-1].phys_addr + PAGE_SIZE;
 259                 cnt_regs[obio_node].reg_size = cnt_regs[obio_node-1].reg_size;
 260                 cnt_regs[obio_node].which_io = cnt_regs[obio_node-1].which_io;
 261         }
 262
 263         memset((char*)&r, 0, sizeof(struct resource));
 264         /* Map the per-cpu Counter registers. */
 265         r.flags = cnt_regs[0].which_io;
 266         r.start = cnt_regs[0].phys_addr;
 267         sun4m_timers = (struct sun4m_timer_regs *) sbus_ioremap(&r, 0,
 268             PAGE_SIZE*SUN4M_NCPUS, "sun4m_cpu_cnt");
 269         /* Map the system Counter register. */
 270         /* XXX Here we expect consequent calls to yeld adjusent maps. */
 271         r.flags = cnt_regs[4].which_io;
 272         r.start = cnt_regs[4].phys_addr;
 273         sbus_ioremap(&r, 0, cnt_regs[4].reg_size, "sun4m_sys_cnt");
 274
 275         sun4m_timers->l10_timer_limit =  (((1000000/HZ) + 1) << 10);
 276         master_l10_counter = &sun4m_timers->l10_cur_count;
 277         master_l10_limit = &sun4m_timers->l10_timer_limit;
 278
 279         irq = request_irq(TIMER_IRQ,
 280                           counter_fn,
 281                           (IRQF_DISABLED | SA_STATIC_ALLOC),
 282                           "timer", NULL);
 283         if (irq) {
 284                 prom_printf("time_init: unable to attach IRQ%d\n",TIMER_IRQ);
 285                 prom_halt();
 286         }
 287
 288         if (!cpu_find_by_instance(1, NULL, NULL)) {
 289                 for(cpu = 0; cpu < 4; cpu++)
 290                         sun4m_timers->cpu_timers[cpu].l14_timer_limit = 0;
 291                 sun4m_interrupts->set = SUN4M_INT_E14;
 292         } else {
 293                 sun4m_timers->cpu_timers[0].l14_timer_limit = 0;
 294         }
 295 #ifdef CONFIG_SMP
 296         {
 297                 unsigned long flags;
 298                 extern unsigned long lvl14_save[4];
 299                 struct tt_entry *trap_table = &sparc_ttable[SP_TRAP_IRQ1 + (14 - 1)];
 300
 301                 /* For SMP we use the level 14 ticker, however the bootup code
 302                  * has copied the firmwares level 14 vector into boot cpu's
 303                  * trap table, we must fix this now or we get squashed.
 304                  */
 305                 local_irq_save(flags);
 306                 trap_table->inst_one = lvl14_save[0];
 307                 trap_table->inst_two = lvl14_save[1];
 308                 trap_table->inst_three = lvl14_save[2];
 309                 trap_table->inst_four = lvl14_save[3];
 310                 local_flush_cache_all();
 311                 local_irq_restore(flags);
 312         }
 313 #endif
 314 }
 315
 316 void __init sun4m_init_IRQ(void)
 317 {
 318         int ie_node,i;
 319         struct linux_prom_registers int_regs[PROMREG_MAX];
 320         int num_regs;
 321         struct resource r;
 322         int mid;
 323
 324         local_irq_disable();
 325         if((ie_node = prom_searchsiblings(prom_getchild(prom_root_node), "obio")) == 0 ||
 326            (ie_node = prom_getchild (ie_node)) == 0 ||
 327            (ie_node = prom_searchsiblings (ie_node, "interrupt")) == 0) {
 328                 prom_printf("Cannot find /obio/interrupt node\n");
 329                 prom_halt();
 330         }
 331         num_regs = prom_getproperty(ie_node, "reg", (char *) int_regs,
 332                                     sizeof(int_regs));
 333         num_regs = (num_regs/sizeof(struct linux_prom_registers));
 334
 335         /* Apply the obio ranges to these registers. */
 336         prom_apply_obio_ranges(int_regs, num_regs);
 337
 338         int_regs[4].phys_addr = int_regs[num_regs-1].phys_addr;
 339         int_regs[4].reg_size = int_regs[num_regs-1].reg_size;
 340         int_regs[4].which_io = int_regs[num_regs-1].which_io;
 341         for(ie_node = 1; ie_node < 4; ie_node++) {
 342                 int_regs[ie_node].phys_addr = int_regs[ie_node-1].phys_addr + PAGE_SIZE;
 343                 int_regs[ie_node].reg_size = int_regs[ie_node-1].reg_size;
 344                 int_regs[ie_node].which_io = int_regs[ie_node-1].which_io;
 345         }
 346
 347         memset((char *)&r, 0, sizeof(struct resource));
 348         /* Map the interrupt registers for all possible cpus. */
 349         r.flags = int_regs[0].which_io;
 350         r.start = int_regs[0].phys_addr;
 351         sun4m_interrupts = (struct sun4m_intregs *) sbus_ioremap(&r, 0,
 352             PAGE_SIZE*SUN4M_NCPUS, "interrupts_percpu");
 353
 354         /* Map the system interrupt control registers. */
 355         r.flags = int_regs[4].which_io;
 356         r.start = int_regs[4].phys_addr;
 357         sbus_ioremap(&r, 0, int_regs[4].reg_size, "interrupts_system");
 358
 359         sun4m_interrupts->set = ~SUN4M_INT_MASKALL;
 360         for (i = 0; !cpu_find_by_instance(i, NULL, &mid); i++)
 361                 sun4m_interrupts->cpu_intregs[mid].clear = ~0x17fff;
 362
 363         if (!cpu_find_by_instance(1, NULL, NULL)) {
 364                 /* system wide interrupts go to cpu 0, this should always
 365                  * be safe because it is guaranteed to be fitted or OBP doesn't
 366                  * come up
 367                  *
 368                  * Not sure, but writing here on SLAVIO systems may puke
 369                  * so I don't do it unless there is more than 1 cpu.
 370                  */
 371                 irq_rcvreg = (unsigned long *)
 372                                 &sun4m_interrupts->undirected_target;
 373                 sun4m_interrupts->undirected_target = 0;
 374         }
 375         BTFIXUPSET_CALL(sbint_to_irq, sun4m_sbint_to_irq, BTFIXUPCALL_NORM);
 376         BTFIXUPSET_CALL(enable_irq, sun4m_enable_irq, BTFIXUPCALL_NORM);
 377         BTFIXUPSET_CALL(disable_irq, sun4m_disable_irq, BTFIXUPCALL_NORM);
 378         BTFIXUPSET_CALL(enable_pil_irq, sun4m_enable_pil_irq, BTFIXUPCALL_NORM);
 379         BTFIXUPSET_CALL(disable_pil_irq, sun4m_disable_pil_irq, BTFIXUPCALL_NORM);
 380         BTFIXUPSET_CALL(clear_clock_irq, sun4m_clear_clock_irq, BTFIXUPCALL_NORM);
 381         BTFIXUPSET_CALL(clear_profile_irq, sun4m_clear_profile_irq, BTFIXUPCALL_NORM);
 382         BTFIXUPSET_CALL(load_profile_irq, sun4m_load_profile_irq, BTFIXUPCALL_NORM);
 383         sparc_init_timers = sun4m_init_timers;
 384 #ifdef CONFIG_SMP
 385         BTFIXUPSET_CALL(set_cpu_int, sun4m_send_ipi, BTFIXUPCALL_NORM);
 386         BTFIXUPSET_CALL(clear_cpu_int, sun4m_clear_ipi, BTFIXUPCALL_NORM);
 387         BTFIXUPSET_CALL(set_irq_udt, sun4m_set_udt, BTFIXUPCALL_NORM);
 388 #endif
 389         /* Cannot enable interrupts until OBP ticker is disabled. */
 390 }