xel.c revision 1.13 1 /* $NetBSD: xel.c,v 1.13 2007/03/11 08:09:26 isaki Exp $ */
2
3 /*
4 * Copyright (c) 1998 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Minoura Makoto.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 * 3. All advertising materials mentioning features or use of this software
19 * must display the following acknowledgement:
20 * This product includes software developed by the NetBSD
21 * Foundation, Inc. and its contributors.
22 * 4. Neither the name of The NetBSD Foundation nor the names of its
23 * contributors may be used to endorse or promote products derived
24 * from this software without specific prior written permission.
25 *
26 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 * POSSIBILITY OF SUCH DAMAGE.
37 */
38
39 /*
40 * TSR Xellent30 driver.
41 * Detect Xellent30, and reserve its I/O area.
42 */
43
44 #include <sys/cdefs.h>
45 __KERNEL_RCSID(0, "$NetBSD: xel.c,v 1.13 2007/03/11 08:09:26 isaki Exp $");
46
47 #include <sys/param.h>
48 #include <sys/systm.h>
49 #include <sys/kernel.h>
50 #include <sys/device.h>
51
52 #include <machine/cpu.h>
53 #include <machine/bus.h>
54
55 #include <arch/x68k/dev/intiovar.h>
56
57 static paddr_t xel_addr(struct device *, struct cfdata *,
58 struct intio_attach_args *);
59 static int xel_probe(paddr_t);
60 static int xel_match(struct device *, struct cfdata *, void *);
61 static void xel_attach(struct device *, struct device *, void *);
62
63 struct xel_softc {
64 struct device dev;
65
66 bus_space_tag_t sc_bst;
67 bus_space_handle_t sc_bh;
68 };
69
70 CFATTACH_DECL(xel, sizeof(struct xel_softc),
71 xel_match, xel_attach, NULL, NULL);
72
73 static paddr_t xel_addrs[] = { 0xec0000, 0xec4000, 0xec8000, 0xecc000 };
74
75 #define XEL_MODE_RAM_LOWER 0x00
76 #define XEL_MODE_RAM_HIGHER 0x01
77 #define XEL_MODE_UNMAP_RAM 0x00
78 #define XEL_MODE_MAP_RAM 0x02
79 #define XEL_MODE_MPU_000 0x00
80 #define XEL_MODE_MPU_030 0x04
81
82 #define XEL_RAM_ADDR_LOWER 0xbc0000
83 #define XEL_RAM_ADDR_HIGHER 0xfc0000
84
85
86 static paddr_t
87 xel_addr(struct device *parent, struct cfdata *match,
88 struct intio_attach_args *ia)
89 {
90 paddr_t addr = 0;
91
92 if (match->cf_addr == INTIOCF_ADDR_DEFAULT) {
93 int i;
94
95 for (i = 0; i < sizeof(xel_addrs)/sizeof(xel_addrs[0]); i++) {
96 if (xel_probe(xel_addrs[i])) {
97 addr = xel_addrs[i];
98 break;
99 }
100 }
101 } else {
102 if (xel_probe((paddr_t) match->cf_addr))
103 addr = (paddr_t) match->cf_addr;
104 }
105
106 if (addr) {
107 /* found! */
108 ia->ia_addr = (int) addr;
109 ia->ia_size = 0x4000;
110 if (intio_map_allocate_region(parent, ia, INTIO_MAP_TESTONLY)
111 < 0)
112 return 0;
113 else
114 return addr;
115 }
116
117 return 0;
118 }
119
120 extern int *nofault;
121
122 static int
123 xel_probe(paddr_t addr)
124 {
125 u_int32_t b1, b2;
126 volatile u_int16_t *start = (volatile void *)INTIO_ADDR(addr);
127 label_t faultbuf;
128 volatile u_int32_t *sram = (volatile void *)INTIO_ADDR(XEL_RAM_ADDR_HIGHER);
129
130 if (badaddr(start))
131 return 0;
132
133 nofault = (int *) &faultbuf;
134 if (setjmp(&faultbuf)) {
135 nofault = NULL;
136 return 0;
137 }
138
139 b1 = sram[0];
140 b2 = sram[1];
141 /* Try to map the Xellent local memory. */
142 start[0] = XEL_MODE_RAM_HIGHER | XEL_MODE_MAP_RAM | XEL_MODE_MPU_030;
143
144 #if 0
145 /* the contents should be deferent. */
146 if (b1 == sram[0] && b2 == sram[1]) {
147 nofault = (int *) 0;
148 return 0;
149 }
150 #else
151 /* Try to write to the local memory. */
152 sram[0] = 0x55555555;
153 sram[1] = 0xaaaaaaaa;
154 if (sram[0] != 0x55555555 || sram[1] != 0xaaaaaaaa) {
155 sram[0] = b1;
156 sram[1] = b2;
157 nofault = (int *) 0;
158 return 0;
159 }
160 sram[0] = 0xaaaaaaaa;
161 sram[1] = 0x55555555;
162 if (sram[0] != 0xaaaaaaaa || sram[1] != 0x55555555) {
163 sram[0] = b1;
164 sram[1] = b2;
165 nofault = (int *) 0;
166 return 0;
167 }
168 sram[0] = b1;
169 sram[1] = b2;
170 #endif
171
172 /* Unmap. */
173 start[0] = XEL_MODE_UNMAP_RAM | XEL_MODE_MPU_030;
174
175 nofault = NULL;
176 return 1;
177 }
178
179 static int
180 xel_match(struct device *parent, struct cfdata *match, void *aux)
181 {
182 struct intio_attach_args *ia = aux;
183
184 if (strcmp(ia->ia_name, "xel") != 0)
185 return 0;
186
187 if (xel_addr(parent, match, ia)) {
188 #ifdef DIAGNOSTIC
189 if (cputype != CPU_68030)
190 panic("Non-030 Xellent???");
191 #endif
192 return 1;
193 }
194 return 0;
195 }
196
197 static void
198 xel_attach(struct device *parent, struct device *self, void *aux)
199 {
200 struct xel_softc *sc = (void *)self;
201 struct intio_attach_args *ia = aux;
202 struct cfdata *cf = device_cfdata(self);
203 paddr_t addr;
204 int r;
205
206 addr = xel_addr(parent, cf, aux);
207 sc->sc_bst = ia->ia_bst;
208 ia->ia_addr = (int) addr;
209 ia->ia_size = 0x4000;
210 r = intio_map_allocate_region(parent, ia, INTIO_MAP_ALLOCATE);
211 #ifdef DIAGNOSTIC
212 if (r)
213 panic("IO map for Xellent30 corruption??");
214 #endif
215 printf(": Xellent30 MPU Accelerator.\n");
216
217 return;
218 }
219