1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
|
/* $OpenBSD: uni_n.c,v 1.1 2001/09/01 15:50:00 drahn Exp $ */
/*
* Copyright (c) 1998-2001 Dale Rahn. All rights reserved.
*
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by Dale Rahn.
* 4. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#include <sys/param.h>
#include <sys/device.h>
#include <sys/systm.h>
#include <machine/bus.h>
#include <machine/autoconf.h>
#include <dev/ofw/openfirm.h>
static int memcmatch __P((struct device *, void *, void *));
static void memcattach __P((struct device *, struct device *, void *));
struct memc_softc {
struct device sc_dev;
char *baseaddr;
};
/* Driver definition */
struct cfdriver memc_cd = {
NULL, "memc", DV_DULL
};
/* Driver definition */
struct cfattach memc_ca = {
sizeof(struct memc_softc), memcmatch, memcattach
};
void *uni_n_config(int handle);
int
memcmatch(parent, cf, aux)
struct device *parent;
void *cf;
void *aux;
{
struct confargs *ca = aux;
static int memc_attached = 0;
/* allow only one instance */
if (memc_attached == 0) {
if (0 == strcmp (ca->ca_name, "memc")) {
return 1;
}
}
return 0;
}
static void
memcattach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
struct confargs *ca = aux;
int len;
char name[64];
struct memc_softc *sc = (struct memc_softc *)self;
len = OF_getprop(ca->ca_node, "name", name, sizeof name);
if (len > 0) {
name[len] = 0;
}
if (strcmp (name, "uni-n")== 0) {
sc->baseaddr = uni_n_config(ca->ca_node);
}
printf (": %s\n", name);
}
void *
uni_n_config(int handle)
{
char name[20];
char *baseaddr;
int *ctladdr;
u_int32_t address;
if (OF_getprop(handle, "name", name, sizeof name) > 0) {
/* sanity test */
if (!strcmp (name, "uni-n")) {
if (OF_getprop(handle, "reg", &address,
sizeof address) > 0) {
baseaddr = mapiodev(address, NBPG);
ctladdr = (void*)(baseaddr + 0x20);
*ctladdr |= 0x02;
}
return baseaddr;
}
}
return 0;
}
|