gemini_ipi.c revision 1.4.10.3
1 1.4.10.2 yamt #include "opt_gemini.h" 2 1.4.10.2 yamt #if !defined(GEMINI_MASTER) && !defined(GEMINI_SLAVE) 3 1.4.10.2 yamt # error IPI needs GEMINI_MASTER or GEMINI_SLAVE 4 1.4.10.2 yamt #endif 5 1.4.10.2 yamt #include "locators.h" 6 1.4.10.2 yamt #include "geminiipm.h" 7 1.4.10.2 yamt 8 1.4.10.2 yamt #include <sys/cdefs.h> 9 1.4.10.2 yamt 10 1.4.10.3 yamt __KERNEL_RCSID(0, "$NetBSD: gemini_ipi.c,v 1.4.10.3 2010/03/11 15:02:06 yamt Exp $"); 11 1.4.10.2 yamt 12 1.4.10.2 yamt #include <sys/param.h> 13 1.4.10.2 yamt #include <sys/systm.h> 14 1.4.10.2 yamt #include <sys/device.h> 15 1.4.10.2 yamt #include <sys/intr.h> 16 1.4.10.2 yamt #include <sys/malloc.h> 17 1.4.10.2 yamt #include <arch/arm/gemini/gemini_obiovar.h> 18 1.4.10.2 yamt #include <arch/arm/gemini/gemini_ipivar.h> 19 1.4.10.2 yamt #include <arch/arm/gemini/gemini_reg.h> 20 1.4.10.2 yamt 21 1.4.10.2 yamt static int gemini_ipi_match(struct device *, struct cfdata *, void *); 22 1.4.10.2 yamt static void gemini_ipi_attach(struct device *, struct device *, void *); 23 1.4.10.2 yamt static int gemini_ipiintr(void *); 24 1.4.10.2 yamt 25 1.4.10.2 yamt CFATTACH_DECL_NEW(geminiipi, sizeof(struct gemini_ipi_softc), 26 1.4.10.2 yamt gemini_ipi_match, gemini_ipi_attach, NULL, NULL); 27 1.4.10.2 yamt 28 1.4.10.2 yamt static gemini_ipi_softc_t *gemini_ipi_sc; 29 1.4.10.2 yamt 30 1.4.10.2 yamt 31 1.4.10.2 yamt static int 32 1.4.10.2 yamt gemini_ipi_match(struct device *parent, struct cfdata *cf, void *aux) 33 1.4.10.2 yamt { 34 1.4.10.2 yamt struct obio_attach_args *obio = aux; 35 1.4.10.2 yamt 36 1.4.10.2 yamt if (obio->obio_intr == LPCCF_INTR_DEFAULT) 37 1.4.10.2 yamt panic("ipi must specify intr in config."); 38 1.4.10.2 yamt 39 1.4.10.2 yamt return 1; 40 1.4.10.2 yamt } 41 1.4.10.2 yamt 42 1.4.10.2 yamt static void 43 1.4.10.2 yamt gemini_ipi_attach(struct device *parent, struct device *self, void *aux) 44 1.4.10.2 yamt { 45 1.4.10.2 yamt gemini_ipi_softc_t *sc = device_private(self); 46 1.4.10.2 yamt struct obio_attach_args *obio = aux; 47 1.4.10.2 yamt bus_space_tag_t iot; 48 1.4.10.2 yamt bus_space_handle_t ioh; 49 1.4.10.2 yamt bus_size_t size; 50 1.4.10.2 yamt bus_addr_t addr; 51 1.4.10.2 yamt void *ih; 52 1.4.10.2 yamt 53 1.4.10.2 yamt iot = obio->obio_iot; 54 1.4.10.2 yamt addr = GEMINI_GLOBAL_BASE; 55 1.4.10.2 yamt size = 4096; /* XXX */ 56 1.4.10.2 yamt 57 1.4.10.2 yamt if (bus_space_map(iot, addr, size, 0, &ioh)) 58 1.4.10.2 yamt panic("%s: Cannot map registers", device_xname(self)); 59 1.4.10.2 yamt 60 1.4.10.2 yamt /* 61 1.4.10.3 yamt * NOTE: we are using IPL_NET, not IPL_HIGH use of IPI on this system 62 1.4.10.3 yamt * is (mainly) networking keep simple (for now) and force all IPIs 63 1.4.10.3 yamt * to same level so splnet() can block them as any other NIC. 64 1.4.10.2 yamt */ 65 1.4.10.2 yamt #if 0 66 1.4.10.2 yamt ih = intr_establish(obio->obio_intr, IPL_NET, IST_LEVEL_HIGH, 67 1.4.10.2 yamt gemini_ipiintr, sc); 68 1.4.10.2 yamt #else 69 1.4.10.2 yamt ih = intr_establish(obio->obio_intr, IPL_NET, IST_EDGE_RISING, 70 1.4.10.2 yamt gemini_ipiintr, sc); 71 1.4.10.2 yamt #endif 72 1.4.10.2 yamt if (ih == NULL) 73 1.4.10.2 yamt panic("%s: Cannot establish interrupt %d\n", 74 1.4.10.2 yamt device_xname(self), obio->obio_intr); 75 1.4.10.2 yamt 76 1.4.10.2 yamt SIMPLEQ_INIT(&sc->sc_intrq); 77 1.4.10.2 yamt 78 1.4.10.2 yamt sc->sc_iot = iot; 79 1.4.10.2 yamt sc->sc_ioh = ioh; 80 1.4.10.2 yamt sc->sc_addr = addr; 81 1.4.10.2 yamt sc->sc_size = size; 82 1.4.10.2 yamt sc->sc_intr = obio->obio_intr; 83 1.4.10.2 yamt sc->sc_ih = ih; 84 1.4.10.2 yamt 85 1.4.10.2 yamt gemini_ipi_sc = sc; 86 1.4.10.2 yamt 87 1.4.10.2 yamt aprint_normal("\n"); 88 1.4.10.2 yamt aprint_naive("\n"); 89 1.4.10.2 yamt 90 1.4.10.2 yamt #if NGEMINIIPM > 0 91 1.4.10.2 yamt config_found(self, __UNCONST("geminiipm"), NULL); 92 1.4.10.2 yamt #endif 93 1.4.10.2 yamt } 94 1.4.10.2 yamt 95 1.4.10.2 yamt static inline int 96 1.4.10.2 yamt gemini_ipi_intrq_empty(gemini_ipi_softc_t *sc) 97 1.4.10.2 yamt { 98 1.4.10.2 yamt return SIMPLEQ_EMPTY(&sc->sc_intrq); 99 1.4.10.2 yamt } 100 1.4.10.2 yamt 101 1.4.10.2 yamt static inline void * 102 1.4.10.2 yamt gemini_ipi_intrq_insert(gemini_ipi_softc_t *sc, int (*func)(void *), void *arg) 103 1.4.10.2 yamt { 104 1.4.10.2 yamt gemini_ipi_intrq_t *iqp; 105 1.4.10.2 yamt 106 1.4.10.2 yamt iqp = malloc(sizeof(*iqp), M_DEVBUF, M_NOWAIT|M_ZERO); 107 1.4.10.2 yamt if (iqp == NULL) { 108 1.4.10.2 yamt printf("gemini_ipi_intrq_insert: malloc failed\n"); 109 1.4.10.2 yamt return NULL; 110 1.4.10.2 yamt } 111 1.4.10.2 yamt 112 1.4.10.2 yamt iqp->iq_func = func; 113 1.4.10.2 yamt iqp->iq_arg = arg; 114 1.4.10.2 yamt SIMPLEQ_INSERT_TAIL(&sc->sc_intrq, iqp, iq_q); 115 1.4.10.2 yamt 116 1.4.10.2 yamt return (void *)iqp; 117 1.4.10.2 yamt } 118 1.4.10.2 yamt 119 1.4.10.2 yamt static inline void 120 1.4.10.2 yamt gemini_ipi_intrq_remove(gemini_ipi_softc_t *sc, void *cookie) 121 1.4.10.2 yamt { 122 1.4.10.2 yamt gemini_ipi_intrq_t *iqp; 123 1.4.10.2 yamt 124 1.4.10.2 yamt SIMPLEQ_FOREACH(iqp, &sc->sc_intrq, iq_q) { 125 1.4.10.2 yamt if ((void *)iqp == cookie) { 126 1.4.10.2 yamt SIMPLEQ_REMOVE(&sc->sc_intrq, 127 1.4.10.2 yamt iqp, gemini_ipi_intrq, iq_q); 128 1.4.10.2 yamt free(iqp, M_DEVBUF); 129 1.4.10.2 yamt return; 130 1.4.10.2 yamt } 131 1.4.10.2 yamt } 132 1.4.10.2 yamt } 133 1.4.10.2 yamt 134 1.4.10.2 yamt static inline int 135 1.4.10.2 yamt gemini_ipi_intrq_dispatch(gemini_ipi_softc_t *sc) 136 1.4.10.2 yamt { 137 1.4.10.2 yamt gemini_ipi_intrq_t *iqp; 138 1.4.10.2 yamt int rv = 0; 139 1.4.10.2 yamt 140 1.4.10.2 yamt SIMPLEQ_FOREACH(iqp, &sc->sc_intrq, iq_q) 141 1.4.10.2 yamt rv |= (*iqp->iq_func)(iqp->iq_arg); 142 1.4.10.2 yamt 143 1.4.10.2 yamt return (rv != 0); 144 1.4.10.2 yamt } 145 1.4.10.2 yamt 146 1.4.10.2 yamt 147 1.4.10.2 yamt void * 148 1.4.10.2 yamt ipi_intr_establish(int (*func)(void *), void *arg) 149 1.4.10.2 yamt { 150 1.4.10.2 yamt gemini_ipi_softc_t *sc = gemini_ipi_sc; 151 1.4.10.2 yamt void *ih; 152 1.4.10.2 yamt 153 1.4.10.2 yamt if (sc == NULL) 154 1.4.10.2 yamt return NULL; 155 1.4.10.2 yamt 156 1.4.10.2 yamt ih = gemini_ipi_intrq_insert(sc, func, arg); 157 1.4.10.2 yamt #ifdef DEBUG 158 1.4.10.2 yamt if (ih == NULL) 159 1.4.10.2 yamt panic("%s: gemini_ipi_intrq_insert failed", 160 1.4.10.2 yamt device_xname(&sc->sc_dev)); 161 1.4.10.2 yamt #endif 162 1.4.10.2 yamt 163 1.4.10.2 yamt return ih; 164 1.4.10.2 yamt } 165 1.4.10.2 yamt 166 1.4.10.2 yamt void 167 1.4.10.2 yamt ipi_intr_disestablish(void *ih) 168 1.4.10.2 yamt { 169 1.4.10.2 yamt gemini_ipi_softc_t *sc = gemini_ipi_sc; 170 1.4.10.2 yamt 171 1.4.10.2 yamt if (sc == NULL) 172 1.4.10.2 yamt panic("%s: NULL gemini_ipi_sc", device_xname(&sc->sc_dev)); 173 1.4.10.2 yamt 174 1.4.10.2 yamt gemini_ipi_intrq_remove(sc, ih); 175 1.4.10.2 yamt } 176 1.4.10.2 yamt 177 1.4.10.2 yamt int 178 1.4.10.2 yamt ipi_send(void) 179 1.4.10.2 yamt { 180 1.4.10.2 yamt gemini_ipi_softc_t *sc = gemini_ipi_sc; 181 1.4.10.2 yamt uint32_t r; 182 1.4.10.2 yamt uint32_t bit; 183 1.4.10.2 yamt bus_addr_t off; 184 1.4.10.2 yamt 185 1.4.10.2 yamt if (sc == NULL) 186 1.4.10.2 yamt return -1; 187 1.4.10.2 yamt 188 1.4.10.2 yamt #if defined(GEMINI_MASTER) 189 1.4.10.2 yamt off = GEMINI_GLOBAL_CPU0; 190 1.4.10.2 yamt bit = GLOBAL_CPU0_IPICPU1; 191 1.4.10.2 yamt #elif defined(GEMINI_SLAVE) 192 1.4.10.2 yamt off = GEMINI_GLOBAL_CPU1; 193 1.4.10.2 yamt bit = GLOBAL_CPU1_IPICPU0; 194 1.4.10.2 yamt #endif 195 1.4.10.2 yamt 196 1.4.10.2 yamt r = bus_space_read_4(sc->sc_iot, sc->sc_ioh, off); 197 1.4.10.2 yamt r |= bit; 198 1.4.10.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_ioh, off, r); 199 1.4.10.2 yamt 200 1.4.10.2 yamt return 0; 201 1.4.10.2 yamt } 202 1.4.10.2 yamt 203 1.4.10.2 yamt static inline void 204 1.4.10.2 yamt ipi_ack(gemini_ipi_softc_t *sc) 205 1.4.10.2 yamt { 206 1.4.10.2 yamt uint32_t r; 207 1.4.10.2 yamt uint32_t bit; 208 1.4.10.2 yamt bus_addr_t off; 209 1.4.10.2 yamt 210 1.4.10.2 yamt #if defined(GEMINI_MASTER) 211 1.4.10.2 yamt off = GEMINI_GLOBAL_CPU1; 212 1.4.10.2 yamt bit = GLOBAL_CPU1_IPICPU0; 213 1.4.10.2 yamt #elif defined(GEMINI_SLAVE) 214 1.4.10.2 yamt off = GEMINI_GLOBAL_CPU0; 215 1.4.10.2 yamt bit = GLOBAL_CPU0_IPICPU1; 216 1.4.10.2 yamt #endif 217 1.4.10.2 yamt 218 1.4.10.2 yamt r = bus_space_read_4(sc->sc_iot, sc->sc_ioh, off); 219 1.4.10.2 yamt r &= ~bit; 220 1.4.10.2 yamt bus_space_write_4(sc->sc_iot, sc->sc_ioh, off, r); 221 1.4.10.2 yamt } 222 1.4.10.2 yamt 223 1.4.10.2 yamt static int 224 1.4.10.2 yamt gemini_ipiintr(void *arg) 225 1.4.10.2 yamt { 226 1.4.10.2 yamt gemini_ipi_softc_t *sc = arg; 227 1.4.10.2 yamt int rv; 228 1.4.10.2 yamt 229 1.4.10.2 yamt if (sc == NULL) 230 1.4.10.2 yamt return -1; 231 1.4.10.2 yamt 232 1.4.10.2 yamt ipi_ack(sc); 233 1.4.10.2 yamt 234 1.4.10.2 yamt rv = gemini_ipi_intrq_dispatch(sc); 235 1.4.10.2 yamt 236 1.4.10.2 yamt return rv; 237 1.4.10.2 yamt } 238
Indexes created Tue Sep 30 20:09:53 GMT 2025