pic_prepivr.c revision 1.2
1 1.2 garbled /* $NetBSD: pic_prepivr.c,v 1.2 2007/10/17 19:56:46 garbled 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 * 3. All advertising materials mentioning features or use of this software 19 1.2 garbled * must display the following acknowledgement: 20 1.2 garbled * This product includes software developed by the NetBSD 21 1.2 garbled * Foundation, Inc. and its contributors. 22 1.2 garbled * 4. Neither the name of The NetBSD Foundation nor the names of its 23 1.2 garbled * contributors may be used to endorse or promote products derived 24 1.2 garbled * from this software without specific prior written permission. 25 1.2 garbled * 26 1.2 garbled * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 1.2 garbled * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 1.2 garbled * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 1.2 garbled * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 1.2 garbled * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 1.2 garbled * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 1.2 garbled * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 1.2 garbled * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 1.2 garbled * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 1.2 garbled * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 1.2 garbled * POSSIBILITY OF SUCH DAMAGE. 37 1.2 garbled */ 38 1.2 garbled 39 1.2 garbled #include <sys/cdefs.h> 40 1.2 garbled __KERNEL_RCSID(0, "$NetBSD: pic_prepivr.c,v 1.2 2007/10/17 19:56:46 garbled Exp $"); 41 1.2 garbled 42 1.2 garbled #include <sys/param.h> 43 1.2 garbled #include <sys/malloc.h> 44 1.2 garbled #include <sys/kernel.h> 45 1.2 garbled 46 1.2 garbled #include <uvm/uvm_extern.h> 47 1.2 garbled 48 1.2 garbled #include <machine/pio.h> 49 1.2 garbled #include <machine/intr.h> 50 1.2 garbled 51 1.2 garbled #include <arch/powerpc/pic/picvar.h> 52 1.2 garbled 53 1.2 garbled #include <dev/isa/isareg.h> 54 1.2 garbled #include <dev/isa/isavar.h> 55 1.2 garbled 56 1.2 garbled static int prepivr_get_irq(struct pic_ops *); 57 1.2 garbled static int motivr_get_irq(struct pic_ops *); 58 1.2 garbled static void prepivr_establish_irq(struct pic_ops *, int, int, int); 59 1.2 garbled 60 1.2 garbled vaddr_t prep_intr_reg; /* PReP interrupt vector register */ 61 1.2 garbled uint32_t prep_intr_reg_off; /* IVR offset within the mapped page */ 62 1.2 garbled 63 1.2 garbled #define IO_ELCR1 0x4d0 64 1.2 garbled #define IO_ELCR2 0x4d1 65 1.2 garbled 66 1.2 garbled /* 67 1.2 garbled * Prior to calling init_prepivr, the port is expected to have mapped the 68 1.2 garbled * page containing the IVR with mapiodev to prep_intr_reg and set up the 69 1.2 garbled * prep_intr_reg_off. 70 1.2 garbled */ 71 1.2 garbled 72 1.2 garbled struct pic_ops * 73 1.2 garbled setup_prepivr(int ivrtype) 74 1.2 garbled { 75 1.2 garbled struct i8259_ops *prepivr; 76 1.2 garbled struct pic_ops *pic; 77 1.2 garbled uint32_t pivr; 78 1.2 garbled 79 1.2 garbled prepivr = malloc(sizeof(struct i8259_ops), M_DEVBUF, M_NOWAIT); 80 1.2 garbled KASSERT(prepivr != NULL); 81 1.2 garbled pic = &prepivr->pic; 82 1.2 garbled 83 1.2 garbled pivr = prep_intr_reg + prep_intr_reg_off; 84 1.2 garbled pic->pic_numintrs = 16; 85 1.2 garbled pic->pic_cookie = (void *)pivr; 86 1.2 garbled pic->pic_enable_irq = i8259_enable_irq; 87 1.2 garbled pic->pic_reenable_irq = i8259_enable_irq; 88 1.2 garbled pic->pic_disable_irq = i8259_disable_irq; 89 1.2 garbled if (ivrtype == PIC_IVR_MOT) 90 1.2 garbled pic->pic_get_irq = motivr_get_irq; 91 1.2 garbled else 92 1.2 garbled pic->pic_get_irq = prepivr_get_irq; 93 1.2 garbled pic->pic_ack_irq = i8259_ack_irq; 94 1.2 garbled pic->pic_establish_irq = prepivr_establish_irq; 95 1.2 garbled pic->pic_finish_setup = NULL; 96 1.2 garbled strcpy(pic->pic_name, "prepivr"); 97 1.2 garbled pic_add(pic); 98 1.2 garbled prepivr->pending_events = 0; 99 1.2 garbled prepivr->enable_mask = 0xffffffff; 100 1.2 garbled prepivr->irqs = 0; 101 1.2 garbled 102 1.2 garbled /* initialize the ELCR */ 103 1.2 garbled isa_outb(IO_ELCR1, (0 >> 0) & 0xff); 104 1.2 garbled isa_outb(IO_ELCR2, (0 >> 8) & 0xff); 105 1.2 garbled i8259_initialize(); 106 1.2 garbled 107 1.2 garbled return pic; 108 1.2 garbled } 109 1.2 garbled 110 1.2 garbled static void 111 1.2 garbled prepivr_establish_irq(struct pic_ops *pic, int irq, int type, int maxlevel) 112 1.2 garbled { 113 1.2 garbled u_int8_t elcr[2]; 114 1.2 garbled int icu, bit; 115 1.2 garbled 116 1.2 garbled icu = irq / 8; 117 1.2 garbled bit = irq % 8; 118 1.2 garbled elcr[0] = isa_inb(IO_ELCR1); 119 1.2 garbled elcr[1] = isa_inb(IO_ELCR2); 120 1.2 garbled 121 1.2 garbled if (type == IST_LEVEL) 122 1.2 garbled elcr[icu] |= 1 << bit; 123 1.2 garbled else 124 1.2 garbled elcr[icu] &= ~(1 << bit); 125 1.2 garbled 126 1.2 garbled isa_outb(IO_ELCR1, elcr[0]); 127 1.2 garbled isa_outb(IO_ELCR2, elcr[1]); 128 1.2 garbled } 129 1.2 garbled 130 1.2 garbled static int 131 1.2 garbled motivr_get_irq(struct pic_ops *pic) 132 1.2 garbled { 133 1.2 garbled static int lirq; 134 1.2 garbled int irq; 135 1.2 garbled 136 1.2 garbled irq = i8259_get_irq(pic); 137 1.2 garbled /* read the IVR to ack it */ 138 1.2 garbled (void)inb(pic->pic_cookie); 139 1.2 garbled 140 1.2 garbled if (lirq == 7 && irq == lirq) { 141 1.2 garbled lirq = -1; 142 1.2 garbled return 255; 143 1.2 garbled } 144 1.2 garbled 145 1.2 garbled lirq = irq; 146 1.2 garbled if (irq == 0) 147 1.2 garbled return 255; 148 1.2 garbled 149 1.2 garbled return irq; 150 1.2 garbled } 151 1.2 garbled 152 1.2 garbled static int 153 1.2 garbled prepivr_get_irq(struct pic_ops *pic) 154 1.2 garbled { 155 1.2 garbled static int lirq; 156 1.2 garbled int irq; 157 1.2 garbled 158 1.2 garbled irq = inb(pic->pic_cookie); 159 1.2 garbled if (lirq == 7 && irq == lirq) { 160 1.2 garbled lirq = -1; 161 1.2 garbled return 255; 162 1.2 garbled } 163 1.2 garbled 164 1.2 garbled lirq = irq; 165 1.2 garbled if (irq == 0) 166 1.2 garbled return 255; 167 1.2 garbled 168 1.2 garbled return irq; 169 1.2 garbled } 170
Indexes created Mon Sep 29 21:09:56 GMT 2025