1 /* $NetBSD: rmixl_mainbus.c,v 1.8 2022/09/29 07:00:47 skrll 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.8 2022/09/29 07:00:47 skrll 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/device.h>
52
53 #include <evbmips/rmixl/autoconf.h>
54 #include <sys/bus.h>
55 #include "locators.h"
56
57 static int mainbusmatch(device_t, cfdata_t, void *);
58 static void mainbusattach(device_t, device_t, void *);
59 static int mainbus_node_alloc(struct mainbus_softc *, int);
60 static int mainbus_search(device_t, cfdata_t, const int *, void *);
61 static int mainbus_print(void *, const char *);
62
63 CFATTACH_DECL_NEW(mainbus, sizeof(struct mainbus_softc),
64 mainbusmatch, mainbusattach, NULL, NULL);
65
66 static int mainbus_found;
67
68 static int
mainbusmatch(device_t parent,cfdata_t cf,void * aux)69 mainbusmatch(device_t parent, cfdata_t cf, void *aux)
70 {
71 if (mainbus_found)
72 return 0;
73 return 1;
74 }
75
76 static void
mainbusattach(device_t parent,device_t self,void * aux)77 mainbusattach(device_t parent, device_t self, void *aux)
78 {
79 struct mainbus_softc *sc = device_private(self);
80
81 aprint_naive("\n");
82 aprint_normal("\n");
83
84 sc->sc_dev = self;
85 sc->sc_node_next = 0;
86 sc->sc_node_mask = 0;
87
88 mainbus_found = 1;
89
90 /*
91 * attach mainbus devices
92 */
93 config_search(self, NULL,
94 CFARGS(.search = mainbus_search));
95 }
96
97 static int
mainbus_print(void * aux,const char * pnp)98 mainbus_print(void *aux, const char *pnp)
99 {
100 struct mainbus_attach_args *ma = aux;
101
102 if (pnp != NULL)
103 aprint_normal("%s:", pnp);
104 aprint_normal(" node %d", ma->ma_node);
105
106 return (UNCONF);
107 }
108
109 static int
mainbus_node_alloc(struct mainbus_softc * sc,int node)110 mainbus_node_alloc(struct mainbus_softc *sc, int node)
111 {
112 uint64_t bit;
113
114 if (node == MAINBUSCF_NODE_DEFAULT) {
115 for (node=sc->sc_node_next; node < 64; node++) {
116 bit = 1 << node;
117 if ((sc->sc_node_mask & bit) == 0) {
118 sc->sc_node_mask |= bit;
119 sc->sc_node_next = node + 1;
120 return node;
121 }
122 }
123 panic("%s: node mask underflow", __func__);
124 } else {
125 if (node >= 64)
126 panic("%s: node >= 64", __func__);
127 if (node < 0)
128 panic("%s: bad node %d", __func__, node);
129 bit = 1 << node;
130 if ((sc->sc_node_mask & bit) == 0) {
131 sc->sc_node_mask |= bit;
132 sc->sc_node_next = node + 1;
133 return node;
134 } else {
135 panic("%s: node %d already used\n",
136 __func__, node);
137 }
138 }
139
140 /*NOTREACHED*/
141 return -1; /* as if */
142 }
143
144 static int
mainbus_search(device_t parent,cfdata_t cf,const int * ldesc,void * aux)145 mainbus_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
146 {
147 struct mainbus_softc *sc = device_private(parent);
148 struct mainbus_attach_args ma;
149
150 ma.ma_node = mainbus_node_alloc(sc, cf->cf_loc[MAINBUSCF_NODE]);
151
152 if (config_probe(parent, cf, &ma))
153 config_attach(parent, cf, &ma, mainbus_print, CFARGS_NONE);
154
155 return 0;
156 }
157
158