Home | History | Annotate | Line # | Download | only in pic
pic_prepivr.c revision 1.1.2.7 
      1 /* $NetBSD: pic_prepivr.c,v 1.1.2.7 2007/05/09 20:22:38 garbled Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2007 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Tim Rightnour
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  * 3. All advertising materials mentioning features or use of this software
     19  *    must display the following acknowledgement:
     20  *        This product includes software developed by the NetBSD
     21  *        Foundation, Inc. and its contributors.
     22  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  *    contributors may be used to endorse or promote products derived
     24  *    from this software without specific prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  * POSSIBILITY OF SUCH DAMAGE.
     37  */
     38 
     39 #include <sys/cdefs.h>
     40 __KERNEL_RCSID(0, "$NetBSD: pic_prepivr.c,v 1.1.2.7 2007/05/09 20:22:38 garbled Exp $");
     41 
     42 #include <sys/param.h>
     43 #include <sys/malloc.h>
     44 #include <sys/kernel.h>
     45 
     46 #include <uvm/uvm_extern.h>
     47 
     48 #include <machine/pio.h>
     49 #include <machine/intr.h>
     50 
     51 #include <arch/powerpc/pic/picvar.h>
     52 
     53 #include <dev/isa/isareg.h>
     54 #include <dev/isa/isavar.h>
     55 
     56 static int  prepivr_get_irq(struct pic_ops *);
     57 static void prepivr_establish_irq(struct pic_ops *, int, int, int);
     58 
     59 vaddr_t prep_intr_reg;		/* PReP interrupt vector register */
     60 uint32_t prep_intr_reg_off;	/* IVR offset within the mapped page */
     61 
     62 #define IO_ELCR1	0x4d0
     63 #define IO_ELCR2	0x4d1
     64 
     65 /*
     66  * Prior to calling init_prepivr, the port is expected to have mapped the
     67  * page containing the IVR with mapiodev to prep_intr_reg and set up the
     68  * prep_intr_reg_off.
     69  */
     70 
     71 struct pic_ops *
     72 setup_prepivr(void)
     73 {
     74 	struct i8259_ops *prepivr;
     75 	struct pic_ops *pic;
     76 	uint32_t pivr;
     77 
     78 	prepivr = malloc(sizeof(struct i8259_ops), M_DEVBUF, M_NOWAIT);
     79 	KASSERT(prepivr != NULL);
     80 	pic = &prepivr->pic;
     81 
     82 	pivr = prep_intr_reg + prep_intr_reg_off;
     83 	pic->pic_numintrs = 16;
     84 	pic->pic_cookie = (void *)pivr;
     85 	pic->pic_enable_irq = i8259_enable_irq;
     86 	pic->pic_reenable_irq = i8259_enable_irq;
     87 	pic->pic_disable_irq = i8259_disable_irq;
     88 	pic->pic_get_irq = prepivr_get_irq;
     89 	pic->pic_ack_irq = i8259_ack_irq;
     90 	pic->pic_establish_irq = prepivr_establish_irq;
     91 	strcpy(pic->pic_name, "prepivr");
     92 	pic_add(pic);
     93 	prepivr->pending_events = 0;
     94 	prepivr->enable_mask = 0xffffffff;
     95 	prepivr->irqs = 0;
     96 
     97 	i8259_initialize();
     98 
     99 	return pic;
    100 }
    101 
    102 static void
    103 prepivr_establish_irq(struct pic_ops *pic, int irq, int type, int maxlevel)
    104 {
    105 	u_int8_t elcr[2];
    106 	int icu, bit;
    107 
    108 	icu = irq / 8;
    109 	bit = irq % 8;
    110 	elcr[0] = isa_inb(IO_ELCR1);
    111 	elcr[1] = isa_inb(IO_ELCR2);
    112 
    113 	if (type == IST_LEVEL)
    114 		elcr[icu] |= 1 << bit;
    115 	else
    116 		elcr[icu] &= ~(1 << bit);
    117 
    118 	isa_outb(IO_ELCR1, elcr[0]);
    119 	isa_outb(IO_ELCR2, elcr[1]);
    120 }
    121 
    122 static int
    123 prepivr_get_irq(struct pic_ops *pic)
    124 {
    125 	static int lirq;
    126 	int irq;
    127 
    128 	irq = inb(pic->pic_cookie);
    129 	if (lirq == 7 && irq == lirq)
    130 		return 255;
    131 
    132 	lirq = irq;
    133 	if (irq == 0)
    134 		return 255;
    135 
    136 	return irq;
    137 }
    138