exynos_combiner.c revision 1.3.2.2
1 1.3.2.2 skrll /* $NetBSD: exynos_combiner.c,v 1.3.2.2 2015/12/27 12:09:32 skrll Exp $ */ 2 1.3.2.2 skrll 3 1.3.2.2 skrll /*- 4 1.3.2.2 skrll * Copyright (c) 2015 The NetBSD Foundation, Inc. 5 1.3.2.2 skrll * All rights reserved. 6 1.3.2.2 skrll * 7 1.3.2.2 skrll * This code is derived from software contributed to The NetBSD Foundation 8 1.3.2.2 skrll * by Marty Fouts 9 1.3.2.2 skrll * 10 1.3.2.2 skrll * Redistribution and use in source and binary forms, with or without 11 1.3.2.2 skrll * modification, are permitted provided that the following conditions 12 1.3.2.2 skrll * are met: 13 1.3.2.2 skrll * 1. Redistributions of source code must retain the above copyright 14 1.3.2.2 skrll * notice, this list of conditions and the following disclaimer. 15 1.3.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright 16 1.3.2.2 skrll * notice, this list of conditions and the following disclaimer in the 17 1.3.2.2 skrll * documentation and/or other materials provided with the distribution. 18 1.3.2.2 skrll * 19 1.3.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.3.2.2 skrll * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.3.2.2 skrll * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.3.2.2 skrll * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.3.2.2 skrll * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.3.2.2 skrll * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.3.2.2 skrll * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.3.2.2 skrll * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.3.2.2 skrll * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.3.2.2 skrll * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.3.2.2 skrll * POSSIBILITY OF SUCH DAMAGE. 30 1.3.2.2 skrll */ 31 1.3.2.2 skrll 32 1.3.2.2 skrll #include "opt_exynos.h" 33 1.3.2.2 skrll #include "opt_arm_debug.h" 34 1.3.2.2 skrll #include "gpio.h" 35 1.3.2.2 skrll 36 1.3.2.2 skrll #include <sys/cdefs.h> 37 1.3.2.2 skrll __KERNEL_RCSID(1, "$NetBSD: exynos_combiner.c,v 1.3.2.2 2015/12/27 12:09:32 skrll Exp $"); 38 1.3.2.2 skrll 39 1.3.2.2 skrll #include <sys/param.h> 40 1.3.2.2 skrll #include <sys/bus.h> 41 1.3.2.2 skrll #include <sys/device.h> 42 1.3.2.2 skrll #include <sys/intr.h> 43 1.3.2.2 skrll #include <sys/systm.h> 44 1.3.2.2 skrll #include <sys/kmem.h> 45 1.3.2.2 skrll 46 1.3.2.2 skrll #include <arm/cortex/gic_intr.h> 47 1.3.2.2 skrll 48 1.3.2.2 skrll #include <arm/samsung/exynos_reg.h> 49 1.3.2.2 skrll #include <arm/samsung/exynos_intr.h> 50 1.3.2.2 skrll 51 1.3.2.2 skrll #include <dev/fdt/fdtvar.h> 52 1.3.2.2 skrll 53 1.3.2.2 skrll #define COMBINER_IESR_OFFSET 0x00 54 1.3.2.2 skrll #define COMBINER_IECR_OFFSET 0x04 55 1.3.2.2 skrll #define COMBINER_ISTR_OFFSET 0x08 56 1.3.2.2 skrll #define COMBINER_IMSR_OFFSET 0x0C 57 1.3.2.2 skrll #define COMBINER_BLOCK_SIZE 0x10 58 1.3.2.2 skrll 59 1.3.2.2 skrll struct exynos_combiner_softc { 60 1.3.2.2 skrll device_t sc_dev; 61 1.3.2.2 skrll bus_space_tag_t sc_bst; 62 1.3.2.2 skrll bus_space_handle_t sc_bsh; 63 1.3.2.2 skrll int sc_phandle; 64 1.3.2.2 skrll 65 1.3.2.2 skrll }; 66 1.3.2.2 skrll 67 1.3.2.2 skrll static int exynos_combiner_match(device_t, cfdata_t, void *); 68 1.3.2.2 skrll static void exynos_combiner_attach(device_t, device_t, void *); 69 1.3.2.2 skrll 70 1.3.2.2 skrll static void * exynos_combiner_establish(device_t, int, u_int, int, int, 71 1.3.2.2 skrll int (*)(void *), void *); 72 1.3.2.2 skrll static void exynos_combiner_disestablish(device_t, void *); 73 1.3.2.2 skrll static bool exynos_combiner_intrstr(device_t, int, u_int, char *, size_t); 74 1.3.2.2 skrll 75 1.3.2.2 skrll struct fdtbus_interrupt_controller_func exynos_combiner_funcs = { 76 1.3.2.2 skrll .establish = exynos_combiner_establish, 77 1.3.2.2 skrll .disestablish = exynos_combiner_disestablish, 78 1.3.2.2 skrll .intrstr = exynos_combiner_intrstr 79 1.3.2.2 skrll }; 80 1.3.2.2 skrll 81 1.3.2.2 skrll CFATTACH_DECL_NEW(exynos_intr, sizeof(struct exynos_combiner_softc), 82 1.3.2.2 skrll exynos_combiner_match, exynos_combiner_attach, NULL, NULL); 83 1.3.2.2 skrll 84 1.3.2.2 skrll static int 85 1.3.2.2 skrll exynos_combiner_match(device_t parent, cfdata_t cf, void *aux) 86 1.3.2.2 skrll { 87 1.3.2.2 skrll const char * const compatible[] = { "samsung,exynos4210-combiner", 88 1.3.2.2 skrll NULL }; 89 1.3.2.2 skrll struct fdt_attach_args * const faa = aux; 90 1.3.2.2 skrll return of_match_compatible(faa->faa_phandle, compatible); 91 1.3.2.2 skrll } 92 1.3.2.2 skrll 93 1.3.2.2 skrll static void 94 1.3.2.2 skrll exynos_combiner_attach(device_t parent, device_t self, void *aux) 95 1.3.2.2 skrll { 96 1.3.2.2 skrll struct exynos_combiner_softc * const sc 97 1.3.2.2 skrll = kmem_zalloc(sizeof(*sc), KM_SLEEP); 98 1.3.2.2 skrll struct fdt_attach_args * const faa = aux; 99 1.3.2.2 skrll bus_addr_t addr; 100 1.3.2.2 skrll bus_size_t size; 101 1.3.2.2 skrll int error; 102 1.3.2.2 skrll 103 1.3.2.2 skrll if (fdtbus_get_reg(faa->faa_phandle, 0, &addr, &size) != 0) { 104 1.3.2.2 skrll aprint_error(": couldn't get registers\n"); 105 1.3.2.2 skrll return; 106 1.3.2.2 skrll } 107 1.3.2.2 skrll 108 1.3.2.2 skrll sc->sc_dev = self; 109 1.3.2.2 skrll sc->sc_phandle = faa->faa_phandle; 110 1.3.2.2 skrll sc->sc_bst = faa->faa_bst; 111 1.3.2.2 skrll 112 1.3.2.2 skrll error = bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh); 113 1.3.2.2 skrll if (error) { 114 1.3.2.2 skrll aprint_error(": couldn't map %#llx: %d", 115 1.3.2.2 skrll (uint64_t)addr, error); 116 1.3.2.2 skrll return; 117 1.3.2.2 skrll } 118 1.3.2.2 skrll 119 1.3.2.2 skrll error = fdtbus_register_interrupt_controller(self, faa->faa_phandle, 120 1.3.2.2 skrll &exynos_combiner_funcs); 121 1.3.2.2 skrll if (error) { 122 1.3.2.2 skrll aprint_error(": couldn't register with fdtbus: %d\n", error); 123 1.3.2.2 skrll return; 124 1.3.2.2 skrll } 125 1.3.2.2 skrll 126 1.3.2.2 skrll aprint_normal(" @ 0x%08x: interrupt combiner", (uint)addr); 127 1.3.2.2 skrll aprint_naive("\n"); 128 1.3.2.2 skrll aprint_normal("\n"); 129 1.3.2.2 skrll 130 1.3.2.2 skrll } 131 1.3.2.2 skrll 132 1.3.2.2 skrll static void * 133 1.3.2.2 skrll exynos_combiner_establish(device_t dev, int phandle, u_int index, int ipl, 134 1.3.2.2 skrll int flags, 135 1.3.2.2 skrll int (*func)(void *), void *arg) 136 1.3.2.2 skrll { 137 1.3.2.2 skrll struct exynos_combiner_softc * const sc = device_private(dev); 138 1.3.2.2 skrll int iflags = (flags & FDT_INTR_MPSAFE) ? IST_MPSAFE : 0; 139 1.3.2.2 skrll int iblock = index >> 3; 140 1.3.2.2 skrll int ioffset = index & 0x07; 141 1.3.2.2 skrll int block_offset = 142 1.3.2.2 skrll iblock * COMBINER_BLOCK_SIZE + COMBINER_IESR_OFFSET; 143 1.3.2.2 skrll int istatus = 144 1.3.2.2 skrll bus_space_read_4(sc->sc_bst, sc->sc_bsh, block_offset); 145 1.3.2.2 skrll printf("Establishing irq %d (0x%x) @ iblock = %d, ioffset = %d\n", 146 1.3.2.2 skrll index, index, iblock, ioffset); 147 1.3.2.2 skrll istatus |= 1 << ioffset; 148 1.3.2.2 skrll bus_space_write_4(sc->sc_bst, sc->sc_bsh, block_offset, istatus); 149 1.3.2.2 skrll return intr_establish(index, ipl, iflags, func, arg); 150 1.3.2.2 skrll } 151 1.3.2.2 skrll 152 1.3.2.2 skrll static void 153 1.3.2.2 skrll exynos_combiner_disestablish(device_t dev, void *ih) 154 1.3.2.2 skrll { 155 1.3.2.2 skrll intr_disestablish(ih); 156 1.3.2.2 skrll } 157 1.3.2.2 skrll 158 1.3.2.2 skrll static bool 159 1.3.2.2 skrll exynos_combiner_intrstr(device_t dev, int phandle, u_int index, char *buf, 160 1.3.2.2 skrll size_t buflen) 161 1.3.2.2 skrll { 162 1.3.2.2 skrll struct exynos_combiner_softc * const sc = device_private(dev); 163 1.3.2.2 skrll u_int *interrupts; 164 1.3.2.2 skrll int interrupt_cells, len; 165 1.3.2.2 skrll 166 1.3.2.2 skrll if (of_getprop_uint32(sc->sc_phandle, "#interrupt-cells", 167 1.3.2.2 skrll &interrupt_cells)) { 168 1.3.2.2 skrll return false; 169 1.3.2.2 skrll } 170 1.3.2.2 skrll 171 1.3.2.2 skrll len = OF_getproplen(phandle, "interrupts"); 172 1.3.2.2 skrll if (len <= 0) { 173 1.3.2.2 skrll return false; 174 1.3.2.2 skrll } 175 1.3.2.2 skrll 176 1.3.2.2 skrll const u_int clen = interrupt_cells * 4; 177 1.3.2.2 skrll const u_int nintr = len / interrupt_cells; 178 1.3.2.2 skrll 179 1.3.2.2 skrll if (index >= nintr) { 180 1.3.2.2 skrll return false; 181 1.3.2.2 skrll } 182 1.3.2.2 skrll 183 1.3.2.2 skrll interrupts = kmem_alloc(len, KM_SLEEP); 184 1.3.2.2 skrll 185 1.3.2.2 skrll if (OF_getprop(phandle, "interrupts", interrupts, len) != len) { 186 1.3.2.2 skrll kmem_free(interrupts, len); 187 1.3.2.2 skrll return false; 188 1.3.2.2 skrll } 189 1.3.2.2 skrll 190 1.3.2.2 skrll /* 1st cell is the interrupt type; */ 191 1.3.2.2 skrll /* 2nd cell is the interrupt number */ 192 1.3.2.2 skrll /* 3rd cell is flags */ 193 1.3.2.2 skrll 194 1.3.2.2 skrll const u_int type = be32toh(interrupts[index * clen + 0]); 195 1.3.2.2 skrll const u_int intr = be32toh(interrupts[index * clen + 1]); 196 1.3.2.2 skrll const u_int irq = type == 0 ? IRQ_SPI(intr) : IRQ_PPI(intr); 197 1.3.2.2 skrll 198 1.3.2.2 skrll kmem_free(interrupts, len); 199 1.3.2.2 skrll 200 1.3.2.2 skrll snprintf(buf, buflen, "LIC irq %d", irq); 201 1.3.2.2 skrll 202 1.3.2.2 skrll return true; 203 1.3.2.2 skrll } 204
Indexes created Sun Oct 26 17:10:13 GMT 2025