wds.c revision 1.4 1 1.4 cgd /* $NetBSD: wds.c,v 1.4 1996/04/11 22:30:38 cgd Exp $ */
2 1.1 mycroft
3 1.1 mycroft #define WDSDIAG
4 1.1 mycroft #define integrate
5 1.1 mycroft
6 1.1 mycroft /*
7 1.1 mycroft * XXX
8 1.1 mycroft * sense data
9 1.1 mycroft * aborts
10 1.1 mycroft * resets
11 1.1 mycroft */
12 1.1 mycroft
13 1.1 mycroft /*
14 1.1 mycroft * Copyright (c) 1994, 1995 Julian Highfield. All rights reserved.
15 1.1 mycroft * Portions copyright (c) 1994, 1996 Charles M. Hannum. All rights reserved.
16 1.1 mycroft *
17 1.1 mycroft * Redistribution and use in source and binary forms, with or without
18 1.1 mycroft * modification, are permitted provided that the following conditions
19 1.1 mycroft * are met:
20 1.1 mycroft * 1. Redistributions of source code must retain the above copyright
21 1.1 mycroft * notice, this list of conditions and the following disclaimer.
22 1.1 mycroft * 2. Redistributions in binary form must reproduce the above copyright
23 1.1 mycroft * notice, this list of conditions and the following disclaimer in the
24 1.1 mycroft * documentation and/or other materials provided with the distribution.
25 1.1 mycroft * 3. All advertising materials mentioning features or use of this software
26 1.1 mycroft * must display the following acknowledgement:
27 1.1 mycroft * This product includes software developed by Julian Highfield.
28 1.1 mycroft * 4. The name of the author may not be used to endorse or promote products
29 1.1 mycroft * derived from this software without specific prior written permission.
30 1.1 mycroft *
31 1.1 mycroft * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
32 1.1 mycroft * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
33 1.1 mycroft * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
34 1.1 mycroft * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
35 1.1 mycroft * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
36 1.1 mycroft * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
37 1.1 mycroft * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
38 1.1 mycroft * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
39 1.1 mycroft * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
40 1.1 mycroft * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
41 1.1 mycroft */
42 1.1 mycroft
43 1.1 mycroft /*
44 1.1 mycroft * This driver is for the WD7000 family of SCSI controllers:
45 1.1 mycroft * the WD7000-ASC, a bus-mastering DMA controller,
46 1.1 mycroft * the WD7000-FASST2, an -ASC with new firmware and scatter-gather,
47 1.1 mycroft * and the WD7000-ASE, which was custom manufactured for Apollo
48 1.1 mycroft * workstations and seems to include an -ASC as well as floppy
49 1.1 mycroft * and ESDI interfaces.
50 1.1 mycroft *
51 1.1 mycroft * Loosely based on Theo Deraadt's unfinished attempt.
52 1.1 mycroft */
53 1.1 mycroft
54 1.1 mycroft #include <sys/types.h>
55 1.1 mycroft #include <sys/param.h>
56 1.1 mycroft #include <sys/systm.h>
57 1.1 mycroft #include <sys/kernel.h>
58 1.1 mycroft #include <sys/errno.h>
59 1.1 mycroft #include <sys/ioctl.h>
60 1.1 mycroft #include <sys/device.h>
61 1.1 mycroft #include <sys/malloc.h>
62 1.1 mycroft #include <sys/buf.h>
63 1.1 mycroft #include <sys/proc.h>
64 1.1 mycroft #include <sys/user.h>
65 1.1 mycroft
66 1.1 mycroft #include <machine/pio.h>
67 1.1 mycroft
68 1.1 mycroft #include <scsi/scsi_all.h>
69 1.1 mycroft #include <scsi/scsiconf.h>
70 1.1 mycroft
71 1.1 mycroft #include <dev/isa/isavar.h>
72 1.1 mycroft #include <dev/isa/isadmavar.h>
73 1.1 mycroft #include <dev/isa/wdsreg.h>
74 1.3 cgd
75 1.3 cgd #ifndef DDB
76 1.3 cgd #define Debugger() panic("should call debugger here (wds.c)")
77 1.3 cgd #endif /* ! DDB */
78 1.1 mycroft
79 1.1 mycroft #define WDS_MBX_SIZE 16
80 1.1 mycroft
81 1.1 mycroft #define WDS_SCB_MAX 32
82 1.1 mycroft #define SCB_HASH_SIZE 32 /* hash table size for phystokv */
83 1.1 mycroft #define SCB_HASH_SHIFT 9
84 1.1 mycroft #define SCB_HASH(x) ((((long)(x))>>SCB_HASH_SHIFT) & (SCB_HASH_SIZE - 1))
85 1.1 mycroft
86 1.1 mycroft #define wds_nextmbx(wmb, mbx, mbio) \
87 1.1 mycroft if ((wmb) == &(mbx)->mbio[WDS_MBX_SIZE - 1]) \
88 1.1 mycroft (wmb) = &(mbx)->mbio[0]; \
89 1.1 mycroft else \
90 1.1 mycroft (wmb)++;
91 1.1 mycroft
92 1.1 mycroft struct wds_mbx {
93 1.1 mycroft struct wds_mbx_out mbo[WDS_MBX_SIZE];
94 1.1 mycroft struct wds_mbx_in mbi[WDS_MBX_SIZE];
95 1.1 mycroft struct wds_mbx_out *cmbo; /* Collection Mail Box out */
96 1.1 mycroft struct wds_mbx_out *tmbo; /* Target Mail Box out */
97 1.1 mycroft struct wds_mbx_in *tmbi; /* Target Mail Box in */
98 1.1 mycroft };
99 1.1 mycroft
100 1.1 mycroft #define KVTOPHYS(x) vtophys(x)
101 1.1 mycroft
102 1.1 mycroft struct wds_softc {
103 1.1 mycroft struct device sc_dev;
104 1.1 mycroft struct isadev sc_id;
105 1.1 mycroft void *sc_ih;
106 1.1 mycroft
107 1.1 mycroft int sc_iobase;
108 1.1 mycroft int sc_irq, sc_drq;
109 1.1 mycroft
110 1.1 mycroft int sc_revision;
111 1.1 mycroft
112 1.1 mycroft struct wds_mbx sc_mbx;
113 1.1 mycroft #define wmbx (&sc->sc_mbx)
114 1.1 mycroft struct wds_scb *sc_scbhash[SCB_HASH_SIZE];
115 1.1 mycroft TAILQ_HEAD(, wds_scb) sc_free_scb, sc_waiting_scb;
116 1.1 mycroft int sc_numscbs, sc_mbofull;
117 1.1 mycroft int sc_scsi_dev;
118 1.1 mycroft struct scsi_link sc_link; /* prototype for subdevs */
119 1.1 mycroft };
120 1.1 mycroft
121 1.1 mycroft /* Define the bounce buffer length... */
122 1.1 mycroft #define BUFLEN (64*1024)
123 1.1 mycroft /* ..and how many there are. One per device! Non-FASST boards need these. */
124 1.1 mycroft #define BUFCNT 8
125 1.1 mycroft /* The macro for deciding whether the board needs a buffer. */
126 1.1 mycroft #define NEEDBUFFER(sc) (sc->sc_revision < 0x800)
127 1.1 mycroft
128 1.1 mycroft struct wds_buf {
129 1.1 mycroft u_char data[BUFLEN];
130 1.1 mycroft int busy;
131 1.1 mycroft TAILQ_ENTRY(wds_buf) chain;
132 1.1 mycroft } wds_buffer[BUFCNT];
133 1.1 mycroft
134 1.1 mycroft TAILQ_HEAD(, wds_buf) wds_free_buffer;
135 1.1 mycroft
136 1.1 mycroft integrate void wds_wait __P((int, int, int));
137 1.1 mycroft int wds_cmd __P((int, u_char *, int));
138 1.1 mycroft integrate void wds_finish_scbs __P((struct wds_softc *));
139 1.1 mycroft int wdsintr __P((void *));
140 1.1 mycroft integrate void wds_reset_scb __P((struct wds_softc *, struct wds_scb *));
141 1.1 mycroft void wds_free_scb __P((struct wds_softc *, struct wds_scb *));
142 1.1 mycroft void wds_free_buf __P((struct wds_softc *, struct wds_buf *));
143 1.1 mycroft integrate void wds_init_scb __P((struct wds_softc *, struct wds_scb *));
144 1.1 mycroft struct wds_scb *wds_get_scb __P((struct wds_softc *, int, int));
145 1.1 mycroft struct wds_buf *wds_get_buf __P((struct wds_softc *, int));
146 1.1 mycroft struct wds_scb *wds_scb_phys_kv __P((struct wds_softc *, u_long));
147 1.1 mycroft void wds_queue_scb __P((struct wds_softc *, struct wds_scb *));
148 1.1 mycroft void wds_collect_mbo __P((struct wds_softc *));
149 1.1 mycroft void wds_start_scbs __P((struct wds_softc *));
150 1.1 mycroft void wds_done __P((struct wds_softc *, struct wds_scb *, u_char));
151 1.1 mycroft int wds_find __P((struct isa_attach_args *, struct wds_softc *));
152 1.1 mycroft void wds_init __P((struct wds_softc *));
153 1.1 mycroft void wds_inquire_setup_information __P((struct wds_softc *));
154 1.1 mycroft void wdsminphys __P((struct buf *));
155 1.1 mycroft int wds_scsi_cmd __P((struct scsi_xfer *));
156 1.2 mycroft void wds_sense __P((struct wds_softc *, struct wds_scb *));
157 1.1 mycroft int wds_poll __P((struct wds_softc *, struct scsi_xfer *, int));
158 1.1 mycroft int wds_ipoll __P((struct wds_softc *, struct wds_scb *, int));
159 1.1 mycroft void wds_timeout __P((void *));
160 1.1 mycroft
161 1.1 mycroft struct scsi_adapter wds_switch = {
162 1.1 mycroft wds_scsi_cmd,
163 1.1 mycroft wdsminphys,
164 1.1 mycroft 0,
165 1.1 mycroft 0,
166 1.1 mycroft };
167 1.1 mycroft
168 1.1 mycroft /* the below structure is so we have a default dev struct for our link struct */
169 1.1 mycroft struct scsi_device wds_dev = {
170 1.1 mycroft NULL, /* Use default error handler */
171 1.1 mycroft NULL, /* have a queue, served by this */
172 1.1 mycroft NULL, /* have no async handler */
173 1.1 mycroft NULL, /* Use default 'done' routine */
174 1.1 mycroft };
175 1.1 mycroft
176 1.1 mycroft int wdsprobe __P((struct device *, void *, void *));
177 1.1 mycroft void wdsattach __P((struct device *, struct device *, void *));
178 1.1 mycroft int wdsprint __P((void *, char *));
179 1.1 mycroft
180 1.1 mycroft struct cfattach wds_ca = {
181 1.1 mycroft sizeof(struct wds_softc), wdsprobe, wdsattach
182 1.1 mycroft };
183 1.1 mycroft
184 1.1 mycroft struct cfdriver wds_cd = {
185 1.1 mycroft NULL, "wds", DV_DULL
186 1.1 mycroft };
187 1.1 mycroft
188 1.1 mycroft #define WDS_ABORT_TIMEOUT 2000 /* time to wait for abort (mSec) */
189 1.1 mycroft
190 1.1 mycroft integrate void
191 1.1 mycroft wds_wait(port, mask, val)
192 1.1 mycroft int port;
193 1.1 mycroft int mask;
194 1.1 mycroft int val;
195 1.1 mycroft {
196 1.1 mycroft
197 1.1 mycroft while ((inb(port) & mask) != val)
198 1.1 mycroft ;
199 1.1 mycroft }
200 1.1 mycroft
201 1.1 mycroft /*
202 1.1 mycroft * Write a command to the board's I/O ports.
203 1.1 mycroft */
204 1.1 mycroft int
205 1.1 mycroft wds_cmd(iobase, ibuf, icnt)
206 1.1 mycroft int iobase;
207 1.1 mycroft u_char *ibuf;
208 1.1 mycroft int icnt;
209 1.1 mycroft {
210 1.1 mycroft u_char c;
211 1.1 mycroft
212 1.1 mycroft wds_wait(iobase + WDS_STAT, WDSS_RDY, WDSS_RDY);
213 1.1 mycroft
214 1.1 mycroft while (icnt--) {
215 1.1 mycroft outb(iobase + WDS_CMD, *ibuf++);
216 1.1 mycroft wds_wait(iobase + WDS_STAT, WDSS_RDY, WDSS_RDY);
217 1.1 mycroft c = inb(iobase + WDS_STAT);
218 1.1 mycroft if (c & WDSS_REJ)
219 1.1 mycroft return 1;
220 1.1 mycroft }
221 1.1 mycroft
222 1.1 mycroft return 0;
223 1.1 mycroft }
224 1.1 mycroft
225 1.1 mycroft /*
226 1.1 mycroft * Check for the presence of a WD7000 SCSI controller.
227 1.1 mycroft */
228 1.1 mycroft int
229 1.1 mycroft wdsprobe(parent, match, aux)
230 1.1 mycroft struct device *parent;
231 1.1 mycroft void *match, *aux;
232 1.1 mycroft {
233 1.1 mycroft register struct isa_attach_args *ia = aux;
234 1.1 mycroft
235 1.1 mycroft #ifdef NEWCONFIG
236 1.1 mycroft if (ia->ia_iobase == IOBASEUNK)
237 1.1 mycroft return 0;
238 1.1 mycroft #endif
239 1.1 mycroft
240 1.1 mycroft /* See if there is a unit at this location. */
241 1.1 mycroft if (wds_find(ia, NULL) != 0)
242 1.1 mycroft return 0;
243 1.1 mycroft
244 1.1 mycroft ia->ia_msize = 0;
245 1.1 mycroft ia->ia_iosize = 8;
246 1.1 mycroft return 1;
247 1.1 mycroft }
248 1.1 mycroft
249 1.1 mycroft int
250 1.1 mycroft wdsprint(aux, name)
251 1.1 mycroft void *aux;
252 1.1 mycroft char *name;
253 1.1 mycroft {
254 1.1 mycroft
255 1.1 mycroft if (name != NULL)
256 1.1 mycroft printf("%s: scsibus ", name);
257 1.1 mycroft return UNCONF;
258 1.1 mycroft }
259 1.1 mycroft
260 1.1 mycroft /*
261 1.1 mycroft * Attach all available units.
262 1.1 mycroft */
263 1.1 mycroft void
264 1.1 mycroft wdsattach(parent, self, aux)
265 1.1 mycroft struct device *parent, *self;
266 1.1 mycroft void *aux;
267 1.1 mycroft {
268 1.1 mycroft struct isa_attach_args *ia = aux;
269 1.1 mycroft struct wds_softc *sc = (void *)self;
270 1.1 mycroft
271 1.1 mycroft if (wds_find(ia, sc) != 0)
272 1.1 mycroft panic("wdsattach: wds_find of %s failed", self->dv_xname);
273 1.1 mycroft sc->sc_iobase = ia->ia_iobase;
274 1.1 mycroft
275 1.1 mycroft if (sc->sc_drq != DRQUNK)
276 1.1 mycroft isa_dmacascade(sc->sc_drq);
277 1.1 mycroft
278 1.1 mycroft wds_init(sc);
279 1.1 mycroft TAILQ_INIT(&sc->sc_free_scb);
280 1.1 mycroft TAILQ_INIT(&sc->sc_waiting_scb);
281 1.1 mycroft wds_inquire_setup_information(sc);
282 1.1 mycroft
283 1.1 mycroft /*
284 1.1 mycroft * fill in the prototype scsi_link.
285 1.1 mycroft */
286 1.1 mycroft sc->sc_link.adapter_softc = sc;
287 1.1 mycroft sc->sc_link.adapter_target = sc->sc_scsi_dev;
288 1.1 mycroft sc->sc_link.adapter = &wds_switch;
289 1.1 mycroft sc->sc_link.device = &wds_dev;
290 1.1 mycroft /* XXX */
291 1.1 mycroft /* I don't think the -ASE can handle openings > 1. */
292 1.1 mycroft /* It gives Vendor Error 26 whenever I try it. */
293 1.1 mycroft sc->sc_link.openings = 1;
294 1.1 mycroft
295 1.1 mycroft #ifdef NEWCONFIG
296 1.1 mycroft isa_establish(&sc->sc_id, &sc->sc_dev);
297 1.1 mycroft #endif
298 1.4 cgd sc->sc_ih = isa_intr_establish(ia->ia_ic, sc->sc_irq, IST_EDGE,
299 1.4 cgd IPL_BIO, wdsintr, sc);
300 1.1 mycroft
301 1.1 mycroft /*
302 1.1 mycroft * ask the adapter what subunits are present
303 1.1 mycroft */
304 1.1 mycroft config_found(self, &sc->sc_link, wdsprint);
305 1.1 mycroft }
306 1.1 mycroft
307 1.1 mycroft integrate void
308 1.1 mycroft wds_finish_scbs(sc)
309 1.1 mycroft struct wds_softc *sc;
310 1.1 mycroft {
311 1.1 mycroft struct wds_mbx_in *wmbi;
312 1.1 mycroft struct wds_scb *scb;
313 1.1 mycroft int i;
314 1.1 mycroft
315 1.1 mycroft wmbi = wmbx->tmbi;
316 1.1 mycroft
317 1.1 mycroft if (wmbi->stat == WDS_MBI_FREE) {
318 1.1 mycroft for (i = 0; i < WDS_MBX_SIZE; i++) {
319 1.1 mycroft if (wmbi->stat != WDS_MBI_FREE) {
320 1.1 mycroft printf("%s: mbi not in round-robin order\n",
321 1.1 mycroft sc->sc_dev.dv_xname);
322 1.1 mycroft goto AGAIN;
323 1.1 mycroft }
324 1.1 mycroft wds_nextmbx(wmbi, wmbx, mbi);
325 1.1 mycroft }
326 1.1 mycroft #ifdef WDSDIAGnot
327 1.1 mycroft printf("%s: mbi interrupt with no full mailboxes\n",
328 1.1 mycroft sc->sc_dev.dv_xname);
329 1.1 mycroft #endif
330 1.1 mycroft return;
331 1.1 mycroft }
332 1.1 mycroft
333 1.1 mycroft AGAIN:
334 1.1 mycroft do {
335 1.1 mycroft scb = wds_scb_phys_kv(sc, phystol(wmbi->scb_addr));
336 1.1 mycroft if (!scb) {
337 1.1 mycroft printf("%s: bad mbi scb pointer; skipping\n",
338 1.1 mycroft sc->sc_dev.dv_xname);
339 1.1 mycroft goto next;
340 1.1 mycroft }
341 1.1 mycroft
342 1.1 mycroft #ifdef WDSDEBUG
343 1.1 mycroft if (wds_debug) {
344 1.1 mycroft u_char *cp = &scb->scsi_cmd;
345 1.1 mycroft printf("op=%x %x %x %x %x %x\n",
346 1.1 mycroft cp[0], cp[1], cp[2], cp[3], cp[4], cp[5]);
347 1.1 mycroft printf("stat %x for mbi addr = 0x%08x, ",
348 1.1 mycroft wmbi->stat, wmbi);
349 1.1 mycroft printf("scb addr = 0x%x\n", scb);
350 1.1 mycroft }
351 1.1 mycroft #endif /* WDSDEBUG */
352 1.1 mycroft
353 1.1 mycroft untimeout(wds_timeout, scb);
354 1.1 mycroft wds_done(sc, scb, wmbi->stat);
355 1.1 mycroft
356 1.1 mycroft next:
357 1.1 mycroft wmbi->stat = WDS_MBI_FREE;
358 1.1 mycroft wds_nextmbx(wmbi, wmbx, mbi);
359 1.1 mycroft } while (wmbi->stat != WDS_MBI_FREE);
360 1.1 mycroft
361 1.1 mycroft wmbx->tmbi = wmbi;
362 1.1 mycroft }
363 1.1 mycroft
364 1.1 mycroft /*
365 1.1 mycroft * Process an interrupt.
366 1.1 mycroft */
367 1.1 mycroft int
368 1.1 mycroft wdsintr(arg)
369 1.1 mycroft void *arg;
370 1.1 mycroft {
371 1.1 mycroft struct wds_softc *sc = arg;
372 1.1 mycroft int iobase = sc->sc_iobase;
373 1.1 mycroft u_char sts;
374 1.1 mycroft
375 1.1 mycroft struct wds_mbx_in *in;
376 1.1 mycroft struct wds_scb *scb;
377 1.1 mycroft u_char stat, c;
378 1.1 mycroft
379 1.1 mycroft /* Was it really an interrupt from the board? */
380 1.1 mycroft if ((inb(iobase + WDS_STAT) & WDSS_IRQ) == 0)
381 1.1 mycroft return 0;
382 1.1 mycroft
383 1.1 mycroft /* Get the interrupt status byte. */
384 1.1 mycroft c = inb(iobase + WDS_IRQSTAT) & WDSI_MASK;
385 1.1 mycroft
386 1.1 mycroft /* Acknowledge (which resets) the interrupt. */
387 1.1 mycroft outb(iobase + WDS_IRQACK, 0x00);
388 1.1 mycroft
389 1.1 mycroft switch (c) {
390 1.1 mycroft case WDSI_MSVC:
391 1.1 mycroft wds_finish_scbs(sc);
392 1.1 mycroft break;
393 1.1 mycroft
394 1.1 mycroft case WDSI_MFREE:
395 1.1 mycroft wds_start_scbs(sc);
396 1.1 mycroft break;
397 1.1 mycroft
398 1.1 mycroft default:
399 1.1 mycroft printf("%s: unrecognized interrupt type %02x", c);
400 1.1 mycroft break;
401 1.1 mycroft }
402 1.1 mycroft
403 1.1 mycroft return 1;
404 1.1 mycroft }
405 1.1 mycroft
406 1.1 mycroft integrate void
407 1.1 mycroft wds_reset_scb(sc, scb)
408 1.1 mycroft struct wds_softc *sc;
409 1.1 mycroft struct wds_scb *scb;
410 1.1 mycroft {
411 1.1 mycroft
412 1.1 mycroft scb->flags = 0;
413 1.1 mycroft }
414 1.1 mycroft
415 1.1 mycroft /*
416 1.1 mycroft * Free the command structure, the outgoing mailbox and the data buffer.
417 1.1 mycroft */
418 1.1 mycroft void
419 1.1 mycroft wds_free_scb(sc, scb)
420 1.1 mycroft struct wds_softc *sc;
421 1.1 mycroft struct wds_scb *scb;
422 1.1 mycroft {
423 1.1 mycroft int s;
424 1.1 mycroft
425 1.1 mycroft if (scb->buf != 0) {
426 1.1 mycroft wds_free_buf(sc, scb->buf);
427 1.1 mycroft scb->buf = 0;
428 1.1 mycroft }
429 1.1 mycroft
430 1.1 mycroft s = splbio();
431 1.1 mycroft
432 1.1 mycroft wds_reset_scb(sc, scb);
433 1.1 mycroft TAILQ_INSERT_HEAD(&sc->sc_free_scb, scb, chain);
434 1.1 mycroft
435 1.1 mycroft /*
436 1.1 mycroft * If there were none, wake anybody waiting for one to come free,
437 1.1 mycroft * starting with queued entries.
438 1.1 mycroft */
439 1.1 mycroft if (scb->chain.tqe_next == 0)
440 1.1 mycroft wakeup(&sc->sc_free_scb);
441 1.1 mycroft
442 1.1 mycroft splx(s);
443 1.1 mycroft }
444 1.1 mycroft
445 1.1 mycroft void
446 1.1 mycroft wds_free_buf(sc, buf)
447 1.1 mycroft struct wds_softc *sc;
448 1.1 mycroft struct wds_buf *buf;
449 1.1 mycroft {
450 1.1 mycroft int s;
451 1.1 mycroft
452 1.1 mycroft s = splbio();
453 1.1 mycroft
454 1.1 mycroft buf->busy = 0;
455 1.1 mycroft TAILQ_INSERT_HEAD(&wds_free_buffer, buf, chain);
456 1.1 mycroft
457 1.1 mycroft /*
458 1.1 mycroft * If there were none, wake anybody waiting for one to come free,
459 1.1 mycroft * starting with queued entries.
460 1.1 mycroft */
461 1.1 mycroft if (buf->chain.tqe_next == 0)
462 1.1 mycroft wakeup(&wds_free_buffer);
463 1.1 mycroft
464 1.1 mycroft splx(s);
465 1.1 mycroft }
466 1.1 mycroft
467 1.1 mycroft integrate void
468 1.1 mycroft wds_init_scb(sc, scb)
469 1.1 mycroft struct wds_softc *sc;
470 1.1 mycroft struct wds_scb *scb;
471 1.1 mycroft {
472 1.1 mycroft int hashnum;
473 1.1 mycroft
474 1.1 mycroft bzero(scb, sizeof(struct wds_scb));
475 1.1 mycroft /*
476 1.1 mycroft * put in the phystokv hash table
477 1.1 mycroft * Never gets taken out.
478 1.1 mycroft */
479 1.1 mycroft scb->hashkey = KVTOPHYS(scb);
480 1.1 mycroft hashnum = SCB_HASH(scb->hashkey);
481 1.1 mycroft scb->nexthash = sc->sc_scbhash[hashnum];
482 1.1 mycroft sc->sc_scbhash[hashnum] = scb;
483 1.1 mycroft wds_reset_scb(sc, scb);
484 1.1 mycroft }
485 1.1 mycroft
486 1.1 mycroft /*
487 1.1 mycroft * Get a free scb
488 1.1 mycroft *
489 1.1 mycroft * If there are none, see if we can allocate a new one. If so, put it in
490 1.1 mycroft * the hash table too otherwise either return an error or sleep.
491 1.1 mycroft */
492 1.1 mycroft struct wds_scb *
493 1.1 mycroft wds_get_scb(sc, flags, needbuffer)
494 1.1 mycroft struct wds_softc *sc;
495 1.1 mycroft int flags;
496 1.1 mycroft int needbuffer;
497 1.1 mycroft {
498 1.1 mycroft struct wds_scb *scb;
499 1.1 mycroft int s;
500 1.1 mycroft
501 1.1 mycroft s = splbio();
502 1.1 mycroft
503 1.1 mycroft /*
504 1.1 mycroft * If we can and have to, sleep waiting for one to come free
505 1.1 mycroft * but only if we can't allocate a new one.
506 1.1 mycroft */
507 1.1 mycroft for (;;) {
508 1.1 mycroft scb = sc->sc_free_scb.tqh_first;
509 1.1 mycroft if (scb) {
510 1.1 mycroft TAILQ_REMOVE(&sc->sc_free_scb, scb, chain);
511 1.1 mycroft break;
512 1.1 mycroft }
513 1.1 mycroft if (sc->sc_numscbs < WDS_SCB_MAX) {
514 1.1 mycroft scb = (struct wds_scb *) malloc(sizeof(struct wds_scb),
515 1.1 mycroft M_TEMP, M_NOWAIT);
516 1.1 mycroft if (!scb) {
517 1.1 mycroft printf("%s: can't malloc scb\n",
518 1.1 mycroft sc->sc_dev.dv_xname);
519 1.1 mycroft goto out;
520 1.1 mycroft }
521 1.1 mycroft wds_init_scb(sc, scb);
522 1.1 mycroft sc->sc_numscbs++;
523 1.1 mycroft break;
524 1.1 mycroft }
525 1.1 mycroft if ((flags & SCSI_NOSLEEP) != 0)
526 1.1 mycroft goto out;
527 1.1 mycroft tsleep(&sc->sc_free_scb, PRIBIO, "wdsscb", 0);
528 1.1 mycroft }
529 1.1 mycroft
530 1.1 mycroft scb->flags |= SCB_ALLOC;
531 1.1 mycroft
532 1.1 mycroft if (needbuffer) {
533 1.1 mycroft scb->buf = wds_get_buf(sc, flags);
534 1.1 mycroft if (scb->buf == 0)
535 1.1 mycroft wds_free_scb(sc, scb);
536 1.1 mycroft scb = 0;
537 1.1 mycroft }
538 1.1 mycroft
539 1.1 mycroft out:
540 1.1 mycroft splx(s);
541 1.1 mycroft return (scb);
542 1.1 mycroft }
543 1.1 mycroft
544 1.1 mycroft struct wds_buf *
545 1.1 mycroft wds_get_buf(sc, flags)
546 1.1 mycroft struct wds_softc *sc;
547 1.1 mycroft int flags;
548 1.1 mycroft {
549 1.1 mycroft struct wds_buf *buf;
550 1.1 mycroft int s;
551 1.1 mycroft
552 1.1 mycroft s = splbio();
553 1.1 mycroft
554 1.1 mycroft for (;;) {
555 1.1 mycroft buf = wds_free_buffer.tqh_first;
556 1.1 mycroft if (buf) {
557 1.1 mycroft TAILQ_REMOVE(&wds_free_buffer, buf, chain);
558 1.1 mycroft break;
559 1.1 mycroft }
560 1.1 mycroft if ((flags & SCSI_NOSLEEP) != 0)
561 1.1 mycroft goto out;
562 1.1 mycroft tsleep(&wds_free_buffer, PRIBIO, "wdsbuf", 0);
563 1.1 mycroft }
564 1.1 mycroft
565 1.1 mycroft buf->busy = 1;
566 1.1 mycroft
567 1.1 mycroft out:
568 1.1 mycroft splx(s);
569 1.1 mycroft return (buf);
570 1.1 mycroft }
571 1.1 mycroft
572 1.1 mycroft struct wds_scb *
573 1.1 mycroft wds_scb_phys_kv(sc, scb_phys)
574 1.1 mycroft struct wds_softc *sc;
575 1.1 mycroft u_long scb_phys;
576 1.1 mycroft {
577 1.1 mycroft int hashnum = SCB_HASH(scb_phys);
578 1.1 mycroft struct wds_scb *scb = sc->sc_scbhash[hashnum];
579 1.1 mycroft
580 1.1 mycroft while (scb) {
581 1.1 mycroft if (scb->hashkey == scb_phys)
582 1.1 mycroft break;
583 1.1 mycroft /* XXX Check to see if it matches the sense command block. */
584 1.1 mycroft if (scb->hashkey == (scb_phys - sizeof(struct wds_cmd)))
585 1.1 mycroft break;
586 1.1 mycroft scb = scb->nexthash;
587 1.1 mycroft }
588 1.1 mycroft return scb;
589 1.1 mycroft }
590 1.1 mycroft
591 1.1 mycroft /*
592 1.1 mycroft * Queue a SCB to be sent to the controller, and send it if possible.
593 1.1 mycroft */
594 1.1 mycroft void
595 1.1 mycroft wds_queue_scb(sc, scb)
596 1.1 mycroft struct wds_softc *sc;
597 1.1 mycroft struct wds_scb *scb;
598 1.1 mycroft {
599 1.1 mycroft
600 1.1 mycroft TAILQ_INSERT_TAIL(&sc->sc_waiting_scb, scb, chain);
601 1.1 mycroft wds_start_scbs(sc);
602 1.1 mycroft }
603 1.1 mycroft
604 1.1 mycroft /*
605 1.1 mycroft * Garbage collect mailboxes that are no longer in use.
606 1.1 mycroft */
607 1.1 mycroft void
608 1.1 mycroft wds_collect_mbo(sc)
609 1.1 mycroft struct wds_softc *sc;
610 1.1 mycroft {
611 1.1 mycroft struct wds_mbx_out *wmbo; /* Mail Box Out pointer */
612 1.1 mycroft struct wds_scb *scb;
613 1.1 mycroft
614 1.1 mycroft wmbo = wmbx->cmbo;
615 1.1 mycroft
616 1.1 mycroft while (sc->sc_mbofull > 0) {
617 1.1 mycroft if (wmbo->cmd != WDS_MBO_FREE)
618 1.1 mycroft break;
619 1.1 mycroft
620 1.1 mycroft #ifdef WDSDIAG
621 1.1 mycroft scb = wds_scb_phys_kv(sc, phystol(wmbo->scb_addr));
622 1.1 mycroft scb->flags &= ~SCB_SENDING;
623 1.1 mycroft #endif
624 1.1 mycroft
625 1.1 mycroft --sc->sc_mbofull;
626 1.1 mycroft wds_nextmbx(wmbo, wmbx, mbo);
627 1.1 mycroft }
628 1.1 mycroft
629 1.1 mycroft wmbx->cmbo = wmbo;
630 1.1 mycroft }
631 1.1 mycroft
632 1.1 mycroft /*
633 1.1 mycroft * Send as many SCBs as we have empty mailboxes for.
634 1.1 mycroft */
635 1.1 mycroft void
636 1.1 mycroft wds_start_scbs(sc)
637 1.1 mycroft struct wds_softc *sc;
638 1.1 mycroft {
639 1.1 mycroft int iobase = sc->sc_iobase;
640 1.1 mycroft struct wds_mbx_out *wmbo; /* Mail Box Out pointer */
641 1.1 mycroft struct wds_scb *scb;
642 1.1 mycroft int i;
643 1.1 mycroft u_char c;
644 1.1 mycroft
645 1.1 mycroft wmbo = wmbx->tmbo;
646 1.1 mycroft
647 1.1 mycroft while (scb = sc->sc_waiting_scb.tqh_first) {
648 1.1 mycroft if (sc->sc_mbofull >= WDS_MBX_SIZE) {
649 1.1 mycroft wds_collect_mbo(sc);
650 1.1 mycroft if (sc->sc_mbofull >= WDS_MBX_SIZE) {
651 1.1 mycroft c = WDSC_IRQMFREE;
652 1.1 mycroft wds_cmd(iobase, &c, sizeof c);
653 1.1 mycroft break;
654 1.1 mycroft }
655 1.1 mycroft }
656 1.1 mycroft
657 1.1 mycroft TAILQ_REMOVE(&sc->sc_waiting_scb, scb, chain);
658 1.1 mycroft #ifdef WDSDIAG
659 1.1 mycroft scb->flags |= SCB_SENDING;
660 1.1 mycroft #endif
661 1.1 mycroft
662 1.1 mycroft /* Link scb to mbo. */
663 1.1 mycroft if (scb->flags & SCB_SENSE)
664 1.1 mycroft ltophys(KVTOPHYS(&scb->sense), wmbo->scb_addr);
665 1.1 mycroft else
666 1.1 mycroft ltophys(KVTOPHYS(&scb->cmd), wmbo->scb_addr);
667 1.1 mycroft /* XXX What about aborts? */
668 1.1 mycroft wmbo->cmd = WDS_MBO_START;
669 1.1 mycroft
670 1.1 mycroft /* Tell the card to poll immediately. */
671 1.1 mycroft c = WDSC_MSTART(wmbo - wmbx->mbo);
672 1.1 mycroft wds_cmd(sc->sc_iobase, &c, sizeof c);
673 1.1 mycroft
674 1.1 mycroft if ((scb->flags & SCB_POLLED) == 0)
675 1.1 mycroft timeout(wds_timeout, scb, (scb->timeout * hz) / 1000);
676 1.1 mycroft
677 1.1 mycroft next:
678 1.1 mycroft ++sc->sc_mbofull;
679 1.1 mycroft wds_nextmbx(wmbo, wmbx, mbo);
680 1.1 mycroft }
681 1.1 mycroft
682 1.1 mycroft wmbx->tmbo = wmbo;
683 1.1 mycroft }
684 1.1 mycroft
685 1.1 mycroft /*
686 1.1 mycroft * Process the result of a SCSI command.
687 1.1 mycroft */
688 1.1 mycroft void
689 1.1 mycroft wds_done(sc, scb, stat)
690 1.1 mycroft struct wds_softc *sc;
691 1.1 mycroft struct wds_scb *scb;
692 1.1 mycroft u_char stat;
693 1.1 mycroft {
694 1.1 mycroft struct scsi_xfer *xs = scb->xs;
695 1.1 mycroft int i, x;
696 1.1 mycroft
697 1.1 mycroft /* XXXXX */
698 1.1 mycroft
699 1.1 mycroft /* Don't release the SCB if it was an internal command. */
700 1.1 mycroft if (xs == 0) {
701 1.1 mycroft scb->flags |= SCB_DONE;
702 1.1 mycroft return;
703 1.1 mycroft }
704 1.1 mycroft
705 1.1 mycroft /* Sense handling. */
706 1.1 mycroft if (xs->error == XS_SENSE) {
707 1.1 mycroft bcopy(&scb->sense_data, &xs->sense, sizeof (struct scsi_sense_data));
708 1.1 mycroft } else {
709 1.1 mycroft if (xs->error == XS_NOERROR) {
710 1.1 mycroft /* If all went well, or an error is acceptable. */
711 1.1 mycroft if (stat == WDS_MBI_OK) {
712 1.1 mycroft /* OK, set the result */
713 1.1 mycroft xs->resid = 0;
714 1.1 mycroft } else {
715 1.1 mycroft /* Check the mailbox status. */
716 1.1 mycroft switch (stat) {
717 1.1 mycroft case WDS_MBI_OKERR:
718 1.1 mycroft /* SCSI error recorded in scb, counts as WDS_MBI_OK */
719 1.1 mycroft switch (scb->cmd.venderr) {
720 1.1 mycroft case 0x00:
721 1.1 mycroft printf("%s: Is this an error?\n", sc->sc_dev.dv_xname);
722 1.1 mycroft xs->error = XS_DRIVER_STUFFUP; /* Experiment */
723 1.1 mycroft break;
724 1.1 mycroft case 0x01:
725 1.1 mycroft /*printf("%s: OK, see SCSI error field.\n", sc->sc_dev.dv_xname);*/
726 1.1 mycroft if (scb->cmd.stat == SCSI_CHECK) {
727 1.1 mycroft /* Do sense. */
728 1.1 mycroft wds_sense (sc, scb);
729 1.1 mycroft return;
730 1.1 mycroft } else if (scb->cmd.stat == SCSI_BUSY) {
731 1.1 mycroft xs->error = XS_BUSY;
732 1.1 mycroft }
733 1.1 mycroft break;
734 1.1 mycroft case 0x40:
735 1.1 mycroft /*printf("%s: DMA underrun!\n", sc->sc_dev.dv_xname);*/
736 1.1 mycroft /* Hits this if the target returns fewer that datalen bytes (eg my CD-ROM,
737 1.1 mycroft which returns a short version string, or if DMA is turned off etc. */
738 1.1 mycroft xs->resid = 0;
739 1.1 mycroft break;
740 1.1 mycroft default:
741 1.1 mycroft printf("%s: VENDOR ERROR %02x, scsi %02x\n", sc->sc_dev.dv_xname, scb->cmd.venderr, scb->cmd.stat);
742 1.1 mycroft xs->error = XS_DRIVER_STUFFUP; /* Experiment */
743 1.1 mycroft break;
744 1.1 mycroft }
745 1.1 mycroft break;
746 1.1 mycroft case WDS_MBI_ETIME:
747 1.1 mycroft /*
748 1.1 mycroft * The documentation isn't clear on
749 1.1 mycroft * what conditions might generate this,
750 1.1 mycroft * but selection timeouts are the only
751 1.1 mycroft * one I can think of.
752 1.1 mycroft */
753 1.1 mycroft xs->error = XS_SELTIMEOUT;
754 1.1 mycroft break;
755 1.1 mycroft case WDS_MBI_ERESET:
756 1.1 mycroft case WDS_MBI_ETARCMD:
757 1.1 mycroft case WDS_MBI_ERESEL:
758 1.1 mycroft case WDS_MBI_ESEL:
759 1.1 mycroft case WDS_MBI_EABORT:
760 1.1 mycroft case WDS_MBI_ESRESET:
761 1.1 mycroft case WDS_MBI_EHRESET:
762 1.1 mycroft xs->error = XS_DRIVER_STUFFUP;
763 1.1 mycroft break;
764 1.1 mycroft }
765 1.1 mycroft }
766 1.1 mycroft } /* else sense */
767 1.1 mycroft
768 1.1 mycroft if (NEEDBUFFER(sc) && xs->datalen) {
769 1.1 mycroft if (xs->flags & SCSI_DATA_IN)
770 1.1 mycroft bcopy(scb->buf->data, xs->data, xs->datalen);
771 1.1 mycroft }
772 1.1 mycroft } /* XS_NOERROR */
773 1.1 mycroft
774 1.1 mycroft wds_free_scb(sc, scb);
775 1.1 mycroft xs->flags |= ITSDONE;
776 1.1 mycroft scsi_done(xs);
777 1.1 mycroft }
778 1.1 mycroft
779 1.1 mycroft int
780 1.1 mycroft wds_find(ia, sc)
781 1.1 mycroft struct isa_attach_args *ia;
782 1.1 mycroft struct wds_softc *sc;
783 1.1 mycroft {
784 1.1 mycroft int iobase = ia->ia_iobase;
785 1.1 mycroft u_char c;
786 1.1 mycroft int i;
787 1.1 mycroft
788 1.1 mycroft /* XXXXX */
789 1.1 mycroft
790 1.1 mycroft /*
791 1.1 mycroft * Sending a command causes the CMDRDY bit to clear.
792 1.1 mycroft */
793 1.1 mycroft c = inb(iobase + WDS_STAT);
794 1.1 mycroft for (i = 0; i < 4; i++)
795 1.1 mycroft if ((inb(iobase+WDS_STAT) & WDSS_RDY) != 0) {
796 1.1 mycroft goto ready;
797 1.1 mycroft delay(10);
798 1.1 mycroft }
799 1.1 mycroft return 1;
800 1.1 mycroft
801 1.1 mycroft ready:
802 1.1 mycroft outb(iobase + WDS_CMD, WDSC_NOOP);
803 1.1 mycroft if (inb(iobase + WDS_STAT) & WDSS_RDY)
804 1.1 mycroft return 1;
805 1.1 mycroft
806 1.1 mycroft outb(iobase + WDS_HCR, WDSH_SCSIRESET|WDSH_ASCRESET);
807 1.1 mycroft delay(10000);
808 1.1 mycroft outb(iobase + WDS_HCR, 0x00);
809 1.1 mycroft delay(500000);
810 1.1 mycroft wds_wait(iobase + WDS_STAT, WDSS_RDY, WDSS_RDY);
811 1.1 mycroft if (inb(iobase + WDS_IRQSTAT) != 1)
812 1.1 mycroft if (inb(iobase + WDS_IRQSTAT) != 7)
813 1.1 mycroft printf("%s: failed reset!!! %2x\n", sc->sc_dev.dv_xname, inb(iobase + WDS_IRQSTAT));
814 1.1 mycroft
815 1.1 mycroft if ((inb(iobase + WDS_STAT) & (WDSS_RDY)) != WDSS_RDY) {
816 1.1 mycroft printf("%s: waiting for controller to become ready.", sc->sc_dev.dv_xname);
817 1.1 mycroft for (i = 0; i < 20; i++) {
818 1.1 mycroft if ((inb(iobase + WDS_STAT) & (WDSS_RDY)) == WDSS_RDY)
819 1.1 mycroft break;
820 1.1 mycroft printf(".");
821 1.1 mycroft delay(10000);
822 1.1 mycroft }
823 1.1 mycroft if ((inb(iobase + WDS_STAT) & (WDSS_RDY)) != WDSS_RDY) {
824 1.1 mycroft printf(" failed\n");
825 1.1 mycroft return 1;
826 1.1 mycroft }
827 1.1 mycroft printf("\n");
828 1.1 mycroft }
829 1.1 mycroft
830 1.1 mycroft if (sc != NULL) {
831 1.1 mycroft /* XXX Can we do this better? */
832 1.1 mycroft /* who are we on the scsi bus? */
833 1.1 mycroft sc->sc_scsi_dev = 7;
834 1.1 mycroft
835 1.1 mycroft sc->sc_iobase = iobase;
836 1.1 mycroft sc->sc_irq = ia->ia_irq;
837 1.1 mycroft sc->sc_drq = ia->ia_drq;
838 1.1 mycroft }
839 1.1 mycroft
840 1.1 mycroft return 0;
841 1.1 mycroft }
842 1.1 mycroft
843 1.1 mycroft /*
844 1.1 mycroft * Initialise the board and driver.
845 1.1 mycroft */
846 1.1 mycroft void
847 1.1 mycroft wds_init(sc)
848 1.1 mycroft struct wds_softc *sc;
849 1.1 mycroft {
850 1.1 mycroft int iobase = sc->sc_iobase;
851 1.1 mycroft struct wds_setup init;
852 1.1 mycroft u_char c;
853 1.1 mycroft int i;
854 1.1 mycroft
855 1.1 mycroft /*
856 1.1 mycroft * Set up initial mail box for round-robin operation.
857 1.1 mycroft */
858 1.1 mycroft for (i = 0; i < WDS_MBX_SIZE; i++) {
859 1.1 mycroft wmbx->mbo[i].cmd = WDS_MBO_FREE;
860 1.1 mycroft wmbx->mbi[i].stat = WDS_MBO_FREE;
861 1.1 mycroft }
862 1.1 mycroft wmbx->cmbo = wmbx->tmbo = &wmbx->mbo[0];
863 1.1 mycroft wmbx->tmbi = &wmbx->mbi[0];
864 1.1 mycroft sc->sc_mbofull = 0;
865 1.1 mycroft
866 1.1 mycroft /* Clear the buffers. */
867 1.1 mycroft TAILQ_INIT(&wds_free_buffer);
868 1.1 mycroft for (i = 0; i < BUFCNT; i++) {
869 1.1 mycroft wds_buffer[i].busy = 0;
870 1.1 mycroft TAILQ_INSERT_HEAD(&wds_free_buffer, &wds_buffer[i], chain);
871 1.1 mycroft }
872 1.1 mycroft
873 1.1 mycroft init.opcode = WDSC_INIT;
874 1.1 mycroft init.scsi_id = sc->sc_scsi_dev;
875 1.1 mycroft /* Record scsi id of controller for use in scsi_attach */
876 1.1 mycroft sc->sc_scsi_dev = init.scsi_id;
877 1.1 mycroft init.buson_t = 48;
878 1.1 mycroft init.busoff_t = 24;
879 1.1 mycroft init.xx = 0;
880 1.1 mycroft ltophys(KVTOPHYS(wmbx), init.mbaddr);
881 1.1 mycroft init.nomb = init.nimb = WDS_MBX_SIZE;
882 1.1 mycroft wds_cmd(iobase, (u_char *)&init, sizeof init);
883 1.1 mycroft
884 1.1 mycroft wds_wait(iobase + WDS_STAT, WDSS_INIT, WDSS_INIT);
885 1.1 mycroft
886 1.1 mycroft c = WDSC_DISUNSOL;
887 1.1 mycroft wds_cmd(iobase, &c, sizeof c);
888 1.1 mycroft
889 1.1 mycroft outb(iobase + WDS_HCR, WDSH_DRQEN);
890 1.1 mycroft }
891 1.1 mycroft
892 1.1 mycroft /*
893 1.1 mycroft * Read the board's firmware revision information.
894 1.1 mycroft */
895 1.1 mycroft void
896 1.1 mycroft wds_inquire_setup_information(sc)
897 1.1 mycroft struct wds_softc *sc;
898 1.1 mycroft {
899 1.1 mycroft struct wds_scb *scb;
900 1.1 mycroft int iobase;
901 1.1 mycroft u_char *j;
902 1.1 mycroft int s;
903 1.1 mycroft
904 1.1 mycroft iobase = sc->sc_iobase;
905 1.1 mycroft
906 1.1 mycroft if ((scb = wds_get_scb(sc, SCSI_NOSLEEP, 0)) == NULL) {
907 1.1 mycroft printf("%s: no request slot available in getvers()!\n", sc->sc_dev.dv_xname);
908 1.1 mycroft return;
909 1.1 mycroft }
910 1.1 mycroft scb->xs = NULL;
911 1.1 mycroft scb->timeout = 40;
912 1.1 mycroft
913 1.1 mycroft bzero(&scb->cmd, sizeof scb->cmd);
914 1.1 mycroft scb->cmd.write = 0x80;
915 1.1 mycroft scb->cmd.opcode = WDSX_GETFIRMREV;
916 1.1 mycroft
917 1.1 mycroft /* Will poll card, await result. */
918 1.1 mycroft outb(iobase + WDS_HCR, WDSH_DRQEN);
919 1.1 mycroft scb->flags |= SCB_POLLED;
920 1.1 mycroft
921 1.1 mycroft s = splbio();
922 1.1 mycroft wds_queue_scb(sc, scb);
923 1.1 mycroft splx(s);
924 1.1 mycroft
925 1.1 mycroft if (wds_ipoll(sc, scb, scb->timeout))
926 1.1 mycroft goto out;
927 1.1 mycroft
928 1.1 mycroft /* Print the version number. */
929 1.1 mycroft printf(": version %x.%02x ", scb->cmd.targ, scb->cmd.scb.opcode);
930 1.1 mycroft sc->sc_revision = (scb->cmd.targ << 8) | scb->cmd.scb.opcode;
931 1.1 mycroft /* Print out the version string. */
932 1.1 mycroft j = 2 + &(scb->cmd.targ);
933 1.1 mycroft while ((*j >= 32) && (*j < 128)) {
934 1.1 mycroft printf("%c", *j);
935 1.1 mycroft j++;
936 1.1 mycroft }
937 1.1 mycroft
938 1.1 mycroft out:
939 1.1 mycroft printf("\n");
940 1.1 mycroft wds_free_scb(sc, scb);
941 1.1 mycroft }
942 1.1 mycroft
943 1.1 mycroft void
944 1.1 mycroft wdsminphys(bp)
945 1.1 mycroft struct buf *bp;
946 1.1 mycroft {
947 1.1 mycroft
948 1.1 mycroft if (bp->b_bcount > ((WDS_NSEG - 1) << PGSHIFT))
949 1.1 mycroft bp->b_bcount = ((WDS_NSEG - 1) << PGSHIFT);
950 1.1 mycroft minphys(bp);
951 1.1 mycroft }
952 1.1 mycroft
953 1.1 mycroft /*
954 1.1 mycroft * Send a SCSI command.
955 1.1 mycroft */
956 1.1 mycroft int
957 1.1 mycroft wds_scsi_cmd(xs)
958 1.1 mycroft struct scsi_xfer *xs;
959 1.1 mycroft {
960 1.1 mycroft struct scsi_link *sc_link = xs->sc_link;
961 1.1 mycroft struct wds_softc *sc = sc_link->adapter_softc;
962 1.1 mycroft struct wds_scb *scb;
963 1.1 mycroft struct wds_scat_gath *sg;
964 1.1 mycroft int seg;
965 1.1 mycroft u_long thiskv, thisphys, nextphys;
966 1.1 mycroft int bytes_this_seg, bytes_this_page, datalen, flags;
967 1.1 mycroft struct iovec *iovp;
968 1.1 mycroft int s;
969 1.1 mycroft
970 1.1 mycroft int iobase;
971 1.1 mycroft
972 1.1 mycroft iobase = sc->sc_iobase;
973 1.1 mycroft
974 1.1 mycroft if (xs->flags & SCSI_RESET) {
975 1.1 mycroft /* XXX Fix me! */
976 1.1 mycroft printf("%s: reset!\n", sc->sc_dev.dv_xname);
977 1.1 mycroft wds_init(sc);
978 1.1 mycroft return COMPLETE;
979 1.1 mycroft }
980 1.1 mycroft
981 1.1 mycroft flags = xs->flags;
982 1.1 mycroft if ((scb = wds_get_scb(sc, flags, NEEDBUFFER(sc))) == NULL) {
983 1.1 mycroft xs->error = XS_DRIVER_STUFFUP;
984 1.1 mycroft return TRY_AGAIN_LATER;
985 1.1 mycroft }
986 1.1 mycroft scb->xs = xs;
987 1.1 mycroft scb->timeout = xs->timeout;
988 1.1 mycroft
989 1.1 mycroft if (xs->flags & SCSI_DATA_UIO) {
990 1.1 mycroft /* XXX Fix me! */
991 1.1 mycroft /* Let's not worry about UIO. There isn't any code for the *
992 1.1 mycroft * non-SG boards anyway! */
993 1.1 mycroft printf("%s: UIO is untested and disabled!\n", sc->sc_dev.dv_xname);
994 1.1 mycroft goto bad;
995 1.1 mycroft }
996 1.1 mycroft
997 1.1 mycroft /* Zero out the command structure. */
998 1.1 mycroft bzero(&scb->cmd, sizeof scb->cmd);
999 1.1 mycroft bcopy(xs->cmd, &scb->cmd.scb, xs->cmdlen < 12 ? xs->cmdlen : 12);
1000 1.1 mycroft
1001 1.1 mycroft /* Set up some of the command fields. */
1002 1.1 mycroft scb->cmd.targ = (xs->sc_link->target << 5) | xs->sc_link->lun;
1003 1.1 mycroft
1004 1.1 mycroft /* NOTE: cmd.write may be OK as 0x40 (disable direction checking)
1005 1.1 mycroft * on boards other than the WD-7000V-ASE. Need this for the ASE:
1006 1.1 mycroft */
1007 1.1 mycroft scb->cmd.write = (xs->flags & SCSI_DATA_IN) ? 0x80 : 0x00;
1008 1.1 mycroft
1009 1.1 mycroft if (!NEEDBUFFER(sc) && xs->datalen) {
1010 1.1 mycroft sg = scb->scat_gath;
1011 1.1 mycroft seg = 0;
1012 1.1 mycroft #ifdef TFS
1013 1.1 mycroft if (flags & SCSI_DATA_UIO) {
1014 1.1 mycroft iovp = ((struct uio *)xs->data)->uio_iov;
1015 1.1 mycroft datalen = ((struct uio *)xs->data)->uio_iovcnt;
1016 1.1 mycroft xs->datalen = 0;
1017 1.1 mycroft while (datalen && seg < WDS_NSEG) {
1018 1.1 mycroft ltophys(iovp->iov_base, sg->seg_addr);
1019 1.1 mycroft ltophys(iovp->iov_len, sg->seg_len);
1020 1.1 mycroft xs->datalen += iovp->iov_len;
1021 1.1 mycroft SC_DEBUGN(sc_link, SDEV_DB4, ("UIO(0x%x@0x%x)",
1022 1.1 mycroft iovp->iov_len, iovp->iov_base));
1023 1.1 mycroft sg++;
1024 1.1 mycroft iovp++;
1025 1.1 mycroft seg++;
1026 1.1 mycroft datalen--;
1027 1.1 mycroft }
1028 1.1 mycroft } else
1029 1.1 mycroft #endif /* TFS */
1030 1.1 mycroft {
1031 1.1 mycroft /*
1032 1.1 mycroft * Set up the scatter-gather block.
1033 1.1 mycroft */
1034 1.1 mycroft SC_DEBUG(sc_link, SDEV_DB4,
1035 1.1 mycroft ("%d @0x%x:- ", xs->datalen, xs->data));
1036 1.1 mycroft
1037 1.1 mycroft datalen = xs->datalen;
1038 1.1 mycroft thiskv = (int)xs->data;
1039 1.1 mycroft thisphys = KVTOPHYS(xs->data);
1040 1.1 mycroft
1041 1.1 mycroft while (datalen && seg < WDS_NSEG) {
1042 1.1 mycroft bytes_this_seg = 0;
1043 1.1 mycroft
1044 1.1 mycroft /* put in the base address */
1045 1.1 mycroft ltophys(thisphys, sg->seg_addr);
1046 1.1 mycroft
1047 1.1 mycroft SC_DEBUGN(sc_link, SDEV_DB4, ("0x%x", thisphys));
1048 1.1 mycroft
1049 1.1 mycroft /* do it at least once */
1050 1.1 mycroft nextphys = thisphys;
1051 1.1 mycroft while (datalen && thisphys == nextphys) {
1052 1.1 mycroft /*
1053 1.1 mycroft * This page is contiguous (physically)
1054 1.1 mycroft * with the the last, just extend the
1055 1.1 mycroft * length
1056 1.1 mycroft */
1057 1.1 mycroft /* check it fits on the ISA bus */
1058 1.1 mycroft if (thisphys > 0xFFFFFF) {
1059 1.1 mycroft printf("%s: DMA beyond"
1060 1.1 mycroft " end of ISA\n",
1061 1.1 mycroft sc->sc_dev.dv_xname);
1062 1.1 mycroft goto bad;
1063 1.1 mycroft }
1064 1.1 mycroft /* how far to the end of the page */
1065 1.1 mycroft nextphys = (thisphys & ~PGOFSET) + NBPG;
1066 1.1 mycroft bytes_this_page = nextphys - thisphys;
1067 1.1 mycroft /**** or the data ****/
1068 1.1 mycroft bytes_this_page = min(bytes_this_page,
1069 1.1 mycroft datalen);
1070 1.1 mycroft bytes_this_seg += bytes_this_page;
1071 1.1 mycroft datalen -= bytes_this_page;
1072 1.1 mycroft
1073 1.1 mycroft /* get more ready for the next page */
1074 1.1 mycroft thiskv = (thiskv & ~PGOFSET) + NBPG;
1075 1.1 mycroft if (datalen)
1076 1.1 mycroft thisphys = KVTOPHYS(thiskv);
1077 1.1 mycroft }
1078 1.1 mycroft /*
1079 1.1 mycroft * next page isn't contiguous, finish the seg
1080 1.1 mycroft */
1081 1.1 mycroft SC_DEBUGN(sc_link, SDEV_DB4,
1082 1.1 mycroft ("(0x%x)", bytes_this_seg));
1083 1.1 mycroft ltophys(bytes_this_seg, sg->seg_len);
1084 1.1 mycroft sg++;
1085 1.1 mycroft seg++;
1086 1.1 mycroft }
1087 1.1 mycroft }
1088 1.1 mycroft /* end of iov/kv decision */
1089 1.1 mycroft SC_DEBUGN(sc_link, SDEV_DB4, ("\n"));
1090 1.1 mycroft if (datalen) {
1091 1.1 mycroft /*
1092 1.1 mycroft * there's still data, must have run out of segs!
1093 1.1 mycroft */
1094 1.1 mycroft printf("%s: wds_scsi_cmd, more than %d dma segs\n",
1095 1.1 mycroft sc->sc_dev.dv_xname, WDS_NSEG);
1096 1.1 mycroft goto bad;
1097 1.1 mycroft }
1098 1.1 mycroft scb->cmd.opcode = WDSX_SCSISG;
1099 1.1 mycroft ltophys(KVTOPHYS(scb->scat_gath), scb->cmd.data);
1100 1.1 mycroft ltophys(seg * sizeof(struct wds_scat_gath), scb->cmd.len);
1101 1.1 mycroft } else if (xs->datalen > 0) {
1102 1.1 mycroft /* The board is an ASC or ASE. Do not use scatter/gather. */
1103 1.1 mycroft if (xs->datalen > BUFLEN) {
1104 1.1 mycroft printf("%s: wds_scsi_cmd, I/O too large for bounce buffer\n",
1105 1.1 mycroft sc->sc_dev.dv_xname);
1106 1.1 mycroft goto bad;
1107 1.1 mycroft }
1108 1.1 mycroft if (xs->flags & SCSI_DATA_OUT)
1109 1.1 mycroft bcopy(xs->data, scb->buf->data, xs->datalen);
1110 1.1 mycroft else
1111 1.1 mycroft bzero(scb->buf->data, xs->datalen);
1112 1.1 mycroft scb->cmd.opcode = WDSX_SCSICMD;
1113 1.1 mycroft ltophys(KVTOPHYS(scb->buf->data), scb->cmd.data);
1114 1.1 mycroft ltophys(xs->datalen, scb->cmd.len);
1115 1.1 mycroft } else {
1116 1.1 mycroft scb->cmd.opcode = WDSX_SCSICMD;
1117 1.1 mycroft ltophys(0, scb->cmd.data);
1118 1.1 mycroft ltophys(0, scb->cmd.len);
1119 1.1 mycroft }
1120 1.1 mycroft
1121 1.1 mycroft scb->cmd.stat = 0x00;
1122 1.1 mycroft scb->cmd.venderr = 0x00;
1123 1.1 mycroft ltophys(0, scb->cmd.link);
1124 1.1 mycroft
1125 1.1 mycroft /* XXX Do we really want to do this? */
1126 1.1 mycroft if (flags & SCSI_POLL) {
1127 1.1 mycroft /* Will poll card, await result. */
1128 1.1 mycroft outb(iobase + WDS_HCR, WDSH_DRQEN);
1129 1.1 mycroft scb->flags |= SCB_POLLED;
1130 1.1 mycroft } else {
1131 1.1 mycroft /* Will send command, let interrupt routine handle result. */
1132 1.1 mycroft outb(iobase + WDS_HCR, WDSH_IRQEN | WDSH_DRQEN);
1133 1.1 mycroft }
1134 1.1 mycroft
1135 1.1 mycroft s = splbio();
1136 1.1 mycroft wds_queue_scb(sc, scb);
1137 1.1 mycroft splx(s);
1138 1.1 mycroft
1139 1.1 mycroft if ((flags & SCSI_POLL) == 0)
1140 1.1 mycroft return SUCCESSFULLY_QUEUED;
1141 1.1 mycroft
1142 1.1 mycroft if (wds_poll(sc, xs, scb->timeout)) {
1143 1.1 mycroft wds_timeout(scb);
1144 1.1 mycroft if (wds_poll(sc, xs, scb->timeout))
1145 1.1 mycroft wds_timeout(scb);
1146 1.1 mycroft }
1147 1.1 mycroft return COMPLETE;
1148 1.1 mycroft
1149 1.1 mycroft bad:
1150 1.1 mycroft xs->error = XS_DRIVER_STUFFUP;
1151 1.1 mycroft wds_free_scb(sc, scb);
1152 1.1 mycroft return COMPLETE;
1153 1.1 mycroft }
1154 1.1 mycroft
1155 1.1 mycroft /*
1156 1.1 mycroft * Send a sense request.
1157 1.1 mycroft */
1158 1.2 mycroft void
1159 1.1 mycroft wds_sense(sc, scb)
1160 1.1 mycroft struct wds_softc *sc;
1161 1.1 mycroft struct wds_scb *scb;
1162 1.1 mycroft {
1163 1.1 mycroft struct scsi_xfer *xs = scb->xs;
1164 1.1 mycroft struct scsi_sense *ss = (void *)&scb->sense.scb;
1165 1.1 mycroft int s;
1166 1.1 mycroft u_char c;
1167 1.1 mycroft int i;
1168 1.1 mycroft
1169 1.1 mycroft /* XXXXX */
1170 1.1 mycroft
1171 1.1 mycroft /* Send sense request SCSI command. */
1172 1.1 mycroft xs->error = XS_SENSE;
1173 1.1 mycroft scb->flags |= SCB_SENSE;
1174 1.1 mycroft
1175 1.1 mycroft /* First, save the return values */
1176 1.1 mycroft if (NEEDBUFFER(sc) && xs->datalen) {
1177 1.1 mycroft if (xs->flags & SCSI_DATA_IN)
1178 1.1 mycroft bcopy(scb->buf->data, xs->data, xs->datalen);
1179 1.1 mycroft }
1180 1.1 mycroft
1181 1.1 mycroft /* Next, setup a request sense command block */
1182 1.1 mycroft bzero(ss, sizeof(*ss));
1183 1.1 mycroft ss->opcode = REQUEST_SENSE;
1184 1.1 mycroft ss->byte2 = xs->sc_link->lun << 5;
1185 1.1 mycroft ss->length = sizeof(struct scsi_sense_data);
1186 1.1 mycroft
1187 1.1 mycroft /* Set up some of the command fields. */
1188 1.1 mycroft scb->sense.targ = scb->cmd.targ;
1189 1.1 mycroft scb->sense.write = 0x80;
1190 1.1 mycroft scb->sense.opcode = WDSX_SCSICMD;
1191 1.1 mycroft ltophys(KVTOPHYS(&scb->sense_data), scb->sense.data);
1192 1.1 mycroft ltophys(sizeof(struct scsi_sense_data), scb->sense.len);
1193 1.1 mycroft
1194 1.1 mycroft s = splbio();
1195 1.1 mycroft wds_queue_scb(sc, scb);
1196 1.1 mycroft splx(s);
1197 1.1 mycroft
1198 1.1 mycroft /*
1199 1.1 mycroft * There's no reason for us to poll here. There are two cases:
1200 1.1 mycroft * 1) If it's a polling operation, then we're called from the interrupt
1201 1.1 mycroft * handler, and we return and continue polling.
1202 1.1 mycroft * 2) If it's an interrupt-driven operation, then it gets completed
1203 1.1 mycroft * later on when the REQUEST SENSE finishes.
1204 1.1 mycroft */
1205 1.1 mycroft }
1206 1.1 mycroft
1207 1.1 mycroft /*
1208 1.1 mycroft * Poll a particular unit, looking for a particular scb
1209 1.1 mycroft */
1210 1.1 mycroft int
1211 1.1 mycroft wds_poll(sc, xs, count)
1212 1.1 mycroft struct wds_softc *sc;
1213 1.1 mycroft struct scsi_xfer *xs;
1214 1.1 mycroft int count;
1215 1.1 mycroft {
1216 1.1 mycroft int iobase = sc->sc_iobase;
1217 1.1 mycroft
1218 1.1 mycroft /* timeouts are in msec, so we loop in 1000 usec cycles */
1219 1.1 mycroft while (count) {
1220 1.1 mycroft /*
1221 1.1 mycroft * If we had interrupts enabled, would we
1222 1.1 mycroft * have got an interrupt?
1223 1.1 mycroft */
1224 1.1 mycroft if (inb(iobase + WDS_STAT) & WDSS_IRQ)
1225 1.1 mycroft wdsintr(sc);
1226 1.1 mycroft if (xs->flags & ITSDONE)
1227 1.1 mycroft return 0;
1228 1.1 mycroft delay(1000); /* only happens in boot so ok */
1229 1.1 mycroft count--;
1230 1.1 mycroft }
1231 1.1 mycroft return 1;
1232 1.1 mycroft }
1233 1.1 mycroft
1234 1.1 mycroft /*
1235 1.1 mycroft * Poll a particular unit, looking for a particular scb
1236 1.1 mycroft */
1237 1.1 mycroft int
1238 1.1 mycroft wds_ipoll(sc, scb, count)
1239 1.1 mycroft struct wds_softc *sc;
1240 1.1 mycroft struct wds_scb *scb;
1241 1.1 mycroft int count;
1242 1.1 mycroft {
1243 1.1 mycroft int iobase = sc->sc_iobase;
1244 1.1 mycroft
1245 1.1 mycroft /* timeouts are in msec, so we loop in 1000 usec cycles */
1246 1.1 mycroft while (count) {
1247 1.1 mycroft /*
1248 1.1 mycroft * If we had interrupts enabled, would we
1249 1.1 mycroft * have got an interrupt?
1250 1.1 mycroft */
1251 1.1 mycroft if (inb(iobase + WDS_STAT) & WDSS_IRQ)
1252 1.1 mycroft wdsintr(sc);
1253 1.1 mycroft if (scb->flags & SCB_DONE)
1254 1.1 mycroft return 0;
1255 1.1 mycroft delay(1000); /* only happens in boot so ok */
1256 1.1 mycroft count--;
1257 1.1 mycroft }
1258 1.1 mycroft return 1;
1259 1.1 mycroft }
1260 1.1 mycroft
1261 1.1 mycroft void
1262 1.1 mycroft wds_timeout(arg)
1263 1.1 mycroft void *arg;
1264 1.1 mycroft {
1265 1.1 mycroft struct wds_scb *scb = arg;
1266 1.1 mycroft struct scsi_xfer *xs = scb->xs;
1267 1.1 mycroft struct scsi_link *sc_link = xs->sc_link;
1268 1.1 mycroft struct wds_softc *sc = sc_link->adapter_softc;
1269 1.1 mycroft int s;
1270 1.1 mycroft
1271 1.1 mycroft sc_print_addr(sc_link);
1272 1.1 mycroft printf("timed out");
1273 1.1 mycroft
1274 1.1 mycroft s = splbio();
1275 1.1 mycroft
1276 1.1 mycroft #ifdef WDSDIAG
1277 1.1 mycroft /*
1278 1.1 mycroft * If The scb's mbx is not free, then the board has gone south?
1279 1.1 mycroft */
1280 1.1 mycroft wds_collect_mbo(sc);
1281 1.1 mycroft if (scb->flags & SCB_SENDING) {
1282 1.1 mycroft printf("%s: not taking commands!\n", sc->sc_dev.dv_xname);
1283 1.1 mycroft Debugger();
1284 1.1 mycroft }
1285 1.1 mycroft #endif
1286 1.1 mycroft
1287 1.1 mycroft /*
1288 1.1 mycroft * If it has been through before, then
1289 1.1 mycroft * a previous abort has failed, don't
1290 1.1 mycroft * try abort again
1291 1.1 mycroft */
1292 1.1 mycroft if (scb->flags & SCB_ABORT) {
1293 1.1 mycroft /* abort timed out */
1294 1.1 mycroft printf(" AGAIN\n");
1295 1.1 mycroft /* XXX Must reset! */
1296 1.1 mycroft } else {
1297 1.1 mycroft /* abort the operation that has timed out */
1298 1.1 mycroft printf("\n");
1299 1.1 mycroft scb->xs->error = XS_TIMEOUT;
1300 1.1 mycroft scb->timeout = WDS_ABORT_TIMEOUT;
1301 1.1 mycroft scb->flags |= SCB_ABORT;
1302 1.1 mycroft wds_queue_scb(sc, scb);
1303 1.1 mycroft }
1304 1.1 mycroft
1305 1.1 mycroft splx(s);
1306 1.1 mycroft }
1307