xref: /freebsd/sys/powerpc/mpc85xx/lbc.c (revision f7dc5935d36430779d3daa77f0c12659141a2790)
108077f58SMarcel Moolenaar /*-
208077f58SMarcel Moolenaar  * Copyright (c) 2006-2008, Juniper Networks, Inc.
325c22eb4SRafal Jaworowski  * Copyright (c) 2008 Semihalf, Rafal Czubak
4d1d3233eSRafal Jaworowski  * Copyright (c) 2009 The FreeBSD Foundation
508077f58SMarcel Moolenaar  * All rights reserved.
608077f58SMarcel Moolenaar  *
7d1d3233eSRafal Jaworowski  * Portions of this software were developed by Semihalf
8d1d3233eSRafal Jaworowski  * under sponsorship from the FreeBSD Foundation.
9d1d3233eSRafal Jaworowski  *
1008077f58SMarcel Moolenaar  * Redistribution and use in source and binary forms, with or without
1108077f58SMarcel Moolenaar  * modification, are permitted provided that the following conditions
1208077f58SMarcel Moolenaar  * are met:
1308077f58SMarcel Moolenaar  * 1. Redistributions of source code must retain the above copyright
1408077f58SMarcel Moolenaar  *    notice, this list of conditions and the following disclaimer.
1508077f58SMarcel Moolenaar  * 2. Redistributions in binary form must reproduce the above copyright
1608077f58SMarcel Moolenaar  *    notice, this list of conditions and the following disclaimer in the
1708077f58SMarcel Moolenaar  *    documentation and/or other materials provided with the distribution.
1808077f58SMarcel Moolenaar  * 3. The name of the author may not be used to endorse or promote products
1908077f58SMarcel Moolenaar  *    derived from this software without specific prior written permission.
2008077f58SMarcel Moolenaar  *
2108077f58SMarcel Moolenaar  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
2208077f58SMarcel Moolenaar  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
2308077f58SMarcel Moolenaar  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
2408077f58SMarcel Moolenaar  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
2508077f58SMarcel Moolenaar  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
2608077f58SMarcel Moolenaar  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
2708077f58SMarcel Moolenaar  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
2808077f58SMarcel Moolenaar  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
2908077f58SMarcel Moolenaar  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
3008077f58SMarcel Moolenaar  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3108077f58SMarcel Moolenaar  * SUCH DAMAGE.
3208077f58SMarcel Moolenaar  */
3308077f58SMarcel Moolenaar 
3408077f58SMarcel Moolenaar #include <sys/cdefs.h>
3508077f58SMarcel Moolenaar __FBSDID("$FreeBSD$");
3608077f58SMarcel Moolenaar 
3708077f58SMarcel Moolenaar #include <sys/param.h>
3808077f58SMarcel Moolenaar #include <sys/systm.h>
3908077f58SMarcel Moolenaar #include <sys/ktr.h>
4008077f58SMarcel Moolenaar #include <sys/kernel.h>
4108077f58SMarcel Moolenaar #include <sys/malloc.h>
4208077f58SMarcel Moolenaar #include <sys/module.h>
4308077f58SMarcel Moolenaar #include <sys/bus.h>
4408077f58SMarcel Moolenaar #include <sys/rman.h>
4508077f58SMarcel Moolenaar #include <machine/bus.h>
4608077f58SMarcel Moolenaar 
4708077f58SMarcel Moolenaar #include <vm/vm.h>
4808077f58SMarcel Moolenaar #include <vm/pmap.h>
4908077f58SMarcel Moolenaar 
50d1d3233eSRafal Jaworowski #include <dev/fdt/fdt_common.h>
51d1d3233eSRafal Jaworowski #include <dev/ofw/ofw_bus.h>
52d1d3233eSRafal Jaworowski #include <dev/ofw/ofw_bus_subr.h>
53d1d3233eSRafal Jaworowski 
5425c22eb4SRafal Jaworowski #include <powerpc/mpc85xx/mpc85xx.h>
5508077f58SMarcel Moolenaar 
56d1d3233eSRafal Jaworowski #include "ofw_bus_if.h"
57d1d3233eSRafal Jaworowski #include "lbc.h"
5808077f58SMarcel Moolenaar 
59d1d3233eSRafal Jaworowski #ifdef DEBUG
60d1d3233eSRafal Jaworowski #define debugf(fmt, args...) do { printf("%s(): ", __func__);	\
61d1d3233eSRafal Jaworowski     printf(fmt,##args); } while (0)
62d1d3233eSRafal Jaworowski #else
63d1d3233eSRafal Jaworowski #define debugf(fmt, args...)
64d1d3233eSRafal Jaworowski #endif
6508077f58SMarcel Moolenaar 
66d1d3233eSRafal Jaworowski static MALLOC_DEFINE(M_LBC, "localbus", "localbus devices information");
67d1d3233eSRafal Jaworowski 
68d1d3233eSRafal Jaworowski static int lbc_probe(device_t);
69d1d3233eSRafal Jaworowski static int lbc_attach(device_t);
70d1d3233eSRafal Jaworowski static int lbc_shutdown(device_t);
71d1d3233eSRafal Jaworowski static struct resource *lbc_alloc_resource(device_t, device_t, int, int *,
722dd1bdf1SJustin Hibbits     rman_res_t, rman_res_t, rman_res_t, u_int);
73d1d3233eSRafal Jaworowski static int lbc_print_child(device_t, device_t);
74d1d3233eSRafal Jaworowski static int lbc_release_resource(device_t, device_t, int, int,
75d1d3233eSRafal Jaworowski     struct resource *);
76d1d3233eSRafal Jaworowski static const struct ofw_bus_devinfo *lbc_get_devinfo(device_t, device_t);
77d1d3233eSRafal Jaworowski 
78d1d3233eSRafal Jaworowski /*
79d1d3233eSRafal Jaworowski  * Bus interface definition
80d1d3233eSRafal Jaworowski  */
81d1d3233eSRafal Jaworowski static device_method_t lbc_methods[] = {
82d1d3233eSRafal Jaworowski 	/* Device interface */
83d1d3233eSRafal Jaworowski 	DEVMETHOD(device_probe,		lbc_probe),
84d1d3233eSRafal Jaworowski 	DEVMETHOD(device_attach,	lbc_attach),
85d1d3233eSRafal Jaworowski 	DEVMETHOD(device_shutdown,	lbc_shutdown),
86d1d3233eSRafal Jaworowski 
87d1d3233eSRafal Jaworowski 	/* Bus interface */
88d1d3233eSRafal Jaworowski 	DEVMETHOD(bus_print_child,	lbc_print_child),
89d1d3233eSRafal Jaworowski 	DEVMETHOD(bus_setup_intr,	bus_generic_setup_intr),
90d1d3233eSRafal Jaworowski 	DEVMETHOD(bus_teardown_intr,	NULL),
91d1d3233eSRafal Jaworowski 
92d1d3233eSRafal Jaworowski 	DEVMETHOD(bus_alloc_resource,	lbc_alloc_resource),
93d1d3233eSRafal Jaworowski 	DEVMETHOD(bus_release_resource,	lbc_release_resource),
94d1d3233eSRafal Jaworowski 	DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
95d1d3233eSRafal Jaworowski 	DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
96d1d3233eSRafal Jaworowski 
97d1d3233eSRafal Jaworowski 	/* OFW bus interface */
98d1d3233eSRafal Jaworowski 	DEVMETHOD(ofw_bus_get_devinfo,	lbc_get_devinfo),
99d1d3233eSRafal Jaworowski 	DEVMETHOD(ofw_bus_get_compat,	ofw_bus_gen_get_compat),
100d1d3233eSRafal Jaworowski 	DEVMETHOD(ofw_bus_get_model,	ofw_bus_gen_get_model),
101d1d3233eSRafal Jaworowski 	DEVMETHOD(ofw_bus_get_name,	ofw_bus_gen_get_name),
102d1d3233eSRafal Jaworowski 	DEVMETHOD(ofw_bus_get_node,	ofw_bus_gen_get_node),
103d1d3233eSRafal Jaworowski 	DEVMETHOD(ofw_bus_get_type,	ofw_bus_gen_get_type),
104d1d3233eSRafal Jaworowski 
105d1d3233eSRafal Jaworowski 	{ 0, 0 }
106d1d3233eSRafal Jaworowski };
107d1d3233eSRafal Jaworowski 
108d1d3233eSRafal Jaworowski static driver_t lbc_driver = {
109d1d3233eSRafal Jaworowski 	"lbc",
110d1d3233eSRafal Jaworowski 	lbc_methods,
111d1d3233eSRafal Jaworowski 	sizeof(struct lbc_softc)
112d1d3233eSRafal Jaworowski };
113d1d3233eSRafal Jaworowski 
114d1d3233eSRafal Jaworowski devclass_t lbc_devclass;
115d1d3233eSRafal Jaworowski 
11612cb797eSJustin Hibbits EARLY_DRIVER_MODULE(lbc, ofwbus, lbc_driver, lbc_devclass,
11712cb797eSJustin Hibbits     0, 0, BUS_PASS_BUS);
118d1d3233eSRafal Jaworowski 
11925c22eb4SRafal Jaworowski /*
12025c22eb4SRafal Jaworowski  * Calculate address mask used by OR(n) registers. Use memory region size to
12125c22eb4SRafal Jaworowski  * determine mask value. The size must be a power of two and within the range
12225c22eb4SRafal Jaworowski  * of 32KB - 4GB. Otherwise error code is returned. Value representing
12325c22eb4SRafal Jaworowski  * 4GB size can be passed as 0xffffffff.
12425c22eb4SRafal Jaworowski  */
12525c22eb4SRafal Jaworowski static uint32_t
12625c22eb4SRafal Jaworowski lbc_address_mask(uint32_t size)
12725c22eb4SRafal Jaworowski {
12825c22eb4SRafal Jaworowski 	int n = 15;
12925c22eb4SRafal Jaworowski 
130295be330SJustin Hibbits 	if (size == ~0)
13125c22eb4SRafal Jaworowski 		return (0);
13225c22eb4SRafal Jaworowski 
13325c22eb4SRafal Jaworowski 	while (n < 32) {
134295be330SJustin Hibbits 		if (size == (1U << n))
13525c22eb4SRafal Jaworowski 			break;
13625c22eb4SRafal Jaworowski 		n++;
13725c22eb4SRafal Jaworowski 	}
13825c22eb4SRafal Jaworowski 
13925c22eb4SRafal Jaworowski 	if (n == 32)
14025c22eb4SRafal Jaworowski 		return (EINVAL);
14125c22eb4SRafal Jaworowski 
14225c22eb4SRafal Jaworowski 	return (0xffff8000 << (n - 15));
14325c22eb4SRafal Jaworowski }
14425c22eb4SRafal Jaworowski 
145d1d3233eSRafal Jaworowski static void
146d1d3233eSRafal Jaworowski lbc_banks_unmap(struct lbc_softc *sc)
14708077f58SMarcel Moolenaar {
148f6703dd2SMarcel Moolenaar 	int r;
14908077f58SMarcel Moolenaar 
150f6703dd2SMarcel Moolenaar 	r = 0;
151f6703dd2SMarcel Moolenaar 	while (r < LBC_DEV_MAX) {
152f6703dd2SMarcel Moolenaar 		if (sc->sc_range[r].size == 0)
153f6703dd2SMarcel Moolenaar 			return;
15425c22eb4SRafal Jaworowski 
155f6703dd2SMarcel Moolenaar 		pmap_unmapdev(sc->sc_range[r].kva, sc->sc_range[r].size);
156f6703dd2SMarcel Moolenaar 		law_disable(OCP85XX_TGTIF_LBC, sc->sc_range[r].addr,
157f6703dd2SMarcel Moolenaar 		    sc->sc_range[r].size);
158f6703dd2SMarcel Moolenaar 		r++;
15908077f58SMarcel Moolenaar 	}
16008077f58SMarcel Moolenaar }
16108077f58SMarcel Moolenaar 
16208077f58SMarcel Moolenaar static int
163d1d3233eSRafal Jaworowski lbc_banks_map(struct lbc_softc *sc)
16425c22eb4SRafal Jaworowski {
165f6703dd2SMarcel Moolenaar 	vm_paddr_t end, start;
166f6703dd2SMarcel Moolenaar 	vm_size_t size;
167f6703dd2SMarcel Moolenaar 	u_int i, r, ranges, s;
168f6703dd2SMarcel Moolenaar 	int error;
16925c22eb4SRafal Jaworowski 
170f6703dd2SMarcel Moolenaar 	bzero(sc->sc_range, sizeof(sc->sc_range));
17125c22eb4SRafal Jaworowski 
17225c22eb4SRafal Jaworowski 	/*
173f6703dd2SMarcel Moolenaar 	 * Determine number of discontiguous address ranges to program.
17425c22eb4SRafal Jaworowski 	 */
175f6703dd2SMarcel Moolenaar 	ranges = 0;
176f6703dd2SMarcel Moolenaar 	for (i = 0; i < LBC_DEV_MAX; i++) {
177f6703dd2SMarcel Moolenaar 		size = sc->sc_banks[i].size;
178f6703dd2SMarcel Moolenaar 		if (size == 0)
179f6703dd2SMarcel Moolenaar 			continue;
180f6703dd2SMarcel Moolenaar 
181f6703dd2SMarcel Moolenaar 		start = sc->sc_banks[i].addr;
182f6703dd2SMarcel Moolenaar 		for (r = 0; r < ranges; r++) {
183f6703dd2SMarcel Moolenaar 			/* Avoid wrap-around bugs. */
184f6703dd2SMarcel Moolenaar 			end = sc->sc_range[r].addr - 1 + sc->sc_range[r].size;
185f6703dd2SMarcel Moolenaar 			if (start > 0 && end == start - 1) {
186f6703dd2SMarcel Moolenaar 				sc->sc_range[r].size += size;
187f6703dd2SMarcel Moolenaar 				break;
188f6703dd2SMarcel Moolenaar 			}
189f6703dd2SMarcel Moolenaar 			/* Avoid wrap-around bugs. */
190f6703dd2SMarcel Moolenaar 			end = start - 1 + size;
191f6703dd2SMarcel Moolenaar 			if (sc->sc_range[r].addr > 0 &&
192f6703dd2SMarcel Moolenaar 			    end == sc->sc_range[r].addr - 1) {
193f6703dd2SMarcel Moolenaar 				sc->sc_range[r].addr = start;
194f6703dd2SMarcel Moolenaar 				sc->sc_range[r].size += size;
195f6703dd2SMarcel Moolenaar 				break;
196f6703dd2SMarcel Moolenaar 			}
197f6703dd2SMarcel Moolenaar 		}
198f6703dd2SMarcel Moolenaar 		if (r == ranges) {
199f6703dd2SMarcel Moolenaar 			/* New range; add using insertion sort */
200f6703dd2SMarcel Moolenaar 			r = 0;
201f6703dd2SMarcel Moolenaar 			while (r < ranges && sc->sc_range[r].addr < start)
202f6703dd2SMarcel Moolenaar 				r++;
203f6703dd2SMarcel Moolenaar 			for (s = ranges; s > r; s--)
204f6703dd2SMarcel Moolenaar 				sc->sc_range[s] = sc->sc_range[s-1];
205f6703dd2SMarcel Moolenaar 			sc->sc_range[r].addr = start;
206f6703dd2SMarcel Moolenaar 			sc->sc_range[r].size = size;
207f6703dd2SMarcel Moolenaar 			ranges++;
208f6703dd2SMarcel Moolenaar 		}
209f6703dd2SMarcel Moolenaar 	}
210f6703dd2SMarcel Moolenaar 
211f6703dd2SMarcel Moolenaar 	/*
212f6703dd2SMarcel Moolenaar 	 * Ranges are sorted so quickly go over the list to merge ranges
213f6703dd2SMarcel Moolenaar 	 * that grew toward each other while building the ranges.
214f6703dd2SMarcel Moolenaar 	 */
215f6703dd2SMarcel Moolenaar 	r = 0;
216f6703dd2SMarcel Moolenaar 	while (r < ranges - 1) {
217f6703dd2SMarcel Moolenaar 		end = sc->sc_range[r].addr + sc->sc_range[r].size;
218f6703dd2SMarcel Moolenaar 		if (end != sc->sc_range[r+1].addr) {
219f6703dd2SMarcel Moolenaar 			r++;
220f6703dd2SMarcel Moolenaar 			continue;
221f6703dd2SMarcel Moolenaar 		}
222f6703dd2SMarcel Moolenaar 		sc->sc_range[r].size += sc->sc_range[r+1].size;
223f6703dd2SMarcel Moolenaar 		for (s = r + 1; s < ranges - 1; s++)
224f6703dd2SMarcel Moolenaar 			sc->sc_range[s] = sc->sc_range[s+1];
225f6703dd2SMarcel Moolenaar 		bzero(&sc->sc_range[s], sizeof(sc->sc_range[s]));
226f6703dd2SMarcel Moolenaar 		ranges--;
227f6703dd2SMarcel Moolenaar 	}
228f6703dd2SMarcel Moolenaar 
229f6703dd2SMarcel Moolenaar 	/*
230f6703dd2SMarcel Moolenaar 	 * Configure LAW for the LBC ranges and map the physical memory
231f6703dd2SMarcel Moolenaar 	 * range into KVA.
232f6703dd2SMarcel Moolenaar 	 */
233f6703dd2SMarcel Moolenaar 	for (r = 0; r < ranges; r++) {
234f6703dd2SMarcel Moolenaar 		start = sc->sc_range[r].addr;
235f6703dd2SMarcel Moolenaar 		size = sc->sc_range[r].size;
23625c22eb4SRafal Jaworowski 		error = law_enable(OCP85XX_TGTIF_LBC, start, size);
23725c22eb4SRafal Jaworowski 		if (error)
23825c22eb4SRafal Jaworowski 			return (error);
239f6703dd2SMarcel Moolenaar 		sc->sc_range[r].kva = (vm_offset_t)pmap_mapdev(start, size);
240f6703dd2SMarcel Moolenaar 	}
24125c22eb4SRafal Jaworowski 
242f6703dd2SMarcel Moolenaar 	/* XXX: need something better here? */
243f6703dd2SMarcel Moolenaar 	if (ranges == 0)
244f6703dd2SMarcel Moolenaar 		return (EINVAL);
245f6703dd2SMarcel Moolenaar 
246f6703dd2SMarcel Moolenaar 	/* Assign KVA to banks based on the enclosing range. */
247f6703dd2SMarcel Moolenaar 	for (i = 0; i < LBC_DEV_MAX; i++) {
248f6703dd2SMarcel Moolenaar 		size = sc->sc_banks[i].size;
249f6703dd2SMarcel Moolenaar 		if (size == 0)
250f6703dd2SMarcel Moolenaar 			continue;
251f6703dd2SMarcel Moolenaar 
252f6703dd2SMarcel Moolenaar 		start = sc->sc_banks[i].addr;
253f6703dd2SMarcel Moolenaar 		for (r = 0; r < ranges; r++) {
254f6703dd2SMarcel Moolenaar 			end = sc->sc_range[r].addr - 1 + sc->sc_range[r].size;
255f6703dd2SMarcel Moolenaar 			if (start >= sc->sc_range[r].addr &&
256f6703dd2SMarcel Moolenaar 			    start - 1 + size <= end)
257f6703dd2SMarcel Moolenaar 				break;
258f6703dd2SMarcel Moolenaar 		}
259f6703dd2SMarcel Moolenaar 		if (r < ranges) {
260f6703dd2SMarcel Moolenaar 			sc->sc_banks[i].kva = sc->sc_range[r].kva +
261f6703dd2SMarcel Moolenaar 			    (start - sc->sc_range[r].addr);
26225c22eb4SRafal Jaworowski 		}
263d1d3233eSRafal Jaworowski 	}
264f6703dd2SMarcel Moolenaar 
265d1d3233eSRafal Jaworowski 	return (0);
266d1d3233eSRafal Jaworowski }
26725c22eb4SRafal Jaworowski 
268d1d3233eSRafal Jaworowski static int
269d1d3233eSRafal Jaworowski lbc_banks_enable(struct lbc_softc *sc)
270d1d3233eSRafal Jaworowski {
271295be330SJustin Hibbits 	uint32_t size;
272d1d3233eSRafal Jaworowski 	uint32_t regval;
273d1d3233eSRafal Jaworowski 	int error, i;
274d1d3233eSRafal Jaworowski 
275d1d3233eSRafal Jaworowski 	for (i = 0; i < LBC_DEV_MAX; i++) {
276d1d3233eSRafal Jaworowski 		size = sc->sc_banks[i].size;
27723fbc06bSMarcel Moolenaar 		if (size == 0)
278d1d3233eSRafal Jaworowski 			continue;
279f6703dd2SMarcel Moolenaar 
28025c22eb4SRafal Jaworowski 		/*
281d1d3233eSRafal Jaworowski 		 * Compute and program BR value.
28225c22eb4SRafal Jaworowski 		 */
283f6703dd2SMarcel Moolenaar 		regval = sc->sc_banks[i].addr;
284d1d3233eSRafal Jaworowski 		switch (sc->sc_banks[i].width) {
28525c22eb4SRafal Jaworowski 		case 8:
286d1d3233eSRafal Jaworowski 			regval |= (1 << 11);
28725c22eb4SRafal Jaworowski 			break;
28825c22eb4SRafal Jaworowski 		case 16:
289d1d3233eSRafal Jaworowski 			regval |= (2 << 11);
29025c22eb4SRafal Jaworowski 			break;
29125c22eb4SRafal Jaworowski 		case 32:
292d1d3233eSRafal Jaworowski 			regval |= (3 << 11);
29325c22eb4SRafal Jaworowski 			break;
29425c22eb4SRafal Jaworowski 		default:
29525c22eb4SRafal Jaworowski 			error = EINVAL;
29625c22eb4SRafal Jaworowski 			goto fail;
29725c22eb4SRafal Jaworowski 		}
298d1d3233eSRafal Jaworowski 		regval |= (sc->sc_banks[i].decc << 9);
299d1d3233eSRafal Jaworowski 		regval |= (sc->sc_banks[i].wp << 8);
300d1d3233eSRafal Jaworowski 		regval |= (sc->sc_banks[i].msel << 5);
301d1d3233eSRafal Jaworowski 		regval |= (sc->sc_banks[i].atom << 2);
302d1d3233eSRafal Jaworowski 		regval |= 1;
303f6703dd2SMarcel Moolenaar 		bus_space_write_4(sc->sc_bst, sc->sc_bsh,
304f6703dd2SMarcel Moolenaar 		    LBC85XX_BR(i), regval);
30525c22eb4SRafal Jaworowski 
30625c22eb4SRafal Jaworowski 		/*
307d1d3233eSRafal Jaworowski 		 * Compute and program OR value.
30825c22eb4SRafal Jaworowski 		 */
309f6703dd2SMarcel Moolenaar 		regval = lbc_address_mask(size);
310d1d3233eSRafal Jaworowski 		switch (sc->sc_banks[i].msel) {
31125c22eb4SRafal Jaworowski 		case LBCRES_MSEL_GPCM:
31225c22eb4SRafal Jaworowski 			/* TODO Add flag support for option registers */
313f6703dd2SMarcel Moolenaar 			regval |= 0x0ff7;
31425c22eb4SRafal Jaworowski 			break;
31525c22eb4SRafal Jaworowski 		case LBCRES_MSEL_FCM:
316f6703dd2SMarcel Moolenaar 			/* TODO Add flag support for options register */
317f6703dd2SMarcel Moolenaar 			regval |= 0x0796;
318f6703dd2SMarcel Moolenaar 			break;
31925c22eb4SRafal Jaworowski 		case LBCRES_MSEL_UPMA:
32025c22eb4SRafal Jaworowski 		case LBCRES_MSEL_UPMB:
32125c22eb4SRafal Jaworowski 		case LBCRES_MSEL_UPMC:
32225c22eb4SRafal Jaworowski 			printf("UPM mode not supported yet!");
32325c22eb4SRafal Jaworowski 			error = ENOSYS;
32425c22eb4SRafal Jaworowski 			goto fail;
32525c22eb4SRafal Jaworowski 		}
326f6703dd2SMarcel Moolenaar 		bus_space_write_4(sc->sc_bst, sc->sc_bsh,
327f6703dd2SMarcel Moolenaar 		    LBC85XX_OR(i), regval);
328d1d3233eSRafal Jaworowski 	}
32925c22eb4SRafal Jaworowski 
33025c22eb4SRafal Jaworowski 	return (0);
331d1d3233eSRafal Jaworowski 
33225c22eb4SRafal Jaworowski fail:
333d1d3233eSRafal Jaworowski 	lbc_banks_unmap(sc);
33425c22eb4SRafal Jaworowski 	return (error);
335d1d3233eSRafal Jaworowski }
336d1d3233eSRafal Jaworowski 
337d1d3233eSRafal Jaworowski static void
338d1d3233eSRafal Jaworowski fdt_lbc_fixup(phandle_t node, struct lbc_softc *sc, struct lbc_devinfo *di)
339d1d3233eSRafal Jaworowski {
340d1d3233eSRafal Jaworowski 	pcell_t width;
341d1d3233eSRafal Jaworowski 	int bank;
342d1d3233eSRafal Jaworowski 
343d1d3233eSRafal Jaworowski 	if (OF_getprop(node, "bank-width", (void *)&width, sizeof(width)) <= 0)
344d1d3233eSRafal Jaworowski 		return;
345d1d3233eSRafal Jaworowski 
346d1d3233eSRafal Jaworowski 	bank = di->di_bank;
347d1d3233eSRafal Jaworowski 	if (sc->sc_banks[bank].size == 0)
348d1d3233eSRafal Jaworowski 		return;
349d1d3233eSRafal Jaworowski 
350d1d3233eSRafal Jaworowski 	/* Express width in bits. */
351d1d3233eSRafal Jaworowski 	sc->sc_banks[bank].width = width * 8;
352d1d3233eSRafal Jaworowski }
353d1d3233eSRafal Jaworowski 
354d1d3233eSRafal Jaworowski static int
355d1d3233eSRafal Jaworowski fdt_lbc_reg_decode(phandle_t node, struct lbc_softc *sc,
356d1d3233eSRafal Jaworowski     struct lbc_devinfo *di)
357d1d3233eSRafal Jaworowski {
358d1d3233eSRafal Jaworowski 	u_long start, end, count;
359d1d3233eSRafal Jaworowski 	pcell_t *reg, *regptr;
360d1d3233eSRafal Jaworowski 	pcell_t addr_cells, size_cells;
361d1d3233eSRafal Jaworowski 	int tuple_size, tuples;
362d1d3233eSRafal Jaworowski 	int i, rv, bank;
363d1d3233eSRafal Jaworowski 
364d1d3233eSRafal Jaworowski 	if (fdt_addrsize_cells(OF_parent(node), &addr_cells, &size_cells) != 0)
365d1d3233eSRafal Jaworowski 		return (ENXIO);
366d1d3233eSRafal Jaworowski 
367d1d3233eSRafal Jaworowski 	tuple_size = sizeof(pcell_t) * (addr_cells + size_cells);
368d1d3233eSRafal Jaworowski 	tuples = OF_getprop_alloc(node, "reg", tuple_size, (void **)&reg);
369d1d3233eSRafal Jaworowski 	debugf("addr_cells = %d, size_cells = %d\n", addr_cells, size_cells);
370d1d3233eSRafal Jaworowski 	debugf("tuples = %d, tuple size = %d\n", tuples, tuple_size);
371d1d3233eSRafal Jaworowski 	if (tuples <= 0)
372d1d3233eSRafal Jaworowski 		/* No 'reg' property in this node. */
373d1d3233eSRafal Jaworowski 		return (0);
374d1d3233eSRafal Jaworowski 
375d1d3233eSRafal Jaworowski 	regptr = reg;
376d1d3233eSRafal Jaworowski 	for (i = 0; i < tuples; i++) {
377d1d3233eSRafal Jaworowski 
378d1d3233eSRafal Jaworowski 		bank = fdt_data_get((void *)reg, 1);
379d1d3233eSRafal Jaworowski 		di->di_bank = bank;
380d1d3233eSRafal Jaworowski 		reg += 1;
381d1d3233eSRafal Jaworowski 
382d1d3233eSRafal Jaworowski 		/* Get address/size. */
383d1d3233eSRafal Jaworowski 		rv = fdt_data_to_res(reg, addr_cells - 1, size_cells, &start,
384d1d3233eSRafal Jaworowski 		    &count);
385d1d3233eSRafal Jaworowski 		if (rv != 0) {
386d1d3233eSRafal Jaworowski 			resource_list_free(&di->di_res);
387d1d3233eSRafal Jaworowski 			goto out;
388d1d3233eSRafal Jaworowski 		}
389d1d3233eSRafal Jaworowski 		reg += addr_cells - 1 + size_cells;
390d1d3233eSRafal Jaworowski 
391d1d3233eSRafal Jaworowski 		/* Calculate address range relative to VA base. */
392f6703dd2SMarcel Moolenaar 		start = sc->sc_banks[bank].kva + start;
393d1d3233eSRafal Jaworowski 		end = start + count - 1;
394d1d3233eSRafal Jaworowski 
395d1d3233eSRafal Jaworowski 		debugf("reg addr bank = %d, start = %lx, end = %lx, "
396d1d3233eSRafal Jaworowski 		    "count = %lx\n", bank, start, end, count);
397d1d3233eSRafal Jaworowski 
398d1d3233eSRafal Jaworowski 		/* Use bank (CS) cell as rid. */
399d1d3233eSRafal Jaworowski 		resource_list_add(&di->di_res, SYS_RES_MEMORY, bank, start,
400d1d3233eSRafal Jaworowski 		    end, count);
401d1d3233eSRafal Jaworowski 	}
402d1d3233eSRafal Jaworowski 	rv = 0;
403d1d3233eSRafal Jaworowski out:
404d1d3233eSRafal Jaworowski 	free(regptr, M_OFWPROP);
405d1d3233eSRafal Jaworowski 	return (rv);
40625c22eb4SRafal Jaworowski }
40725c22eb4SRafal Jaworowski 
40823fbc06bSMarcel Moolenaar static void
40923fbc06bSMarcel Moolenaar lbc_intr(void *arg)
41023fbc06bSMarcel Moolenaar {
41123fbc06bSMarcel Moolenaar 	struct lbc_softc *sc = arg;
41223fbc06bSMarcel Moolenaar 	uint32_t ltesr;
41323fbc06bSMarcel Moolenaar 
41423fbc06bSMarcel Moolenaar 	ltesr = bus_space_read_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTESR);
41523fbc06bSMarcel Moolenaar 	sc->sc_ltesr = ltesr;
41623fbc06bSMarcel Moolenaar 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTESR, ltesr);
41723fbc06bSMarcel Moolenaar 	wakeup(sc->sc_dev);
41823fbc06bSMarcel Moolenaar }
41923fbc06bSMarcel Moolenaar 
42025c22eb4SRafal Jaworowski static int
42108077f58SMarcel Moolenaar lbc_probe(device_t dev)
42208077f58SMarcel Moolenaar {
42308077f58SMarcel Moolenaar 
424d1d3233eSRafal Jaworowski 	if (!(ofw_bus_is_compatible(dev, "fsl,lbc") ||
425d1d3233eSRafal Jaworowski 	    ofw_bus_is_compatible(dev, "fsl,elbc")))
42608077f58SMarcel Moolenaar 		return (ENXIO);
42708077f58SMarcel Moolenaar 
428d1d3233eSRafal Jaworowski 	device_set_desc(dev, "Freescale Local Bus Controller");
42908077f58SMarcel Moolenaar 	return (BUS_PROBE_DEFAULT);
43008077f58SMarcel Moolenaar }
43108077f58SMarcel Moolenaar 
43208077f58SMarcel Moolenaar static int
43308077f58SMarcel Moolenaar lbc_attach(device_t dev)
43408077f58SMarcel Moolenaar {
43508077f58SMarcel Moolenaar 	struct lbc_softc *sc;
436d1d3233eSRafal Jaworowski 	struct lbc_devinfo *di;
43708077f58SMarcel Moolenaar 	struct rman *rm;
438d1d3233eSRafal Jaworowski 	u_long offset, start, size;
439d1d3233eSRafal Jaworowski 	device_t cdev;
440d1d3233eSRafal Jaworowski 	phandle_t node, child;
441d1d3233eSRafal Jaworowski 	pcell_t *ranges, *rangesptr;
442d1d3233eSRafal Jaworowski 	int tuple_size, tuples;
443d1d3233eSRafal Jaworowski 	int par_addr_cells;
444d1d3233eSRafal Jaworowski 	int bank, error, i;
44508077f58SMarcel Moolenaar 
44608077f58SMarcel Moolenaar 	sc = device_get_softc(dev);
44708077f58SMarcel Moolenaar 	sc->sc_dev = dev;
44808077f58SMarcel Moolenaar 
44923fbc06bSMarcel Moolenaar 	sc->sc_mrid = 0;
45023fbc06bSMarcel Moolenaar 	sc->sc_mres = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->sc_mrid,
45108077f58SMarcel Moolenaar 	    RF_ACTIVE);
45223fbc06bSMarcel Moolenaar 	if (sc->sc_mres == NULL)
45308077f58SMarcel Moolenaar 		return (ENXIO);
45408077f58SMarcel Moolenaar 
45523fbc06bSMarcel Moolenaar 	sc->sc_bst = rman_get_bustag(sc->sc_mres);
45623fbc06bSMarcel Moolenaar 	sc->sc_bsh = rman_get_bushandle(sc->sc_mres);
45723fbc06bSMarcel Moolenaar 
45823fbc06bSMarcel Moolenaar 	for (bank = 0; bank < LBC_DEV_MAX; bank++) {
45923fbc06bSMarcel Moolenaar 		bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_BR(bank), 0);
46023fbc06bSMarcel Moolenaar 		bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_OR(bank), 0);
46123fbc06bSMarcel Moolenaar 	}
46223fbc06bSMarcel Moolenaar 
46323fbc06bSMarcel Moolenaar 	/*
46423fbc06bSMarcel Moolenaar 	 * Initialize configuration register:
46523fbc06bSMarcel Moolenaar 	 * - enable Local Bus
46623fbc06bSMarcel Moolenaar 	 * - set data buffer control signal function
46723fbc06bSMarcel Moolenaar 	 * - disable parity byte select
46823fbc06bSMarcel Moolenaar 	 * - set ECC parity type
46923fbc06bSMarcel Moolenaar 	 * - set bus monitor timing and timer prescale
47023fbc06bSMarcel Moolenaar 	 */
47123fbc06bSMarcel Moolenaar 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LBCR, 0);
47223fbc06bSMarcel Moolenaar 
47323fbc06bSMarcel Moolenaar 	/*
47423fbc06bSMarcel Moolenaar 	 * Initialize clock ratio register:
47523fbc06bSMarcel Moolenaar 	 * - disable PLL bypass mode
47623fbc06bSMarcel Moolenaar 	 * - configure LCLK delay cycles for the assertion of LALE
47723fbc06bSMarcel Moolenaar 	 * - set system clock divider
47823fbc06bSMarcel Moolenaar 	 */
47923fbc06bSMarcel Moolenaar 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LCRR, 0x00030008);
48023fbc06bSMarcel Moolenaar 
48123fbc06bSMarcel Moolenaar 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTEDR, 0);
48223fbc06bSMarcel Moolenaar 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTESR, ~0);
48323fbc06bSMarcel Moolenaar 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, LBC85XX_LTEIR, 0x64080001);
48423fbc06bSMarcel Moolenaar 
48523fbc06bSMarcel Moolenaar 	sc->sc_irid = 0;
48623fbc06bSMarcel Moolenaar 	sc->sc_ires = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->sc_irid,
48723fbc06bSMarcel Moolenaar 	    RF_ACTIVE | RF_SHAREABLE);
48823fbc06bSMarcel Moolenaar 	if (sc->sc_ires != NULL) {
48923fbc06bSMarcel Moolenaar 		error = bus_setup_intr(dev, sc->sc_ires,
49023fbc06bSMarcel Moolenaar 		    INTR_TYPE_MISC | INTR_MPSAFE, NULL, lbc_intr, sc,
49123fbc06bSMarcel Moolenaar 		    &sc->sc_icookie);
49223fbc06bSMarcel Moolenaar 		if (error) {
49323fbc06bSMarcel Moolenaar 			device_printf(dev, "could not activate interrupt\n");
49423fbc06bSMarcel Moolenaar 			bus_release_resource(dev, SYS_RES_IRQ, sc->sc_irid,
49523fbc06bSMarcel Moolenaar 			    sc->sc_ires);
49623fbc06bSMarcel Moolenaar 			sc->sc_ires = NULL;
49723fbc06bSMarcel Moolenaar 		}
49823fbc06bSMarcel Moolenaar 	}
49923fbc06bSMarcel Moolenaar 
50023fbc06bSMarcel Moolenaar 	sc->sc_ltesr = ~0;
50123fbc06bSMarcel Moolenaar 
502d1d3233eSRafal Jaworowski 	rangesptr = NULL;
50308077f58SMarcel Moolenaar 
50408077f58SMarcel Moolenaar 	rm = &sc->sc_rman;
50508077f58SMarcel Moolenaar 	rm->rm_type = RMAN_ARRAY;
506d1d3233eSRafal Jaworowski 	rm->rm_descr = "Local Bus Space";
50725c22eb4SRafal Jaworowski 	rm->rm_start = 0UL;
50825c22eb4SRafal Jaworowski 	rm->rm_end = ~0UL;
50908077f58SMarcel Moolenaar 	error = rman_init(rm);
51008077f58SMarcel Moolenaar 	if (error)
51108077f58SMarcel Moolenaar 		goto fail;
51208077f58SMarcel Moolenaar 
51308077f58SMarcel Moolenaar 	error = rman_manage_region(rm, rm->rm_start, rm->rm_end);
51408077f58SMarcel Moolenaar 	if (error) {
51508077f58SMarcel Moolenaar 		rman_fini(rm);
51608077f58SMarcel Moolenaar 		goto fail;
51708077f58SMarcel Moolenaar 	}
51808077f58SMarcel Moolenaar 
51925c22eb4SRafal Jaworowski 	/*
520d1d3233eSRafal Jaworowski 	 * Process 'ranges' property.
52125c22eb4SRafal Jaworowski 	 */
522d1d3233eSRafal Jaworowski 	node = ofw_bus_get_node(dev);
523d1d3233eSRafal Jaworowski 	if ((fdt_addrsize_cells(node, &sc->sc_addr_cells,
524d1d3233eSRafal Jaworowski 	    &sc->sc_size_cells)) != 0) {
52525c22eb4SRafal Jaworowski 		error = ENXIO;
52625c22eb4SRafal Jaworowski 		goto fail;
52725c22eb4SRafal Jaworowski 	}
52808077f58SMarcel Moolenaar 
529d1d3233eSRafal Jaworowski 	par_addr_cells = fdt_parent_addr_cells(node);
530d1d3233eSRafal Jaworowski 	if (par_addr_cells > 2) {
531d1d3233eSRafal Jaworowski 		device_printf(dev, "unsupported parent #addr-cells\n");
532d1d3233eSRafal Jaworowski 		error = ERANGE;
533d1d3233eSRafal Jaworowski 		goto fail;
534d1d3233eSRafal Jaworowski 	}
535d1d3233eSRafal Jaworowski 	tuple_size = sizeof(pcell_t) * (sc->sc_addr_cells + par_addr_cells +
536d1d3233eSRafal Jaworowski 	    sc->sc_size_cells);
537d1d3233eSRafal Jaworowski 
538d1d3233eSRafal Jaworowski 	tuples = OF_getprop_alloc(node, "ranges", tuple_size,
539d1d3233eSRafal Jaworowski 	    (void **)&ranges);
540d1d3233eSRafal Jaworowski 	if (tuples < 0) {
541d1d3233eSRafal Jaworowski 		device_printf(dev, "could not retrieve 'ranges' property\n");
542d1d3233eSRafal Jaworowski 		error = ENXIO;
543d1d3233eSRafal Jaworowski 		goto fail;
544d1d3233eSRafal Jaworowski 	}
545d1d3233eSRafal Jaworowski 	rangesptr = ranges;
546d1d3233eSRafal Jaworowski 
547d1d3233eSRafal Jaworowski 	debugf("par addr_cells = %d, addr_cells = %d, size_cells = %d, "
548d1d3233eSRafal Jaworowski 	    "tuple_size = %d, tuples = %d\n", par_addr_cells,
549d1d3233eSRafal Jaworowski 	    sc->sc_addr_cells, sc->sc_size_cells, tuple_size, tuples);
550d1d3233eSRafal Jaworowski 
551d1d3233eSRafal Jaworowski 	start = 0;
552d1d3233eSRafal Jaworowski 	size = 0;
553d1d3233eSRafal Jaworowski 	for (i = 0; i < tuples; i++) {
554d1d3233eSRafal Jaworowski 
555d1d3233eSRafal Jaworowski 		/* The first cell is the bank (chip select) number. */
556d1d3233eSRafal Jaworowski 		bank = fdt_data_get((void *)ranges, 1);
557d1d3233eSRafal Jaworowski 		if (bank < 0 || bank > LBC_DEV_MAX) {
558d1d3233eSRafal Jaworowski 			device_printf(dev, "bank out of range: %d\n", bank);
559d1d3233eSRafal Jaworowski 			error = ERANGE;
560d1d3233eSRafal Jaworowski 			goto fail;
561d1d3233eSRafal Jaworowski 		}
562d1d3233eSRafal Jaworowski 		ranges += 1;
563d1d3233eSRafal Jaworowski 
564d1d3233eSRafal Jaworowski 		/*
565d1d3233eSRafal Jaworowski 		 * Remaining cells of the child address define offset into
566d1d3233eSRafal Jaworowski 		 * this CS.
567d1d3233eSRafal Jaworowski 		 */
568d1d3233eSRafal Jaworowski 		offset = fdt_data_get((void *)ranges, sc->sc_addr_cells - 1);
569d1d3233eSRafal Jaworowski 		ranges += sc->sc_addr_cells - 1;
570d1d3233eSRafal Jaworowski 
571d1d3233eSRafal Jaworowski 		/* Parent bus start address of this bank. */
572d1d3233eSRafal Jaworowski 		start = fdt_data_get((void *)ranges, par_addr_cells);
573d1d3233eSRafal Jaworowski 		ranges += par_addr_cells;
574d1d3233eSRafal Jaworowski 
575d1d3233eSRafal Jaworowski 		size = fdt_data_get((void *)ranges, sc->sc_size_cells);
576d1d3233eSRafal Jaworowski 		ranges += sc->sc_size_cells;
577d1d3233eSRafal Jaworowski 		debugf("bank = %d, start = %lx, size = %lx\n", bank,
578d1d3233eSRafal Jaworowski 		    start, size);
579d1d3233eSRafal Jaworowski 
580f6703dd2SMarcel Moolenaar 		sc->sc_banks[bank].addr = start + offset;
581d1d3233eSRafal Jaworowski 		sc->sc_banks[bank].size = size;
582d1d3233eSRafal Jaworowski 
583d1d3233eSRafal Jaworowski 		/*
584d1d3233eSRafal Jaworowski 		 * Attributes for the bank.
585d1d3233eSRafal Jaworowski 		 *
586d1d3233eSRafal Jaworowski 		 * XXX Note there are no DT bindings defined for them at the
587d1d3233eSRafal Jaworowski 		 * moment, so we need to provide some defaults.
588d1d3233eSRafal Jaworowski 		 */
589d1d3233eSRafal Jaworowski 		sc->sc_banks[bank].width = 16;
590d1d3233eSRafal Jaworowski 		sc->sc_banks[bank].msel = LBCRES_MSEL_GPCM;
591d1d3233eSRafal Jaworowski 		sc->sc_banks[bank].decc = LBCRES_DECC_DISABLED;
592d1d3233eSRafal Jaworowski 		sc->sc_banks[bank].atom = LBCRES_ATOM_DISABLED;
593d1d3233eSRafal Jaworowski 		sc->sc_banks[bank].wp = 0;
594d1d3233eSRafal Jaworowski 	}
595d1d3233eSRafal Jaworowski 
596d1d3233eSRafal Jaworowski 	/*
597d1d3233eSRafal Jaworowski 	 * Initialize mem-mappings for the LBC banks (i.e. chip selects).
598d1d3233eSRafal Jaworowski 	 */
599d1d3233eSRafal Jaworowski 	error = lbc_banks_map(sc);
600d1d3233eSRafal Jaworowski 	if (error)
601d1d3233eSRafal Jaworowski 		goto fail;
602d1d3233eSRafal Jaworowski 
603d1d3233eSRafal Jaworowski 	/*
604d1d3233eSRafal Jaworowski 	 * Walk the localbus and add direct subordinates as our children.
605d1d3233eSRafal Jaworowski 	 */
606d1d3233eSRafal Jaworowski 	for (child = OF_child(node); child != 0; child = OF_peer(child)) {
607d1d3233eSRafal Jaworowski 
608d1d3233eSRafal Jaworowski 		di = malloc(sizeof(*di), M_LBC, M_WAITOK | M_ZERO);
609d1d3233eSRafal Jaworowski 
610d1d3233eSRafal Jaworowski 		if (ofw_bus_gen_setup_devinfo(&di->di_ofw, child) != 0) {
611d1d3233eSRafal Jaworowski 			free(di, M_LBC);
612d1d3233eSRafal Jaworowski 			device_printf(dev, "could not set up devinfo\n");
613d1d3233eSRafal Jaworowski 			continue;
614d1d3233eSRafal Jaworowski 		}
615d1d3233eSRafal Jaworowski 
616d1d3233eSRafal Jaworowski 		resource_list_init(&di->di_res);
617d1d3233eSRafal Jaworowski 
618d1d3233eSRafal Jaworowski 		if (fdt_lbc_reg_decode(child, sc, di)) {
619d1d3233eSRafal Jaworowski 			device_printf(dev, "could not process 'reg' "
620d1d3233eSRafal Jaworowski 			    "property\n");
621d1d3233eSRafal Jaworowski 			ofw_bus_gen_destroy_devinfo(&di->di_ofw);
622d1d3233eSRafal Jaworowski 			free(di, M_LBC);
623d1d3233eSRafal Jaworowski 			continue;
624d1d3233eSRafal Jaworowski 		}
625d1d3233eSRafal Jaworowski 
626d1d3233eSRafal Jaworowski 		fdt_lbc_fixup(child, sc, di);
627d1d3233eSRafal Jaworowski 
628d1d3233eSRafal Jaworowski 		/* Add newbus device for this FDT node */
629d1d3233eSRafal Jaworowski 		cdev = device_add_child(dev, NULL, -1);
630d1d3233eSRafal Jaworowski 		if (cdev == NULL) {
631d1d3233eSRafal Jaworowski 			device_printf(dev, "could not add child: %s\n",
632d1d3233eSRafal Jaworowski 			    di->di_ofw.obd_name);
633d1d3233eSRafal Jaworowski 			resource_list_free(&di->di_res);
634d1d3233eSRafal Jaworowski 			ofw_bus_gen_destroy_devinfo(&di->di_ofw);
635d1d3233eSRafal Jaworowski 			free(di, M_LBC);
636d1d3233eSRafal Jaworowski 			continue;
637d1d3233eSRafal Jaworowski 		}
638d1d3233eSRafal Jaworowski 		debugf("added child name='%s', node=%p\n", di->di_ofw.obd_name,
639d1d3233eSRafal Jaworowski 		    (void *)child);
640d1d3233eSRafal Jaworowski 		device_set_ivars(cdev, di);
641d1d3233eSRafal Jaworowski 	}
642d1d3233eSRafal Jaworowski 
643d1d3233eSRafal Jaworowski 	/*
644d1d3233eSRafal Jaworowski 	 * Enable the LBC.
645d1d3233eSRafal Jaworowski 	 */
646d1d3233eSRafal Jaworowski 	lbc_banks_enable(sc);
647d1d3233eSRafal Jaworowski 
648d1d3233eSRafal Jaworowski 	free(rangesptr, M_OFWPROP);
64908077f58SMarcel Moolenaar 	return (bus_generic_attach(dev));
65008077f58SMarcel Moolenaar 
65108077f58SMarcel Moolenaar fail:
652d1d3233eSRafal Jaworowski 	free(rangesptr, M_OFWPROP);
65323fbc06bSMarcel Moolenaar 	bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_mrid, sc->sc_mres);
65408077f58SMarcel Moolenaar 	return (error);
65508077f58SMarcel Moolenaar }
65608077f58SMarcel Moolenaar 
65708077f58SMarcel Moolenaar static int
65808077f58SMarcel Moolenaar lbc_shutdown(device_t dev)
65908077f58SMarcel Moolenaar {
66008077f58SMarcel Moolenaar 
66108077f58SMarcel Moolenaar 	/* TODO */
66208077f58SMarcel Moolenaar 	return(0);
66308077f58SMarcel Moolenaar }
66408077f58SMarcel Moolenaar 
66508077f58SMarcel Moolenaar static struct resource *
666d1d3233eSRafal Jaworowski lbc_alloc_resource(device_t bus, device_t child, int type, int *rid,
6672dd1bdf1SJustin Hibbits     rman_res_t start, rman_res_t end, rman_res_t count, u_int flags)
66808077f58SMarcel Moolenaar {
66908077f58SMarcel Moolenaar 	struct lbc_softc *sc;
670d1d3233eSRafal Jaworowski 	struct lbc_devinfo *di;
671d1d3233eSRafal Jaworowski 	struct resource_list_entry *rle;
672d1d3233eSRafal Jaworowski 	struct resource *res;
67308077f58SMarcel Moolenaar 	struct rman *rm;
674d1d3233eSRafal Jaworowski 	int needactivate;
67508077f58SMarcel Moolenaar 
67608077f58SMarcel Moolenaar 	/* We only support default allocations. */
677*f7dc5935SJustin Hibbits 	if (!RMAN_IS_DEFAULT_RANGE(start, end))
67808077f58SMarcel Moolenaar 		return (NULL);
67908077f58SMarcel Moolenaar 
680d1d3233eSRafal Jaworowski 	sc = device_get_softc(bus);
68108077f58SMarcel Moolenaar 	if (type == SYS_RES_IRQ)
682d1d3233eSRafal Jaworowski 		return (bus_alloc_resource(bus, type, rid, start, end, count,
68308077f58SMarcel Moolenaar 		    flags));
68408077f58SMarcel Moolenaar 
685d1d3233eSRafal Jaworowski 	/*
686d1d3233eSRafal Jaworowski 	 * Request for the default allocation with a given rid: use resource
687d1d3233eSRafal Jaworowski 	 * list stored in the local device info.
688d1d3233eSRafal Jaworowski 	 */
689d1d3233eSRafal Jaworowski 	if ((di = device_get_ivars(child)) == NULL)
690d1d3233eSRafal Jaworowski 		return (NULL);
691d1d3233eSRafal Jaworowski 
692d1d3233eSRafal Jaworowski 	if (type == SYS_RES_IOPORT)
693d1d3233eSRafal Jaworowski 		type = SYS_RES_MEMORY;
694d1d3233eSRafal Jaworowski 
695d1d3233eSRafal Jaworowski 	rid = &di->di_bank;
696d1d3233eSRafal Jaworowski 
697d1d3233eSRafal Jaworowski 	rle = resource_list_find(&di->di_res, type, *rid);
698d1d3233eSRafal Jaworowski 	if (rle == NULL) {
699d1d3233eSRafal Jaworowski 		device_printf(bus, "no default resources for "
700d1d3233eSRafal Jaworowski 		    "rid = %d, type = %d\n", *rid, type);
70125c22eb4SRafal Jaworowski 		return (NULL);
70225c22eb4SRafal Jaworowski 	}
703d1d3233eSRafal Jaworowski 	start = rle->start;
704d1d3233eSRafal Jaworowski 	count = rle->count;
705d1d3233eSRafal Jaworowski 	end = start + count - 1;
70625c22eb4SRafal Jaworowski 
707d1d3233eSRafal Jaworowski 	sc = device_get_softc(bus);
708d1d3233eSRafal Jaworowski 
709d1d3233eSRafal Jaworowski 	needactivate = flags & RF_ACTIVE;
710d1d3233eSRafal Jaworowski 	flags &= ~RF_ACTIVE;
71108077f58SMarcel Moolenaar 
71208077f58SMarcel Moolenaar 	rm = &sc->sc_rman;
713d1d3233eSRafal Jaworowski 
714d1d3233eSRafal Jaworowski 	res = rman_reserve_resource(rm, start, end, count, flags, child);
715d1d3233eSRafal Jaworowski 	if (res == NULL) {
716d1d3233eSRafal Jaworowski 		device_printf(bus, "failed to reserve resource %#lx - %#lx "
717d1d3233eSRafal Jaworowski 		    "(%#lx)\n", start, end, count);
718d1d3233eSRafal Jaworowski 		return (NULL);
71908077f58SMarcel Moolenaar 	}
720d1d3233eSRafal Jaworowski 
721d1d3233eSRafal Jaworowski 	rman_set_rid(res, *rid);
722d1d3233eSRafal Jaworowski 	rman_set_bustag(res, &bs_be_tag);
723d1d3233eSRafal Jaworowski 	rman_set_bushandle(res, rman_get_start(res));
724d1d3233eSRafal Jaworowski 
725d1d3233eSRafal Jaworowski 	if (needactivate)
726d1d3233eSRafal Jaworowski 		if (bus_activate_resource(child, type, *rid, res)) {
727d1d3233eSRafal Jaworowski 			device_printf(child, "resource activation failed\n");
728d1d3233eSRafal Jaworowski 			rman_release_resource(res);
729d1d3233eSRafal Jaworowski 			return (NULL);
730d1d3233eSRafal Jaworowski 		}
731d1d3233eSRafal Jaworowski 
732d1d3233eSRafal Jaworowski 	return (res);
73308077f58SMarcel Moolenaar }
73408077f58SMarcel Moolenaar 
73508077f58SMarcel Moolenaar static int
73608077f58SMarcel Moolenaar lbc_print_child(device_t dev, device_t child)
73708077f58SMarcel Moolenaar {
738d1d3233eSRafal Jaworowski 	struct lbc_devinfo *di;
739d1d3233eSRafal Jaworowski 	struct resource_list *rl;
740d1d3233eSRafal Jaworowski 	int rv;
74108077f58SMarcel Moolenaar 
742d1d3233eSRafal Jaworowski 	di = device_get_ivars(child);
743d1d3233eSRafal Jaworowski 	rl = &di->di_res;
74408077f58SMarcel Moolenaar 
745d1d3233eSRafal Jaworowski 	rv = 0;
746d1d3233eSRafal Jaworowski 	rv += bus_print_child_header(dev, child);
747d1d3233eSRafal Jaworowski 	rv += resource_list_print_type(rl, "mem", SYS_RES_MEMORY, "%#lx");
748d1d3233eSRafal Jaworowski 	rv += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%ld");
749d1d3233eSRafal Jaworowski 	rv += bus_print_child_footer(dev, child);
75008077f58SMarcel Moolenaar 
751d1d3233eSRafal Jaworowski 	return (rv);
75208077f58SMarcel Moolenaar }
75308077f58SMarcel Moolenaar 
75408077f58SMarcel Moolenaar static int
75508077f58SMarcel Moolenaar lbc_release_resource(device_t dev, device_t child, int type, int rid,
75608077f58SMarcel Moolenaar     struct resource *res)
75708077f58SMarcel Moolenaar {
758d1d3233eSRafal Jaworowski 	int err;
759d1d3233eSRafal Jaworowski 
760d1d3233eSRafal Jaworowski 	if (rman_get_flags(res) & RF_ACTIVE) {
761d1d3233eSRafal Jaworowski 		err = bus_deactivate_resource(child, type, rid, res);
762d1d3233eSRafal Jaworowski 		if (err)
763d1d3233eSRafal Jaworowski 			return (err);
764d1d3233eSRafal Jaworowski 	}
76508077f58SMarcel Moolenaar 
76608077f58SMarcel Moolenaar 	return (rman_release_resource(res));
76708077f58SMarcel Moolenaar }
76808077f58SMarcel Moolenaar 
769d1d3233eSRafal Jaworowski static const struct ofw_bus_devinfo *
770d1d3233eSRafal Jaworowski lbc_get_devinfo(device_t bus, device_t child)
77108077f58SMarcel Moolenaar {
772d1d3233eSRafal Jaworowski 	struct lbc_devinfo *di;
77308077f58SMarcel Moolenaar 
774d1d3233eSRafal Jaworowski 	di = device_get_ivars(child);
775d1d3233eSRafal Jaworowski 	return (&di->di_ofw);
77608077f58SMarcel Moolenaar }
777f6703dd2SMarcel Moolenaar 
778f6703dd2SMarcel Moolenaar void
779f6703dd2SMarcel Moolenaar lbc_write_reg(device_t child, u_int off, uint32_t val)
780f6703dd2SMarcel Moolenaar {
78123fbc06bSMarcel Moolenaar 	device_t dev;
782f6703dd2SMarcel Moolenaar 	struct lbc_softc *sc;
783f6703dd2SMarcel Moolenaar 
78423fbc06bSMarcel Moolenaar 	dev = device_get_parent(child);
78523fbc06bSMarcel Moolenaar 
78623fbc06bSMarcel Moolenaar 	if (off >= 0x1000) {
78723fbc06bSMarcel Moolenaar 		device_printf(dev, "%s(%s): invalid offset %#x\n",
78823fbc06bSMarcel Moolenaar 		    __func__, device_get_nameunit(child), off);
78923fbc06bSMarcel Moolenaar 		return;
79023fbc06bSMarcel Moolenaar 	}
79123fbc06bSMarcel Moolenaar 
79223fbc06bSMarcel Moolenaar 	sc = device_get_softc(dev);
79323fbc06bSMarcel Moolenaar 
79423fbc06bSMarcel Moolenaar 	if (off == LBC85XX_LTESR && sc->sc_ltesr != ~0u) {
79523fbc06bSMarcel Moolenaar 		sc->sc_ltesr ^= (val & sc->sc_ltesr);
79623fbc06bSMarcel Moolenaar 		return;
79723fbc06bSMarcel Moolenaar 	}
79823fbc06bSMarcel Moolenaar 
79923fbc06bSMarcel Moolenaar 	if (off == LBC85XX_LTEATR && (val & 1) == 0)
80023fbc06bSMarcel Moolenaar 		sc->sc_ltesr = ~0u;
801f6703dd2SMarcel Moolenaar 	bus_space_write_4(sc->sc_bst, sc->sc_bsh, off, val);
802f6703dd2SMarcel Moolenaar }
803f6703dd2SMarcel Moolenaar 
804f6703dd2SMarcel Moolenaar uint32_t
805f6703dd2SMarcel Moolenaar lbc_read_reg(device_t child, u_int off)
806f6703dd2SMarcel Moolenaar {
80723fbc06bSMarcel Moolenaar 	device_t dev;
808f6703dd2SMarcel Moolenaar 	struct lbc_softc *sc;
80923fbc06bSMarcel Moolenaar 	uint32_t val;
810f6703dd2SMarcel Moolenaar 
81123fbc06bSMarcel Moolenaar 	dev = device_get_parent(child);
81223fbc06bSMarcel Moolenaar 
81323fbc06bSMarcel Moolenaar 	if (off >= 0x1000) {
81423fbc06bSMarcel Moolenaar 		device_printf(dev, "%s(%s): invalid offset %#x\n",
81523fbc06bSMarcel Moolenaar 		    __func__, device_get_nameunit(child), off);
81623fbc06bSMarcel Moolenaar 		return (~0U);
81723fbc06bSMarcel Moolenaar 	}
81823fbc06bSMarcel Moolenaar 
81923fbc06bSMarcel Moolenaar 	sc = device_get_softc(dev);
82023fbc06bSMarcel Moolenaar 
82123fbc06bSMarcel Moolenaar 	if (off == LBC85XX_LTESR && sc->sc_ltesr != ~0U)
82223fbc06bSMarcel Moolenaar 		val = sc->sc_ltesr;
82323fbc06bSMarcel Moolenaar 	else
82423fbc06bSMarcel Moolenaar 		val = bus_space_read_4(sc->sc_bst, sc->sc_bsh, off);
82523fbc06bSMarcel Moolenaar 	return (val);
826f6703dd2SMarcel Moolenaar }
827