1 /* $OpenBSD: riscv_cpu_intc.c,v 1.11 2024/04/19 14:39:34 jca Exp $ */ 2 3 /* 4 * Copyright (c) 2020, Mars Li <mengshi.li.mars@gmail.com> 5 * 6 * Permission to use, copy, modify, and distribute this software for any 7 * purpose with or without fee is hereby granted, provided that the above 8 * copyright notice and this permission notice appear in all copies. 9 * 10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 17 */ 18 19 #include <sys/param.h> 20 #include <sys/systm.h> 21 #include <sys/malloc.h> 22 #include <sys/device.h> 23 24 #include <machine/fdt.h> 25 #include <machine/riscvreg.h> 26 27 #include <dev/ofw/openfirm.h> 28 29 #include "riscv_cpu_intc.h" 30 31 struct intrhand { 32 int (*ih_func)(void *); /* handler */ 33 void *ih_arg; /* arg for handler */ 34 int ih_irq; /* IRQ number */ 35 char *ih_name; 36 }; 37 38 struct intrhand* intc_handler[INTC_NIRQS] = {NULL}; 39 struct interrupt_controller intc_ic; 40 41 int riscv_intc_match(struct device *, void *, void *); 42 void riscv_intc_attach(struct device *, struct device *, void *); 43 44 void riscv_intc_irq_handler(void *); 45 void *riscv_intc_intr_establish(int, int, int (*)(void *), 46 void *, char *); 47 void riscv_intc_intr_disestablish(void *); 48 49 50 const struct cfattach intc_ca = { 51 sizeof (struct device), riscv_intc_match, riscv_intc_attach 52 }; 53 54 struct cfdriver intc_cd = { 55 NULL, "intc", DV_DULL 56 }; 57 58 int 59 riscv_intc_match(struct device *parent, void *match, void *aux) 60 { 61 struct fdt_attach_args *faa = aux; 62 int node = faa->fa_node; 63 return (OF_getproplen(node, "interrupt-controller") >= 0 && 64 OF_is_compatible(node, "riscv,cpu-intc")); 65 } 66 67 void 68 riscv_intc_attach(struct device *parent, struct device *self, void *aux) 69 { 70 struct fdt_attach_args *faa = aux;/* should only use fa_node field */ 71 72 riscv_init_smask(); 73 74 /* hook the intr_handler */ 75 riscv_set_intr_handler(riscv_intc_irq_handler); 76 77 printf("\n"); 78 79 intc_ic.ic_node = faa->fa_node; 80 intc_ic.ic_cookie = &intc_ic; 81 82 /* 83 * only allow install/uninstall handler to/from global vector 84 * by calling riscv_intc_intr_establish/disestablish 85 */ 86 intc_ic.ic_establish = NULL; 87 intc_ic.ic_disestablish = NULL; 88 89 riscv_intr_register_fdt(&intc_ic); 90 91 #ifdef MULTIPROCESSOR 92 extern int ipi_intr(void *); 93 riscv_intc_intr_establish(IRQ_SOFTWARE_SUPERVISOR, 0, 94 ipi_intr, NULL, NULL); 95 #endif 96 97 /* 98 * XXX right time to enable interrupts ?? 99 * might need to postpone until autoconf is finished 100 */ 101 intr_enable(); 102 } 103 104 105 /* global interrupt handler */ 106 void 107 riscv_intc_irq_handler(void *frame) 108 { 109 int irq; 110 struct intrhand *ih; 111 struct trapframe *_frame = (struct trapframe*) frame; 112 113 KASSERTMSG(_frame->tf_scause & EXCP_INTR, 114 "riscv_cpu_intr: wrong frame passed"); 115 116 irq = (_frame->tf_scause & EXCP_MASK); 117 #ifdef DEBUG_INTC 118 printf("irq %d fired\n", irq); 119 #endif 120 121 ih = intc_handler[irq]; 122 if (ih->ih_func(frame) == 0) 123 #ifdef DEBUG_INTC 124 printf("fail in handling irq %d %s\n", irq, ih->ih_name); 125 #else 126 ; 127 #endif /* DEBUG_INTC */ 128 } 129 130 void * 131 riscv_intc_intr_establish(int irqno, int dummy_level, int (*func)(void *), 132 void *arg, char *name) 133 { 134 struct intrhand *ih; 135 u_long sie; 136 137 if (irqno < 0 || irqno >= INTC_NIRQS) 138 panic("intc_intr_establish: bogus irqnumber %d: %s", 139 irqno, name); 140 141 ih = malloc(sizeof(*ih), M_DEVBUF, M_WAITOK); 142 ih->ih_func = func; 143 ih->ih_arg = arg; 144 ih->ih_irq = irqno; 145 ih->ih_name = name; 146 147 sie = intr_disable(); 148 intc_handler[irqno] = ih; 149 intr_restore(sie); 150 151 return (ih); 152 } 153 154 void 155 riscv_intc_intr_disestablish(void *cookie) 156 { 157 struct intrhand *ih = cookie; 158 int irqno = ih->ih_irq; 159 u_long sie; 160 161 sie = intr_disable(); 162 intc_handler[irqno] = NULL; 163 intr_restore(sie); 164 165 free(ih, M_DEVBUF, 0); 166 } 167