Home | History | Annotate | Line # | Download | only in pic
pic_openpic.c revision 1.1.2.1
      1 /*	$NetBSD: pic_openpic.c,v 1.1.2.1 2007/05/02 23:51:38 macallan 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  * 3. Neither the name of The NetBSD Foundation nor the names of its
     16  *    contributors may be used to endorse or promote products derived
     17  *    from this software without specific prior written permission.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: pic_openpic.c,v 1.1.2.1 2007/05/02 23:51:38 macallan Exp $");
     34 
     35 #include "opt_interrupt.h"
     36 
     37 #ifdef PIC_OPENPIC
     38 
     39 #include <sys/param.h>
     40 #include <sys/malloc.h>
     41 #include <sys/kernel.h>
     42 
     43 #include <uvm/uvm_extern.h>
     44 
     45 #include <machine/pio.h>
     46 #include <powerpc/openpic.h>
     47 
     48 #include <dev/ofw/openfirm.h>
     49 
     50 #include <machine/autoconf.h>
     51 #include <arch/powerpc/pic/picvar.h>
     52 
     53 static int  opic_irq_is_enabled(struct pic_ops *, int);
     54 static void opic_enable_irq(struct pic_ops *, int, int);
     55 static void opic_disable_irq(struct pic_ops *, int);
     56 static void opic_clear_irq(struct pic_ops *, int);
     57 static int  opic_get_irq(struct pic_ops *);
     58 static void opic_ack_irq(struct pic_ops *, int);
     59 
     60 struct openpic_ops {
     61 	struct pic_ops pic;
     62 	uint32_t enable_mask;
     63 };
     64 
     65 static struct openpic_ops *setup_openpic(uint32_t, int, int);
     66 
     67 static struct openpic_ops *
     68 setup_openpic(uint32_t addr, int num, int passthrough)
     69 {
     70 	struct openpic_ops *openpic;
     71 	struct pic_ops *pic;
     72 	int irq;
     73 	u_int x;
     74 
     75 	openpic_base = (void *)addr;
     76 	openpic = malloc(sizeof(struct openpic_ops), M_DEVBUF, M_NOWAIT);
     77 	KASSERT(openpic != NULL);
     78 	pic = &openpic->pic;
     79 
     80 	pic->pic_numintrs = num;
     81 	pic->pic_cookie = (void *)addr;
     82 	pic->pic_irq_is_enabled = opic_irq_is_enabled;
     83 	pic->pic_enable_irq = opic_enable_irq;
     84 	pic->pic_reenable_irq = opic_enable_irq;
     85 	pic->pic_disable_irq = opic_disable_irq;
     86 	pic->pic_clear_irq = opic_clear_irq;
     87 	pic->pic_get_irq = opic_get_irq;
     88 	pic->pic_ack_irq = opic_ack_irq;
     89 	strcpy(pic->pic_name, "openpic");
     90 	pic_add(pic);
     91 
     92 	/* disable all interrupts */
     93 	for (irq = 0; irq < 256; irq++)
     94 		openpic_write(OPENPIC_SRC_VECTOR(irq), OPENPIC_IMASK);
     95 
     96 	openpic_set_priority(0, 15);
     97 
     98 	x = openpic_read(OPENPIC_CONFIG);
     99 	if (passthrough) {
    100 		x &= ~OPENPIC_CONFIG_8259_PASSTHRU_DISABLE;
    101 	} else {
    102 		x |= OPENPIC_CONFIG_8259_PASSTHRU_DISABLE;
    103 	}
    104 	openpic_write(OPENPIC_CONFIG, x);
    105 
    106 	/* send all interrupts to CPU 0 */
    107 	for (irq = 0; irq < ICU_LEN; irq++)
    108 		openpic_write(OPENPIC_IDEST(irq), 1 << 0);
    109 
    110 	for (irq = 0; irq < ICU_LEN; irq++) {
    111 		x = irq;
    112 		x |= OPENPIC_IMASK;
    113 		x |= OPENPIC_POLARITY_POSITIVE;
    114 		x |= OPENPIC_SENSE_LEVEL;
    115 		x |= 8 << OPENPIC_PRIORITY_SHIFT;
    116 		openpic_write(OPENPIC_SRC_VECTOR(irq), x);
    117 	}
    118 
    119 	openpic_set_priority(0, 0);
    120 
    121 	/* clear all pending interrunts */
    122 	for (irq = 0; irq < 256; irq++) {
    123 		openpic_read_irq(0);
    124 		openpic_eoi(0);
    125 	}
    126 
    127 	for (irq = 0; irq < num; irq++)
    128 		openpic_disable_irq(irq);
    129 
    130 #ifdef MULTIPROCESSOR
    131 	x = openpic_read(OPENPIC_IPI_VECTOR(1));
    132 	x &= ~(OPENPIC_IMASK | OPENPIC_PRIORITY_MASK | OPENPIC_VECTOR_MASK);
    133 	x |= (15 << OPENPIC_PRIORITY_SHIFT) | IPI_VECTOR;
    134 	openpic_write(OPENPIC_IPI_VECTOR(1), x);
    135 #endif
    136 
    137 	return openpic;
    138 }
    139 
    140 static int
    141 opic_irq_is_enabled(struct pic_ops *pic, int irq)
    142 {
    143 	/* XXX */
    144 
    145 	return 1;
    146 }
    147 
    148 static void
    149 opic_enable_irq(struct pic_ops *pic, int irq, int type)
    150 {
    151 
    152 	openpic_enable_irq(irq, type);
    153 }
    154 
    155 static void
    156 opic_disable_irq(struct pic_ops *pic, int irq)
    157 {
    158 
    159 	openpic_disable_irq(irq);
    160 }
    161 
    162 static void
    163 opic_clear_irq(struct pic_ops *pic, int irq)
    164 {
    165 
    166 	/* we only use ack here */
    167 }
    168 
    169 static int
    170 opic_get_irq(struct pic_ops *pic)
    171 {
    172 
    173 	return openpic_read_irq(cpu_number());
    174 }
    175 
    176 static void
    177 opic_ack_irq(struct pic_ops *pic, int irq)
    178 {
    179 
    180 	openpic_eoi(cpu_number());
    181 }
    182 
    183 #endif /* PIC_OPENPIC */
    184