rmixl_mainbus.c revision 1.6 
1/*	$NetBSD: rmixl_mainbus.c,v 1.6 2021/08/07 16:18:59 thorpej Exp $	*/
2
3/*
4 * Copyright (c) 1994,1995 Mark Brinicombe.
5 * Copyright (c) 1994 Brini.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 *    notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 *    notice, this list of conditions and the following disclaimer in the
15 *    documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 *    must display the following acknowledgement:
18 *	This product includes software developed by Brini.
19 * 4. The name of the company nor the name of the author may be used to
20 *    endorse or promote products derived from this software without specific
21 *    prior written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY BRINI ``AS IS'' AND ANY EXPRESS OR IMPLIED
24 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
25 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 * IN NO EVENT SHALL BRINI OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
27 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
28 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
29 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33 * SUCH DAMAGE.
34 *
35 * RiscBSD kernel project
36 *
37 * mainbus.c
38 *
39 * mainbus configuration
40 *
41 * Created      : 15/12/94
42 */
43
44#include <sys/cdefs.h>
45__KERNEL_RCSID(0, "$NetBSD: rmixl_mainbus.c,v 1.6 2021/08/07 16:18:59 thorpej Exp $");
46
47#include <sys/param.h>
48#include <sys/systm.h>
49#include <sys/kernel.h>
50#include <sys/conf.h>
51#include <sys/malloc.h>
52#include <sys/device.h>
53
54#include <evbmips/rmixl/autoconf.h>
55#include <sys/bus.h>
56#include "locators.h"
57
58static int  mainbusmatch(device_t,  cfdata_t, void *);
59static void mainbusattach(device_t,  device_t,  void *);
60static int  mainbus_node_alloc(struct mainbus_softc *, int);
61static int  mainbus_search(device_t, cfdata_t, const int *, void *);
62static int  mainbus_print(void *, const char *);
63
64CFATTACH_DECL_NEW(mainbus, sizeof(struct mainbus_softc),
65	mainbusmatch, mainbusattach, NULL, NULL);
66
67static int mainbus_found;
68
69static int
70mainbusmatch(device_t parent, cfdata_t cf, void *aux)
71{
72	if (mainbus_found)
73		return 0;
74	return 1;
75}
76
77static void
78mainbusattach(device_t parent, device_t self, void *aux)
79{
80	struct mainbus_softc *sc = device_private(self);
81
82	aprint_naive("\n");
83	aprint_normal("\n");
84
85	sc->sc_dev = self;
86	sc->sc_node_next = 0;
87	sc->sc_node_mask = 0;
88
89	mainbus_found = 1;
90
91	/*
92	 * attach mainbus devices
93	 */
94	config_search(self, NULL,
95	    CFARGS(.search = mainbus_search));
96}
97
98static int
99mainbus_print(void *aux, const char *pnp)
100{
101	struct mainbus_attach_args *ma = aux;
102
103	if (pnp != NULL)
104		aprint_normal("%s:", pnp);
105	aprint_normal(" node %d", ma->ma_node);
106
107	return (UNCONF);
108}
109
110static int
111mainbus_node_alloc(struct mainbus_softc *sc, int node)
112{
113	uint64_t bit;
114
115	if (node == MAINBUSCF_NODE_DEFAULT) {
116		for (node=sc->sc_node_next; node < 64; node++) {
117			bit = 1 << node;
118			if ((sc->sc_node_mask & bit) == 0) {
119				sc->sc_node_mask |= bit;
120				sc->sc_node_next = node + 1;
121				return node;
122			}
123		}
124		panic("%s: node mask underflow", __func__);
125	} else {
126		if (node >= 64)
127			panic("%s: node >= 64", __func__);
128		if (node < 0)
129			panic("%s: bad node %d", __func__, node);
130		bit = 1 << node;
131		if ((sc->sc_node_mask & bit) == 0) {
132			sc->sc_node_mask |= bit;
133			sc->sc_node_next = node + 1;
134			return node;
135		} else {
136			panic("%s: node %d already used\n",
137				__func__, node);
138		}
139	}
140
141	/*NOTREACHED*/
142	return -1;	/* as if */
143}
144
145static int
146mainbus_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
147{
148	struct mainbus_softc *sc = device_private(parent);
149	struct mainbus_attach_args ma;
150
151	ma.ma_node = mainbus_node_alloc(sc, cf->cf_loc[MAINBUSCF_NODE]);
152
153	if (config_probe(parent, cf, &ma))
154		config_attach(parent, cf, &ma, mainbus_print, CFARGS_NONE);
155
156	return 0;
157}
158
159