mediabay.c revision 1.6 1 1.6 thorpej /* $NetBSD: mediabay.c,v 1.6 2002/10/02 05:30:42 thorpej Exp $ */
2 1.1 tsubai
3 1.1 tsubai /*-
4 1.1 tsubai * Copyright (C) 1999 Tsubai Masanari. All rights reserved.
5 1.1 tsubai *
6 1.1 tsubai * Redistribution and use in source and binary forms, with or without
7 1.1 tsubai * modification, are permitted provided that the following conditions
8 1.1 tsubai * are met:
9 1.1 tsubai * 1. Redistributions of source code must retain the above copyright
10 1.1 tsubai * notice, this list of conditions and the following disclaimer.
11 1.1 tsubai * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 tsubai * notice, this list of conditions and the following disclaimer in the
13 1.1 tsubai * documentation and/or other materials provided with the distribution.
14 1.1 tsubai * 3. The name of the author may not be used to endorse or promote products
15 1.1 tsubai * derived from this software without specific prior written permission.
16 1.1 tsubai *
17 1.1 tsubai * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 1.1 tsubai * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 1.1 tsubai * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 1.1 tsubai * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 1.1 tsubai * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 1.1 tsubai * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 1.1 tsubai * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 1.1 tsubai * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 1.1 tsubai * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
26 1.1 tsubai * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 1.1 tsubai */
28 1.1 tsubai
29 1.1 tsubai #include <sys/param.h>
30 1.2 tsubai #include <sys/device.h>
31 1.2 tsubai #include <sys/kernel.h>
32 1.2 tsubai #include <sys/kthread.h>
33 1.1 tsubai #include <sys/systm.h>
34 1.2 tsubai
35 1.2 tsubai #include <dev/ofw/openfirm.h>
36 1.1 tsubai
37 1.1 tsubai #include <machine/autoconf.h>
38 1.1 tsubai #include <machine/pio.h>
39 1.1 tsubai
40 1.1 tsubai struct mediabay_softc {
41 1.1 tsubai struct device sc_dev;
42 1.1 tsubai int sc_node;
43 1.1 tsubai u_int *sc_addr;
44 1.1 tsubai u_int *sc_fcr;
45 1.2 tsubai u_int sc_baseaddr;
46 1.2 tsubai struct device *sc_content;
47 1.2 tsubai struct proc *sc_kthread;
48 1.1 tsubai };
49 1.1 tsubai
50 1.2 tsubai void mediabay_attach __P((struct device *, struct device *, void *));
51 1.2 tsubai int mediabay_match __P((struct device *, struct cfdata *, void *));
52 1.2 tsubai int mediabay_print __P((void *, const char *));
53 1.2 tsubai void mediabay_attach_content __P((struct mediabay_softc *));
54 1.2 tsubai int mediabay_intr __P((void *));
55 1.2 tsubai void mediabay_create_kthread __P((void *));
56 1.2 tsubai void mediabay_kthread __P((void *));
57 1.1 tsubai
58 1.6 thorpej CFATTACH_DECL(mediabay, sizeof(struct mediabay_softc),
59 1.6 thorpej mediabay_match, mediabay_attach, NULL, NULL);
60 1.1 tsubai
61 1.2 tsubai #ifdef MEDIABAY_DEBUG
62 1.2 tsubai # define DPRINTF printf
63 1.2 tsubai #else
64 1.2 tsubai # define DPRINTF while (0) printf
65 1.2 tsubai #endif
66 1.1 tsubai
67 1.1 tsubai #define FCR_MEDIABAY_RESET 0x00000002
68 1.1 tsubai #define FCR_MEDIABAY_IDE_ENABLE 0x00000008
69 1.1 tsubai #define FCR_MEDIABAY_FD_ENABLE 0x00000010
70 1.1 tsubai #define FCR_MEDIABAY_ENABLE 0x00000080
71 1.1 tsubai #define FCR_MEDIABAY_CD_POWER 0x00800000
72 1.1 tsubai
73 1.2 tsubai #define MEDIABAY_ID(x) (((x) >> 12) & 0xf)
74 1.1 tsubai #define MEDIABAY_ID_FD 0
75 1.1 tsubai #define MEDIABAY_ID_CD 3
76 1.1 tsubai #define MEDIABAY_ID_NONE 7
77 1.1 tsubai
78 1.1 tsubai int
79 1.1 tsubai mediabay_match(parent, cf, aux)
80 1.1 tsubai struct device *parent;
81 1.1 tsubai struct cfdata *cf;
82 1.1 tsubai void *aux;
83 1.1 tsubai {
84 1.1 tsubai struct confargs *ca = aux;
85 1.1 tsubai
86 1.1 tsubai if (strcmp(ca->ca_name, "media-bay") == 0)
87 1.1 tsubai return 1;
88 1.1 tsubai
89 1.1 tsubai return 0;
90 1.1 tsubai }
91 1.1 tsubai
92 1.1 tsubai /*
93 1.1 tsubai * Attach all the sub-devices we can find
94 1.1 tsubai */
95 1.1 tsubai void
96 1.1 tsubai mediabay_attach(parent, self, aux)
97 1.1 tsubai struct device *parent, *self;
98 1.1 tsubai void *aux;
99 1.1 tsubai {
100 1.1 tsubai struct mediabay_softc *sc = (struct mediabay_softc *)self;
101 1.2 tsubai struct confargs *ca = aux;
102 1.3 tsubai int irq, type;
103 1.2 tsubai
104 1.2 tsubai ca->ca_reg[0] += ca->ca_baseaddr;
105 1.1 tsubai
106 1.2 tsubai sc->sc_addr = mapiodev(ca->ca_reg[0], NBPG);
107 1.1 tsubai sc->sc_fcr = sc->sc_addr + 1;
108 1.2 tsubai sc->sc_node = ca->ca_node;
109 1.2 tsubai sc->sc_baseaddr = ca->ca_baseaddr;
110 1.2 tsubai irq = ca->ca_intr[0];
111 1.3 tsubai type = IST_LEVEL;
112 1.1 tsubai
113 1.3 tsubai if (ca->ca_nintr == 8 && ca->ca_intr[1] == 0)
114 1.3 tsubai type = IST_EDGE;
115 1.3 tsubai
116 1.3 tsubai printf(" irq %d %s\n", irq, intr_typename(type));
117 1.3 tsubai intr_establish(irq, type, IPL_BIO, mediabay_intr, sc);
118 1.1 tsubai
119 1.2 tsubai kthread_create(mediabay_create_kthread, sc);
120 1.2 tsubai
121 1.2 tsubai sc->sc_content = NULL;
122 1.2 tsubai
123 1.2 tsubai if (MEDIABAY_ID(in32rb(sc->sc_addr)) != MEDIABAY_ID_NONE)
124 1.2 tsubai mediabay_attach_content(sc);
125 1.2 tsubai }
126 1.2 tsubai
127 1.2 tsubai void
128 1.2 tsubai mediabay_attach_content(sc)
129 1.2 tsubai struct mediabay_softc *sc;
130 1.2 tsubai {
131 1.2 tsubai int child;
132 1.2 tsubai u_int fcr;
133 1.2 tsubai struct device *content;
134 1.2 tsubai struct confargs ca;
135 1.2 tsubai u_int reg[20], intr[5];
136 1.2 tsubai char name[32];
137 1.2 tsubai
138 1.1 tsubai fcr = in32rb(sc->sc_fcr);
139 1.1 tsubai fcr |= FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_RESET;
140 1.1 tsubai out32rb(sc->sc_fcr, fcr);
141 1.1 tsubai delay(50000);
142 1.1 tsubai
143 1.1 tsubai fcr &= ~FCR_MEDIABAY_RESET;
144 1.1 tsubai out32rb(sc->sc_fcr, fcr);
145 1.1 tsubai delay(50000);
146 1.1 tsubai
147 1.1 tsubai fcr |= FCR_MEDIABAY_IDE_ENABLE | FCR_MEDIABAY_CD_POWER;
148 1.1 tsubai out32rb(sc->sc_fcr, fcr);
149 1.1 tsubai delay(50000);
150 1.1 tsubai
151 1.1 tsubai for (child = OF_child(sc->sc_node); child; child = OF_peer(child)) {
152 1.4 wiz memset(name, 0, sizeof(name));
153 1.1 tsubai if (OF_getprop(child, "name", name, sizeof(name)) == -1)
154 1.1 tsubai continue;
155 1.1 tsubai ca.ca_name = name;
156 1.1 tsubai ca.ca_node = child;
157 1.2 tsubai ca.ca_baseaddr = sc->sc_baseaddr;
158 1.1 tsubai
159 1.1 tsubai ca.ca_nreg = OF_getprop(child, "reg", reg, sizeof(reg));
160 1.1 tsubai ca.ca_nintr = OF_getprop(child, "AAPL,interrupts", intr,
161 1.1 tsubai sizeof(intr));
162 1.1 tsubai if (ca.ca_nintr == -1)
163 1.1 tsubai ca.ca_nintr = OF_getprop(child, "interrupts", intr,
164 1.1 tsubai sizeof(intr));
165 1.1 tsubai ca.ca_reg = reg;
166 1.1 tsubai ca.ca_intr = intr;
167 1.1 tsubai
168 1.2 tsubai content = config_found(&sc->sc_dev, &ca, mediabay_print);
169 1.2 tsubai if (content) {
170 1.2 tsubai sc->sc_content = content;
171 1.2 tsubai return;
172 1.2 tsubai }
173 1.1 tsubai }
174 1.2 tsubai
175 1.2 tsubai /* No devices found. Disable media-bay. */
176 1.2 tsubai fcr &= ~(FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_IDE_ENABLE |
177 1.2 tsubai FCR_MEDIABAY_CD_POWER | FCR_MEDIABAY_FD_ENABLE);
178 1.2 tsubai out32rb(sc->sc_fcr, fcr);
179 1.1 tsubai }
180 1.1 tsubai
181 1.1 tsubai int
182 1.1 tsubai mediabay_print(aux, mediabay)
183 1.1 tsubai void *aux;
184 1.1 tsubai const char *mediabay;
185 1.1 tsubai {
186 1.1 tsubai struct confargs *ca = aux;
187 1.1 tsubai
188 1.2 tsubai if (mediabay == NULL && ca->ca_nreg > 0)
189 1.1 tsubai printf(" offset 0x%x", ca->ca_reg[0]);
190 1.1 tsubai
191 1.2 tsubai return QUIET;
192 1.1 tsubai }
193 1.1 tsubai
194 1.1 tsubai int
195 1.1 tsubai mediabay_intr(v)
196 1.1 tsubai void *v;
197 1.1 tsubai {
198 1.1 tsubai struct mediabay_softc *sc = v;
199 1.1 tsubai
200 1.2 tsubai wakeup(&sc->sc_kthread);
201 1.2 tsubai return 1;
202 1.2 tsubai }
203 1.2 tsubai
204 1.2 tsubai void
205 1.2 tsubai mediabay_create_kthread(v)
206 1.2 tsubai void *v;
207 1.2 tsubai {
208 1.2 tsubai struct mediabay_softc *sc = v;
209 1.2 tsubai
210 1.2 tsubai kthread_create1(mediabay_kthread, sc, &sc->sc_kthread, "media-bay");
211 1.2 tsubai }
212 1.2 tsubai
213 1.2 tsubai void
214 1.2 tsubai mediabay_kthread(v)
215 1.2 tsubai void *v;
216 1.2 tsubai {
217 1.2 tsubai struct mediabay_softc *sc = v;
218 1.2 tsubai u_int x, fcr;
219 1.2 tsubai
220 1.2 tsubai sleep:
221 1.2 tsubai tsleep(&sc->sc_kthread, PRIBIO, "mbayev", 0);
222 1.2 tsubai
223 1.2 tsubai /* sleep 0.25 sec */
224 1.2 tsubai tsleep(mediabay_kthread, PRIBIO, "mbayev", hz/4);
225 1.2 tsubai
226 1.2 tsubai DPRINTF("%s: ", sc->sc_dev.dv_xname);
227 1.1 tsubai x = in32rb(sc->sc_addr);
228 1.1 tsubai
229 1.1 tsubai switch (MEDIABAY_ID(x)) {
230 1.1 tsubai case MEDIABAY_ID_NONE:
231 1.2 tsubai DPRINTF("removed\n");
232 1.2 tsubai if (sc->sc_content != NULL) {
233 1.2 tsubai config_detach(sc->sc_content, DETACH_FORCE);
234 1.2 tsubai DPRINTF("%s: detach done\n", sc->sc_dev.dv_xname);
235 1.2 tsubai sc->sc_content = NULL;
236 1.2 tsubai
237 1.2 tsubai /* disable media-bay */
238 1.2 tsubai fcr = in32rb(sc->sc_fcr);
239 1.2 tsubai fcr &= ~(FCR_MEDIABAY_ENABLE |
240 1.2 tsubai FCR_MEDIABAY_IDE_ENABLE |
241 1.2 tsubai FCR_MEDIABAY_CD_POWER |
242 1.2 tsubai FCR_MEDIABAY_FD_ENABLE);
243 1.2 tsubai out32rb(sc->sc_fcr, fcr);
244 1.2 tsubai }
245 1.1 tsubai break;
246 1.1 tsubai case MEDIABAY_ID_FD:
247 1.2 tsubai DPRINTF("FD inserted\n");
248 1.1 tsubai break;
249 1.1 tsubai case MEDIABAY_ID_CD:
250 1.2 tsubai DPRINTF("CD inserted\n");
251 1.2 tsubai
252 1.2 tsubai if (sc->sc_content == NULL)
253 1.2 tsubai mediabay_attach_content(sc);
254 1.1 tsubai break;
255 1.1 tsubai default:
256 1.1 tsubai printf("unknown event (0x%x)\n", x);
257 1.1 tsubai }
258 1.1 tsubai
259 1.2 tsubai goto sleep;
260 1.1 tsubai }
261 1.1 tsubai
262 1.1 tsubai /* PBG3: 0x7025X0c0 */
263 1.1 tsubai /* 2400: 0x0070X0a8 */
264