edc_mca.c revision 1.46 1 1.46 tls /* $NetBSD: edc_mca.c,v 1.46 2012/02/02 19:43:04 tls Exp $ */
2 1.1 jdolecek
3 1.1 jdolecek /*
4 1.1 jdolecek * Copyright (c) 2001 The NetBSD Foundation, Inc.
5 1.40 martin * All rights reserved.
6 1.1 jdolecek *
7 1.1 jdolecek * This code is derived from software contributed to The NetBSD Foundation
8 1.1 jdolecek * by Jaromir Dolecek.
9 1.1 jdolecek *
10 1.1 jdolecek * Redistribution and use in source and binary forms, with or without
11 1.1 jdolecek * modification, are permitted provided that the following conditions
12 1.1 jdolecek * are met:
13 1.1 jdolecek * 1. Redistributions of source code must retain the above copyright
14 1.1 jdolecek * notice, this list of conditions and the following disclaimer.
15 1.1 jdolecek * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 jdolecek * notice, this list of conditions and the following disclaimer in the
17 1.1 jdolecek * documentation and/or other materials provided with the distribution.
18 1.1 jdolecek *
19 1.40 martin * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.40 martin * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.40 martin * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.40 martin * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.40 martin * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.40 martin * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.40 martin * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.40 martin * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.40 martin * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.40 martin * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.40 martin * POSSIBILITY OF SUCH DAMAGE.
30 1.1 jdolecek */
31 1.1 jdolecek
32 1.1 jdolecek /*
33 1.1 jdolecek * Driver for MCA ESDI controllers and disks conforming to IBM DASD
34 1.1 jdolecek * spec.
35 1.1 jdolecek *
36 1.1 jdolecek * The driver was written with DASD Storage Interface Specification
37 1.1 jdolecek * for MCA rev. 2.2 in hands, thanks to Scott Telford <st (at) epcc.ed.ac.uk>.
38 1.1 jdolecek *
39 1.1 jdolecek * TODO:
40 1.1 jdolecek * - improve error recovery
41 1.11 jdolecek * Issue soft reset on error or timeout?
42 1.11 jdolecek * - test with > 1 disk (this is supported by some controllers)
43 1.1 jdolecek * - test with > 1 ESDI controller in machine; shared interrupts
44 1.1 jdolecek * necessary for this to work should be supported - edc_intr() specifically
45 1.1 jdolecek * checks if the interrupt is for this controller
46 1.1 jdolecek */
47 1.10 lukem
48 1.10 lukem #include <sys/cdefs.h>
49 1.46 tls __KERNEL_RCSID(0, "$NetBSD: edc_mca.c,v 1.46 2012/02/02 19:43:04 tls Exp $");
50 1.1 jdolecek
51 1.1 jdolecek #include <sys/param.h>
52 1.1 jdolecek #include <sys/systm.h>
53 1.26 yamt #include <sys/buf.h>
54 1.26 yamt #include <sys/bufq.h>
55 1.1 jdolecek #include <sys/errno.h>
56 1.1 jdolecek #include <sys/device.h>
57 1.1 jdolecek #include <sys/malloc.h>
58 1.1 jdolecek #include <sys/endian.h>
59 1.1 jdolecek #include <sys/disklabel.h>
60 1.1 jdolecek #include <sys/disk.h>
61 1.1 jdolecek #include <sys/syslog.h>
62 1.1 jdolecek #include <sys/proc.h>
63 1.1 jdolecek #include <sys/vnode.h>
64 1.1 jdolecek #include <sys/kernel.h>
65 1.11 jdolecek #include <sys/kthread.h>
66 1.1 jdolecek #include <sys/rnd.h>
67 1.1 jdolecek
68 1.38 ad #include <sys/bus.h>
69 1.38 ad #include <sys/intr.h>
70 1.1 jdolecek
71 1.1 jdolecek #include <dev/mca/mcareg.h>
72 1.1 jdolecek #include <dev/mca/mcavar.h>
73 1.1 jdolecek #include <dev/mca/mcadevs.h>
74 1.1 jdolecek
75 1.1 jdolecek #include <dev/mca/edcreg.h>
76 1.1 jdolecek #include <dev/mca/edvar.h>
77 1.1 jdolecek #include <dev/mca/edcvar.h>
78 1.1 jdolecek
79 1.25 drochner #include "locators.h"
80 1.25 drochner
81 1.9 jdolecek #define EDC_ATTN_MAXTRIES 10000 /* How many times check for unbusy */
82 1.11 jdolecek #define EDC_MAX_CMD_RES_LEN 8
83 1.9 jdolecek
84 1.1 jdolecek struct edc_mca_softc {
85 1.1 jdolecek struct device sc_dev;
86 1.1 jdolecek
87 1.1 jdolecek bus_space_tag_t sc_iot;
88 1.1 jdolecek bus_space_handle_t sc_ioh;
89 1.1 jdolecek
90 1.11 jdolecek /* DMA related stuff */
91 1.1 jdolecek bus_dma_tag_t sc_dmat; /* DMA tag as passed by parent */
92 1.11 jdolecek bus_dmamap_t sc_dmamap_xfer; /* transfer dma map */
93 1.1 jdolecek
94 1.1 jdolecek void *sc_ih; /* interrupt handle */
95 1.1 jdolecek
96 1.1 jdolecek int sc_flags;
97 1.1 jdolecek #define DASD_QUIET 0x01 /* don't dump cmd error info */
98 1.11 jdolecek
99 1.9 jdolecek #define DASD_MAXDEVS 8
100 1.1 jdolecek struct ed_softc *sc_ed[DASD_MAXDEVS];
101 1.11 jdolecek int sc_maxdevs; /* max number of disks attached to this
102 1.11 jdolecek * controller */
103 1.11 jdolecek
104 1.11 jdolecek /* I/O results variables */
105 1.16 jdolecek volatile int sc_stat;
106 1.16 jdolecek #define STAT_START 0
107 1.16 jdolecek #define STAT_ERROR 1
108 1.16 jdolecek #define STAT_DONE 2
109 1.11 jdolecek volatile int sc_resblk; /* residual block count */
110 1.16 jdolecek
111 1.16 jdolecek /* CMD status block - only set & used in edc_intr() */
112 1.16 jdolecek u_int16_t status_block[EDC_MAX_CMD_RES_LEN];
113 1.1 jdolecek };
114 1.1 jdolecek
115 1.44 cegger int edc_mca_probe(device_t, cfdata_t, void *);
116 1.44 cegger void edc_mca_attach(device_t, device_t, void *);
117 1.1 jdolecek
118 1.19 thorpej CFATTACH_DECL(edc_mca, sizeof(struct edc_mca_softc),
119 1.20 thorpej edc_mca_probe, edc_mca_attach, NULL, NULL);
120 1.1 jdolecek
121 1.27 perry static int edc_intr(void *);
122 1.27 perry static void edc_dump_status_block(struct edc_mca_softc *,
123 1.27 perry u_int16_t *, int);
124 1.27 perry static int edc_do_attn(struct edc_mca_softc *, int, int, int);
125 1.27 perry static void edc_cmd_wait(struct edc_mca_softc *, int, int);
126 1.27 perry static void edcworker(void *);
127 1.1 jdolecek
128 1.1 jdolecek int
129 1.44 cegger edc_mca_probe(device_t parent, cfdata_t match,
130 1.34 christos void *aux)
131 1.1 jdolecek {
132 1.1 jdolecek struct mca_attach_args *ma = aux;
133 1.1 jdolecek
134 1.1 jdolecek switch (ma->ma_id) {
135 1.1 jdolecek case MCA_PRODUCT_IBM_ESDIC:
136 1.1 jdolecek case MCA_PRODUCT_IBM_ESDIC_IG:
137 1.1 jdolecek return (1);
138 1.1 jdolecek default:
139 1.1 jdolecek return (0);
140 1.1 jdolecek }
141 1.1 jdolecek }
142 1.1 jdolecek
143 1.1 jdolecek void
144 1.44 cegger edc_mca_attach(device_t parent, device_t self, void *aux)
145 1.1 jdolecek {
146 1.33 thorpej struct edc_mca_softc *sc = device_private(self);
147 1.1 jdolecek struct mca_attach_args *ma = aux;
148 1.11 jdolecek struct ed_attach_args eda;
149 1.1 jdolecek int pos2, pos3, pos4;
150 1.1 jdolecek int irq, drq, iobase;
151 1.1 jdolecek const char *typestr;
152 1.11 jdolecek int devno, error;
153 1.29 drochner int locs[EDCCF_NLOCS];
154 1.1 jdolecek
155 1.1 jdolecek pos2 = mca_conf_read(ma->ma_mc, ma->ma_slot, 2);
156 1.1 jdolecek pos3 = mca_conf_read(ma->ma_mc, ma->ma_slot, 3);
157 1.1 jdolecek pos4 = mca_conf_read(ma->ma_mc, ma->ma_slot, 4);
158 1.1 jdolecek
159 1.1 jdolecek /*
160 1.1 jdolecek * POS register 2: (adf pos0)
161 1.28 perry *
162 1.1 jdolecek * 7 6 5 4 3 2 1 0
163 1.1 jdolecek * \ \____/ \ \__ enable: 0=adapter disabled, 1=adapter enabled
164 1.23 wiz * \ \ \___ Primary/Alternate Port Addresses:
165 1.1 jdolecek * \ \ 0=0x3510-3517 1=0x3518-0x351f
166 1.1 jdolecek * \ \_____ DMA Arbitration Level: 0101=5 0110=6 0111=7
167 1.1 jdolecek * \ 0000=0 0001=1 0011=3 0100=4
168 1.1 jdolecek * \_________ Fairness On/Off: 1=On 0=Off
169 1.1 jdolecek *
170 1.1 jdolecek * POS register 3: (adf pos1)
171 1.28 perry *
172 1.1 jdolecek * 7 6 5 4 3 2 1 0
173 1.1 jdolecek * 0 0 \_/
174 1.1 jdolecek * \__________ DMA Burst Pacing Interval: 10=24ms 11=31ms
175 1.1 jdolecek * 01=16ms 00=Burst Disabled
176 1.1 jdolecek *
177 1.1 jdolecek * POS register 4: (adf pos2)
178 1.28 perry *
179 1.1 jdolecek * 7 6 5 4 3 2 1 0
180 1.1 jdolecek * \_/ \__ DMA Pacing Control: 1=Disabled 0=Enabled
181 1.1 jdolecek * \____ Time to Release: 1X=6ms 01=3ms 00=Immediate
182 1.1 jdolecek *
183 1.1 jdolecek * IRQ is fixed to 14 (0x0e).
184 1.1 jdolecek */
185 1.1 jdolecek
186 1.1 jdolecek switch (ma->ma_id) {
187 1.1 jdolecek case MCA_PRODUCT_IBM_ESDIC:
188 1.1 jdolecek typestr = "IBM ESDI Fixed Disk Controller";
189 1.1 jdolecek break;
190 1.1 jdolecek case MCA_PRODUCT_IBM_ESDIC_IG:
191 1.1 jdolecek typestr = "IBM Integ. ESDI Fixed Disk & Controller";
192 1.1 jdolecek break;
193 1.1 jdolecek default:
194 1.22 christos typestr = NULL;
195 1.22 christos break;
196 1.1 jdolecek }
197 1.28 perry
198 1.1 jdolecek irq = ESDIC_IRQ;
199 1.1 jdolecek iobase = (pos2 & IO_IS_ALT) ? ESDIC_IOALT : ESDIC_IOPRM;
200 1.1 jdolecek drq = (pos2 & DRQ_MASK) >> 2;
201 1.1 jdolecek
202 1.7 jdolecek printf(" slot %d irq %d drq %d: %s\n", ma->ma_slot+1,
203 1.7 jdolecek irq, drq, typestr);
204 1.6 jdolecek
205 1.1 jdolecek #ifdef DIAGNOSTIC
206 1.1 jdolecek /*
207 1.1 jdolecek * It's not strictly necessary to check this, machine configuration
208 1.23 wiz * utility uses only valid addresses.
209 1.1 jdolecek */
210 1.1 jdolecek if (drq == 2 || drq >= 8) {
211 1.39 cegger aprint_error_dev(&sc->sc_dev, "invalid DMA Arbitration Level %d\n", drq);
212 1.1 jdolecek return;
213 1.1 jdolecek }
214 1.1 jdolecek #endif
215 1.1 jdolecek
216 1.7 jdolecek printf("%s: Fairness %s, Release %s, ",
217 1.39 cegger device_xname(&sc->sc_dev),
218 1.1 jdolecek (pos2 & FAIRNESS_ENABLE) ? "On" : "Off",
219 1.1 jdolecek (pos4 & RELEASE_1) ? "6ms"
220 1.7 jdolecek : ((pos4 & RELEASE_2) ? "3ms" : "Immediate")
221 1.7 jdolecek );
222 1.1 jdolecek if ((pos4 & PACING_CTRL_DISABLE) == 0) {
223 1.1 jdolecek static const char * const pacint[] =
224 1.1 jdolecek { "disabled", "16ms", "24ms", "31ms"};
225 1.1 jdolecek printf("DMA burst pacing interval %s\n",
226 1.1 jdolecek pacint[(pos3 & PACING_INT_MASK) >> 4]);
227 1.1 jdolecek } else
228 1.1 jdolecek printf("DMA pacing control disabled\n");
229 1.1 jdolecek
230 1.1 jdolecek sc->sc_iot = ma->ma_iot;
231 1.1 jdolecek
232 1.1 jdolecek if (bus_space_map(sc->sc_iot, iobase,
233 1.1 jdolecek ESDIC_REG_NPORTS, 0, &sc->sc_ioh)) {
234 1.39 cegger aprint_error_dev(&sc->sc_dev, "couldn't map registers\n");
235 1.1 jdolecek return;
236 1.1 jdolecek }
237 1.1 jdolecek
238 1.11 jdolecek sc->sc_ih = mca_intr_establish(ma->ma_mc, irq, IPL_BIO, edc_intr, sc);
239 1.11 jdolecek if (sc->sc_ih == NULL) {
240 1.39 cegger aprint_error_dev(&sc->sc_dev, "couldn't establish interrupt handler\n");
241 1.1 jdolecek return;
242 1.1 jdolecek }
243 1.1 jdolecek
244 1.11 jdolecek /* Create a MCA DMA map, used for data transfer */
245 1.1 jdolecek sc->sc_dmat = ma->ma_dmat;
246 1.11 jdolecek if ((error = mca_dmamap_create(sc->sc_dmat, MAXPHYS,
247 1.14 jdolecek BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW | MCABUS_DMA_16BIT,
248 1.12 jdolecek &sc->sc_dmamap_xfer, drq)) != 0){
249 1.39 cegger aprint_error_dev(&sc->sc_dev, "couldn't create DMA map - error %d\n", error);
250 1.1 jdolecek return;
251 1.1 jdolecek }
252 1.1 jdolecek
253 1.1 jdolecek /*
254 1.1 jdolecek * Integrated ESDI controller supports only one disk, other
255 1.1 jdolecek * controllers support two disks.
256 1.1 jdolecek */
257 1.1 jdolecek if (ma->ma_id == MCA_PRODUCT_IBM_ESDIC_IG)
258 1.11 jdolecek sc->sc_maxdevs = 1;
259 1.1 jdolecek else
260 1.11 jdolecek sc->sc_maxdevs = 2;
261 1.1 jdolecek
262 1.9 jdolecek /*
263 1.9 jdolecek * Reset controller and attach individual disks. ed attach routine
264 1.9 jdolecek * uses polling so that this works with interrupts disabled.
265 1.9 jdolecek */
266 1.1 jdolecek
267 1.1 jdolecek /* Do a reset to ensure sane state after warm boot. */
268 1.1 jdolecek if (bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR) & BSR_BUSY) {
269 1.1 jdolecek /* hard reset */
270 1.1 jdolecek printf("%s: controller busy, performing hardware reset ...\n",
271 1.39 cegger device_xname(&sc->sc_dev));
272 1.1 jdolecek bus_space_write_1(sc->sc_iot, sc->sc_ioh, BCR,
273 1.1 jdolecek BCR_INT_ENABLE|BCR_RESET);
274 1.1 jdolecek } else {
275 1.1 jdolecek /* "SOFT" reset */
276 1.1 jdolecek edc_do_attn(sc, ATN_RESET_ATTACHMENT, DASD_DEVNO_CONTROLLER,0);
277 1.1 jdolecek }
278 1.25 drochner
279 1.9 jdolecek /*
280 1.16 jdolecek * Since interrupts are disabled, it's necessary
281 1.9 jdolecek * to detect the interrupt request and call edc_intr()
282 1.9 jdolecek * explicitly. See also edc_run_cmd().
283 1.9 jdolecek */
284 1.25 drochner while (bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR) & BSR_BUSY) {
285 1.9 jdolecek if (bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR) & BSR_INTR)
286 1.9 jdolecek edc_intr(sc);
287 1.9 jdolecek
288 1.9 jdolecek delay(100);
289 1.9 jdolecek }
290 1.1 jdolecek
291 1.11 jdolecek /* be quiet during probes */
292 1.1 jdolecek sc->sc_flags |= DASD_QUIET;
293 1.1 jdolecek
294 1.1 jdolecek /* check for attached disks */
295 1.25 drochner for (devno = 0; devno < sc->sc_maxdevs; devno++) {
296 1.11 jdolecek eda.edc_drive = devno;
297 1.29 drochner locs[EDCCF_DRIVE] = devno;
298 1.11 jdolecek sc->sc_ed[devno] =
299 1.29 drochner (void *) config_found_sm_loc(self, "edc", locs, &eda,
300 1.30 drochner NULL, config_stdsubmatch);
301 1.11 jdolecek
302 1.11 jdolecek /* If initialization did not succeed, NULL the pointer. */
303 1.11 jdolecek if (sc->sc_ed[devno]
304 1.11 jdolecek && (sc->sc_ed[devno]->sc_flags & EDF_INIT) == 0)
305 1.11 jdolecek sc->sc_ed[devno] = NULL;
306 1.1 jdolecek }
307 1.1 jdolecek
308 1.1 jdolecek /* enable full error dumps again */
309 1.1 jdolecek sc->sc_flags &= ~DASD_QUIET;
310 1.1 jdolecek
311 1.9 jdolecek /*
312 1.9 jdolecek * Check if there are any disks attached. If not, disestablish
313 1.9 jdolecek * the interrupt.
314 1.9 jdolecek */
315 1.25 drochner for (devno = 0; devno < sc->sc_maxdevs; devno++) {
316 1.11 jdolecek if (sc->sc_ed[devno])
317 1.9 jdolecek break;
318 1.9 jdolecek }
319 1.11 jdolecek
320 1.11 jdolecek if (devno == sc->sc_maxdevs) {
321 1.9 jdolecek printf("%s: disabling controller (no drives attached)\n",
322 1.39 cegger device_xname(&sc->sc_dev));
323 1.9 jdolecek mca_intr_disestablish(ma->ma_mc, sc->sc_ih);
324 1.11 jdolecek return;
325 1.9 jdolecek }
326 1.11 jdolecek
327 1.11 jdolecek /*
328 1.11 jdolecek * Run the worker thread.
329 1.11 jdolecek */
330 1.11 jdolecek config_pending_incr();
331 1.36 ad if ((error = kthread_create(PRI_NONE, 0, NULL, edcworker, sc, NULL,
332 1.39 cegger "%s", device_xname(&sc->sc_dev)))) {
333 1.39 cegger aprint_error_dev(&sc->sc_dev, "cannot spawn worker thread: errno=%d\n", error);
334 1.36 ad panic("edc_mca_attach");
335 1.36 ad }
336 1.1 jdolecek }
337 1.1 jdolecek
338 1.1 jdolecek void
339 1.34 christos edc_add_disk(struct edc_mca_softc *sc, struct ed_softc *ed)
340 1.1 jdolecek {
341 1.11 jdolecek sc->sc_ed[ed->sc_devno] = ed;
342 1.1 jdolecek }
343 1.1 jdolecek
344 1.1 jdolecek static int
345 1.34 christos edc_intr(void *arg)
346 1.1 jdolecek {
347 1.1 jdolecek struct edc_mca_softc *sc = arg;
348 1.1 jdolecek u_int8_t isr, intr_id;
349 1.1 jdolecek u_int16_t sifr;
350 1.16 jdolecek int cmd=-1, devno;
351 1.1 jdolecek
352 1.1 jdolecek /*
353 1.1 jdolecek * Check if the interrupt was for us.
354 1.1 jdolecek */
355 1.1 jdolecek if ((bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR) & BSR_INTR) == 0)
356 1.1 jdolecek return (0);
357 1.1 jdolecek
358 1.1 jdolecek /*
359 1.1 jdolecek * Read ISR to find out interrupt type. This also clears the interrupt
360 1.1 jdolecek * condition and BSR_INTR flag. Accordings to docs interrupt ID of 0, 2
361 1.1 jdolecek * and 4 are reserved and not used.
362 1.1 jdolecek */
363 1.1 jdolecek isr = bus_space_read_1(sc->sc_iot, sc->sc_ioh, ISR);
364 1.1 jdolecek intr_id = isr & ISR_INTR_ID_MASK;
365 1.1 jdolecek
366 1.16 jdolecek #ifdef EDC_DEBUG
367 1.1 jdolecek if (intr_id == 0 || intr_id == 2 || intr_id == 4) {
368 1.39 cegger aprint_error_dev(&sc->sc_dev, "bogus interrupt id %d\n",
369 1.1 jdolecek (int) intr_id);
370 1.1 jdolecek return (0);
371 1.1 jdolecek }
372 1.1 jdolecek #endif
373 1.1 jdolecek
374 1.1 jdolecek /* Get number of device whose intr this was */
375 1.1 jdolecek devno = (isr & 0xe0) >> 5;
376 1.1 jdolecek
377 1.1 jdolecek /*
378 1.1 jdolecek * Get Status block. Higher byte always says how long the status
379 1.1 jdolecek * block is, rest is device number and command code.
380 1.1 jdolecek * Check the status block length against our supported maximum length
381 1.1 jdolecek * and fetch the data.
382 1.1 jdolecek */
383 1.9 jdolecek if (bus_space_read_1(sc->sc_iot, sc->sc_ioh,BSR) & BSR_SIFR_FULL) {
384 1.1 jdolecek size_t len;
385 1.1 jdolecek int i;
386 1.1 jdolecek
387 1.1 jdolecek sifr = le16toh(bus_space_read_2(sc->sc_iot, sc->sc_ioh, SIFR));
388 1.1 jdolecek len = (sifr & 0xff00) >> 8;
389 1.9 jdolecek #ifdef DEBUG
390 1.13 sommerfe if (len > EDC_MAX_CMD_RES_LEN)
391 1.9 jdolecek panic("%s: maximum Status Length exceeded: %d > %d",
392 1.39 cegger device_xname(&sc->sc_dev),
393 1.13 sommerfe len, EDC_MAX_CMD_RES_LEN);
394 1.9 jdolecek #endif
395 1.1 jdolecek
396 1.1 jdolecek /* Get command code */
397 1.1 jdolecek cmd = sifr & SIFR_CMD_MASK;
398 1.1 jdolecek
399 1.1 jdolecek /* Read whole status block */
400 1.16 jdolecek sc->status_block[0] = sifr;
401 1.1 jdolecek for(i=1; i < len; i++) {
402 1.1 jdolecek while((bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR)
403 1.1 jdolecek & BSR_SIFR_FULL) == 0)
404 1.16 jdolecek ;
405 1.1 jdolecek
406 1.16 jdolecek sc->status_block[i] = le16toh(
407 1.1 jdolecek bus_space_read_2(sc->sc_iot, sc->sc_ioh, SIFR));
408 1.1 jdolecek }
409 1.16 jdolecek /* zero out rest */
410 1.16 jdolecek if (i < EDC_MAX_CMD_RES_LEN) {
411 1.16 jdolecek memset(&sc->status_block[i], 0,
412 1.16 jdolecek (EDC_MAX_CMD_RES_LEN-i)*sizeof(u_int16_t));
413 1.16 jdolecek }
414 1.1 jdolecek }
415 1.1 jdolecek
416 1.1 jdolecek switch (intr_id) {
417 1.1 jdolecek case ISR_DATA_TRANSFER_RDY:
418 1.1 jdolecek /*
419 1.11 jdolecek * Ready to do DMA. The DMA controller has already been
420 1.11 jdolecek * setup, now just kick disk controller to do the transfer.
421 1.1 jdolecek */
422 1.11 jdolecek bus_space_write_1(sc->sc_iot, sc->sc_ioh, BCR,
423 1.11 jdolecek BCR_INT_ENABLE|BCR_DMA_ENABLE);
424 1.1 jdolecek break;
425 1.16 jdolecek
426 1.1 jdolecek case ISR_COMPLETED:
427 1.1 jdolecek case ISR_COMPLETED_WITH_ECC:
428 1.1 jdolecek case ISR_COMPLETED_RETRIES:
429 1.1 jdolecek case ISR_COMPLETED_WARNING:
430 1.11 jdolecek /*
431 1.11 jdolecek * Copy device config data if appropriate. sc->sc_ed[]
432 1.11 jdolecek * entry might be NULL during probe.
433 1.11 jdolecek */
434 1.11 jdolecek if (cmd == CMD_GET_DEV_CONF && sc->sc_ed[devno]) {
435 1.16 jdolecek memcpy(sc->sc_ed[devno]->sense_data, sc->status_block,
436 1.11 jdolecek sizeof(sc->sc_ed[devno]->sense_data));
437 1.11 jdolecek }
438 1.11 jdolecek
439 1.16 jdolecek sc->sc_stat = STAT_DONE;
440 1.1 jdolecek break;
441 1.16 jdolecek
442 1.1 jdolecek case ISR_RESET_COMPLETED:
443 1.1 jdolecek case ISR_ABORT_COMPLETED:
444 1.1 jdolecek /* nothing to do */
445 1.1 jdolecek break;
446 1.16 jdolecek
447 1.16 jdolecek case ISR_ATTN_ERROR:
448 1.16 jdolecek /*
449 1.16 jdolecek * Basically, this means driver bug or something seriously
450 1.28 perry * hosed. panic rather than extending the lossage.
451 1.16 jdolecek * No status block available, so no further info.
452 1.16 jdolecek */
453 1.16 jdolecek panic("%s: dev %d: attention error",
454 1.39 cegger device_xname(&sc->sc_dev),
455 1.16 jdolecek devno);
456 1.16 jdolecek /* NOTREACHED */
457 1.16 jdolecek break;
458 1.16 jdolecek
459 1.1 jdolecek default:
460 1.1 jdolecek if ((sc->sc_flags & DASD_QUIET) == 0)
461 1.16 jdolecek edc_dump_status_block(sc, sc->status_block, intr_id);
462 1.1 jdolecek
463 1.16 jdolecek sc->sc_stat = STAT_ERROR;
464 1.1 jdolecek break;
465 1.1 jdolecek }
466 1.28 perry
467 1.1 jdolecek /*
468 1.1 jdolecek * Unless the interrupt is for Data Transfer Ready or
469 1.1 jdolecek * Attention Error, finish by assertion EOI. This makes
470 1.1 jdolecek * attachment aware the interrupt is processed and system
471 1.1 jdolecek * is ready to accept another one.
472 1.1 jdolecek */
473 1.1 jdolecek if (intr_id != ISR_DATA_TRANSFER_RDY && intr_id != ISR_ATTN_ERROR)
474 1.1 jdolecek edc_do_attn(sc, ATN_END_INT, devno, intr_id);
475 1.1 jdolecek
476 1.1 jdolecek /* If Read or Write Data, wakeup worker thread to finish it */
477 1.16 jdolecek if (intr_id != ISR_DATA_TRANSFER_RDY) {
478 1.16 jdolecek if (cmd == CMD_READ_DATA || cmd == CMD_WRITE_DATA)
479 1.16 jdolecek sc->sc_resblk = sc->status_block[SB_RESBLKCNT_IDX];
480 1.45 rmind wakeup(sc);
481 1.1 jdolecek }
482 1.1 jdolecek
483 1.1 jdolecek return (1);
484 1.1 jdolecek }
485 1.1 jdolecek
486 1.1 jdolecek /*
487 1.1 jdolecek * This follows the exact order for Attention Request as
488 1.1 jdolecek * written in DASD Storage Interface Specification MC (Rev 2.2).
489 1.28 perry */
490 1.1 jdolecek static int
491 1.34 christos edc_do_attn(struct edc_mca_softc *sc, int attn_type, int devno, int intr_id)
492 1.1 jdolecek {
493 1.1 jdolecek int tries;
494 1.1 jdolecek
495 1.1 jdolecek /* 1. Disable interrupts in BCR. */
496 1.1 jdolecek bus_space_write_1(sc->sc_iot, sc->sc_ioh, BCR, 0);
497 1.1 jdolecek
498 1.9 jdolecek /*
499 1.9 jdolecek * 2. Assure NOT BUSY and NO INTERRUPT PENDING, unless acknowledging
500 1.9 jdolecek * a RESET COMPLETED interrupt.
501 1.9 jdolecek */
502 1.1 jdolecek if (intr_id != ISR_RESET_COMPLETED) {
503 1.16 jdolecek #ifdef EDC_DEBUG
504 1.16 jdolecek if (attn_type == ATN_CMD_REQ
505 1.16 jdolecek && (bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR)
506 1.16 jdolecek & BSR_INT_PENDING))
507 1.39 cegger panic("%s: edc int pending", device_xname(&sc->sc_dev));
508 1.16 jdolecek #endif
509 1.16 jdolecek
510 1.9 jdolecek for(tries=1; tries < EDC_ATTN_MAXTRIES; tries++) {
511 1.1 jdolecek if ((bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR)
512 1.16 jdolecek & BSR_BUSY) == 0)
513 1.1 jdolecek break;
514 1.1 jdolecek }
515 1.1 jdolecek
516 1.9 jdolecek if (tries == EDC_ATTN_MAXTRIES) {
517 1.1 jdolecek printf("%s: edc_do_attn: timeout waiting for attachment to become available\n",
518 1.39 cegger device_xname(&sc->sc_ed[devno]->sc_dev));
519 1.16 jdolecek return (EIO);
520 1.1 jdolecek }
521 1.1 jdolecek }
522 1.1 jdolecek
523 1.1 jdolecek /*
524 1.1 jdolecek * 3. Write proper DEVICE NUMBER and Attention number to ATN.
525 1.28 perry */
526 1.16 jdolecek bus_space_write_1(sc->sc_iot, sc->sc_ioh, ATN, attn_type | (devno<<5));
527 1.1 jdolecek
528 1.1 jdolecek /*
529 1.1 jdolecek * 4. Enable interrupts via BCR.
530 1.1 jdolecek */
531 1.1 jdolecek bus_space_write_1(sc->sc_iot, sc->sc_ioh, BCR, BCR_INT_ENABLE);
532 1.1 jdolecek
533 1.1 jdolecek return (0);
534 1.1 jdolecek }
535 1.1 jdolecek
536 1.1 jdolecek /*
537 1.1 jdolecek * Wait until command is processed, timeout after 'secs' seconds.
538 1.1 jdolecek * We use mono_time, since we don't need actual RTC, just time
539 1.1 jdolecek * interval.
540 1.1 jdolecek */
541 1.16 jdolecek static void
542 1.34 christos edc_cmd_wait(struct edc_mca_softc *sc, int secs, int poll)
543 1.1 jdolecek {
544 1.16 jdolecek int val;
545 1.1 jdolecek
546 1.11 jdolecek if (!poll) {
547 1.16 jdolecek int s;
548 1.11 jdolecek
549 1.11 jdolecek /* Not polling, can sleep. Sleep until we are awakened,
550 1.11 jdolecek * but maximum secs seconds.
551 1.11 jdolecek */
552 1.16 jdolecek s = splbio();
553 1.16 jdolecek if (sc->sc_stat != STAT_DONE)
554 1.16 jdolecek (void) tsleep(sc, PRIBIO, "edcwcmd", secs * hz);
555 1.16 jdolecek splx(s);
556 1.11 jdolecek }
557 1.11 jdolecek
558 1.16 jdolecek /* Wait until the command is completely finished */
559 1.16 jdolecek while((val = bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR))
560 1.16 jdolecek & BSR_CMD_INPROGRESS) {
561 1.16 jdolecek if (poll && (val & BSR_INTR))
562 1.16 jdolecek edc_intr(sc);
563 1.1 jdolecek }
564 1.1 jdolecek }
565 1.28 perry
566 1.16 jdolecek /*
567 1.16 jdolecek * Command controller to execute specified command on a device.
568 1.16 jdolecek */
569 1.1 jdolecek int
570 1.34 christos edc_run_cmd(struct edc_mca_softc *sc, int cmd, int devno,
571 1.34 christos u_int16_t cmd_args[], int cmd_len, int poll)
572 1.1 jdolecek {
573 1.9 jdolecek int i, error, tries;
574 1.1 jdolecek u_int16_t cmd0;
575 1.1 jdolecek
576 1.16 jdolecek sc->sc_stat = STAT_START;
577 1.1 jdolecek
578 1.1 jdolecek /* Do Attention Request for Command Request. */
579 1.1 jdolecek if ((error = edc_do_attn(sc, ATN_CMD_REQ, devno, 0)))
580 1.1 jdolecek return (error);
581 1.1 jdolecek
582 1.1 jdolecek /*
583 1.1 jdolecek * Construct the command. The bits are like this:
584 1.1 jdolecek *
585 1.1 jdolecek * 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0
586 1.28 perry * \_/ 0 0 1 0 \__/ \_____/
587 1.1 jdolecek * \ \__________/ \ \_ Command Code (see CMD_*)
588 1.1 jdolecek * \ \ \__ Device: 0 common, 7 controller
589 1.1 jdolecek * \ \__ Options: reserved, bit 10=cache bypass bit
590 1.1 jdolecek * \_ Type: 00=2B, 01=4B, 10 and 11 reserved
591 1.1 jdolecek *
592 1.1 jdolecek * We always use device 0 or 1, so difference is made only by Command
593 1.1 jdolecek * Code, Command Options and command length.
594 1.1 jdolecek */
595 1.1 jdolecek cmd0 = ((cmd_len == 4) ? (CIFR_LONG_CMD) : 0)
596 1.1 jdolecek | (devno << 5)
597 1.1 jdolecek | (cmd_args[0] << 8) | cmd;
598 1.1 jdolecek cmd_args[0] = cmd0;
599 1.28 perry
600 1.1 jdolecek /*
601 1.1 jdolecek * Write word of CMD to the CIFR. This sets "Command
602 1.1 jdolecek * Interface Register Full (CMD IN)" in BSR. Once the attachment
603 1.11 jdolecek * detects it, it reads the word and clears CMD IN. This all should
604 1.16 jdolecek * be quite fast, so don't sleep in !poll case neither.
605 1.1 jdolecek */
606 1.1 jdolecek for(i=0; i < cmd_len; i++) {
607 1.1 jdolecek bus_space_write_2(sc->sc_iot, sc->sc_ioh, CIFR,
608 1.1 jdolecek htole16(cmd_args[i]));
609 1.28 perry
610 1.16 jdolecek /* Wait until CMD IN is cleared. */
611 1.9 jdolecek tries = 0;
612 1.11 jdolecek for(; (bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR)
613 1.16 jdolecek & BSR_CIFR_FULL) && tries < 10000 ; tries++)
614 1.9 jdolecek delay(poll ? 1000 : 1);
615 1.16 jdolecek ;
616 1.1 jdolecek
617 1.16 jdolecek if (tries == 10000
618 1.16 jdolecek && bus_space_read_1(sc->sc_iot, sc->sc_ioh, BSR)
619 1.16 jdolecek & BSR_CIFR_FULL) {
620 1.39 cegger aprint_error_dev(&sc->sc_dev, "device too slow to accept command %d\n", cmd);
621 1.16 jdolecek return (EIO);
622 1.11 jdolecek }
623 1.1 jdolecek }
624 1.1 jdolecek
625 1.1 jdolecek /* Wait for command to complete, but maximum 15 seconds. */
626 1.16 jdolecek edc_cmd_wait(sc, 15, poll);
627 1.1 jdolecek
628 1.16 jdolecek return ((sc->sc_stat != STAT_DONE) ? EIO : 0);
629 1.1 jdolecek }
630 1.1 jdolecek
631 1.11 jdolecek #ifdef EDC_DEBUG
632 1.1 jdolecek static const char * const edc_commands[] = {
633 1.1 jdolecek "Invalid Command",
634 1.1 jdolecek "Read Data",
635 1.1 jdolecek "Write Data",
636 1.1 jdolecek "Read Verify",
637 1.1 jdolecek "Write with Verify",
638 1.1 jdolecek "Seek",
639 1.1 jdolecek "Park Head",
640 1.1 jdolecek "Get Command Complete Status",
641 1.1 jdolecek "Get Device Status",
642 1.1 jdolecek "Get Device Configuration",
643 1.1 jdolecek "Get POS Information",
644 1.1 jdolecek "Translate RBA",
645 1.1 jdolecek "Write Attachment Buffer",
646 1.1 jdolecek "Read Attachment Buffer",
647 1.1 jdolecek "Run Diagnostic Test",
648 1.1 jdolecek "Get Diagnostic Status Block",
649 1.1 jdolecek "Get MFG Header",
650 1.1 jdolecek "Format Unit",
651 1.1 jdolecek "Format Prepare",
652 1.1 jdolecek "Set MAX RBA",
653 1.1 jdolecek "Set Power Saving Mode",
654 1.1 jdolecek "Power Conservation Command",
655 1.1 jdolecek };
656 1.1 jdolecek
657 1.1 jdolecek static const char * const edc_cmd_status[256] = {
658 1.1 jdolecek "Reserved",
659 1.1 jdolecek "Command completed successfully",
660 1.1 jdolecek "Reserved",
661 1.1 jdolecek "Command completed successfully with ECC applied",
662 1.1 jdolecek "Reserved",
663 1.1 jdolecek "Command completed successfully with retries",
664 1.1 jdolecek "Format Command partially completed", /* Status available */
665 1.1 jdolecek "Command completed successfully with ECC and retries",
666 1.1 jdolecek "Command completed with Warning", /* Command Error is available */
667 1.1 jdolecek "Aborted",
668 1.1 jdolecek "Reset completed",
669 1.1 jdolecek "Data Transfer Ready", /* No Status Block available */
670 1.1 jdolecek "Command terminated with failure", /* Device Error is available */
671 1.1 jdolecek "DMA Error", /* Retry entire command as recovery */
672 1.1 jdolecek "Command Block Error",
673 1.1 jdolecek "Attention Error (Illegal Attention Code)",
674 1.1 jdolecek /* 0x14 - 0xff reserved */
675 1.1 jdolecek };
676 1.1 jdolecek
677 1.1 jdolecek static const char * const edc_cmd_error[256] = {
678 1.1 jdolecek "No Error",
679 1.1 jdolecek "Invalid parameter in the command block",
680 1.1 jdolecek "Reserved",
681 1.1 jdolecek "Command not supported",
682 1.1 jdolecek "Command Aborted per request",
683 1.1 jdolecek "Reserved",
684 1.1 jdolecek "Command rejected", /* Attachment diagnostic failure */
685 1.1 jdolecek "Format Rejected", /* Prepare Format command is required */
686 1.1 jdolecek "Format Error (Primary Map is not readable)",
687 1.1 jdolecek "Format Error (Secondary map is not readable)",
688 1.1 jdolecek "Format Error (Diagnostic Failure)",
689 1.1 jdolecek "Format Warning (Secondary Map Overflow)",
690 1.1 jdolecek "Reserved"
691 1.1 jdolecek "Format Error (Host Checksum Error)",
692 1.1 jdolecek "Reserved",
693 1.1 jdolecek "Format Warning (Push table overflow)",
694 1.1 jdolecek "Format Warning (More pushes than allowed)",
695 1.1 jdolecek "Reserved",
696 1.1 jdolecek "Format Warning (Error during verifying)",
697 1.1 jdolecek "Invalid device number for the command",
698 1.1 jdolecek /* 0x14-0xff reserved */
699 1.1 jdolecek };
700 1.1 jdolecek
701 1.1 jdolecek static const char * const edc_dev_errors[] = {
702 1.1 jdolecek "No Error",
703 1.1 jdolecek "Seek Fault", /* Device report */
704 1.1 jdolecek "Interface Fault (Parity, Attn, or Cmd Complete Error)",
705 1.1 jdolecek "Block not found (ID not found)",
706 1.1 jdolecek "Block not found (AM not found)",
707 1.1 jdolecek "Data ECC Error (hard error)",
708 1.1 jdolecek "ID CRC Error",
709 1.1 jdolecek "RBA Out of Range",
710 1.1 jdolecek "Reserved",
711 1.1 jdolecek "Defective Block",
712 1.1 jdolecek "Reserved",
713 1.1 jdolecek "Selection Error",
714 1.1 jdolecek "Reserved",
715 1.1 jdolecek "Write Fault",
716 1.1 jdolecek "No index or sector pulse",
717 1.1 jdolecek "Device Not Ready",
718 1.1 jdolecek "Seek Error", /* Attachment report */
719 1.1 jdolecek "Bad Format",
720 1.1 jdolecek "Volume Overflow",
721 1.1 jdolecek "No Data AM Found",
722 1.8 simonb "Block not found (No ID AM or ID CRC error occurred)",
723 1.1 jdolecek "Reserved",
724 1.1 jdolecek "Reserved",
725 1.1 jdolecek "No ID found on track (ID search)",
726 1.1 jdolecek /* 0x19 - 0xff reserved */
727 1.1 jdolecek };
728 1.11 jdolecek #endif /* EDC_DEBUG */
729 1.1 jdolecek
730 1.1 jdolecek static void
731 1.34 christos edc_dump_status_block(struct edc_mca_softc *sc, u_int16_t *status_block,
732 1.34 christos int intr_id)
733 1.1 jdolecek {
734 1.11 jdolecek #ifdef EDC_DEBUG
735 1.16 jdolecek printf("%s: Command: %s, Status: %s (intr %d)\n",
736 1.39 cegger device_xname(&sc->sc_dev),
737 1.11 jdolecek edc_commands[status_block[0] & 0x1f],
738 1.16 jdolecek edc_cmd_status[SB_GET_CMD_STATUS(status_block)],
739 1.16 jdolecek intr_id
740 1.1 jdolecek );
741 1.11 jdolecek #else
742 1.16 jdolecek printf("%s: Command: %d, Status: %d (intr %d)\n",
743 1.39 cegger device_xname(&sc->sc_dev),
744 1.11 jdolecek status_block[0] & 0x1f,
745 1.16 jdolecek SB_GET_CMD_STATUS(status_block),
746 1.16 jdolecek intr_id
747 1.16 jdolecek );
748 1.11 jdolecek #endif
749 1.3 jdolecek printf("%s: # left blocks: %u, last processed RBA: %u\n",
750 1.39 cegger device_xname(&sc->sc_dev),
751 1.11 jdolecek status_block[SB_RESBLKCNT_IDX],
752 1.11 jdolecek (status_block[5] << 16) | status_block[4]);
753 1.1 jdolecek
754 1.4 jdolecek if (intr_id == ISR_COMPLETED_WARNING) {
755 1.11 jdolecek #ifdef EDC_DEBUG
756 1.39 cegger aprint_error_dev(&sc->sc_dev, "Command Error Code: %s\n",
757 1.11 jdolecek edc_cmd_error[status_block[1] & 0xff]);
758 1.11 jdolecek #else
759 1.39 cegger aprint_error_dev(&sc->sc_dev, "Command Error Code: %d\n",
760 1.11 jdolecek status_block[1] & 0xff);
761 1.11 jdolecek #endif
762 1.1 jdolecek }
763 1.1 jdolecek
764 1.4 jdolecek if (intr_id == ISR_CMD_FAILED) {
765 1.11 jdolecek #ifdef EDC_DEBUG
766 1.4 jdolecek char buf[100];
767 1.4 jdolecek
768 1.4 jdolecek printf("%s: Device Error Code: %s\n",
769 1.39 cegger device_xname(&sc->sc_dev),
770 1.11 jdolecek edc_dev_errors[status_block[2] & 0xff]);
771 1.41 christos snprintb(buf, sizeof(buf),
772 1.4 jdolecek "\20"
773 1.4 jdolecek "\01SeekOrCmdComplete"
774 1.4 jdolecek "\02Track0Flag"
775 1.4 jdolecek "\03WriteFault"
776 1.4 jdolecek "\04Selected"
777 1.4 jdolecek "\05Ready"
778 1.4 jdolecek "\06Reserved0"
779 1.4 jdolecek "\07STANDBY"
780 1.41 christos "\010Reserved0", (status_block[2] & 0xff00) >> 8);
781 1.41 christos
782 1.4 jdolecek printf("%s: Device Status: %s\n",
783 1.39 cegger device_xname(&sc->sc_dev), buf);
784 1.11 jdolecek #else
785 1.11 jdolecek printf("%s: Device Error Code: %d, Device Status: %d\n",
786 1.39 cegger device_xname(&sc->sc_dev),
787 1.11 jdolecek status_block[2] & 0xff,
788 1.11 jdolecek (status_block[2] & 0xff00) >> 8);
789 1.11 jdolecek #endif
790 1.11 jdolecek }
791 1.11 jdolecek }
792 1.11 jdolecek /*
793 1.11 jdolecek * Main worker thread function.
794 1.11 jdolecek */
795 1.11 jdolecek void
796 1.34 christos edcworker(void *arg)
797 1.11 jdolecek {
798 1.11 jdolecek struct edc_mca_softc *sc = (struct edc_mca_softc *) arg;
799 1.11 jdolecek struct ed_softc *ed;
800 1.11 jdolecek struct buf *bp;
801 1.16 jdolecek int i, error;
802 1.11 jdolecek
803 1.11 jdolecek config_pending_decr();
804 1.11 jdolecek
805 1.11 jdolecek for(;;) {
806 1.11 jdolecek /* Wait until awakened */
807 1.11 jdolecek (void) tsleep(sc, PRIBIO, "edcidle", 0);
808 1.11 jdolecek
809 1.11 jdolecek for(i=0; i<sc->sc_maxdevs; ) {
810 1.11 jdolecek if ((ed = sc->sc_ed[i]) == NULL) {
811 1.11 jdolecek i++;
812 1.11 jdolecek continue;
813 1.11 jdolecek }
814 1.11 jdolecek
815 1.11 jdolecek /* Is there a buf for us ? */
816 1.11 jdolecek simple_lock(&ed->sc_q_lock);
817 1.42 yamt if ((bp = bufq_get(ed->sc_q)) == NULL) {
818 1.11 jdolecek simple_unlock(&ed->sc_q_lock);
819 1.11 jdolecek i++;
820 1.11 jdolecek continue;
821 1.11 jdolecek }
822 1.11 jdolecek simple_unlock(&ed->sc_q_lock);
823 1.11 jdolecek
824 1.11 jdolecek /* Instrumentation. */
825 1.11 jdolecek disk_busy(&ed->sc_dk);
826 1.28 perry
827 1.11 jdolecek error = edc_bio(sc, ed, bp->b_data, bp->b_bcount,
828 1.11 jdolecek bp->b_rawblkno, (bp->b_flags & B_READ), 0);
829 1.11 jdolecek
830 1.11 jdolecek if (error) {
831 1.11 jdolecek bp->b_error = error;
832 1.11 jdolecek } else {
833 1.11 jdolecek /* Set resid, most commonly to zero. */
834 1.11 jdolecek bp->b_resid = sc->sc_resblk * DEV_BSIZE;
835 1.11 jdolecek }
836 1.11 jdolecek
837 1.21 mrg disk_unbusy(&ed->sc_dk, (bp->b_bcount - bp->b_resid),
838 1.21 mrg (bp->b_flags & B_READ));
839 1.11 jdolecek rnd_add_uint32(&ed->rnd_source, bp->b_blkno);
840 1.11 jdolecek biodone(bp);
841 1.11 jdolecek }
842 1.11 jdolecek }
843 1.11 jdolecek }
844 1.11 jdolecek
845 1.11 jdolecek int
846 1.11 jdolecek edc_bio(struct edc_mca_softc *sc, struct ed_softc *ed, void *data,
847 1.11 jdolecek size_t bcount, daddr_t rawblkno, int isread, int poll)
848 1.11 jdolecek {
849 1.11 jdolecek u_int16_t cmd_args[4];
850 1.11 jdolecek int error=0, fl;
851 1.11 jdolecek u_int16_t track;
852 1.11 jdolecek u_int16_t cyl;
853 1.11 jdolecek u_int8_t head;
854 1.11 jdolecek u_int8_t sector;
855 1.11 jdolecek
856 1.11 jdolecek mca_disk_busy();
857 1.11 jdolecek
858 1.11 jdolecek /* set WAIT and R/W flag appropriately for the DMA transfer */
859 1.11 jdolecek fl = ((poll) ? BUS_DMA_NOWAIT : BUS_DMA_WAITOK)
860 1.11 jdolecek | ((isread) ? BUS_DMA_READ : BUS_DMA_WRITE);
861 1.11 jdolecek
862 1.11 jdolecek /* Load the buffer for DMA transfer. */
863 1.11 jdolecek if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap_xfer, data,
864 1.11 jdolecek bcount, NULL, BUS_DMA_STREAMING|fl))) {
865 1.11 jdolecek printf("%s: ed_bio: unable to load DMA buffer - error %d\n",
866 1.39 cegger device_xname(&ed->sc_dev), error);
867 1.11 jdolecek goto out;
868 1.11 jdolecek }
869 1.11 jdolecek
870 1.11 jdolecek bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_xfer, 0,
871 1.11 jdolecek bcount, (isread) ? BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
872 1.28 perry
873 1.11 jdolecek track = rawblkno / ed->sectors;
874 1.11 jdolecek head = track % ed->heads;
875 1.11 jdolecek cyl = track / ed->heads;
876 1.11 jdolecek sector = rawblkno % ed->sectors;
877 1.11 jdolecek
878 1.11 jdolecek /* Read or Write Data command */
879 1.11 jdolecek cmd_args[0] = 2; /* Options 0000010 */
880 1.11 jdolecek cmd_args[1] = bcount / DEV_BSIZE;
881 1.11 jdolecek cmd_args[2] = ((cyl & 0x1f) << 11) | (head << 5) | sector;
882 1.11 jdolecek cmd_args[3] = ((cyl & 0x3E0) >> 5);
883 1.11 jdolecek error = edc_run_cmd(sc,
884 1.11 jdolecek (isread) ? CMD_READ_DATA : CMD_WRITE_DATA,
885 1.11 jdolecek ed->sc_devno, cmd_args, 4, poll);
886 1.11 jdolecek
887 1.11 jdolecek /* Sync the DMA memory */
888 1.11 jdolecek if (!error) {
889 1.11 jdolecek bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap_xfer, 0, bcount,
890 1.11 jdolecek (isread)? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
891 1.11 jdolecek }
892 1.11 jdolecek
893 1.11 jdolecek /* We are done, unload buffer from DMA map */
894 1.11 jdolecek bus_dmamap_unload(sc->sc_dmat, sc->sc_dmamap_xfer);
895 1.11 jdolecek
896 1.11 jdolecek out:
897 1.11 jdolecek mca_disk_unbusy();
898 1.11 jdolecek
899 1.11 jdolecek return (error);
900 1.1 jdolecek }
901