sys/arch/powerpc/pic/pic_openpic.c

   1 /*      $NetBSD: pic_openpic.c,v 1.4 2008/01/17 23:43:00 garbled Exp $ */
   2
   3 /*-
   4  * Copyright (c) 2007 Michael Lorenz
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
  17  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
  20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  26  * POSSIBILITY OF SUCH DAMAGE.
  27  */
  28
  29 #include <sys/cdefs.h>
  30 __KERNEL_RCSID(0, "$NetBSD: pic_openpic.c,v 1.4 2008/01/17 23:43:00 garbled Exp $");
  31
  32 #include <sys/param.h>
  33 #include <sys/malloc.h>
  34 #include <sys/kernel.h>
  35
  36 #include <uvm/uvm_extern.h>
  37
  38 #include <machine/pio.h>
  39 #include <powerpc/openpic.h>
  40
  41 #include <arch/powerpc/pic/picvar.h>
  42
  43 #include "opt_interrupt.h"
  44
  45 static void opic_enable_irq(struct pic_ops *, int, int);
  46 static void opic_disable_irq(struct pic_ops *, int);
  47 static void opic_establish_irq(struct pic_ops*, int, int, int);
  48
  49 struct pic_ops *
  50 setup_openpic(void *addr, int passthrough)
  51 {
  52         struct openpic_ops *opicops;
  53         struct pic_ops *pic;
  54         int irq;
  55         u_int x;
  56
  57         openpic_base = (void *)addr;
  58         opicops = malloc(sizeof(struct openpic_ops), M_DEVBUF, M_NOWAIT);
  59         KASSERT(opicops != NULL);
  60         pic = &opicops->pic;
  61
  62         x = openpic_read(OPENPIC_FEATURE);
  63         if (((x & 0x07ff0000) >> 16) == 0)
  64                 panic("setup_openpic() called on distributed openpic");
  65
  66         aprint_normal("OpenPIC Version 1.%d: "
  67             "Supports %d CPUs and %d interrupt sources.\n",
  68             x & 0xff, ((x & 0x1f00) >> 8) + 1, ((x & 0x07ff0000) >> 16) + 1);
  69
  70         pic->pic_numintrs = ((x & 0x07ff0000) >> 16) + 1;
  71         pic->pic_cookie = addr;
  72         pic->pic_enable_irq = opic_enable_irq;
  73         pic->pic_reenable_irq = opic_enable_irq;
  74         pic->pic_disable_irq = opic_disable_irq;
  75         pic->pic_get_irq = opic_get_irq;
  76         pic->pic_ack_irq = opic_ack_irq;
  77         pic->pic_establish_irq = opic_establish_irq;
  78         pic->pic_finish_setup = opic_finish_setup;
  79         opicops->isu = NULL;
  80         opicops->nrofisus = 0; /* internal only */
  81         opicops->flags = 0; /* no flags (yet) */
  82         opicops->irq_per = NULL; /* internal ISU only */
  83         strcpy(pic->pic_name, "openpic");
  84         pic_add(pic);
  85
  86         /*
  87          * the following sequence should make the same effects as openpic
  88          * controller reset by writing a one at the self-clearing
  89          * OPENPIC_CONFIG_RESET bit.  Please check the document of your
  90          * OpenPIC compliant interrupt controller and see whether #else
  91          * portion can work as described.
  92          */
  93 #if 1
  94         openpic_set_priority(0, 15);
  95
  96         for (irq = 0; irq < pic->pic_numintrs; irq++) {
  97                 /* make sure to keep disabled */
  98                 openpic_write(OPENPIC_SRC_VECTOR(irq), OPENPIC_IMASK);
  99                 /* send all interrupts to CPU 0 */
 100                 openpic_write(OPENPIC_IDEST(irq), 1 << 0);
 101         }
 102
 103         x = openpic_read(OPENPIC_CONFIG);
 104         if (passthrough)
 105                 x &= ~OPENPIC_CONFIG_8259_PASSTHRU_DISABLE;
 106         else
 107                 x |= OPENPIC_CONFIG_8259_PASSTHRU_DISABLE;
 108         openpic_write(OPENPIC_CONFIG, x);
 109
 110         openpic_write(OPENPIC_SPURIOUS_VECTOR, 0xff);
 111
 112         openpic_set_priority(0, 0);
 113
 114         /* clear all pending interrunts */
 115         for (irq = 0; irq < pic->pic_numintrs; irq++) {
 116                 openpic_read_irq(0);
 117                 openpic_eoi(0);
 118         }
 119 #else
 120         irq = 0;
 121         openpic_write(OPENPIC_CONFIG, OPENPIC_CONFIG_RESET);
 122         do {
 123                 x = openpic_read(OPENPIC_CONFIG);
 124         } while (x & OPENPIC_CONFIG_RESET); /* S1C bit */
 125         if (passthrough)
 126                 x &= ~OPENPIC_CONFIG_8259_PASSTHRU_DISABLE;
 127         else
 128                 x |= OPENPIC_CONFIG_8259_PASSTHRU_DISABLE;
 129         openpic_write(OPENPIC_CONFIG, x);
 130         openpic_set_priority(0, 0);
 131 #endif
 132
 133 #if 0
 134         printf("timebase freq=%d\n", openpic_read(0x10f0));
 135 #endif
 136         return pic;
 137 }
 138
 139 static void
 140 opic_establish_irq(struct pic_ops *pic, int irq, int type, int pri)
 141 {
 142         int realpri = max(1, min(15, pri));
 143         uint32_t x;
 144
 145         x = irq;
 146         x |= OPENPIC_IMASK;
 147         x |= (irq == 0) ?
 148             OPENPIC_POLARITY_POSITIVE : OPENPIC_POLARITY_NEGATIVE;
 149         x |= (type == IST_EDGE) ? OPENPIC_SENSE_EDGE : OPENPIC_SENSE_LEVEL;
 150         x |= realpri << OPENPIC_PRIORITY_SHIFT;
 151         openpic_write(OPENPIC_SRC_VECTOR(irq), x);
 152
 153         aprint_debug("%s: setting IRQ %d to priority %d\n", __func__, irq,
 154             realpri);
 155 }
 156
 157 static void
 158 opic_enable_irq(struct pic_ops *pic, int irq, int type)
 159 {
 160         u_int x;
 161
 162         x = openpic_read(OPENPIC_SRC_VECTOR(irq));
 163         x &= ~OPENPIC_IMASK;
 164         openpic_write(OPENPIC_SRC_VECTOR(irq), x);
 165 }
 166
 167 static void
 168 opic_disable_irq(struct pic_ops *pic, int irq)
 169 {
 170         u_int x;
 171
 172         x = openpic_read(OPENPIC_SRC_VECTOR(irq));
 173         x |= OPENPIC_IMASK;
 174         openpic_write(OPENPIC_SRC_VECTOR(irq), x);
 175 }