mediabay.c revision 1.2 1 1.2 tsubai /* $NetBSD: mediabay.c,v 1.2 1999/10/04 22:58:10 tsubai 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.1 tsubai struct cfattach mediabay_ca = {
59 1.1 tsubai sizeof(struct mediabay_softc), mediabay_match, mediabay_attach
60 1.1 tsubai };
61 1.1 tsubai
62 1.2 tsubai #ifdef MEDIABAY_DEBUG
63 1.2 tsubai # define DPRINTF printf
64 1.2 tsubai #else
65 1.2 tsubai # define DPRINTF while (0) printf
66 1.2 tsubai #endif
67 1.1 tsubai
68 1.1 tsubai #define FCR_MEDIABAY_RESET 0x00000002
69 1.1 tsubai #define FCR_MEDIABAY_IDE_ENABLE 0x00000008
70 1.1 tsubai #define FCR_MEDIABAY_FD_ENABLE 0x00000010
71 1.1 tsubai #define FCR_MEDIABAY_ENABLE 0x00000080
72 1.1 tsubai #define FCR_MEDIABAY_CD_POWER 0x00800000
73 1.1 tsubai
74 1.2 tsubai #define MEDIABAY_ID(x) (((x) >> 12) & 0xf)
75 1.1 tsubai #define MEDIABAY_ID_FD 0
76 1.1 tsubai #define MEDIABAY_ID_CD 3
77 1.1 tsubai #define MEDIABAY_ID_NONE 7
78 1.1 tsubai
79 1.1 tsubai int
80 1.1 tsubai mediabay_match(parent, cf, aux)
81 1.1 tsubai struct device *parent;
82 1.1 tsubai struct cfdata *cf;
83 1.1 tsubai void *aux;
84 1.1 tsubai {
85 1.1 tsubai struct confargs *ca = aux;
86 1.1 tsubai
87 1.1 tsubai if (strcmp(ca->ca_name, "media-bay") == 0)
88 1.1 tsubai return 1;
89 1.1 tsubai
90 1.1 tsubai return 0;
91 1.1 tsubai }
92 1.1 tsubai
93 1.1 tsubai /*
94 1.1 tsubai * Attach all the sub-devices we can find
95 1.1 tsubai */
96 1.1 tsubai void
97 1.1 tsubai mediabay_attach(parent, self, aux)
98 1.1 tsubai struct device *parent, *self;
99 1.1 tsubai void *aux;
100 1.1 tsubai {
101 1.1 tsubai struct mediabay_softc *sc = (struct mediabay_softc *)self;
102 1.2 tsubai struct confargs *ca = aux;
103 1.2 tsubai int irq;
104 1.2 tsubai
105 1.2 tsubai ca->ca_reg[0] += ca->ca_baseaddr;
106 1.1 tsubai
107 1.2 tsubai sc->sc_addr = mapiodev(ca->ca_reg[0], NBPG);
108 1.1 tsubai sc->sc_fcr = sc->sc_addr + 1;
109 1.2 tsubai sc->sc_node = ca->ca_node;
110 1.2 tsubai sc->sc_baseaddr = ca->ca_baseaddr;
111 1.2 tsubai irq = ca->ca_intr[0];
112 1.1 tsubai
113 1.1 tsubai printf(" irq %d\n", irq);
114 1.1 tsubai intr_establish(irq, IST_LEVEL, IPL_BIO, mediabay_intr, sc);
115 1.1 tsubai
116 1.2 tsubai kthread_create(mediabay_create_kthread, sc);
117 1.2 tsubai
118 1.2 tsubai sc->sc_content = NULL;
119 1.2 tsubai
120 1.2 tsubai if (MEDIABAY_ID(in32rb(sc->sc_addr)) != MEDIABAY_ID_NONE)
121 1.2 tsubai mediabay_attach_content(sc);
122 1.2 tsubai }
123 1.2 tsubai
124 1.2 tsubai void
125 1.2 tsubai mediabay_attach_content(sc)
126 1.2 tsubai struct mediabay_softc *sc;
127 1.2 tsubai {
128 1.2 tsubai int child;
129 1.2 tsubai u_int fcr;
130 1.2 tsubai struct device *content;
131 1.2 tsubai struct confargs ca;
132 1.2 tsubai u_int reg[20], intr[5];
133 1.2 tsubai char name[32];
134 1.2 tsubai
135 1.1 tsubai fcr = in32rb(sc->sc_fcr);
136 1.1 tsubai fcr |= FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_RESET;
137 1.1 tsubai out32rb(sc->sc_fcr, fcr);
138 1.1 tsubai delay(50000);
139 1.1 tsubai
140 1.1 tsubai fcr &= ~FCR_MEDIABAY_RESET;
141 1.1 tsubai out32rb(sc->sc_fcr, fcr);
142 1.1 tsubai delay(50000);
143 1.1 tsubai
144 1.1 tsubai fcr |= FCR_MEDIABAY_IDE_ENABLE | FCR_MEDIABAY_CD_POWER;
145 1.1 tsubai out32rb(sc->sc_fcr, fcr);
146 1.1 tsubai delay(50000);
147 1.1 tsubai
148 1.1 tsubai for (child = OF_child(sc->sc_node); child; child = OF_peer(child)) {
149 1.1 tsubai bzero(name, sizeof(name));
150 1.1 tsubai if (OF_getprop(child, "name", name, sizeof(name)) == -1)
151 1.1 tsubai continue;
152 1.1 tsubai ca.ca_name = name;
153 1.1 tsubai ca.ca_node = child;
154 1.2 tsubai ca.ca_baseaddr = sc->sc_baseaddr;
155 1.1 tsubai
156 1.1 tsubai ca.ca_nreg = OF_getprop(child, "reg", reg, sizeof(reg));
157 1.1 tsubai ca.ca_nintr = OF_getprop(child, "AAPL,interrupts", intr,
158 1.1 tsubai sizeof(intr));
159 1.1 tsubai if (ca.ca_nintr == -1)
160 1.1 tsubai ca.ca_nintr = OF_getprop(child, "interrupts", intr,
161 1.1 tsubai sizeof(intr));
162 1.1 tsubai ca.ca_reg = reg;
163 1.1 tsubai ca.ca_intr = intr;
164 1.1 tsubai
165 1.2 tsubai content = config_found(&sc->sc_dev, &ca, mediabay_print);
166 1.2 tsubai if (content) {
167 1.2 tsubai sc->sc_content = content;
168 1.2 tsubai return;
169 1.2 tsubai }
170 1.1 tsubai }
171 1.2 tsubai
172 1.2 tsubai /* No devices found. Disable media-bay. */
173 1.2 tsubai fcr &= ~(FCR_MEDIABAY_ENABLE | FCR_MEDIABAY_IDE_ENABLE |
174 1.2 tsubai FCR_MEDIABAY_CD_POWER | FCR_MEDIABAY_FD_ENABLE);
175 1.2 tsubai out32rb(sc->sc_fcr, fcr);
176 1.1 tsubai }
177 1.1 tsubai
178 1.1 tsubai int
179 1.1 tsubai mediabay_print(aux, mediabay)
180 1.1 tsubai void *aux;
181 1.1 tsubai const char *mediabay;
182 1.1 tsubai {
183 1.1 tsubai struct confargs *ca = aux;
184 1.1 tsubai
185 1.2 tsubai if (mediabay == NULL && ca->ca_nreg > 0)
186 1.1 tsubai printf(" offset 0x%x", ca->ca_reg[0]);
187 1.1 tsubai
188 1.2 tsubai return QUIET;
189 1.1 tsubai }
190 1.1 tsubai
191 1.1 tsubai int
192 1.1 tsubai mediabay_intr(v)
193 1.1 tsubai void *v;
194 1.1 tsubai {
195 1.1 tsubai struct mediabay_softc *sc = v;
196 1.1 tsubai
197 1.2 tsubai wakeup(&sc->sc_kthread);
198 1.2 tsubai return 1;
199 1.2 tsubai }
200 1.2 tsubai
201 1.2 tsubai void
202 1.2 tsubai mediabay_create_kthread(v)
203 1.2 tsubai void *v;
204 1.2 tsubai {
205 1.2 tsubai struct mediabay_softc *sc = v;
206 1.2 tsubai
207 1.2 tsubai kthread_create1(mediabay_kthread, sc, &sc->sc_kthread, "media-bay");
208 1.2 tsubai }
209 1.2 tsubai
210 1.2 tsubai void
211 1.2 tsubai mediabay_kthread(v)
212 1.2 tsubai void *v;
213 1.2 tsubai {
214 1.2 tsubai struct mediabay_softc *sc = v;
215 1.2 tsubai u_int x, fcr;
216 1.2 tsubai
217 1.2 tsubai sleep:
218 1.2 tsubai tsleep(&sc->sc_kthread, PRIBIO, "mbayev", 0);
219 1.2 tsubai
220 1.2 tsubai /* sleep 0.25 sec */
221 1.2 tsubai tsleep(mediabay_kthread, PRIBIO, "mbayev", hz/4);
222 1.2 tsubai
223 1.2 tsubai DPRINTF("%s: ", sc->sc_dev.dv_xname);
224 1.1 tsubai x = in32rb(sc->sc_addr);
225 1.1 tsubai
226 1.1 tsubai switch (MEDIABAY_ID(x)) {
227 1.1 tsubai case MEDIABAY_ID_NONE:
228 1.2 tsubai DPRINTF("removed\n");
229 1.2 tsubai if (sc->sc_content != NULL) {
230 1.2 tsubai config_detach(sc->sc_content, DETACH_FORCE);
231 1.2 tsubai DPRINTF("%s: detach done\n", sc->sc_dev.dv_xname);
232 1.2 tsubai sc->sc_content = NULL;
233 1.2 tsubai
234 1.2 tsubai /* disable media-bay */
235 1.2 tsubai fcr = in32rb(sc->sc_fcr);
236 1.2 tsubai fcr &= ~(FCR_MEDIABAY_ENABLE |
237 1.2 tsubai FCR_MEDIABAY_IDE_ENABLE |
238 1.2 tsubai FCR_MEDIABAY_CD_POWER |
239 1.2 tsubai FCR_MEDIABAY_FD_ENABLE);
240 1.2 tsubai out32rb(sc->sc_fcr, fcr);
241 1.2 tsubai }
242 1.1 tsubai break;
243 1.1 tsubai case MEDIABAY_ID_FD:
244 1.2 tsubai DPRINTF("FD inserted\n");
245 1.1 tsubai break;
246 1.1 tsubai case MEDIABAY_ID_CD:
247 1.2 tsubai DPRINTF("CD inserted\n");
248 1.2 tsubai
249 1.2 tsubai if (sc->sc_content == NULL)
250 1.2 tsubai mediabay_attach_content(sc);
251 1.1 tsubai break;
252 1.1 tsubai default:
253 1.1 tsubai printf("unknown event (0x%x)\n", x);
254 1.1 tsubai }
255 1.1 tsubai
256 1.2 tsubai goto sleep;
257 1.1 tsubai }
258 1.1 tsubai
259 1.1 tsubai /* PBG3: 0x7025X0c0 */
260 1.1 tsubai /* 2400: 0x0070X0a8 */
261