108077f58SMarcel Moolenaar /*- 271e3c308SPedro F. Giffuni * SPDX-License-Identifier: BSD-3-Clause 371e3c308SPedro F. Giffuni * 408077f58SMarcel Moolenaar * Copyright (c) 2006-2008, Juniper Networks, Inc. 525c22eb4SRafal Jaworowski * Copyright (c) 2008 Semihalf, Rafal Czubak 6d1d3233eSRafal Jaworowski * Copyright (c) 2009 The FreeBSD Foundation 708077f58SMarcel Moolenaar * All rights reserved. 808077f58SMarcel Moolenaar * 9d1d3233eSRafal Jaworowski * Portions of this software were developed by Semihalf 10d1d3233eSRafal Jaworowski * under sponsorship from the FreeBSD Foundation. 11d1d3233eSRafal Jaworowski * 1208077f58SMarcel Moolenaar * Redistribution and use in source and binary forms, with or without 1308077f58SMarcel Moolenaar * modification, are permitted provided that the following conditions 1408077f58SMarcel Moolenaar * are met: 1508077f58SMarcel Moolenaar * 1. Redistributions of source code must retain the above copyright 1608077f58SMarcel Moolenaar * notice, this list of conditions and the following disclaimer. 1708077f58SMarcel Moolenaar * 2. Redistributions in binary form must reproduce the above copyright 1808077f58SMarcel Moolenaar * notice, this list of conditions and the following disclaimer in the 1908077f58SMarcel Moolenaar * documentation and/or other materials provided with the distribution. 2008077f58SMarcel Moolenaar * 3. The name of the author may not be used to endorse or promote products 2108077f58SMarcel Moolenaar * derived from this software without specific prior written permission. 2208077f58SMarcel Moolenaar * 2308077f58SMarcel Moolenaar * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 2408077f58SMarcel Moolenaar * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 2508077f58SMarcel Moolenaar * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 2608077f58SMarcel Moolenaar * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 2708077f58SMarcel Moolenaar * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 2808077f58SMarcel Moolenaar * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 2908077f58SMarcel Moolenaar * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 3008077f58SMarcel Moolenaar * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 3108077f58SMarcel Moolenaar * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 3208077f58SMarcel Moolenaar * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 3308077f58SMarcel Moolenaar * SUCH DAMAGE. 3408077f58SMarcel Moolenaar */ 3508077f58SMarcel Moolenaar 368bc8506eSJustin Hibbits #include "opt_platform.h" 378bc8506eSJustin Hibbits 3808077f58SMarcel Moolenaar #include <sys/param.h> 3908077f58SMarcel Moolenaar #include <sys/systm.h> 4008077f58SMarcel Moolenaar #include <sys/ktr.h> 4108077f58SMarcel Moolenaar #include <sys/kernel.h> 4208077f58SMarcel Moolenaar #include <sys/malloc.h> 4308077f58SMarcel Moolenaar #include <sys/module.h> 4408077f58SMarcel Moolenaar #include <sys/bus.h> 4508077f58SMarcel Moolenaar #include <sys/rman.h> 4608077f58SMarcel Moolenaar #include <machine/bus.h> 4708077f58SMarcel Moolenaar 4808077f58SMarcel Moolenaar #include <vm/vm.h> 4908077f58SMarcel Moolenaar #include <vm/pmap.h> 5008077f58SMarcel Moolenaar 51d1d3233eSRafal Jaworowski #include <dev/fdt/fdt_common.h> 52d1d3233eSRafal Jaworowski #include <dev/ofw/ofw_bus.h> 53d1d3233eSRafal Jaworowski #include <dev/ofw/ofw_bus_subr.h> 54d1d3233eSRafal Jaworowski 5525c22eb4SRafal Jaworowski #include <powerpc/mpc85xx/mpc85xx.h> 5608077f58SMarcel Moolenaar 57d1d3233eSRafal Jaworowski #include "ofw_bus_if.h" 58d1d3233eSRafal Jaworowski #include "lbc.h" 5908077f58SMarcel Moolenaar 60d1d3233eSRafal Jaworowski #ifdef DEBUG 61d1d3233eSRafal Jaworowski #define debugf(fmt, args...) do { printf("%s(): ", __func__); \ 62d1d3233eSRafal Jaworowski printf(fmt,##args); } while (0) 63d1d3233eSRafal Jaworowski #else 64d1d3233eSRafal Jaworowski #define debugf(fmt, args...) 65d1d3233eSRafal Jaworowski #endif 6608077f58SMarcel Moolenaar 67d1d3233eSRafal Jaworowski static MALLOC_DEFINE(M_LBC, "localbus", "localbus devices information"); 68d1d3233eSRafal Jaworowski 69d1d3233eSRafal Jaworowski static int lbc_probe(device_t); 70d1d3233eSRafal Jaworowski static int lbc_attach(device_t); 71d1d3233eSRafal Jaworowski static int lbc_shutdown(device_t); 72d77f2092SJohn Baldwin static int lbc_map_resource(device_t, device_t, struct resource *, 735a7e717fSJohn Baldwin struct resource_map_request *, struct resource_map *); 74d77f2092SJohn Baldwin static int lbc_unmap_resource(device_t, device_t, struct resource *, 755a7e717fSJohn Baldwin struct resource_map *map); 765a7e717fSJohn Baldwin static int lbc_activate_resource(device_t bus, device_t child, 772baed46eSJohn Baldwin struct resource *r); 782baed46eSJohn Baldwin static int lbc_deactivate_resource(device_t bus, device_t child, 798bc8506eSJustin Hibbits struct resource *r); 805a7e717fSJohn Baldwin static struct rman *lbc_get_rman(device_t, int, u_int); 81d1d3233eSRafal Jaworowski static struct resource *lbc_alloc_resource(device_t, device_t, int, int *, 822dd1bdf1SJustin Hibbits rman_res_t, rman_res_t, rman_res_t, u_int); 83fef01f04SJohn Baldwin static int lbc_adjust_resource(device_t, device_t, struct resource *, 845a7e717fSJohn Baldwin rman_res_t, rman_res_t); 85d1d3233eSRafal Jaworowski static int lbc_print_child(device_t, device_t); 869dbf5b0eSJohn Baldwin static int lbc_release_resource(device_t, device_t, struct resource *); 87d1d3233eSRafal Jaworowski static const struct ofw_bus_devinfo *lbc_get_devinfo(device_t, device_t); 88d1d3233eSRafal Jaworowski 89d1d3233eSRafal Jaworowski /* 90d1d3233eSRafal Jaworowski * Bus interface definition 91d1d3233eSRafal Jaworowski */ 92d1d3233eSRafal Jaworowski static device_method_t lbc_methods[] = { 93d1d3233eSRafal Jaworowski /* Device interface */ 94d1d3233eSRafal Jaworowski DEVMETHOD(device_probe, lbc_probe), 95d1d3233eSRafal Jaworowski DEVMETHOD(device_attach, lbc_attach), 96d1d3233eSRafal Jaworowski DEVMETHOD(device_shutdown, lbc_shutdown), 97d1d3233eSRafal Jaworowski 98d1d3233eSRafal Jaworowski /* Bus interface */ 99d1d3233eSRafal Jaworowski DEVMETHOD(bus_print_child, lbc_print_child), 100d1d3233eSRafal Jaworowski DEVMETHOD(bus_setup_intr, bus_generic_setup_intr), 101d1d3233eSRafal Jaworowski DEVMETHOD(bus_teardown_intr, NULL), 102d1d3233eSRafal Jaworowski 1035a7e717fSJohn Baldwin DEVMETHOD(bus_get_rman, lbc_get_rman), 104d1d3233eSRafal Jaworowski DEVMETHOD(bus_alloc_resource, lbc_alloc_resource), 1055a7e717fSJohn Baldwin DEVMETHOD(bus_adjust_resource, lbc_adjust_resource), 106d1d3233eSRafal Jaworowski DEVMETHOD(bus_release_resource, lbc_release_resource), 1078bc8506eSJustin Hibbits DEVMETHOD(bus_activate_resource, lbc_activate_resource), 1088bc8506eSJustin Hibbits DEVMETHOD(bus_deactivate_resource, lbc_deactivate_resource), 1095a7e717fSJohn Baldwin DEVMETHOD(bus_map_resource, lbc_map_resource), 1105a7e717fSJohn Baldwin DEVMETHOD(bus_unmap_resource, lbc_unmap_resource), 111d1d3233eSRafal Jaworowski 112d1d3233eSRafal Jaworowski /* OFW bus interface */ 113d1d3233eSRafal Jaworowski DEVMETHOD(ofw_bus_get_devinfo, lbc_get_devinfo), 114d1d3233eSRafal Jaworowski DEVMETHOD(ofw_bus_get_compat, ofw_bus_gen_get_compat), 115d1d3233eSRafal Jaworowski DEVMETHOD(ofw_bus_get_model, ofw_bus_gen_get_model), 116d1d3233eSRafal Jaworowski DEVMETHOD(ofw_bus_get_name, ofw_bus_gen_get_name), 117d1d3233eSRafal Jaworowski DEVMETHOD(ofw_bus_get_node, ofw_bus_gen_get_node), 118d1d3233eSRafal Jaworowski DEVMETHOD(ofw_bus_get_type, ofw_bus_gen_get_type), 119d1d3233eSRafal Jaworowski { 0, 0 } 120d1d3233eSRafal Jaworowski }; 121d1d3233eSRafal Jaworowski 122d1d3233eSRafal Jaworowski static driver_t lbc_driver = { 123d1d3233eSRafal Jaworowski "lbc", 124d1d3233eSRafal Jaworowski lbc_methods, 125d1d3233eSRafal Jaworowski sizeof(struct lbc_softc) 126d1d3233eSRafal Jaworowski }; 127d1d3233eSRafal Jaworowski 1285d7d6129SJohn Baldwin EARLY_DRIVER_MODULE(lbc, ofwbus, lbc_driver, 0, 0, BUS_PASS_BUS); 129d1d3233eSRafal Jaworowski 13025c22eb4SRafal Jaworowski /* 13125c22eb4SRafal Jaworowski * Calculate address mask used by OR(n) registers. Use memory region size to 13225c22eb4SRafal Jaworowski * determine mask value. The size must be a power of two and within the range 13325c22eb4SRafal Jaworowski * of 32KB - 4GB. Otherwise error code is returned. Value representing 13425c22eb4SRafal Jaworowski * 4GB size can be passed as 0xffffffff. 13525c22eb4SRafal Jaworowski */ 13625c22eb4SRafal Jaworowski static uint32_t 13725c22eb4SRafal Jaworowski lbc_address_mask(uint32_t size) 13825c22eb4SRafal Jaworowski { 13925c22eb4SRafal Jaworowski int n = 15; 14025c22eb4SRafal Jaworowski 141295be330SJustin Hibbits if (size == ~0) 14225c22eb4SRafal Jaworowski return (0); 14325c22eb4SRafal Jaworowski 14425c22eb4SRafal Jaworowski while (n < 32) { 145295be330SJustin Hibbits if (size == (1U << n)) 14625c22eb4SRafal Jaworowski break; 14725c22eb4SRafal Jaworowski n++; 14825c22eb4SRafal Jaworowski } 14925c22eb4SRafal Jaworowski 15025c22eb4SRafal Jaworowski if (n == 32) 15125c22eb4SRafal Jaworowski return (EINVAL); 15225c22eb4SRafal Jaworowski 15325c22eb4SRafal Jaworowski return (0xffff8000 << (n - 15)); 15425c22eb4SRafal Jaworowski } 15525c22eb4SRafal Jaworowski 156d1d3233eSRafal Jaworowski static void 157d1d3233eSRafal Jaworowski lbc_banks_unmap(struct lbc_softc *sc) 15808077f58SMarcel Moolenaar { 159f6703dd2SMarcel Moolenaar int r; 16008077f58SMarcel Moolenaar 161f6703dd2SMarcel Moolenaar r = 0; 162f6703dd2SMarcel Moolenaar while (r < LBC_DEV_MAX) { 163f6703dd2SMarcel Moolenaar if (sc->sc_range[r].size == 0) 164f6703dd2SMarcel Moolenaar return; 16525c22eb4SRafal Jaworowski 1667ae99f80SJohn Baldwin pmap_unmapdev((void *)sc->sc_range[r].kva, 1677ae99f80SJohn Baldwin sc->sc_range[r].size); 168f6703dd2SMarcel Moolenaar law_disable(OCP85XX_TGTIF_LBC, sc->sc_range[r].addr, 169f6703dd2SMarcel Moolenaar sc->sc_range[r].size); 170f6703dd2SMarcel Moolenaar r++; 17108077f58SMarcel Moolenaar } 17208077f58SMarcel Moolenaar } 17308077f58SMarcel Moolenaar 17408077f58SMarcel Moolenaar static int 175d1d3233eSRafal Jaworowski lbc_banks_map(struct lbc_softc *sc) 17625c22eb4SRafal Jaworowski { 177f6703dd2SMarcel Moolenaar vm_paddr_t end, start; 178f6703dd2SMarcel Moolenaar vm_size_t size; 179f6703dd2SMarcel Moolenaar u_int i, r, ranges, s; 180f6703dd2SMarcel Moolenaar int error; 18125c22eb4SRafal Jaworowski 182f6703dd2SMarcel Moolenaar bzero(sc->sc_range, sizeof(sc->sc_range)); 18325c22eb4SRafal Jaworowski 18425c22eb4SRafal Jaworowski /* 185f6703dd2SMarcel Moolenaar * Determine number of discontiguous address ranges to program. 18625c22eb4SRafal Jaworowski */ 187f6703dd2SMarcel Moolenaar ranges = 0; 188f6703dd2SMarcel Moolenaar for (i = 0; i < LBC_DEV_MAX; i++) { 189f6703dd2SMarcel Moolenaar size = sc->sc_banks[i].size; 190f6703dd2SMarcel Moolenaar if (size == 0) 191f6703dd2SMarcel Moolenaar continue; 192f6703dd2SMarcel Moolenaar 193f6703dd2SMarcel Moolenaar start = sc->sc_banks[i].addr; 194f6703dd2SMarcel Moolenaar for (r = 0; r < ranges; r++) { 195f6703dd2SMarcel Moolenaar /* Avoid wrap-around bugs. */ 196f6703dd2SMarcel Moolenaar end = sc->sc_range[r].addr - 1 + sc->sc_range[r].size; 197f6703dd2SMarcel Moolenaar if (start > 0 && end == start - 1) { 198f6703dd2SMarcel Moolenaar sc->sc_range[r].size += size; 199f6703dd2SMarcel Moolenaar break; 200f6703dd2SMarcel Moolenaar } 201f6703dd2SMarcel Moolenaar /* Avoid wrap-around bugs. */ 202f6703dd2SMarcel Moolenaar end = start - 1 + size; 203f6703dd2SMarcel Moolenaar if (sc->sc_range[r].addr > 0 && 204f6703dd2SMarcel Moolenaar end == sc->sc_range[r].addr - 1) { 205f6703dd2SMarcel Moolenaar sc->sc_range[r].addr = start; 206f6703dd2SMarcel Moolenaar sc->sc_range[r].size += size; 207f6703dd2SMarcel Moolenaar break; 208f6703dd2SMarcel Moolenaar } 209f6703dd2SMarcel Moolenaar } 210f6703dd2SMarcel Moolenaar if (r == ranges) { 211f6703dd2SMarcel Moolenaar /* New range; add using insertion sort */ 212f6703dd2SMarcel Moolenaar r = 0; 213f6703dd2SMarcel Moolenaar while (r < ranges && sc->sc_range[r].addr < start) 214f6703dd2SMarcel Moolenaar r++; 215f6703dd2SMarcel Moolenaar for (s = ranges; s > r; s--) 216f6703dd2SMarcel Moolenaar sc->sc_range[s] = sc->sc_range[s-1]; 217f6703dd2SMarcel Moolenaar sc->sc_range[r].addr = start; 218f6703dd2SMarcel Moolenaar sc->sc_range[r].size = size; 219f6703dd2SMarcel Moolenaar ranges++; 220f6703dd2SMarcel Moolenaar } 221f6703dd2SMarcel Moolenaar } 222f6703dd2SMarcel Moolenaar 223f6703dd2SMarcel Moolenaar /* 224f6703dd2SMarcel Moolenaar * Ranges are sorted so quickly go over the list to merge ranges 225f6703dd2SMarcel Moolenaar * that grew toward each other while building the ranges. 226f6703dd2SMarcel Moolenaar */ 227f6703dd2SMarcel Moolenaar r = 0; 228f6703dd2SMarcel Moolenaar while (r < ranges - 1) { 229f6703dd2SMarcel Moolenaar end = sc->sc_range[r].addr + sc->sc_range[r].size; 230f6703dd2SMarcel Moolenaar if (end != sc->sc_range[r+1].addr) { 231f6703dd2SMarcel Moolenaar r++; 232f6703dd2SMarcel Moolenaar continue; 233f6703dd2SMarcel Moolenaar } 234f6703dd2SMarcel Moolenaar sc->sc_range[r].size += sc->sc_range[r+1].size; 235f6703dd2SMarcel Moolenaar for (s = r + 1; s < ranges - 1; s++) 236f6703dd2SMarcel Moolenaar sc->sc_range[s] = sc->sc_range[s+1]; 237f6703dd2SMarcel Moolenaar bzero(&sc->sc_range[s], sizeof(sc->sc_range[s])); 238f6703dd2SMarcel Moolenaar ranges--; 239f6703dd2SMarcel Moolenaar } 240f6703dd2SMarcel Moolenaar 241f6703dd2SMarcel Moolenaar /* 242f6703dd2SMarcel Moolenaar * Configure LAW for the LBC ranges and map the physical memory 243f6703dd2SMarcel Moolenaar * range into KVA. 244f6703dd2SMarcel Moolenaar */ 245f6703dd2SMarcel Moolenaar for (r = 0; r < ranges; r++) { 246f6703dd2SMarcel Moolenaar start = sc->sc_range[r].addr; 247f6703dd2SMarcel Moolenaar size = sc->sc_range[r].size; 24825c22eb4SRafal Jaworowski error = law_enable(OCP85XX_TGTIF_LBC, start, size); 24925c22eb4SRafal Jaworowski if (error) 25025c22eb4SRafal Jaworowski return (error); 251f6703dd2SMarcel Moolenaar sc->sc_range[r].kva = (vm_offset_t)pmap_mapdev(start, size); 252f6703dd2SMarcel Moolenaar } 25325c22eb4SRafal Jaworowski 254f6703dd2SMarcel Moolenaar /* XXX: need something better here? */ 255f6703dd2SMarcel Moolenaar if (ranges == 0) 256f6703dd2SMarcel Moolenaar return (EINVAL); 257f6703dd2SMarcel Moolenaar 258f6703dd2SMarcel Moolenaar /* Assign KVA to banks based on the enclosing range. */ 259f6703dd2SMarcel Moolenaar for (i = 0; i < LBC_DEV_MAX; i++) { 260f6703dd2SMarcel Moolenaar size = sc->sc_banks[i].size; 261f6703dd2SMarcel Moolenaar if (size == 0) 262f6703dd2SMarcel Moolenaar continue; 263f6703dd2SMarcel Moolenaar 264f6703dd2SMarcel Moolenaar start = sc->sc_banks[i].addr; 265f6703dd2SMarcel Moolenaar for (r = 0; r < ranges; r++) { 266f6703dd2SMarcel Moolenaar end = sc->sc_range[r].addr - 1 + sc->sc_range[r].size; 267f6703dd2SMarcel Moolenaar if (start >= sc->sc_range[r].addr && 268f6703dd2SMarcel Moolenaar start - 1 + size <= end) 269f6703dd2SMarcel Moolenaar break; 270f6703dd2SMarcel Moolenaar } 271f6703dd2SMarcel Moolenaar if (r < ranges) { 272f6703dd2SMarcel Moolenaar sc->sc_banks[i].kva = sc->sc_range[r].kva + 273f6703dd2SMarcel Moolenaar (start - sc->sc_range[r].addr); 27425c22eb4SRafal Jaworowski } 275d1d3233eSRafal Jaworowski } 276f6703dd2SMarcel Moolenaar 277d1d3233eSRafal Jaworowski return (0); 278d1d3233eSRafal Jaworowski } 27925c22eb4SRafal Jaworowski 280d1d3233eSRafal Jaworowski static int 281d1d3233eSRafal Jaworowski lbc_banks_enable(struct lbc_softc *sc) 282d1d3233eSRafal Jaworowski { 283295be330SJustin Hibbits uint32_t size; 284d1d3233eSRafal Jaworowski uint32_t regval; 285d1d3233eSRafal Jaworowski int error, i; 286d1d3233eSRafal Jaworowski 287d1d3233eSRafal Jaworowski for (i = 0; i < LBC_DEV_MAX; i++) { 288d1d3233eSRafal Jaworowski size = sc->sc_banks[i].size; 28923fbc06bSMarcel Moolenaar if (size == 0) 290d1d3233eSRafal Jaworowski continue; 291f6703dd2SMarcel Moolenaar 29225c22eb4SRafal Jaworowski /* 293d1d3233eSRafal Jaworowski * Compute and program BR value. 29425c22eb4SRafal Jaworowski */ 295f6703dd2SMarcel Moolenaar regval = sc->sc_banks[i].addr; 296d1d3233eSRafal Jaworowski switch (sc->sc_banks[i].width) { 29725c22eb4SRafal Jaworowski case 8: 298d1d3233eSRafal Jaworowski regval |= (1 << 11); 29925c22eb4SRafal Jaworowski break; 30025c22eb4SRafal Jaworowski case 16: 301d1d3233eSRafal Jaworowski regval |= (2 << 11); 30225c22eb4SRafal Jaworowski break; 30325c22eb4SRafal Jaworowski case 32: 304d1d3233eSRafal Jaworowski regval |= (3 << 11); 30525c22eb4SRafal Jaworowski break; 30625c22eb4SRafal Jaworowski default: 30725c22eb4SRafal Jaworowski error = EINVAL; 30825c22eb4SRafal Jaworowski goto fail; 30925c22eb4SRafal Jaworowski } 310d1d3233eSRafal Jaworowski regval |= (sc->sc_banks[i].decc << 9); 311d1d3233eSRafal Jaworowski regval |= (sc->sc_banks[i].wp << 8); 312d1d3233eSRafal Jaworowski regval |= (sc->sc_banks[i].msel << 5); 313d1d3233eSRafal Jaworowski regval |= (sc->sc_banks[i].atom << 2); 314d1d3233eSRafal Jaworowski regval |= 1; 315f6703dd2SMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, 316f6703dd2SMarcel Moolenaar LBC85XX_BR(i), regval); 31725c22eb4SRafal Jaworowski 31825c22eb4SRafal Jaworowski /* 319d1d3233eSRafal Jaworowski * Compute and program OR value. 32025c22eb4SRafal Jaworowski */ 321f6703dd2SMarcel Moolenaar regval = lbc_address_mask(size); 322d1d3233eSRafal Jaworowski switch (sc->sc_banks[i].msel) { 32325c22eb4SRafal Jaworowski case LBCRES_MSEL_GPCM: 32425c22eb4SRafal Jaworowski /* TODO Add flag support for option registers */ 325f6703dd2SMarcel Moolenaar regval |= 0x0ff7; 32625c22eb4SRafal Jaworowski break; 32725c22eb4SRafal Jaworowski case LBCRES_MSEL_FCM: 328f6703dd2SMarcel Moolenaar /* TODO Add flag support for options register */ 329f6703dd2SMarcel Moolenaar regval |= 0x0796; 330f6703dd2SMarcel Moolenaar break; 33125c22eb4SRafal Jaworowski case LBCRES_MSEL_UPMA: 33225c22eb4SRafal Jaworowski case LBCRES_MSEL_UPMB: 33325c22eb4SRafal Jaworowski case LBCRES_MSEL_UPMC: 33425c22eb4SRafal Jaworowski printf("UPM mode not supported yet!"); 33525c22eb4SRafal Jaworowski error = ENOSYS; 33625c22eb4SRafal Jaworowski goto fail; 33725c22eb4SRafal Jaworowski } 338f6703dd2SMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, 339f6703dd2SMarcel Moolenaar LBC85XX_OR(i), regval); 340d1d3233eSRafal Jaworowski } 34125c22eb4SRafal Jaworowski 34225c22eb4SRafal Jaworowski return (0); 343d1d3233eSRafal Jaworowski 34425c22eb4SRafal Jaworowski fail: 345d1d3233eSRafal Jaworowski lbc_banks_unmap(sc); 34625c22eb4SRafal Jaworowski return (error); 347d1d3233eSRafal Jaworowski } 348d1d3233eSRafal Jaworowski 349d1d3233eSRafal Jaworowski static void 350d1d3233eSRafal Jaworowski fdt_lbc_fixup(phandle_t node, struct lbc_softc *sc, struct lbc_devinfo *di) 351d1d3233eSRafal Jaworowski { 352d1d3233eSRafal Jaworowski pcell_t width; 353d1d3233eSRafal Jaworowski int bank; 354d1d3233eSRafal Jaworowski 355d1d3233eSRafal Jaworowski if (OF_getprop(node, "bank-width", (void *)&width, sizeof(width)) <= 0) 356d1d3233eSRafal Jaworowski return; 357d1d3233eSRafal Jaworowski 358d1d3233eSRafal Jaworowski bank = di->di_bank; 359d1d3233eSRafal Jaworowski if (sc->sc_banks[bank].size == 0) 360d1d3233eSRafal Jaworowski return; 361d1d3233eSRafal Jaworowski 362d1d3233eSRafal Jaworowski /* Express width in bits. */ 363d1d3233eSRafal Jaworowski sc->sc_banks[bank].width = width * 8; 364d1d3233eSRafal Jaworowski } 365d1d3233eSRafal Jaworowski 366d1d3233eSRafal Jaworowski static int 367d1d3233eSRafal Jaworowski fdt_lbc_reg_decode(phandle_t node, struct lbc_softc *sc, 368d1d3233eSRafal Jaworowski struct lbc_devinfo *di) 369d1d3233eSRafal Jaworowski { 37083d9b89cSJustin Hibbits rman_res_t start, end, count; 371d1d3233eSRafal Jaworowski pcell_t *reg, *regptr; 372d1d3233eSRafal Jaworowski pcell_t addr_cells, size_cells; 373d1d3233eSRafal Jaworowski int tuple_size, tuples; 37483d9b89cSJustin Hibbits int i, j, rv, bank; 375d1d3233eSRafal Jaworowski 376d1d3233eSRafal Jaworowski if (fdt_addrsize_cells(OF_parent(node), &addr_cells, &size_cells) != 0) 377d1d3233eSRafal Jaworowski return (ENXIO); 378d1d3233eSRafal Jaworowski 379d1d3233eSRafal Jaworowski tuple_size = sizeof(pcell_t) * (addr_cells + size_cells); 380f7604b1bSOleksandr Tymoshenko tuples = OF_getencprop_alloc_multi(node, "reg", tuple_size, 381f7604b1bSOleksandr Tymoshenko (void **)®); 382d1d3233eSRafal Jaworowski debugf("addr_cells = %d, size_cells = %d\n", addr_cells, size_cells); 383d1d3233eSRafal Jaworowski debugf("tuples = %d, tuple size = %d\n", tuples, tuple_size); 384d1d3233eSRafal Jaworowski if (tuples <= 0) 385d1d3233eSRafal Jaworowski /* No 'reg' property in this node. */ 386d1d3233eSRafal Jaworowski return (0); 387d1d3233eSRafal Jaworowski 388d1d3233eSRafal Jaworowski regptr = reg; 389d1d3233eSRafal Jaworowski for (i = 0; i < tuples; i++) { 390d1d3233eSRafal Jaworowski bank = fdt_data_get((void *)reg, 1); 391d1d3233eSRafal Jaworowski di->di_bank = bank; 392d1d3233eSRafal Jaworowski reg += 1; 393d1d3233eSRafal Jaworowski 394d1d3233eSRafal Jaworowski /* Get address/size. */ 39583d9b89cSJustin Hibbits start = count = 0; 3967d7671dbSJustin Hibbits for (j = 0; j < addr_cells - 1; j++) { 39783d9b89cSJustin Hibbits start <<= 32; 39883d9b89cSJustin Hibbits start |= reg[j]; 39983d9b89cSJustin Hibbits } 40083d9b89cSJustin Hibbits for (j = 0; j < size_cells; j++) { 40183d9b89cSJustin Hibbits count <<= 32; 402a80e3de3SJustin Hibbits count |= reg[addr_cells + j - 1]; 403d1d3233eSRafal Jaworowski } 404d1d3233eSRafal Jaworowski reg += addr_cells - 1 + size_cells; 405d1d3233eSRafal Jaworowski 406d1d3233eSRafal Jaworowski /* Calculate address range relative to VA base. */ 407f6703dd2SMarcel Moolenaar start = sc->sc_banks[bank].kva + start; 408d1d3233eSRafal Jaworowski end = start + count - 1; 409d1d3233eSRafal Jaworowski 41083d9b89cSJustin Hibbits debugf("reg addr bank = %d, start = %jx, end = %jx, " 41183d9b89cSJustin Hibbits "count = %jx\n", bank, start, end, count); 412d1d3233eSRafal Jaworowski 413d1d3233eSRafal Jaworowski /* Use bank (CS) cell as rid. */ 414d1d3233eSRafal Jaworowski resource_list_add(&di->di_res, SYS_RES_MEMORY, bank, start, 415d1d3233eSRafal Jaworowski end, count); 416d1d3233eSRafal Jaworowski } 417d1d3233eSRafal Jaworowski rv = 0; 4180cc376c1SOleksandr Tymoshenko OF_prop_free(regptr); 419d1d3233eSRafal Jaworowski return (rv); 42025c22eb4SRafal Jaworowski } 42125c22eb4SRafal Jaworowski 42223fbc06bSMarcel Moolenaar static void 42323fbc06bSMarcel Moolenaar lbc_intr(void *arg) 42423fbc06bSMarcel Moolenaar { 42523fbc06bSMarcel Moolenaar struct lbc_softc *sc = arg; 42623fbc06bSMarcel Moolenaar uint32_t ltesr; 42723fbc06bSMarcel Moolenaar 42823fbc06bSMarcel Moolenaar ltesr = bus_space_read_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTESR); 42923fbc06bSMarcel Moolenaar sc->sc_ltesr = ltesr; 43023fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTESR, ltesr); 43123fbc06bSMarcel Moolenaar wakeup(sc->sc_dev); 43223fbc06bSMarcel Moolenaar } 43323fbc06bSMarcel Moolenaar 43425c22eb4SRafal Jaworowski static int 43508077f58SMarcel Moolenaar lbc_probe(device_t dev) 43608077f58SMarcel Moolenaar { 43708077f58SMarcel Moolenaar 438d1d3233eSRafal Jaworowski if (!(ofw_bus_is_compatible(dev, "fsl,lbc") || 439d1d3233eSRafal Jaworowski ofw_bus_is_compatible(dev, "fsl,elbc"))) 44008077f58SMarcel Moolenaar return (ENXIO); 44108077f58SMarcel Moolenaar 442d1d3233eSRafal Jaworowski device_set_desc(dev, "Freescale Local Bus Controller"); 44308077f58SMarcel Moolenaar return (BUS_PROBE_DEFAULT); 44408077f58SMarcel Moolenaar } 44508077f58SMarcel Moolenaar 44608077f58SMarcel Moolenaar static int 44708077f58SMarcel Moolenaar lbc_attach(device_t dev) 44808077f58SMarcel Moolenaar { 44908077f58SMarcel Moolenaar struct lbc_softc *sc; 450d1d3233eSRafal Jaworowski struct lbc_devinfo *di; 45108077f58SMarcel Moolenaar struct rman *rm; 45283d9b89cSJustin Hibbits uintmax_t offset, size; 45383d9b89cSJustin Hibbits vm_paddr_t start; 454d1d3233eSRafal Jaworowski device_t cdev; 455d1d3233eSRafal Jaworowski phandle_t node, child; 456d1d3233eSRafal Jaworowski pcell_t *ranges, *rangesptr; 457d1d3233eSRafal Jaworowski int tuple_size, tuples; 458d1d3233eSRafal Jaworowski int par_addr_cells; 45983d9b89cSJustin Hibbits int bank, error, i, j; 46008077f58SMarcel Moolenaar 46108077f58SMarcel Moolenaar sc = device_get_softc(dev); 46208077f58SMarcel Moolenaar sc->sc_dev = dev; 46308077f58SMarcel Moolenaar 46423fbc06bSMarcel Moolenaar sc->sc_mrid = 0; 46523fbc06bSMarcel Moolenaar sc->sc_mres = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->sc_mrid, 46608077f58SMarcel Moolenaar RF_ACTIVE); 46723fbc06bSMarcel Moolenaar if (sc->sc_mres == NULL) 46808077f58SMarcel Moolenaar return (ENXIO); 46908077f58SMarcel Moolenaar 47023fbc06bSMarcel Moolenaar sc->sc_bst = rman_get_bustag(sc->sc_mres); 47123fbc06bSMarcel Moolenaar sc->sc_bsh = rman_get_bushandle(sc->sc_mres); 47223fbc06bSMarcel Moolenaar 47323fbc06bSMarcel Moolenaar for (bank = 0; bank < LBC_DEV_MAX; bank++) { 47423fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_BR(bank), 0); 47523fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_OR(bank), 0); 47623fbc06bSMarcel Moolenaar } 47723fbc06bSMarcel Moolenaar 47823fbc06bSMarcel Moolenaar /* 47923fbc06bSMarcel Moolenaar * Initialize configuration register: 48023fbc06bSMarcel Moolenaar * - enable Local Bus 48123fbc06bSMarcel Moolenaar * - set data buffer control signal function 48223fbc06bSMarcel Moolenaar * - disable parity byte select 48323fbc06bSMarcel Moolenaar * - set ECC parity type 48423fbc06bSMarcel Moolenaar * - set bus monitor timing and timer prescale 48523fbc06bSMarcel Moolenaar */ 48623fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LBCR, 0); 48723fbc06bSMarcel Moolenaar 48823fbc06bSMarcel Moolenaar /* 48923fbc06bSMarcel Moolenaar * Initialize clock ratio register: 49023fbc06bSMarcel Moolenaar * - disable PLL bypass mode 49123fbc06bSMarcel Moolenaar * - configure LCLK delay cycles for the assertion of LALE 49223fbc06bSMarcel Moolenaar * - set system clock divider 49323fbc06bSMarcel Moolenaar */ 49423fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LCRR, 0x00030008); 49523fbc06bSMarcel Moolenaar 49623fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTEDR, 0); 49723fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTESR, ~0); 49823fbc06bSMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTEIR, 0x64080001); 49923fbc06bSMarcel Moolenaar 50023fbc06bSMarcel Moolenaar sc->sc_irid = 0; 50123fbc06bSMarcel Moolenaar sc->sc_ires = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->sc_irid, 50223fbc06bSMarcel Moolenaar RF_ACTIVE | RF_SHAREABLE); 50323fbc06bSMarcel Moolenaar if (sc->sc_ires != NULL) { 50423fbc06bSMarcel Moolenaar error = bus_setup_intr(dev, sc->sc_ires, 50523fbc06bSMarcel Moolenaar INTR_TYPE_MISC | INTR_MPSAFE, NULL, lbc_intr, sc, 50623fbc06bSMarcel Moolenaar &sc->sc_icookie); 50723fbc06bSMarcel Moolenaar if (error) { 50823fbc06bSMarcel Moolenaar device_printf(dev, "could not activate interrupt\n"); 50923fbc06bSMarcel Moolenaar bus_release_resource(dev, SYS_RES_IRQ, sc->sc_irid, 51023fbc06bSMarcel Moolenaar sc->sc_ires); 51123fbc06bSMarcel Moolenaar sc->sc_ires = NULL; 51223fbc06bSMarcel Moolenaar } 51323fbc06bSMarcel Moolenaar } 51423fbc06bSMarcel Moolenaar 51523fbc06bSMarcel Moolenaar sc->sc_ltesr = ~0; 51623fbc06bSMarcel Moolenaar 517d1d3233eSRafal Jaworowski rangesptr = NULL; 51808077f58SMarcel Moolenaar 51908077f58SMarcel Moolenaar rm = &sc->sc_rman; 52008077f58SMarcel Moolenaar rm->rm_type = RMAN_ARRAY; 521d1d3233eSRafal Jaworowski rm->rm_descr = "Local Bus Space"; 52208077f58SMarcel Moolenaar error = rman_init(rm); 52308077f58SMarcel Moolenaar if (error) 52408077f58SMarcel Moolenaar goto fail; 52508077f58SMarcel Moolenaar 52608077f58SMarcel Moolenaar error = rman_manage_region(rm, rm->rm_start, rm->rm_end); 52708077f58SMarcel Moolenaar if (error) { 52808077f58SMarcel Moolenaar rman_fini(rm); 52908077f58SMarcel Moolenaar goto fail; 53008077f58SMarcel Moolenaar } 53108077f58SMarcel Moolenaar 53225c22eb4SRafal Jaworowski /* 533d1d3233eSRafal Jaworowski * Process 'ranges' property. 53425c22eb4SRafal Jaworowski */ 535d1d3233eSRafal Jaworowski node = ofw_bus_get_node(dev); 536d1d3233eSRafal Jaworowski if ((fdt_addrsize_cells(node, &sc->sc_addr_cells, 537d1d3233eSRafal Jaworowski &sc->sc_size_cells)) != 0) { 53825c22eb4SRafal Jaworowski error = ENXIO; 53925c22eb4SRafal Jaworowski goto fail; 54025c22eb4SRafal Jaworowski } 54108077f58SMarcel Moolenaar 542d1d3233eSRafal Jaworowski par_addr_cells = fdt_parent_addr_cells(node); 543d1d3233eSRafal Jaworowski if (par_addr_cells > 2) { 544d1d3233eSRafal Jaworowski device_printf(dev, "unsupported parent #addr-cells\n"); 545d1d3233eSRafal Jaworowski error = ERANGE; 546d1d3233eSRafal Jaworowski goto fail; 547d1d3233eSRafal Jaworowski } 548d1d3233eSRafal Jaworowski tuple_size = sizeof(pcell_t) * (sc->sc_addr_cells + par_addr_cells + 549d1d3233eSRafal Jaworowski sc->sc_size_cells); 550d1d3233eSRafal Jaworowski 551f7604b1bSOleksandr Tymoshenko tuples = OF_getencprop_alloc_multi(node, "ranges", tuple_size, 552d1d3233eSRafal Jaworowski (void **)&ranges); 553d1d3233eSRafal Jaworowski if (tuples < 0) { 554d1d3233eSRafal Jaworowski device_printf(dev, "could not retrieve 'ranges' property\n"); 555d1d3233eSRafal Jaworowski error = ENXIO; 556d1d3233eSRafal Jaworowski goto fail; 557d1d3233eSRafal Jaworowski } 558d1d3233eSRafal Jaworowski rangesptr = ranges; 559d1d3233eSRafal Jaworowski 560d1d3233eSRafal Jaworowski debugf("par addr_cells = %d, addr_cells = %d, size_cells = %d, " 561d1d3233eSRafal Jaworowski "tuple_size = %d, tuples = %d\n", par_addr_cells, 562d1d3233eSRafal Jaworowski sc->sc_addr_cells, sc->sc_size_cells, tuple_size, tuples); 563d1d3233eSRafal Jaworowski 564d1d3233eSRafal Jaworowski start = 0; 565d1d3233eSRafal Jaworowski size = 0; 566d1d3233eSRafal Jaworowski for (i = 0; i < tuples; i++) { 567d1d3233eSRafal Jaworowski /* The first cell is the bank (chip select) number. */ 56883d9b89cSJustin Hibbits bank = fdt_data_get(ranges, 1); 569d1d3233eSRafal Jaworowski if (bank < 0 || bank > LBC_DEV_MAX) { 570d1d3233eSRafal Jaworowski device_printf(dev, "bank out of range: %d\n", bank); 571d1d3233eSRafal Jaworowski error = ERANGE; 572d1d3233eSRafal Jaworowski goto fail; 573d1d3233eSRafal Jaworowski } 574d1d3233eSRafal Jaworowski ranges += 1; 575d1d3233eSRafal Jaworowski 576d1d3233eSRafal Jaworowski /* 577d1d3233eSRafal Jaworowski * Remaining cells of the child address define offset into 578d1d3233eSRafal Jaworowski * this CS. 579d1d3233eSRafal Jaworowski */ 58083d9b89cSJustin Hibbits offset = 0; 58183d9b89cSJustin Hibbits for (j = 0; j < sc->sc_addr_cells - 1; j++) { 58283d9b89cSJustin Hibbits offset <<= sizeof(pcell_t) * 8; 58383d9b89cSJustin Hibbits offset |= *ranges; 58483d9b89cSJustin Hibbits ranges++; 58583d9b89cSJustin Hibbits } 586d1d3233eSRafal Jaworowski 587d1d3233eSRafal Jaworowski /* Parent bus start address of this bank. */ 58883d9b89cSJustin Hibbits start = 0; 58983d9b89cSJustin Hibbits for (j = 0; j < par_addr_cells; j++) { 59083d9b89cSJustin Hibbits start <<= sizeof(pcell_t) * 8; 59183d9b89cSJustin Hibbits start |= *ranges; 59283d9b89cSJustin Hibbits ranges++; 59383d9b89cSJustin Hibbits } 594d1d3233eSRafal Jaworowski 595d1d3233eSRafal Jaworowski size = fdt_data_get((void *)ranges, sc->sc_size_cells); 596d1d3233eSRafal Jaworowski ranges += sc->sc_size_cells; 59783d9b89cSJustin Hibbits debugf("bank = %d, start = %jx, size = %jx\n", bank, 59883d9b89cSJustin Hibbits (uintmax_t)start, size); 599d1d3233eSRafal Jaworowski 600f6703dd2SMarcel Moolenaar sc->sc_banks[bank].addr = start + offset; 601d1d3233eSRafal Jaworowski sc->sc_banks[bank].size = size; 602d1d3233eSRafal Jaworowski 603d1d3233eSRafal Jaworowski /* 604d1d3233eSRafal Jaworowski * Attributes for the bank. 605d1d3233eSRafal Jaworowski * 606d1d3233eSRafal Jaworowski * XXX Note there are no DT bindings defined for them at the 607d1d3233eSRafal Jaworowski * moment, so we need to provide some defaults. 608d1d3233eSRafal Jaworowski */ 609d1d3233eSRafal Jaworowski sc->sc_banks[bank].width = 16; 610d1d3233eSRafal Jaworowski sc->sc_banks[bank].msel = LBCRES_MSEL_GPCM; 611d1d3233eSRafal Jaworowski sc->sc_banks[bank].decc = LBCRES_DECC_DISABLED; 612d1d3233eSRafal Jaworowski sc->sc_banks[bank].atom = LBCRES_ATOM_DISABLED; 613d1d3233eSRafal Jaworowski sc->sc_banks[bank].wp = 0; 614d1d3233eSRafal Jaworowski } 615d1d3233eSRafal Jaworowski 616d1d3233eSRafal Jaworowski /* 617d1d3233eSRafal Jaworowski * Initialize mem-mappings for the LBC banks (i.e. chip selects). 618d1d3233eSRafal Jaworowski */ 619d1d3233eSRafal Jaworowski error = lbc_banks_map(sc); 620d1d3233eSRafal Jaworowski if (error) 621d1d3233eSRafal Jaworowski goto fail; 622d1d3233eSRafal Jaworowski 623d1d3233eSRafal Jaworowski /* 624d1d3233eSRafal Jaworowski * Walk the localbus and add direct subordinates as our children. 625d1d3233eSRafal Jaworowski */ 626d1d3233eSRafal Jaworowski for (child = OF_child(node); child != 0; child = OF_peer(child)) { 627d1d3233eSRafal Jaworowski di = malloc(sizeof(*di), M_LBC, M_WAITOK | M_ZERO); 628d1d3233eSRafal Jaworowski 629d1d3233eSRafal Jaworowski if (ofw_bus_gen_setup_devinfo(&di->di_ofw, child) != 0) { 630d1d3233eSRafal Jaworowski free(di, M_LBC); 631d1d3233eSRafal Jaworowski device_printf(dev, "could not set up devinfo\n"); 632d1d3233eSRafal Jaworowski continue; 633d1d3233eSRafal Jaworowski } 634d1d3233eSRafal Jaworowski 635d1d3233eSRafal Jaworowski resource_list_init(&di->di_res); 636d1d3233eSRafal Jaworowski 637d1d3233eSRafal Jaworowski if (fdt_lbc_reg_decode(child, sc, di)) { 638d1d3233eSRafal Jaworowski device_printf(dev, "could not process 'reg' " 639d1d3233eSRafal Jaworowski "property\n"); 640d1d3233eSRafal Jaworowski ofw_bus_gen_destroy_devinfo(&di->di_ofw); 641d1d3233eSRafal Jaworowski free(di, M_LBC); 642d1d3233eSRafal Jaworowski continue; 643d1d3233eSRafal Jaworowski } 644d1d3233eSRafal Jaworowski 645d1d3233eSRafal Jaworowski fdt_lbc_fixup(child, sc, di); 646d1d3233eSRafal Jaworowski 647d1d3233eSRafal Jaworowski /* Add newbus device for this FDT node */ 6485b56413dSWarner Losh cdev = device_add_child(dev, NULL, DEVICE_UNIT_ANY); 649d1d3233eSRafal Jaworowski if (cdev == NULL) { 650d1d3233eSRafal Jaworowski device_printf(dev, "could not add child: %s\n", 651d1d3233eSRafal Jaworowski di->di_ofw.obd_name); 652d1d3233eSRafal Jaworowski resource_list_free(&di->di_res); 653d1d3233eSRafal Jaworowski ofw_bus_gen_destroy_devinfo(&di->di_ofw); 654d1d3233eSRafal Jaworowski free(di, M_LBC); 655d1d3233eSRafal Jaworowski continue; 656d1d3233eSRafal Jaworowski } 6578c6037c4SJustin Hibbits debugf("added child name='%s', node=%x\n", di->di_ofw.obd_name, 6588c6037c4SJustin Hibbits child); 659d1d3233eSRafal Jaworowski device_set_ivars(cdev, di); 660d1d3233eSRafal Jaworowski } 661d1d3233eSRafal Jaworowski 662d1d3233eSRafal Jaworowski /* 663d1d3233eSRafal Jaworowski * Enable the LBC. 664d1d3233eSRafal Jaworowski */ 665d1d3233eSRafal Jaworowski lbc_banks_enable(sc); 666d1d3233eSRafal Jaworowski 6670cc376c1SOleksandr Tymoshenko OF_prop_free(rangesptr); 668*18250ec6SJohn Baldwin bus_attach_children(dev); 669*18250ec6SJohn Baldwin return (0); 67008077f58SMarcel Moolenaar 67108077f58SMarcel Moolenaar fail: 6720cc376c1SOleksandr Tymoshenko OF_prop_free(rangesptr); 67323fbc06bSMarcel Moolenaar bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_mrid, sc->sc_mres); 67408077f58SMarcel Moolenaar return (error); 67508077f58SMarcel Moolenaar } 67608077f58SMarcel Moolenaar 67708077f58SMarcel Moolenaar static int 67808077f58SMarcel Moolenaar lbc_shutdown(device_t dev) 67908077f58SMarcel Moolenaar { 68008077f58SMarcel Moolenaar 68108077f58SMarcel Moolenaar /* TODO */ 68208077f58SMarcel Moolenaar return(0); 68308077f58SMarcel Moolenaar } 68408077f58SMarcel Moolenaar 6855a7e717fSJohn Baldwin static struct rman * 6865a7e717fSJohn Baldwin lbc_get_rman(device_t bus, int type, u_int flags) 6875a7e717fSJohn Baldwin { 6885a7e717fSJohn Baldwin struct lbc_softc *sc; 6895a7e717fSJohn Baldwin 6905a7e717fSJohn Baldwin sc = device_get_softc(bus); 6915a7e717fSJohn Baldwin switch (type) { 6925a7e717fSJohn Baldwin case SYS_RES_MEMORY: 6935a7e717fSJohn Baldwin return (&sc->sc_rman); 6945a7e717fSJohn Baldwin default: 6955a7e717fSJohn Baldwin return (NULL); 6965a7e717fSJohn Baldwin } 6975a7e717fSJohn Baldwin } 6985a7e717fSJohn Baldwin 69908077f58SMarcel Moolenaar static struct resource * 700d1d3233eSRafal Jaworowski lbc_alloc_resource(device_t bus, device_t child, int type, int *rid, 7012dd1bdf1SJustin Hibbits rman_res_t start, rman_res_t end, rman_res_t count, u_int flags) 70208077f58SMarcel Moolenaar { 703d1d3233eSRafal Jaworowski struct lbc_devinfo *di; 704d1d3233eSRafal Jaworowski struct resource_list_entry *rle; 70508077f58SMarcel Moolenaar 70608077f58SMarcel Moolenaar /* We only support default allocations. */ 707f7dc5935SJustin Hibbits if (!RMAN_IS_DEFAULT_RANGE(start, end)) 70808077f58SMarcel Moolenaar return (NULL); 70908077f58SMarcel Moolenaar 71008077f58SMarcel Moolenaar if (type == SYS_RES_IRQ) 711d1d3233eSRafal Jaworowski return (bus_alloc_resource(bus, type, rid, start, end, count, 71208077f58SMarcel Moolenaar flags)); 71308077f58SMarcel Moolenaar 714d1d3233eSRafal Jaworowski /* 715d1d3233eSRafal Jaworowski * Request for the default allocation with a given rid: use resource 716d1d3233eSRafal Jaworowski * list stored in the local device info. 717d1d3233eSRafal Jaworowski */ 718d1d3233eSRafal Jaworowski if ((di = device_get_ivars(child)) == NULL) 719d1d3233eSRafal Jaworowski return (NULL); 720d1d3233eSRafal Jaworowski 721d1d3233eSRafal Jaworowski if (type == SYS_RES_IOPORT) 722d1d3233eSRafal Jaworowski type = SYS_RES_MEMORY; 723d1d3233eSRafal Jaworowski 7245a7e717fSJohn Baldwin /* 7255a7e717fSJohn Baldwin * XXX: We are supposed to return a value to the user, so this 7265a7e717fSJohn Baldwin * doesn't seem right. 7275a7e717fSJohn Baldwin */ 728d1d3233eSRafal Jaworowski rid = &di->di_bank; 729d1d3233eSRafal Jaworowski 730d1d3233eSRafal Jaworowski rle = resource_list_find(&di->di_res, type, *rid); 731d1d3233eSRafal Jaworowski if (rle == NULL) { 732d1d3233eSRafal Jaworowski device_printf(bus, "no default resources for " 733d1d3233eSRafal Jaworowski "rid = %d, type = %d\n", *rid, type); 73425c22eb4SRafal Jaworowski return (NULL); 73525c22eb4SRafal Jaworowski } 736d1d3233eSRafal Jaworowski start = rle->start; 737d1d3233eSRafal Jaworowski count = rle->count; 738d1d3233eSRafal Jaworowski end = start + count - 1; 73925c22eb4SRafal Jaworowski 7405a7e717fSJohn Baldwin return (bus_generic_rman_alloc_resource(bus, child, type, rid, start, 7415a7e717fSJohn Baldwin end, count, flags)); 74208077f58SMarcel Moolenaar } 74308077f58SMarcel Moolenaar 74408077f58SMarcel Moolenaar static int 74508077f58SMarcel Moolenaar lbc_print_child(device_t dev, device_t child) 74608077f58SMarcel Moolenaar { 747d1d3233eSRafal Jaworowski struct lbc_devinfo *di; 748d1d3233eSRafal Jaworowski struct resource_list *rl; 749d1d3233eSRafal Jaworowski int rv; 75008077f58SMarcel Moolenaar 751d1d3233eSRafal Jaworowski di = device_get_ivars(child); 752d1d3233eSRafal Jaworowski rl = &di->di_res; 75308077f58SMarcel Moolenaar 754d1d3233eSRafal Jaworowski rv = 0; 755d1d3233eSRafal Jaworowski rv += bus_print_child_header(dev, child); 756da1b038aSJustin Hibbits rv += resource_list_print_type(rl, "mem", SYS_RES_MEMORY, "%#jx"); 757da1b038aSJustin Hibbits rv += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%jd"); 758d1d3233eSRafal Jaworowski rv += bus_print_child_footer(dev, child); 75908077f58SMarcel Moolenaar 760d1d3233eSRafal Jaworowski return (rv); 76108077f58SMarcel Moolenaar } 76208077f58SMarcel Moolenaar 76308077f58SMarcel Moolenaar static int 764fef01f04SJohn Baldwin lbc_adjust_resource(device_t dev, device_t child, struct resource *r, 7655a7e717fSJohn Baldwin rman_res_t start, rman_res_t end) 7665a7e717fSJohn Baldwin { 767fef01f04SJohn Baldwin switch (rman_get_type(r)) { 7685a7e717fSJohn Baldwin case SYS_RES_MEMORY: 769fef01f04SJohn Baldwin return (bus_generic_rman_adjust_resource(dev, child, r, start, 77068a3ff04SJohn Baldwin end)); 771fef01f04SJohn Baldwin case SYS_RES_IRQ: 772fef01f04SJohn Baldwin return (bus_generic_adjust_resource(dev, child, r, start, end)); 7735a7e717fSJohn Baldwin default: 7745a7e717fSJohn Baldwin return (EINVAL); 7755a7e717fSJohn Baldwin } 7765a7e717fSJohn Baldwin } 7775a7e717fSJohn Baldwin 7785a7e717fSJohn Baldwin static int 7799dbf5b0eSJohn Baldwin lbc_release_resource(device_t dev, device_t child, struct resource *res) 78008077f58SMarcel Moolenaar { 7819dbf5b0eSJohn Baldwin switch (rman_get_type(res)) { 7825a7e717fSJohn Baldwin case SYS_RES_MEMORY: 7839dbf5b0eSJohn Baldwin return (bus_generic_rman_release_resource(dev, child, res)); 7845a7e717fSJohn Baldwin case SYS_RES_IRQ: 7859dbf5b0eSJohn Baldwin return (bus_generic_release_resource(dev, child, res)); 7865a7e717fSJohn Baldwin default: 7875a7e717fSJohn Baldwin return (EINVAL); 788d1d3233eSRafal Jaworowski } 78908077f58SMarcel Moolenaar } 79008077f58SMarcel Moolenaar 7918bc8506eSJustin Hibbits static int 7922baed46eSJohn Baldwin lbc_activate_resource(device_t bus, device_t child, struct resource *r) 7938bc8506eSJustin Hibbits { 7942baed46eSJohn Baldwin switch (rman_get_type(r)) { 7955a7e717fSJohn Baldwin case SYS_RES_MEMORY: 7962baed46eSJohn Baldwin return (bus_generic_rman_activate_resource(bus, child, r)); 7975a7e717fSJohn Baldwin case SYS_RES_IRQ: 7982baed46eSJohn Baldwin return (bus_generic_activate_resource(bus, child, r)); 7995a7e717fSJohn Baldwin default: 8005a7e717fSJohn Baldwin return (EINVAL); 8015a7e717fSJohn Baldwin } 8028bc8506eSJustin Hibbits } 8038bc8506eSJustin Hibbits 8048bc8506eSJustin Hibbits static int 8052baed46eSJohn Baldwin lbc_deactivate_resource(device_t bus, device_t child, struct resource *r) 8065a7e717fSJohn Baldwin { 8072baed46eSJohn Baldwin switch (rman_get_type(r)) { 8085a7e717fSJohn Baldwin case SYS_RES_MEMORY: 8092baed46eSJohn Baldwin return (bus_generic_rman_deactivate_resource(bus, child, r)); 8105a7e717fSJohn Baldwin case SYS_RES_IRQ: 8112baed46eSJohn Baldwin return (bus_generic_deactivate_resource(bus, child, r)); 8125a7e717fSJohn Baldwin default: 8135a7e717fSJohn Baldwin return (EINVAL); 8145a7e717fSJohn Baldwin } 8155a7e717fSJohn Baldwin } 8165a7e717fSJohn Baldwin 8175a7e717fSJohn Baldwin static int 818d77f2092SJohn Baldwin lbc_map_resource(device_t bus, device_t child, struct resource *r, 8195a7e717fSJohn Baldwin struct resource_map_request *argsp, struct resource_map *map) 8205a7e717fSJohn Baldwin { 8215a7e717fSJohn Baldwin struct resource_map_request args; 8225a7e717fSJohn Baldwin rman_res_t length, start; 8235a7e717fSJohn Baldwin int error; 8245a7e717fSJohn Baldwin 8255a7e717fSJohn Baldwin /* Resources must be active to be mapped. */ 8265a7e717fSJohn Baldwin if (!(rman_get_flags(r) & RF_ACTIVE)) 8275a7e717fSJohn Baldwin return (ENXIO); 8285a7e717fSJohn Baldwin 8295a7e717fSJohn Baldwin /* Mappings are only supported on I/O and memory resources. */ 830d77f2092SJohn Baldwin switch (rman_get_type(r)) { 8315a7e717fSJohn Baldwin case SYS_RES_IOPORT: 8325a7e717fSJohn Baldwin case SYS_RES_MEMORY: 8335a7e717fSJohn Baldwin break; 8345a7e717fSJohn Baldwin default: 8355a7e717fSJohn Baldwin return (EINVAL); 8365a7e717fSJohn Baldwin } 8375a7e717fSJohn Baldwin 8385a7e717fSJohn Baldwin resource_init_map_request(&args); 8395a7e717fSJohn Baldwin error = resource_validate_map_request(r, argsp, &args, &start, &length); 8405a7e717fSJohn Baldwin if (error) 8415a7e717fSJohn Baldwin return (error); 8425a7e717fSJohn Baldwin 8435a7e717fSJohn Baldwin map->r_bustag = &bs_be_tag; 8445a7e717fSJohn Baldwin map->r_bushandle = start; 8455a7e717fSJohn Baldwin map->r_size = length; 8465a7e717fSJohn Baldwin map->r_vaddr = NULL; 8475a7e717fSJohn Baldwin return (0); 8485a7e717fSJohn Baldwin } 8495a7e717fSJohn Baldwin 8505a7e717fSJohn Baldwin static int 851d77f2092SJohn Baldwin lbc_unmap_resource(device_t bus, device_t child, struct resource *r, 8525a7e717fSJohn Baldwin struct resource_map *map) 8538bc8506eSJustin Hibbits { 8548bc8506eSJustin Hibbits 8555a7e717fSJohn Baldwin /* Mappings are only supported on I/O and memory resources. */ 856d77f2092SJohn Baldwin switch (rman_get_type(r)) { 8575a7e717fSJohn Baldwin case SYS_RES_IOPORT: 8585a7e717fSJohn Baldwin case SYS_RES_MEMORY: 8595a7e717fSJohn Baldwin break; 8605a7e717fSJohn Baldwin default: 8615a7e717fSJohn Baldwin return (EINVAL); 8625a7e717fSJohn Baldwin } 8635a7e717fSJohn Baldwin return (0); 8648bc8506eSJustin Hibbits } 8658bc8506eSJustin Hibbits 866d1d3233eSRafal Jaworowski static const struct ofw_bus_devinfo * 867d1d3233eSRafal Jaworowski lbc_get_devinfo(device_t bus, device_t child) 86808077f58SMarcel Moolenaar { 869d1d3233eSRafal Jaworowski struct lbc_devinfo *di; 87008077f58SMarcel Moolenaar 871d1d3233eSRafal Jaworowski di = device_get_ivars(child); 872d1d3233eSRafal Jaworowski return (&di->di_ofw); 87308077f58SMarcel Moolenaar } 874f6703dd2SMarcel Moolenaar 875f6703dd2SMarcel Moolenaar void 876f6703dd2SMarcel Moolenaar lbc_write_reg(device_t child, u_int off, uint32_t val) 877f6703dd2SMarcel Moolenaar { 87823fbc06bSMarcel Moolenaar device_t dev; 879f6703dd2SMarcel Moolenaar struct lbc_softc *sc; 880f6703dd2SMarcel Moolenaar 88123fbc06bSMarcel Moolenaar dev = device_get_parent(child); 88223fbc06bSMarcel Moolenaar 88323fbc06bSMarcel Moolenaar if (off >= 0x1000) { 88423fbc06bSMarcel Moolenaar device_printf(dev, "%s(%s): invalid offset %#x\n", 88523fbc06bSMarcel Moolenaar __func__, device_get_nameunit(child), off); 88623fbc06bSMarcel Moolenaar return; 88723fbc06bSMarcel Moolenaar } 88823fbc06bSMarcel Moolenaar 88923fbc06bSMarcel Moolenaar sc = device_get_softc(dev); 89023fbc06bSMarcel Moolenaar 89123fbc06bSMarcel Moolenaar if (off == LBC85XX_LTESR && sc->sc_ltesr != ~0u) { 89223fbc06bSMarcel Moolenaar sc->sc_ltesr ^= (val & sc->sc_ltesr); 89323fbc06bSMarcel Moolenaar return; 89423fbc06bSMarcel Moolenaar } 89523fbc06bSMarcel Moolenaar 89623fbc06bSMarcel Moolenaar if (off == LBC85XX_LTEATR && (val & 1) == 0) 89723fbc06bSMarcel Moolenaar sc->sc_ltesr = ~0u; 898f6703dd2SMarcel Moolenaar bus_space_write_4(sc->sc_bst, sc->sc_bsh, off, val); 899f6703dd2SMarcel Moolenaar } 900f6703dd2SMarcel Moolenaar 901f6703dd2SMarcel Moolenaar uint32_t 902f6703dd2SMarcel Moolenaar lbc_read_reg(device_t child, u_int off) 903f6703dd2SMarcel Moolenaar { 90423fbc06bSMarcel Moolenaar device_t dev; 905f6703dd2SMarcel Moolenaar struct lbc_softc *sc; 90623fbc06bSMarcel Moolenaar uint32_t val; 907f6703dd2SMarcel Moolenaar 90823fbc06bSMarcel Moolenaar dev = device_get_parent(child); 90923fbc06bSMarcel Moolenaar 91023fbc06bSMarcel Moolenaar if (off >= 0x1000) { 91123fbc06bSMarcel Moolenaar device_printf(dev, "%s(%s): invalid offset %#x\n", 91223fbc06bSMarcel Moolenaar __func__, device_get_nameunit(child), off); 91323fbc06bSMarcel Moolenaar return (~0U); 91423fbc06bSMarcel Moolenaar } 91523fbc06bSMarcel Moolenaar 91623fbc06bSMarcel Moolenaar sc = device_get_softc(dev); 91723fbc06bSMarcel Moolenaar 91823fbc06bSMarcel Moolenaar if (off == LBC85XX_LTESR && sc->sc_ltesr != ~0U) 91923fbc06bSMarcel Moolenaar val = sc->sc_ltesr; 92023fbc06bSMarcel Moolenaar else 92123fbc06bSMarcel Moolenaar val = bus_space_read_4(sc->sc_bst, sc->sc_bsh, off); 92223fbc06bSMarcel Moolenaar return (val); 923f6703dd2SMarcel Moolenaar } 924