vrdsu.c revision 1.6 1 1.6 thorpej /* $NetBSD: vrdsu.c,v 1.6 2002/10/02 05:26:55 thorpej Exp $ */
2 1.1 takemura
3 1.1 takemura /*
4 1.1 takemura * Copyright (c) 1999 Shin Takemura All rights reserved.
5 1.1 takemura * Copyright (c) 1999 PocketBSD Project. All rights reserved.
6 1.1 takemura *
7 1.1 takemura * Redistribution and use in source and binary forms, with or without
8 1.1 takemura * modification, are permitted provided that the following conditions
9 1.1 takemura * are met:
10 1.1 takemura * 1. Redistributions of source code must retain the above copyright
11 1.1 takemura * notice, this list of conditions and the following disclaimer.
12 1.1 takemura * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 takemura * notice, this list of conditions and the following disclaimer in the
14 1.1 takemura * documentation and/or other materials provided with the distribution.
15 1.1 takemura *
16 1.1 takemura * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 1.1 takemura * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 takemura * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 takemura * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.1 takemura * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 takemura * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 takemura * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 takemura * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 takemura * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 takemura * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 takemura * SUCH DAMAGE.
27 1.1 takemura */
28 1.1 takemura
29 1.1 takemura #include <sys/param.h>
30 1.1 takemura #include <sys/systm.h>
31 1.1 takemura #include <sys/device.h>
32 1.1 takemura
33 1.1 takemura #include <machine/bus.h>
34 1.1 takemura
35 1.4 takemura #include <hpcmips/vr/vripif.h>
36 1.1 takemura #include <hpcmips/vr/dsureg.h>
37 1.1 takemura #include <hpcmips/vr/vrdsuvar.h>
38 1.1 takemura
39 1.1 takemura struct vrdsu_softc {
40 1.1 takemura struct device sc_dev;
41 1.1 takemura bus_space_tag_t sc_iot;
42 1.1 takemura bus_space_handle_t sc_ioh;
43 1.1 takemura };
44 1.1 takemura
45 1.3 uch static int vrdsumatch(struct device *, struct cfdata *, void *);
46 1.3 uch static void vrdsuattach(struct device *, struct device *, void *);
47 1.1 takemura
48 1.3 uch static void vrdsu_write(struct vrdsu_softc *, int, unsigned short);
49 1.3 uch static unsigned short vrdsu_read(struct vrdsu_softc *, int);
50 1.1 takemura
51 1.6 thorpej CFATTACH_DECL(vrdsu, sizeof(struct vrdsu_softc),
52 1.6 thorpej vrdsumatch, vrdsuattach, NULL, NULL);
53 1.1 takemura
54 1.1 takemura struct vrdsu_softc *the_dsu_sc = NULL;
55 1.1 takemura
56 1.1 takemura static inline void
57 1.3 uch vrdsu_write(struct vrdsu_softc *sc, int port, unsigned short val)
58 1.1 takemura {
59 1.3 uch
60 1.1 takemura bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val);
61 1.1 takemura }
62 1.1 takemura
63 1.1 takemura static inline unsigned short
64 1.3 uch vrdsu_read(struct vrdsu_softc *sc, int port)
65 1.1 takemura {
66 1.3 uch
67 1.3 uch return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, port));
68 1.1 takemura }
69 1.1 takemura
70 1.1 takemura static int
71 1.3 uch vrdsumatch(struct device *parent, struct cfdata *cf, void *aux)
72 1.1 takemura {
73 1.3 uch
74 1.3 uch return (1);
75 1.1 takemura }
76 1.1 takemura
77 1.1 takemura static void
78 1.3 uch vrdsuattach(struct device *parent, struct device *self, void *aux)
79 1.1 takemura {
80 1.1 takemura struct vrdsu_softc *sc = (struct vrdsu_softc *)self;
81 1.1 takemura struct vrip_attach_args *va = aux;
82 1.1 takemura
83 1.2 sato sc->sc_iot = va->va_iot;
84 1.1 takemura if (bus_space_map(va->va_iot, va->va_addr, va->va_size,
85 1.3 uch 0, &sc->sc_ioh)) {
86 1.1 takemura printf(": can't map bus space\n");
87 1.1 takemura return;
88 1.1 takemura }
89 1.1 takemura printf("\n");
90 1.1 takemura the_dsu_sc = sc;
91 1.1 takemura }
92 1.1 takemura
93 1.1 takemura void
94 1.1 takemura vrdsu_reset()
95 1.1 takemura {
96 1.3 uch
97 1.1 takemura if (the_dsu_sc) {
98 1.1 takemura splhigh();
99 1.1 takemura vrdsu_write(the_dsu_sc, DSUSET_REG_W, 1); /* 1 sec */
100 1.1 takemura vrdsu_write(the_dsu_sc, DSUCNT_REG_W, DSUCNT_DSWEN);
101 1.1 takemura while (1);
102 1.1 takemura } else {
103 1.1 takemura printf("%s(%d): There is no DSU.", __FILE__, __LINE__);
104 1.1 takemura }
105 1.1 takemura }
106