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