1/*	$NetBSD: rmixl_mainbus.c,v 1.3 2011/02/20 07:48:37 matt 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.3 2011/02/20 07:48:37 matt 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_ia(mainbus_search, self, "mainbus", mainbus_print);
95}
96
97static int
98mainbus_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
109static int
110mainbus_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
144static int
145mainbus_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_match(parent, cf, &ma) > 0)
153		config_attach(parent, cf, &ma, mainbus_print);
154
155	return 0;
156}
157
158