leo.c revision 1.11 1 1.11 christos /* $NetBSD: leo.c,v 1.11 2007/03/04 05:59:41 christos Exp $ */
2 1.1 leo
3 1.1 leo /*-
4 1.1 leo * Copyright (c) 1997 maximum entropy <entropy (at) zippy.bernstein.com>
5 1.1 leo * Copyright (c) 1997 The NetBSD Foundation, Inc.
6 1.1 leo * All rights reserved.
7 1.1 leo *
8 1.1 leo * Redistribution and use in source and binary forms, with or without
9 1.1 leo * modification, are permitted provided that the following conditions
10 1.1 leo * are met:
11 1.1 leo * 1. Redistributions of source code must retain the above copyright
12 1.1 leo * notice, this list of conditions and the following disclaimer.
13 1.1 leo * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 leo * notice, this list of conditions and the following disclaimer in the
15 1.1 leo * documentation and/or other materials provided with the distribution.
16 1.1 leo * 3. All advertising materials mentioning features or use of this software
17 1.1 leo * must display the following acknowledgement:
18 1.1 leo * This product includes software developed by the NetBSD
19 1.1 leo * Foundation, Inc. and its contributors.
20 1.1 leo * 4. Neither the name of The NetBSD Foundation nor the names of its
21 1.1 leo * contributors may be used to endorse or promote products derived
22 1.1 leo * from this software without specific prior written permission.
23 1.1 leo *
24 1.1 leo * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
25 1.1 leo * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
26 1.1 leo * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
27 1.1 leo * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
28 1.1 leo * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 1.1 leo * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 1.1 leo * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 1.1 leo * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 1.1 leo * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 1.1 leo * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34 1.1 leo * POSSIBILITY OF SUCH DAMAGE.
35 1.1 leo */
36 1.1 leo
37 1.1 leo /*
38 1.1 leo * Driver for the Circad Leonardo 1.2 from Lexicor, a 24-bit true color
39 1.1 leo * VME graphics card based on the Texas Instruments TMS34061.
40 1.1 leo *
41 1.1 leo * Written by maximum entropy <entropy (at) zippy.bernstein.com>, December 5, 1997.
42 1.1 leo *
43 1.1 leo * This driver was written from scratch, but I referred to several other
44 1.1 leo * drivers in the NetBSD distribution as examples. The file I referred to
45 1.1 leo * the most was /sys/arch/atari/vme/if_le_vme.c. Due credits:
46 1.1 leo * Copyright (c) 1997 Leo Weppelman. All rights reserved.
47 1.1 leo * Copyright (c) 1995 Charles M. Hannum. All rights reserved.
48 1.1 leo * Copyright (c) 1992, 1993
49 1.1 leo * The Regents of the University of California. All rights reserved.
50 1.1 leo * This code is derived from software contributed to Berkeley by
51 1.1 leo * Ralph Campbell and Rick Macklem.
52 1.1 leo * This product includes software developed by the University of
53 1.1 leo * California, Berkeley and its contributors.
54 1.1 leo */
55 1.9 lukem
56 1.9 lukem #include <sys/cdefs.h>
57 1.11 christos __KERNEL_RCSID(0, "$NetBSD: leo.c,v 1.11 2007/03/04 05:59:41 christos Exp $");
58 1.1 leo
59 1.1 leo #include <sys/param.h>
60 1.1 leo #include <sys/systm.h>
61 1.1 leo #include <sys/proc.h>
62 1.1 leo #include <sys/errno.h>
63 1.1 leo #include <sys/device.h>
64 1.1 leo #include <sys/conf.h>
65 1.1 leo #include <sys/ioctl.h>
66 1.1 leo #include <machine/cpu.h>
67 1.1 leo #include <machine/bus.h>
68 1.1 leo #include <machine/iomap.h>
69 1.1 leo #include <machine/scu.h>
70 1.1 leo #include <atari/vme/vmevar.h>
71 1.1 leo #include <atari/vme/leovar.h>
72 1.1 leo #include <atari/vme/leoioctl.h>
73 1.1 leo
74 1.1 leo static struct leo_addresses {
75 1.1 leo u_long reg_addr;
76 1.1 leo u_int reg_size;
77 1.1 leo u_long mem_addr;
78 1.1 leo u_int mem_size;
79 1.1 leo } leostd[] = {
80 1.1 leo { 0xfed90000, 0x100, 0xfec00000, 0x100000 }
81 1.1 leo };
82 1.1 leo
83 1.1 leo #define NLEOSTD (sizeof(leostd) / sizeof(leostd[0]))
84 1.1 leo
85 1.1 leo struct leo_softc {
86 1.1 leo struct device sc_dev; /* XXX what goes here? */
87 1.1 leo bus_space_tag_t sc_iot;
88 1.1 leo bus_space_tag_t sc_memt;
89 1.1 leo bus_space_handle_t sc_ioh;
90 1.1 leo bus_space_handle_t sc_memh;
91 1.1 leo int sc_flags;
92 1.1 leo int sc_maddr;
93 1.1 leo u_int sc_msize;
94 1.1 leo };
95 1.1 leo
96 1.1 leo #define LEO_SC_FLAGS_INUSE 1
97 1.1 leo
98 1.1 leo static int leo_match __P((struct device *, struct cfdata *, void *));
99 1.1 leo static void leo_attach __P((struct device *, struct device *, void *));
100 1.1 leo static int leo_probe __P((bus_space_tag_t *, bus_space_tag_t *,
101 1.1 leo bus_space_handle_t *, bus_space_handle_t *,
102 1.1 leo u_int, u_int));
103 1.1 leo static int leo_init __P((struct leo_softc *, int));
104 1.1 leo static int leo_scroll __P((struct leo_softc *, int));
105 1.1 leo
106 1.7 thorpej CFATTACH_DECL(leo, sizeof(struct leo_softc),
107 1.7 thorpej leo_match, leo_attach, NULL, NULL);
108 1.1 leo
109 1.1 leo extern struct cfdriver leo_cd;
110 1.1 leo
111 1.4 gehenna dev_type_open(leoopen);
112 1.4 gehenna dev_type_close(leoclose);
113 1.4 gehenna dev_type_read(leomove);
114 1.4 gehenna dev_type_ioctl(leoioctl);
115 1.4 gehenna dev_type_mmap(leommap);
116 1.4 gehenna
117 1.4 gehenna const struct cdevsw leo_cdevsw = {
118 1.4 gehenna leoopen, leoclose, leomove, leomove, leoioctl,
119 1.8 jdolecek nostop, notty, nopoll, leommap, nokqfilter,
120 1.4 gehenna };
121 1.4 gehenna
122 1.1 leo static int
123 1.1 leo leo_match(parent, cfp, aux)
124 1.1 leo struct device *parent;
125 1.1 leo struct cfdata *cfp;
126 1.1 leo void *aux;
127 1.1 leo {
128 1.1 leo struct vme_attach_args *va = aux;
129 1.1 leo int i;
130 1.1 leo bus_space_tag_t iot;
131 1.1 leo bus_space_tag_t memt;
132 1.1 leo bus_space_handle_t ioh;
133 1.1 leo bus_space_handle_t memh;
134 1.1 leo
135 1.1 leo /*
136 1.1 leo * We are passed our configuration in the attachment arguments.
137 1.1 leo * The configuration information may be partially unspecified.
138 1.1 leo * For any unspecified configuration parameters, we fill in those
139 1.1 leo * parameters with data for a "standard" configuration.
140 1.1 leo * Once we have a fully specified configuration, we try to probe
141 1.1 leo * a card with that configuration.
142 1.1 leo * The Leonardo only has one configuration and it isn't likely
143 1.1 leo * to change, but this routine doesn't assume that's the case.
144 1.1 leo */
145 1.1 leo iot = va->va_iot;
146 1.1 leo memt = va->va_memt;
147 1.1 leo for (i = 0; i < NLEOSTD; i++) {
148 1.1 leo struct leo_addresses *leo_ap = &leostd[i];
149 1.1 leo int found = 0;
150 1.1 leo struct vme_attach_args vat = *va;
151 1.1 leo
152 1.1 leo if (vat.va_irq != VMECF_IRQ_DEFAULT) {
153 1.1 leo printf("leo_match: config error: no irq support\n");
154 1.1 leo return 0;
155 1.1 leo }
156 1.1 leo if (vat.va_iobase == VMECF_IOPORT_DEFAULT)
157 1.1 leo vat.va_iobase = leo_ap->reg_addr;
158 1.1 leo if (vat.va_maddr == VMECF_MEM_DEFAULT)
159 1.1 leo vat.va_maddr = leo_ap->mem_addr;
160 1.1 leo if (vat.va_iosize == VMECF_IOSIZE_DEFAULT)
161 1.1 leo vat.va_iosize = leo_ap->reg_size;
162 1.1 leo if (vat.va_msize == VMECF_MEMSIZ_DEFAULT)
163 1.1 leo vat.va_msize = leo_ap->mem_size;
164 1.1 leo if (bus_space_map(iot, vat.va_iobase, vat.va_iosize, 0, &ioh)) {
165 1.1 leo printf("leo_match: cannot map io area\n");
166 1.1 leo return 0;
167 1.1 leo }
168 1.1 leo if (bus_space_map(memt, vat.va_maddr, vat.va_msize,
169 1.1 leo BUS_SPACE_MAP_LINEAR|BUS_SPACE_MAP_CACHEABLE,
170 1.1 leo &memh)) {
171 1.2 leo bus_space_unmap(iot, ioh, vat.va_iosize);
172 1.1 leo printf("leo_match: cannot map memory area\n");
173 1.1 leo return 0;
174 1.1 leo }
175 1.1 leo found = leo_probe(&iot, &memt, &ioh, &memh,
176 1.1 leo vat.va_iosize, vat.va_msize);
177 1.2 leo bus_space_unmap(iot, ioh, vat.va_iosize);
178 1.2 leo bus_space_unmap(memt, memh, vat.va_msize);
179 1.1 leo if (found) {
180 1.1 leo *va = vat;
181 1.1 leo return 1;
182 1.1 leo }
183 1.1 leo }
184 1.1 leo return 0;
185 1.1 leo }
186 1.1 leo
187 1.1 leo static int
188 1.1 leo leo_probe(iot, memt, ioh, memh, iosize, msize)
189 1.1 leo bus_space_tag_t *iot, *memt;
190 1.1 leo bus_space_handle_t *ioh, *memh;
191 1.1 leo u_int iosize, msize;
192 1.1 leo {
193 1.1 leo
194 1.1 leo /* Test that our highest register is within the io range. */
195 1.1 leo if (0xca > iosize) /* XXX */
196 1.1 leo return 0;
197 1.1 leo /* Test if we can peek each register. */
198 1.1 leo if (!bus_space_peek_1(*iot, *ioh, LEO_REG_MSBSCROLL))
199 1.1 leo return 0;
200 1.1 leo if (!bus_space_peek_1(*iot, *ioh, LEO_REG_LSBSCROLL))
201 1.1 leo return 0;
202 1.1 leo /*
203 1.1 leo * Write a test pattern at the start and end of the memory region,
204 1.1 leo * and test if the pattern can be read back. If so, the region is
205 1.1 leo * backed by memory (i.e. the card is present).
206 1.1 leo * On the Leonardo, the first byte of each longword isn't backed by
207 1.1 leo * physical memory, so we only compare the three low-order bytes
208 1.1 leo * with the test pattern.
209 1.1 leo */
210 1.1 leo bus_space_write_4(*memt, *memh, 0, 0xa5a5a5a5);
211 1.1 leo if ((bus_space_read_4(*memt, *memh, 0) & 0xffffff) != 0xa5a5a5)
212 1.1 leo return 0;
213 1.1 leo bus_space_write_4(*memt, *memh, msize - 4, 0xa5a5a5a5);
214 1.1 leo if ((bus_space_read_4(*memt, *memh, msize - 4) & 0xffffff)
215 1.1 leo != 0xa5a5a5)
216 1.1 leo return 0;
217 1.1 leo return 1;
218 1.1 leo }
219 1.1 leo
220 1.1 leo static void
221 1.1 leo leo_attach(parent, self, aux)
222 1.1 leo struct device *parent, *self;
223 1.1 leo void *aux;
224 1.1 leo {
225 1.1 leo struct leo_softc *sc = (struct leo_softc *)self;
226 1.1 leo struct vme_attach_args *va = aux;
227 1.1 leo bus_space_handle_t ioh;
228 1.1 leo bus_space_handle_t memh;
229 1.1 leo #ifndef SET_REGION
230 1.1 leo int i;
231 1.1 leo #endif
232 1.1 leo
233 1.1 leo printf("\n");
234 1.1 leo if (bus_space_map(va->va_iot, va->va_iobase, va->va_iosize, 0, &ioh))
235 1.5 provos panic("leo_attach: cannot map io area");
236 1.1 leo if (bus_space_map(va->va_memt, va->va_maddr, va->va_msize,
237 1.1 leo BUS_SPACE_MAP_LINEAR|BUS_SPACE_MAP_CACHEABLE, &memh))
238 1.5 provos panic("leo_attach: cannot map memory area");
239 1.1 leo #ifdef SET_REGION /* XXX seems to be unimplemented on atari? */
240 1.1 leo bus_space_set_region_4(va->va_memt, memh, 0, 0, va->va_msize >> 2);
241 1.1 leo #else
242 1.1 leo for (i = 0; i < (va->va_msize >> 2); i++)
243 1.1 leo bus_space_write_4(va->va_memt, memh, i << 2, 0);
244 1.1 leo #endif
245 1.1 leo sc->sc_iot = va->va_iot;
246 1.1 leo sc->sc_ioh = ioh;
247 1.1 leo sc->sc_memt = va->va_memt;
248 1.1 leo sc->sc_memh = memh;
249 1.1 leo sc->sc_flags = 0;
250 1.1 leo sc->sc_maddr = va->va_maddr;
251 1.1 leo sc->sc_msize = va->va_msize;
252 1.1 leo leo_init(sc, 512);
253 1.1 leo leo_scroll(sc, 0);
254 1.1 leo }
255 1.1 leo
256 1.1 leo int
257 1.1 leo leoopen(dev, flags, devtype, p)
258 1.1 leo dev_t dev;
259 1.1 leo int flags, devtype;
260 1.1 leo struct proc *p;
261 1.1 leo {
262 1.1 leo int unit = minor(dev);
263 1.1 leo struct leo_softc *sc;
264 1.1 leo int r;
265 1.1 leo
266 1.1 leo if (unit >= leo_cd.cd_ndevs)
267 1.1 leo return ENXIO;
268 1.1 leo sc = leo_cd.cd_devs[unit];
269 1.1 leo if (!sc)
270 1.1 leo return ENXIO;
271 1.1 leo if (sc->sc_flags & LEO_SC_FLAGS_INUSE)
272 1.1 leo return EBUSY;
273 1.1 leo r = leo_init(sc, 512);
274 1.1 leo if (r != 0)
275 1.1 leo return r;
276 1.1 leo r = leo_scroll(sc, 0);
277 1.1 leo if (r != 0)
278 1.1 leo return r;
279 1.1 leo sc->sc_flags |= LEO_SC_FLAGS_INUSE;
280 1.1 leo return 0;
281 1.1 leo }
282 1.1 leo
283 1.1 leo static int
284 1.1 leo leo_init(sc, ysize)
285 1.1 leo struct leo_softc *sc;
286 1.1 leo int ysize;
287 1.1 leo {
288 1.1 leo
289 1.1 leo if ((ysize != 256) && (ysize != 384) && (ysize != 512))
290 1.1 leo return EINVAL;
291 1.1 leo /* XXX */
292 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x00, 0x6);
293 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x08, 0x0);
294 1.1 leo if (ysize == 384)
295 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x10, 0x10);
296 1.1 leo else
297 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x10, 0x11);
298 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x18, 0x0);
299 1.1 leo if (ysize == 384)
300 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x20, 0x50);
301 1.1 leo else
302 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x20, 0x51);
303 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x28, 0x0);
304 1.1 leo if (ysize == 384)
305 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x30, 0x56);
306 1.1 leo else
307 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x30, 0x57);
308 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x38, 0x0);
309 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x40, 0x6);
310 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x48, 0x0);
311 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x50, 0x25);
312 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x58, 0x0);
313 1.1 leo if (ysize == 256) {
314 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x60, 0x1f);
315 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x68, 0x1);
316 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x70, 0x29);
317 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x78, 0x1);
318 1.1 leo } else if (ysize == 384) {
319 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x60, 0xa5);
320 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x68, 0x1);
321 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x70, 0xa7);
322 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x78, 0x1);
323 1.1 leo } else {
324 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x60, 0x1d);
325 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x68, 0x2);
326 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x70, 0x27);
327 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x78, 0x2);
328 1.1 leo }
329 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0xb8, 0x10);
330 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0xb0, 0x10);
331 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0x80, 0x4);
332 1.1 leo if (ysize == 384)
333 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0xc8, 0x21);
334 1.1 leo else
335 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0xc8, 0x20);
336 1.1 leo bus_space_write_2(sc->sc_iot, sc->sc_ioh, 0xc0, 0x40);
337 1.1 leo return 0;
338 1.1 leo }
339 1.1 leo
340 1.1 leo static int
341 1.1 leo leo_scroll(sc, scroll)
342 1.1 leo struct leo_softc *sc;
343 1.1 leo int scroll;
344 1.1 leo {
345 1.1 leo
346 1.1 leo if ((scroll < 0) || (scroll > 255))
347 1.1 leo return EINVAL;
348 1.1 leo bus_space_write_1(sc->sc_iot, sc->sc_ioh, LEO_REG_MSBSCROLL,
349 1.1 leo (scroll >> 6) && 0xff);
350 1.1 leo bus_space_write_1(sc->sc_iot, sc->sc_ioh, LEO_REG_LSBSCROLL,
351 1.1 leo (scroll << 2) && 0xff);
352 1.1 leo return 0;
353 1.1 leo }
354 1.1 leo
355 1.1 leo int
356 1.1 leo leoclose(dev, flags, devtype, p)
357 1.1 leo dev_t dev;
358 1.1 leo int flags, devtype;
359 1.1 leo struct proc *p;
360 1.1 leo {
361 1.1 leo struct leo_softc *sc;
362 1.1 leo
363 1.1 leo sc = leo_cd.cd_devs[minor(dev)];
364 1.1 leo sc->sc_flags &= ~LEO_SC_FLAGS_INUSE;
365 1.1 leo return 0;
366 1.1 leo }
367 1.1 leo
368 1.1 leo #define SMALLBSIZE 32
369 1.1 leo
370 1.4 gehenna int
371 1.1 leo leomove(dev, uio, flags)
372 1.1 leo dev_t dev;
373 1.1 leo struct uio *uio;
374 1.1 leo int flags;
375 1.1 leo {
376 1.1 leo struct leo_softc *sc;
377 1.1 leo int length, size, error;
378 1.1 leo u_int8_t smallbuf[SMALLBSIZE];
379 1.1 leo off_t offset;
380 1.1 leo
381 1.1 leo sc = leo_cd.cd_devs[minor(dev)];
382 1.1 leo if (uio->uio_offset > sc->sc_msize)
383 1.1 leo return 0;
384 1.1 leo length = sc->sc_msize - uio->uio_offset;
385 1.1 leo if (length > uio->uio_resid)
386 1.1 leo length = uio->uio_resid;
387 1.1 leo while (length > 0) {
388 1.1 leo size = length;
389 1.1 leo if (size > SMALLBSIZE)
390 1.1 leo size = SMALLBSIZE;
391 1.1 leo length -= size;
392 1.1 leo offset = uio->uio_offset;
393 1.1 leo if (uio->uio_rw == UIO_READ)
394 1.1 leo bus_space_read_region_1(sc->sc_memt, sc->sc_memh,
395 1.1 leo offset, smallbuf, size);
396 1.11 christos if ((error = uiomove((void *)smallbuf, size, uio)))
397 1.1 leo return (error);
398 1.1 leo if (uio->uio_rw == UIO_WRITE)
399 1.1 leo bus_space_write_region_1(sc->sc_memt, sc->sc_memh,
400 1.1 leo offset, smallbuf, size);
401 1.1 leo }
402 1.1 leo return 0;
403 1.1 leo }
404 1.1 leo
405 1.1 leo int
406 1.1 leo leoioctl(dev, cmd, data, flags, p)
407 1.1 leo dev_t dev;
408 1.1 leo u_long cmd;
409 1.11 christos void *data;
410 1.1 leo int flags;
411 1.1 leo struct proc *p;
412 1.1 leo {
413 1.1 leo struct leo_softc *sc;
414 1.1 leo
415 1.1 leo sc = leo_cd.cd_devs[minor(dev)];
416 1.1 leo switch (cmd) {
417 1.1 leo case LIOCYRES:
418 1.1 leo return leo_init(sc, *(int *)data);
419 1.1 leo break;
420 1.1 leo case LIOCSCRL:
421 1.1 leo return leo_scroll(sc, *(int *)data);
422 1.1 leo break;
423 1.1 leo default:
424 1.1 leo return EINVAL;
425 1.1 leo break;
426 1.1 leo }
427 1.1 leo }
428 1.1 leo
429 1.3 simonb paddr_t
430 1.1 leo leommap(dev, offset, prot)
431 1.1 leo dev_t dev;
432 1.3 simonb off_t offset;
433 1.1 leo int prot;
434 1.1 leo {
435 1.1 leo struct leo_softc *sc;
436 1.1 leo
437 1.1 leo sc = leo_cd.cd_devs[minor(dev)];
438 1.1 leo if (offset >= 0 && offset < sc->sc_msize)
439 1.1 leo return m68k_btop(sc->sc_maddr + offset);
440 1.1 leo return -1;
441 1.1 leo }
442