sbic.c revision 1.8 1 1.8 scw /* $NetBSD: sbic.c,v 1.8 1998/08/22 10:55:33 scw Exp $ */
2 1.1 chuck
3 1.1 chuck /*
4 1.1 chuck * Changes Copyright (c) 1996 Steve Woodford
5 1.1 chuck * Original Copyright (c) 1994 Christian E. Hopps
6 1.1 chuck * Copyright (c) 1990 The Regents of the University of California.
7 1.1 chuck * All rights reserved.
8 1.1 chuck *
9 1.1 chuck * This code is derived from software contributed to Berkeley by
10 1.1 chuck * Van Jacobson of Lawrence Berkeley Laboratory.
11 1.1 chuck *
12 1.1 chuck * Redistribution and use in source and binary forms, with or without
13 1.1 chuck * modification, are permitted provided that the following conditions
14 1.1 chuck * are met:
15 1.1 chuck * 1. Redistributions of source code must retain the above copyright
16 1.1 chuck * notice, this list of conditions and the following disclaimer.
17 1.1 chuck * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 chuck * notice, this list of conditions and the following disclaimer in the
19 1.1 chuck * documentation and/or other materials provided with the distribution.
20 1.1 chuck * 3. All advertising materials mentioning features or use of this software
21 1.1 chuck * must display the following acknowledgement:
22 1.1 chuck * This product includes software developed by the University of
23 1.1 chuck * California, Berkeley and its contributors.
24 1.1 chuck * 4. Neither the name of the University nor the names of its contributors
25 1.1 chuck * may be used to endorse or promote products derived from this software
26 1.1 chuck * without specific prior written permission.
27 1.1 chuck *
28 1.1 chuck * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
29 1.1 chuck * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
30 1.1 chuck * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
31 1.1 chuck * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
32 1.1 chuck * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
33 1.1 chuck * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
34 1.1 chuck * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
35 1.1 chuck * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
36 1.1 chuck * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
37 1.1 chuck * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
38 1.1 chuck * SUCH DAMAGE.
39 1.1 chuck *
40 1.1 chuck * @(#)scsi.c 7.5 (Berkeley) 5/4/91
41 1.1 chuck */
42 1.1 chuck
43 1.1 chuck /*
44 1.1 chuck * Steve Woodford (SCW), Apr, 1996
45 1.1 chuck * MVME147S WD33C93 Scsi Bus Interface Controller driver,
46 1.1 chuck *
47 1.1 chuck * Basically a de-loused and tidied up version of the Amiga AMD 33C93 driver.
48 1.1 chuck *
49 1.1 chuck * The original driver used features which required at least a WD33C93A
50 1.1 chuck * chip. The '147 has the original WD33C93 chip (no 'A' suffix).
51 1.1 chuck *
52 1.1 chuck * This version of the driver is pretty well generic, so should work with
53 1.1 chuck * any flavour of WD33C93 chip.
54 1.1 chuck */
55 1.7 jonathan #include "opt_ddb.h"
56 1.1 chuck
57 1.1 chuck #include <sys/param.h>
58 1.1 chuck #include <sys/systm.h>
59 1.1 chuck #include <sys/device.h>
60 1.1 chuck #include <sys/kernel.h> /* For hz */
61 1.1 chuck #include <sys/disklabel.h>
62 1.1 chuck #include <sys/dkstat.h>
63 1.1 chuck #include <sys/buf.h>
64 1.6 bouyer #include <dev/scsipi/scsi_all.h>
65 1.6 bouyer #include <dev/scsipi/scsipi_all.h>
66 1.6 bouyer #include <dev/scsipi/scsiconf.h>
67 1.1 chuck #include <vm/vm.h>
68 1.1 chuck #include <vm/vm_kern.h>
69 1.1 chuck #include <vm/vm_page.h>
70 1.1 chuck #include <vm/pmap.h>
71 1.1 chuck #include <machine/pmap.h>
72 1.1 chuck #include <mvme68k/mvme68k/isr.h>
73 1.1 chuck #include <mvme68k/dev/dmavar.h>
74 1.1 chuck #include <mvme68k/dev/sbicreg.h>
75 1.1 chuck #include <mvme68k/dev/sbicvar.h>
76 1.1 chuck
77 1.1 chuck
78 1.1 chuck /*
79 1.1 chuck * Since I can't find this in any other header files
80 1.1 chuck */
81 1.1 chuck #define SCSI_PHASE(reg) (reg&0x07)
82 1.1 chuck
83 1.1 chuck /*
84 1.1 chuck * SCSI delays
85 1.1 chuck * In u-seconds, primarily for state changes on the SPC.
86 1.1 chuck */
87 1.1 chuck #define SBIC_CMD_WAIT 50000 /* wait per step of 'immediate' cmds */
88 1.1 chuck #define SBIC_DATA_WAIT 50000 /* wait per data in/out step */
89 1.1 chuck #define SBIC_INIT_WAIT 50000 /* wait per step (both) during init */
90 1.1 chuck
91 1.1 chuck /*
92 1.1 chuck * Convenience macro for waiting for a particular sbic event
93 1.1 chuck */
94 1.1 chuck #define SBIC_WAIT(regs, until, timeo) sbicwait(regs, until, timeo, __LINE__)
95 1.1 chuck
96 1.1 chuck extern u_int kvtop();
97 1.1 chuck
98 1.1 chuck int sbicicmd __P((struct sbic_softc *, void *, int, void *, int));
99 1.6 bouyer int sbicgo __P((struct sbic_softc *, struct scsipi_xfer *));
100 1.6 bouyer int sbicdmaok __P((struct sbic_softc *, struct scsipi_xfer *));
101 1.1 chuck int sbicwait __P((sbic_regmap_p, u_char, int , int));
102 1.1 chuck int sbiccheckdmap __P((void *, u_long, u_long));
103 1.1 chuck u_char sbicselectbus __P((struct sbic_softc *));
104 1.1 chuck int sbicxfout __P((sbic_regmap_p, int, void *));
105 1.1 chuck int sbicxfin __P((sbic_regmap_p, int, void *));
106 1.1 chuck int sbicfromscsiperiod __P((struct sbic_softc *, int));
107 1.1 chuck int sbictoscsiperiod __P((struct sbic_softc *, int));
108 1.1 chuck int sbicintr __P((struct sbic_softc *));
109 1.1 chuck int sbicpoll __P((struct sbic_softc *));
110 1.1 chuck int sbicnextstate __P((struct sbic_softc *, u_char, u_char));
111 1.1 chuck int sbicmsgin __P((struct sbic_softc *));
112 1.1 chuck int sbicabort __P((struct sbic_softc *, char *));
113 1.1 chuck void sbicxfdone __P((struct sbic_softc *));
114 1.1 chuck void sbicerror __P((struct sbic_softc *,u_char));
115 1.1 chuck void sbicreset __P((struct sbic_softc *));
116 1.1 chuck void sbic_scsidone __P((struct sbic_acb *, int));
117 1.1 chuck void sbic_sched __P((struct sbic_softc *));
118 1.1 chuck void sbic_save_ptrs __P((struct sbic_softc *));
119 1.1 chuck void sbic_load_ptrs __P((struct sbic_softc *));
120 1.1 chuck
121 1.1 chuck /*
122 1.1 chuck * Synch xfer parameters, and timing conversions
123 1.1 chuck */
124 1.1 chuck int sbic_min_period = SBIC_SYN_MIN_PERIOD; /* in cycles = f(ICLK,FSn) */
125 1.1 chuck int sbic_max_offset = SBIC_SYN_MAX_OFFSET; /* pure number */
126 1.1 chuck int sbic_cmd_wait = SBIC_CMD_WAIT;
127 1.1 chuck int sbic_data_wait = SBIC_DATA_WAIT;
128 1.1 chuck int sbic_init_wait = SBIC_INIT_WAIT;
129 1.1 chuck
130 1.1 chuck /*
131 1.1 chuck * was broken before.. now if you want this you get it for all drives
132 1.1 chuck * on sbic controllers.
133 1.1 chuck */
134 1.1 chuck u_char sbic_inhibit_sync[8];
135 1.1 chuck int sbic_enable_reselect = 1; /* Allow Disconnect / Reselect */
136 1.1 chuck int sbic_no_dma = 0; /* Use PIO transfers instead of DMA */
137 1.1 chuck int sbic_parallel_operations = 1; /* Allow command queues */
138 1.1 chuck
139 1.1 chuck /*
140 1.1 chuck * Some useful stuff for debugging purposes
141 1.1 chuck */
142 1.1 chuck #ifdef DEBUG
143 1.1 chuck int sbicdma_ops = 0; /* total DMA operations */
144 1.1 chuck int sbicdma_hits = 0; /* number of DMA chains that were contiguous */
145 1.1 chuck int sbicdma_misses = 0; /* number of DMA chains that were not contiguous */
146 1.1 chuck int sbicdma_saves = 0;
147 1.1 chuck
148 1.5 christos #define QPRINTF(a) if (sbic_debug > 1) printf a
149 1.1 chuck
150 1.1 chuck int sbic_debug = 0; /* Debug all chip related things */
151 1.1 chuck int sync_debug = 0; /* Debug all Synchronous Scsi related things */
152 1.1 chuck int reselect_debug = 0; /* Debug all reselection related things */
153 1.1 chuck int report_sense = 0; /* Always print Sense information */
154 1.1 chuck int data_pointer_debug = 0; /* Debug Data Pointer related things */
155 1.1 chuck
156 1.1 chuck void sbictimeout __P((struct sbic_softc *dev));
157 1.1 chuck
158 1.1 chuck #else
159 1.1 chuck #define QPRINTF(a) /* */
160 1.1 chuck #endif
161 1.1 chuck
162 1.1 chuck
163 1.1 chuck /*
164 1.1 chuck * default minphys routine for sbic based controllers
165 1.1 chuck */
166 1.1 chuck void
167 1.1 chuck sbic_minphys(bp)
168 1.1 chuck struct buf *bp;
169 1.1 chuck {
170 1.1 chuck /*
171 1.1 chuck * No max transfer at this level.
172 1.1 chuck */
173 1.1 chuck minphys(bp);
174 1.1 chuck }
175 1.1 chuck
176 1.1 chuck
177 1.1 chuck /*
178 1.1 chuck * Save DMA pointers. Take into account partial transfer. Shut down DMA.
179 1.1 chuck */
180 1.1 chuck void
181 1.1 chuck sbic_save_ptrs(dev)
182 1.1 chuck struct sbic_softc *dev;
183 1.1 chuck {
184 1.1 chuck sbic_regmap_p regs;
185 1.1 chuck struct sbic_acb* acb;
186 1.1 chuck int count,
187 1.1 chuck asr,
188 1.1 chuck s;
189 1.1 chuck
190 1.1 chuck /*
191 1.1 chuck * Only need to save pointers if DMA was active...
192 1.1 chuck */
193 1.1 chuck if ( dev->sc_cur == NULL || (dev->sc_flags & SBICF_INDMA) == 0 )
194 1.1 chuck return;
195 1.1 chuck
196 1.1 chuck regs = dev->sc_sbicp;
197 1.1 chuck
198 1.1 chuck s = splbio();
199 1.1 chuck
200 1.1 chuck /*
201 1.1 chuck * Wait until WD chip is idle
202 1.1 chuck */
203 1.1 chuck do {
204 1.1 chuck GET_SBIC_asr(regs, asr);
205 1.1 chuck if( asr & SBIC_ASR_DBR ) {
206 1.5 christos printf("sbic_save_ptrs: asr %02x canceled!\n", asr);
207 1.1 chuck splx(s);
208 1.1 chuck return;
209 1.1 chuck }
210 1.1 chuck } while( asr & (SBIC_ASR_BSY|SBIC_ASR_CIP) );
211 1.1 chuck
212 1.1 chuck
213 1.1 chuck /*
214 1.1 chuck * Save important state.
215 1.1 chuck * must be done before dmastop
216 1.1 chuck */
217 1.1 chuck acb = dev->sc_nexus;
218 1.1 chuck acb->sc_dmacmd = dev->sc_dmacmd;
219 1.1 chuck
220 1.1 chuck /*
221 1.1 chuck * Fetch the residual count
222 1.1 chuck */
223 1.1 chuck SBIC_TC_GET(regs, count);
224 1.1 chuck
225 1.1 chuck /*
226 1.1 chuck * Shut down DMA
227 1.1 chuck */
228 1.1 chuck dev->sc_dmastop(dev);
229 1.1 chuck
230 1.1 chuck /*
231 1.1 chuck * No longer in DMA
232 1.1 chuck */
233 1.1 chuck dev->sc_flags &= ~SBICF_INDMA;
234 1.1 chuck
235 1.1 chuck /*
236 1.1 chuck * Ensure the WD chip is back in polled I/O mode, with nothing to
237 1.1 chuck * transfer.
238 1.1 chuck */
239 1.1 chuck SBIC_TC_PUT(regs, 0);
240 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
241 1.1 chuck
242 1.1 chuck /*
243 1.1 chuck * Update current count...
244 1.1 chuck */
245 1.1 chuck acb->sc_tcnt = count;
246 1.1 chuck
247 1.1 chuck /*
248 1.1 chuck * Work out how many bytes were actually transferred
249 1.1 chuck */
250 1.1 chuck count = dev->sc_tcnt - count;
251 1.1 chuck dev->sc_tcnt = acb->sc_tcnt;
252 1.1 chuck
253 1.1 chuck /*
254 1.1 chuck * Fixup partial xfers
255 1.1 chuck */
256 1.1 chuck acb->sc_kv.dc_addr += count;
257 1.1 chuck acb->sc_kv.dc_count -= count;
258 1.1 chuck acb->sc_pa.dc_addr += count;
259 1.1 chuck acb->sc_pa.dc_count -= count >> 1;
260 1.1 chuck
261 1.1 chuck #ifdef DEBUG
262 1.1 chuck if ( data_pointer_debug )
263 1.5 christos printf("save at (%x,%x):%x\n",
264 1.1 chuck dev->sc_cur->dc_addr, dev->sc_cur->dc_count,count);
265 1.1 chuck sbicdma_saves++;
266 1.1 chuck #endif
267 1.1 chuck
268 1.1 chuck splx(s);
269 1.1 chuck }
270 1.1 chuck
271 1.1 chuck
272 1.1 chuck /*
273 1.1 chuck * DOES NOT RESTART DMA!!!
274 1.1 chuck */
275 1.1 chuck void
276 1.1 chuck sbic_load_ptrs(dev)
277 1.1 chuck struct sbic_softc *dev;
278 1.1 chuck {
279 1.1 chuck struct sbic_acb *acb = dev->sc_nexus;
280 1.1 chuck int s;
281 1.1 chuck
282 1.1 chuck if ( acb->sc_kv.dc_count == 0 ) {
283 1.1 chuck /*
284 1.1 chuck * No data to xfer
285 1.1 chuck */
286 1.1 chuck return;
287 1.1 chuck }
288 1.1 chuck
289 1.1 chuck s = splbio();
290 1.1 chuck
291 1.1 chuck /*
292 1.1 chuck * Reset the Scatter-Gather chain
293 1.1 chuck */
294 1.1 chuck dev->sc_last = dev->sc_cur = &acb->sc_pa;
295 1.1 chuck
296 1.1 chuck /*
297 1.1 chuck * Restore the Transfer Count and DMA specific data
298 1.1 chuck */
299 1.1 chuck dev->sc_tcnt = acb->sc_tcnt;
300 1.1 chuck dev->sc_dmacmd = acb->sc_dmacmd;
301 1.1 chuck
302 1.1 chuck #ifdef DEBUG
303 1.1 chuck sbicdma_ops++;
304 1.1 chuck #endif
305 1.1 chuck
306 1.1 chuck /*
307 1.1 chuck * Need to fixup new segment?
308 1.1 chuck */
309 1.1 chuck if ( dev->sc_tcnt == 0 ) {
310 1.1 chuck /*
311 1.1 chuck * sc_tcnt == 0 implies end of segment
312 1.1 chuck */
313 1.1 chuck char *vaddr, *paddr;
314 1.1 chuck int count;
315 1.1 chuck
316 1.1 chuck /*
317 1.1 chuck * do kvm to pa mappings
318 1.1 chuck */
319 1.1 chuck vaddr = acb->sc_kv.dc_addr;
320 1.1 chuck paddr = acb->sc_pa.dc_addr = (char *) kvtop(vaddr);
321 1.1 chuck
322 1.1 chuck for (count = (NBPG - ((int)vaddr & PGOFSET));
323 1.1 chuck count < acb->sc_kv.dc_count &&
324 1.1 chuck (char*)kvtop(vaddr + count + 4) == paddr + count + 4;
325 1.1 chuck count += NBPG)
326 1.1 chuck ; /* Do nothing */
327 1.1 chuck
328 1.1 chuck /*
329 1.1 chuck * If it's all contiguous...
330 1.1 chuck */
331 1.1 chuck if ( count > acb->sc_kv.dc_count ) {
332 1.1 chuck count = acb->sc_kv.dc_count;
333 1.1 chuck #ifdef DEBUG
334 1.1 chuck sbicdma_hits++;
335 1.1 chuck #endif
336 1.1 chuck }
337 1.1 chuck #ifdef DEBUG
338 1.1 chuck else
339 1.1 chuck sbicdma_misses++;
340 1.1 chuck #endif
341 1.1 chuck
342 1.1 chuck acb->sc_tcnt = count;
343 1.1 chuck acb->sc_pa.dc_count = count >> 1;
344 1.1 chuck
345 1.1 chuck #ifdef DEBUG
346 1.1 chuck if ( data_pointer_debug )
347 1.5 christos printf("DMA recalc:kv(%x,%x)pa(%x,%x)\n", acb->sc_kv.dc_addr,
348 1.1 chuck acb->sc_kv.dc_count,
349 1.1 chuck acb->sc_pa.dc_addr,
350 1.1 chuck acb->sc_tcnt);
351 1.1 chuck #endif
352 1.1 chuck
353 1.1 chuck }
354 1.1 chuck
355 1.1 chuck splx(s);
356 1.1 chuck }
357 1.1 chuck
358 1.1 chuck /*
359 1.1 chuck * used by specific sbic controller
360 1.1 chuck *
361 1.1 chuck * it appears that the higher level code does nothing with LUN's
362 1.1 chuck * so I will too. I could plug it in, however so could they
363 1.6 bouyer * in scsi_scsipi_cmd().
364 1.1 chuck */
365 1.1 chuck int
366 1.1 chuck sbic_scsicmd(xs)
367 1.6 bouyer struct scsipi_xfer *xs;
368 1.1 chuck {
369 1.6 bouyer struct scsipi_link *slp = xs->sc_link;
370 1.1 chuck struct sbic_softc *dev = slp->adapter_softc;
371 1.1 chuck struct sbic_acb *acb;
372 1.1 chuck int flags = xs->flags,
373 1.1 chuck s;
374 1.1 chuck
375 1.1 chuck if ( flags & SCSI_DATA_UIO )
376 1.1 chuck panic("sbic: scsi data uio requested");
377 1.1 chuck
378 1.1 chuck if ( dev->sc_nexus && (flags & SCSI_POLL) )
379 1.1 chuck panic("sbic_scsicmd: busy");
380 1.1 chuck
381 1.6 bouyer if ( slp->scsipi_scsi.target == slp->scsipi_scsi.adapter_target )
382 1.1 chuck return ESCAPE_NOT_SUPPORTED;
383 1.1 chuck
384 1.1 chuck s = splbio();
385 1.1 chuck
386 1.1 chuck if ( (acb = dev->free_list.tqh_first) != NULL )
387 1.1 chuck TAILQ_REMOVE(&dev->free_list, acb, chain);
388 1.1 chuck
389 1.1 chuck splx(s);
390 1.1 chuck
391 1.1 chuck if ( acb == NULL ) {
392 1.1 chuck #ifdef DEBUG
393 1.5 christos printf("sbic_scsicmd: unable to queue request for target %d\n",
394 1.6 bouyer slp->scsipi_scsi.target);
395 1.1 chuck #ifdef DDB
396 1.1 chuck Debugger();
397 1.1 chuck #endif
398 1.1 chuck #endif
399 1.1 chuck xs->error = XS_DRIVER_STUFFUP;
400 1.1 chuck
401 1.1 chuck return(TRY_AGAIN_LATER);
402 1.1 chuck }
403 1.1 chuck
404 1.1 chuck if ( flags & SCSI_DATA_IN )
405 1.1 chuck acb->flags = ACB_ACTIVE | ACB_DATAIN;
406 1.1 chuck else
407 1.1 chuck acb->flags = ACB_ACTIVE;
408 1.1 chuck
409 1.1 chuck acb->xs = xs;
410 1.1 chuck acb->clen = xs->cmdlen;
411 1.1 chuck acb->sc_kv.dc_addr = xs->data;
412 1.1 chuck acb->sc_kv.dc_count = xs->datalen;
413 1.1 chuck acb->pa_addr = xs->data ? (char *)kvtop(xs->data) : 0;
414 1.1 chuck bcopy(xs->cmd, &acb->cmd, xs->cmdlen);
415 1.1 chuck
416 1.1 chuck if ( flags & SCSI_POLL ) {
417 1.1 chuck /*
418 1.1 chuck * This has major side effects -- it locks up the machine
419 1.1 chuck */
420 1.1 chuck int stat;
421 1.1 chuck
422 1.1 chuck s = splbio();
423 1.1 chuck
424 1.1 chuck dev->sc_flags |= SBICF_ICMD;
425 1.1 chuck
426 1.1 chuck do {
427 1.1 chuck /*
428 1.1 chuck * If we already had a nexus, while away the time until idle...
429 1.1 chuck * This is likely only to happen if a reselection occurs between
430 1.1 chuck * here and our earlier check for ICMD && sc_nexus (which would
431 1.1 chuck * have resulted in a panic() had it been true).
432 1.1 chuck */
433 1.1 chuck while ( dev->sc_nexus )
434 1.1 chuck sbicpoll(dev);
435 1.1 chuck
436 1.1 chuck /*
437 1.1 chuck * Fix up the new nexus
438 1.1 chuck */
439 1.1 chuck dev->sc_nexus = acb;
440 1.1 chuck dev->sc_xs = xs;
441 1.6 bouyer dev->target = slp->scsipi_scsi.target;
442 1.6 bouyer dev->lun = slp->scsipi_scsi.lun;
443 1.1 chuck
444 1.1 chuck stat = sbicicmd(dev, &acb->cmd, acb->clen,
445 1.1 chuck acb->sc_kv.dc_addr, acb->sc_kv.dc_count);
446 1.1 chuck
447 1.1 chuck } while ( dev->sc_nexus != acb );
448 1.1 chuck
449 1.1 chuck sbic_scsidone(acb, stat);
450 1.1 chuck
451 1.1 chuck splx(s);
452 1.1 chuck
453 1.1 chuck return(COMPLETE);
454 1.1 chuck }
455 1.1 chuck
456 1.1 chuck s = splbio();
457 1.1 chuck TAILQ_INSERT_TAIL(&dev->ready_list, acb, chain);
458 1.1 chuck
459 1.1 chuck /*
460 1.1 chuck * If nothing is active, try to start it now.
461 1.1 chuck */
462 1.1 chuck if ( dev->sc_nexus == NULL )
463 1.1 chuck sbic_sched(dev);
464 1.1 chuck
465 1.1 chuck splx(s);
466 1.1 chuck
467 1.1 chuck return(SUCCESSFULLY_QUEUED);
468 1.1 chuck }
469 1.1 chuck
470 1.1 chuck /*
471 1.1 chuck * attempt to start the next available command
472 1.1 chuck */
473 1.1 chuck void
474 1.1 chuck sbic_sched(dev)
475 1.1 chuck struct sbic_softc *dev;
476 1.1 chuck {
477 1.6 bouyer struct scsipi_xfer *xs;
478 1.6 bouyer struct scsipi_link *slp = NULL; /* Gag the compiler */
479 1.1 chuck struct sbic_acb *acb;
480 1.1 chuck int flags,
481 1.1 chuck stat;
482 1.1 chuck
483 1.1 chuck /*
484 1.1 chuck * XXXSCW
485 1.1 chuck * I'll keep this test here, even though I can't see any obvious way
486 1.1 chuck * in which sbic_sched() could be called with sc_nexus non NULL
487 1.1 chuck */
488 1.1 chuck if ( dev->sc_nexus )
489 1.1 chuck return; /* a command is current active */
490 1.1 chuck
491 1.1 chuck /*
492 1.1 chuck * Loop through the ready list looking for work to do...
493 1.1 chuck */
494 1.1 chuck for (acb = dev->ready_list.tqh_first; acb; acb = acb->chain.tqe_next) {
495 1.1 chuck int i, j;
496 1.1 chuck
497 1.1 chuck slp = acb->xs->sc_link;
498 1.6 bouyer i = slp->scsipi_scsi.target;
499 1.6 bouyer j = 1 << slp->scsipi_scsi.lun;
500 1.1 chuck
501 1.1 chuck /*
502 1.1 chuck * We've found a potential command, but is the target/lun busy?
503 1.1 chuck */
504 1.1 chuck if ( (dev->sc_tinfo[i].lubusy & j) == 0 ) {
505 1.1 chuck /*
506 1.1 chuck * Nope, it's not busy, so we can use it.
507 1.1 chuck */
508 1.1 chuck dev->sc_tinfo[i].lubusy |= j;
509 1.1 chuck TAILQ_REMOVE(&dev->ready_list, acb, chain);
510 1.1 chuck dev->sc_nexus = acb;
511 1.1 chuck acb->sc_pa.dc_addr = acb->pa_addr; /* XXXX check */
512 1.1 chuck break;
513 1.1 chuck }
514 1.1 chuck }
515 1.1 chuck
516 1.1 chuck if ( acb == NULL ) {
517 1.1 chuck QPRINTF(("sbicsched: no work\n"));
518 1.1 chuck return; /* did not find an available command */
519 1.1 chuck }
520 1.1 chuck
521 1.1 chuck #ifdef DEBUG
522 1.1 chuck if ( data_pointer_debug > 1 )
523 1.6 bouyer printf("sbic_sched(%d,%d)\n", slp->scsipi_scsi.target,
524 1.6 bouyer slp->scsipi_scsi.lun);
525 1.1 chuck #endif
526 1.1 chuck
527 1.1 chuck dev->sc_xs = xs = acb->xs;
528 1.1 chuck flags = xs->flags;
529 1.1 chuck
530 1.1 chuck if ( flags & SCSI_RESET )
531 1.1 chuck sbicreset(dev);
532 1.1 chuck
533 1.1 chuck dev->sc_stat[0] = -1;
534 1.6 bouyer dev->target = slp->scsipi_scsi.target;
535 1.6 bouyer dev->lun = slp->scsipi_scsi.lun;
536 1.1 chuck
537 1.1 chuck if ( flags & SCSI_POLL || (!sbic_parallel_operations &&
538 1.1 chuck (sbicdmaok(dev, xs) == 0)) )
539 1.1 chuck stat = sbicicmd(dev, &acb->cmd, acb->clen,
540 1.1 chuck acb->sc_kv.dc_addr, acb->sc_kv.dc_count);
541 1.1 chuck else
542 1.1 chuck if ( sbicgo(dev, xs) == 0 )
543 1.1 chuck return;
544 1.1 chuck else
545 1.1 chuck stat = dev->sc_stat[0];
546 1.1 chuck
547 1.1 chuck sbic_scsidone(acb, stat);
548 1.1 chuck }
549 1.1 chuck
550 1.1 chuck void
551 1.1 chuck sbic_scsidone(acb, stat)
552 1.1 chuck struct sbic_acb *acb;
553 1.1 chuck int stat;
554 1.1 chuck {
555 1.6 bouyer struct scsipi_xfer *xs = acb->xs;
556 1.6 bouyer struct scsipi_link *slp = xs->sc_link;
557 1.1 chuck struct sbic_softc *dev = slp->adapter_softc;
558 1.1 chuck int dosched = 0;
559 1.1 chuck
560 1.1 chuck #ifdef DIAGNOSTIC
561 1.1 chuck if ( acb == NULL || xs == NULL ) {
562 1.6 bouyer printf("sbic_scsidone -- (%d,%d) no scsipi_xfer\n", dev->target, dev->lun);
563 1.1 chuck #ifdef DDB
564 1.1 chuck Debugger();
565 1.1 chuck #endif
566 1.1 chuck return;
567 1.1 chuck }
568 1.1 chuck #endif
569 1.1 chuck
570 1.1 chuck /*
571 1.1 chuck * is this right?
572 1.1 chuck */
573 1.1 chuck xs->status = stat;
574 1.1 chuck
575 1.1 chuck #ifdef DEBUG
576 1.1 chuck if ( data_pointer_debug > 1 )
577 1.6 bouyer printf("scsidone: (%d,%d)->(%d,%d)%02x\n", slp->scsipi_scsi.target,
578 1.6 bouyer slp->scsipi_scsi.lun,
579 1.1 chuck dev->target, dev->lun, stat);
580 1.1 chuck
581 1.6 bouyer if ( xs->sc_link->scsipi_scsi.target ==
582 1.6 bouyer dev->sc_link.scsipi_scsi.adapter_target )
583 1.1 chuck panic("target == hostid");
584 1.1 chuck #endif
585 1.1 chuck
586 1.1 chuck if ( xs->error == XS_NOERROR && (acb->flags & ACB_CHKSENSE) == 0 ) {
587 1.1 chuck
588 1.1 chuck if ( stat == SCSI_CHECK ) {
589 1.1 chuck /*
590 1.1 chuck * Schedule a REQUEST SENSE
591 1.1 chuck */
592 1.6 bouyer struct scsipi_sense *ss = (void *)&acb->cmd;
593 1.1 chuck
594 1.1 chuck #ifdef DEBUG
595 1.1 chuck if ( report_sense )
596 1.5 christos printf("sbic_scsidone: autosense %02x targ %d lun %d",
597 1.6 bouyer acb->cmd.opcode, slp->scsipi_scsi.target,
598 1.6 bouyer slp->scsipi_scsi.lun);
599 1.1 chuck #endif
600 1.1 chuck
601 1.1 chuck bzero(ss, sizeof(*ss));
602 1.1 chuck
603 1.1 chuck ss->opcode = REQUEST_SENSE;
604 1.6 bouyer ss->byte2 = slp->scsipi_scsi.lun << 5;
605 1.6 bouyer ss->length = sizeof(struct scsipi_sense_data);
606 1.1 chuck
607 1.1 chuck acb->clen = sizeof(*ss);
608 1.6 bouyer acb->sc_kv.dc_addr = (char *)&xs->sense.scsi_sense;
609 1.6 bouyer acb->sc_kv.dc_count = sizeof(struct scsipi_sense_data);
610 1.6 bouyer acb->pa_addr = (char *)kvtop(&xs->sense.scsi_sense); /* XXX check */
611 1.1 chuck acb->flags = ACB_ACTIVE | ACB_CHKSENSE | ACB_DATAIN;
612 1.1 chuck
613 1.1 chuck TAILQ_INSERT_HEAD(&dev->ready_list, acb, chain);
614 1.1 chuck
615 1.6 bouyer dev->sc_tinfo[slp->scsipi_scsi.target].lubusy &=
616 1.6 bouyer ~(1 << slp->scsipi_scsi.lun);
617 1.6 bouyer dev->sc_tinfo[slp->scsipi_scsi.target].senses++;
618 1.1 chuck
619 1.1 chuck if ( dev->sc_nexus == acb ) {
620 1.1 chuck dev->sc_nexus = NULL;
621 1.1 chuck dev->sc_xs = NULL;
622 1.1 chuck sbic_sched(dev);
623 1.1 chuck }
624 1.1 chuck return;
625 1.1 chuck }
626 1.1 chuck }
627 1.1 chuck
628 1.1 chuck if ( xs->error == XS_NOERROR && (acb->flags & ACB_CHKSENSE) != 0 ) {
629 1.1 chuck
630 1.1 chuck xs->error = XS_SENSE;
631 1.1 chuck
632 1.1 chuck #ifdef DEBUG
633 1.1 chuck if (report_sense)
634 1.6 bouyer printf(" => %02x %02x\n", xs->sense.scsi_sense.flags,
635 1.6 bouyer xs->sense.scsi_sense.extra_bytes[3]);
636 1.1 chuck #endif
637 1.1 chuck
638 1.1 chuck } else {
639 1.1 chuck xs->resid = 0; /* XXXX */
640 1.1 chuck }
641 1.1 chuck
642 1.1 chuck xs->flags |= ITSDONE;
643 1.1 chuck
644 1.1 chuck /*
645 1.1 chuck * Remove the ACB from whatever queue it's on. We have to do a bit of
646 1.1 chuck * a hack to figure out which queue it's on. Note that it is *not*
647 1.1 chuck * necessary to cdr down the ready queue, but we must cdr down the
648 1.1 chuck * nexus queue and see if it's there, so we can mark the unit as no
649 1.1 chuck * longer busy. This code is sickening, but it works.
650 1.1 chuck */
651 1.1 chuck if ( acb == dev->sc_nexus ) {
652 1.1 chuck
653 1.1 chuck dev->sc_nexus = NULL;
654 1.1 chuck dev->sc_xs = NULL;
655 1.1 chuck
656 1.6 bouyer dev->sc_tinfo[slp->scsipi_scsi.target].lubusy &=
657 1.6 bouyer ~(1 << slp->scsipi_scsi.lun);
658 1.1 chuck
659 1.1 chuck if ( dev->ready_list.tqh_first )
660 1.1 chuck dosched = 1; /* start next command */
661 1.1 chuck
662 1.1 chuck } else
663 1.1 chuck if ( dev->ready_list.tqh_last == &acb->chain.tqe_next ) {
664 1.1 chuck
665 1.1 chuck TAILQ_REMOVE(&dev->ready_list, acb, chain);
666 1.1 chuck
667 1.1 chuck } else {
668 1.1 chuck
669 1.8 scw struct sbic_acb *a;
670 1.1 chuck
671 1.1 chuck for (a = dev->nexus_list.tqh_first; a; a = a->chain.tqe_next) {
672 1.1 chuck if ( a == acb ) {
673 1.1 chuck TAILQ_REMOVE(&dev->nexus_list, acb, chain);
674 1.6 bouyer dev->sc_tinfo[slp->scsipi_scsi.target].lubusy &=
675 1.6 bouyer ~(1 << slp->scsipi_scsi.lun);
676 1.1 chuck break;
677 1.1 chuck }
678 1.1 chuck }
679 1.1 chuck
680 1.1 chuck if ( a )
681 1.1 chuck ;
682 1.1 chuck else if ( acb->chain.tqe_next ) {
683 1.1 chuck TAILQ_REMOVE(&dev->ready_list, acb, chain);
684 1.1 chuck } else {
685 1.5 christos printf("%s: can't find matching acb\n", dev->sc_dev.dv_xname);
686 1.1 chuck #ifdef DDB
687 1.1 chuck Debugger();
688 1.1 chuck #endif
689 1.1 chuck }
690 1.1 chuck }
691 1.1 chuck
692 1.1 chuck /*
693 1.1 chuck * Put it on the free list.
694 1.1 chuck */
695 1.1 chuck acb->flags = ACB_FREE;
696 1.1 chuck TAILQ_INSERT_HEAD(&dev->free_list, acb, chain);
697 1.1 chuck
698 1.6 bouyer dev->sc_tinfo[slp->scsipi_scsi.target].cmds++;
699 1.1 chuck
700 1.6 bouyer scsipi_done(xs);
701 1.1 chuck
702 1.1 chuck if ( dosched )
703 1.1 chuck sbic_sched(dev);
704 1.1 chuck }
705 1.1 chuck
706 1.1 chuck int
707 1.1 chuck sbicdmaok(dev, xs)
708 1.1 chuck struct sbic_softc *dev;
709 1.6 bouyer struct scsipi_xfer *xs;
710 1.1 chuck {
711 1.1 chuck if ( sbic_no_dma || xs->datalen & 0x03 || (int)xs->data & 0x03)
712 1.1 chuck return(0);
713 1.1 chuck
714 1.1 chuck /*
715 1.1 chuck * controller supports dma to any addresses?
716 1.1 chuck */
717 1.1 chuck if ( (dev->sc_flags & SBICF_BADDMA) == 0 )
718 1.1 chuck return(1);
719 1.1 chuck
720 1.1 chuck /*
721 1.1 chuck * this address is ok for dma?
722 1.1 chuck */
723 1.1 chuck if ( sbiccheckdmap(xs->data, xs->datalen, dev->sc_dmamask) == 0 )
724 1.1 chuck return(1);
725 1.1 chuck
726 1.1 chuck return(0);
727 1.1 chuck }
728 1.1 chuck
729 1.1 chuck int
730 1.1 chuck sbicwait(regs, until, timeo, line)
731 1.1 chuck sbic_regmap_p regs;
732 1.1 chuck u_char until;
733 1.1 chuck int timeo;
734 1.1 chuck int line;
735 1.1 chuck {
736 1.1 chuck u_char val;
737 1.1 chuck
738 1.1 chuck if ( timeo == 0 )
739 1.1 chuck timeo = 1000000; /* some large value.. */
740 1.1 chuck
741 1.1 chuck GET_SBIC_asr(regs, val);
742 1.1 chuck
743 1.1 chuck while ( (val & until) == 0 ) {
744 1.1 chuck
745 1.1 chuck if ( timeo-- == 0 ) {
746 1.1 chuck int csr;
747 1.1 chuck GET_SBIC_csr(regs, csr);
748 1.5 christos printf("sbicwait TIMEO @%d with asr=x%x csr=x%x\n", line, val, csr);
749 1.1 chuck #if defined(DDB) && defined(DEBUG)
750 1.1 chuck Debugger();
751 1.1 chuck #endif
752 1.1 chuck return(val); /* Maybe I should abort */
753 1.1 chuck break;
754 1.1 chuck }
755 1.1 chuck
756 1.1 chuck DELAY(1);
757 1.1 chuck GET_SBIC_asr(regs, val);
758 1.1 chuck }
759 1.1 chuck
760 1.1 chuck return(val);
761 1.1 chuck }
762 1.1 chuck
763 1.1 chuck int
764 1.1 chuck sbicabort(dev, where)
765 1.1 chuck struct sbic_softc *dev;
766 1.1 chuck char *where;
767 1.1 chuck {
768 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
769 1.1 chuck u_char csr,
770 1.1 chuck asr;
771 1.1 chuck
772 1.1 chuck GET_SBIC_asr(regs, asr);
773 1.1 chuck GET_SBIC_csr(regs, csr);
774 1.1 chuck
775 1.5 christos printf ("%s: abort %s: csr = 0x%02x, asr = 0x%02x\n",
776 1.1 chuck dev->sc_dev.dv_xname, where, csr, asr);
777 1.1 chuck
778 1.1 chuck /*
779 1.1 chuck * Clean up chip itself
780 1.1 chuck */
781 1.1 chuck if ( dev->sc_flags & SBICF_SELECTED ) {
782 1.1 chuck
783 1.1 chuck while ( asr & SBIC_ASR_DBR ) {
784 1.1 chuck /*
785 1.1 chuck * sbic is jammed w/data. need to clear it
786 1.1 chuck * But we don't know what direction it needs to go
787 1.1 chuck */
788 1.1 chuck GET_SBIC_data(regs, asr);
789 1.5 christos printf("%s: abort %s: clearing data buffer 0x%02x\n",
790 1.1 chuck dev->sc_dev.dv_xname, where, asr);
791 1.1 chuck GET_SBIC_asr(regs, asr);
792 1.1 chuck if ( asr & SBIC_ASR_DBR ) /* Not the read direction, then */
793 1.1 chuck SET_SBIC_data(regs, asr);
794 1.1 chuck GET_SBIC_asr(regs, asr);
795 1.1 chuck }
796 1.1 chuck
797 1.1 chuck WAIT_CIP(regs);
798 1.1 chuck
799 1.5 christos printf("%s: sbicabort - sending ABORT command\n", dev->sc_dev.dv_xname);
800 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_ABORT);
801 1.1 chuck WAIT_CIP(regs);
802 1.1 chuck
803 1.1 chuck GET_SBIC_asr(regs, asr);
804 1.1 chuck
805 1.1 chuck if ( asr & (SBIC_ASR_BSY|SBIC_ASR_LCI) ) {
806 1.1 chuck /*
807 1.1 chuck * ok, get more drastic..
808 1.1 chuck */
809 1.5 christos printf("%s: sbicabort - asr %x, trying to reset\n",
810 1.1 chuck dev->sc_dev.dv_xname, asr);
811 1.1 chuck sbicreset(dev);
812 1.1 chuck dev->sc_flags &= ~SBICF_SELECTED;
813 1.2 chuck return SBIC_STATE_ERROR;
814 1.1 chuck }
815 1.1 chuck
816 1.5 christos printf("%s: sbicabort - sending DISC command\n", dev->sc_dev.dv_xname);
817 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_DISC);
818 1.1 chuck
819 1.1 chuck do {
820 1.1 chuck SBIC_WAIT (regs, SBIC_ASR_INT, 0);
821 1.1 chuck GET_SBIC_asr(regs, asr);
822 1.1 chuck GET_SBIC_csr (regs, csr);
823 1.1 chuck QPRINTF(("csr: 0x%02x, asr: 0x%02x\n", csr, asr));
824 1.1 chuck } while ( (csr != SBIC_CSR_DISC) && (csr != SBIC_CSR_DISC_1) &&
825 1.1 chuck (csr != SBIC_CSR_CMD_INVALID) );
826 1.1 chuck
827 1.1 chuck /*
828 1.1 chuck * lets just hope it worked..
829 1.1 chuck */
830 1.1 chuck dev->sc_flags &= ~SBICF_SELECTED;
831 1.1 chuck }
832 1.1 chuck
833 1.2 chuck return SBIC_STATE_ERROR;
834 1.1 chuck }
835 1.1 chuck
836 1.1 chuck
837 1.1 chuck /*
838 1.1 chuck * Initialize driver-private structures
839 1.1 chuck */
840 1.1 chuck void
841 1.1 chuck sbicinit(dev)
842 1.1 chuck struct sbic_softc *dev;
843 1.1 chuck {
844 1.1 chuck u_int i;
845 1.1 chuck
846 1.1 chuck extern u_long scsi_nosync;
847 1.1 chuck extern int shift_nosync;
848 1.1 chuck
849 1.1 chuck if ( (dev->sc_flags & SBICF_ALIVE) == 0 ) {
850 1.1 chuck
851 1.1 chuck struct sbic_acb *acb;
852 1.1 chuck
853 1.1 chuck TAILQ_INIT(&dev->ready_list);
854 1.1 chuck TAILQ_INIT(&dev->nexus_list);
855 1.1 chuck TAILQ_INIT(&dev->free_list);
856 1.1 chuck
857 1.1 chuck dev->sc_nexus = NULL;
858 1.1 chuck dev->sc_xs = NULL;
859 1.1 chuck
860 1.1 chuck acb = dev->sc_acb;
861 1.1 chuck bzero(acb, sizeof(dev->sc_acb));
862 1.1 chuck
863 1.1 chuck for (i = 0; i < sizeof(dev->sc_acb) / sizeof(*acb); i++) {
864 1.1 chuck TAILQ_INSERT_TAIL(&dev->free_list, acb, chain);
865 1.1 chuck acb++;
866 1.1 chuck }
867 1.1 chuck
868 1.1 chuck bzero(dev->sc_tinfo, sizeof(dev->sc_tinfo));
869 1.1 chuck
870 1.1 chuck #ifdef DEBUG
871 1.1 chuck /*
872 1.1 chuck * make sure timeout is really not needed
873 1.1 chuck */
874 1.1 chuck timeout((void *)sbictimeout, dev, 30 * hz);
875 1.1 chuck #endif
876 1.1 chuck
877 1.1 chuck } else
878 1.1 chuck panic("sbic: reinitializing driver!");
879 1.1 chuck
880 1.1 chuck dev->sc_flags |= SBICF_ALIVE;
881 1.1 chuck dev->sc_flags &= ~SBICF_SELECTED;
882 1.1 chuck
883 1.1 chuck /*
884 1.1 chuck * initialize inhibit array
885 1.1 chuck */
886 1.1 chuck if ( scsi_nosync ) {
887 1.1 chuck
888 1.1 chuck u_int inhibit_sync = (scsi_nosync >> shift_nosync) & 0xff;
889 1.1 chuck
890 1.1 chuck shift_nosync += 8;
891 1.1 chuck
892 1.1 chuck #ifdef DEBUG
893 1.1 chuck if ( inhibit_sync )
894 1.5 christos printf("%s: Inhibiting synchronous transfer %02x\n",
895 1.1 chuck dev->sc_dev.dv_xname, inhibit_sync);
896 1.1 chuck #endif
897 1.1 chuck for (i = 0; i < 8; ++i) {
898 1.1 chuck if ( inhibit_sync & (1 << i) )
899 1.1 chuck sbic_inhibit_sync[i] = 1;
900 1.1 chuck }
901 1.1 chuck }
902 1.1 chuck
903 1.1 chuck sbicreset(dev);
904 1.1 chuck }
905 1.1 chuck
906 1.1 chuck void
907 1.1 chuck sbicreset(dev)
908 1.1 chuck struct sbic_softc *dev;
909 1.1 chuck {
910 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
911 1.1 chuck u_int my_id,
912 1.1 chuck s;
913 1.1 chuck u_char csr;
914 1.1 chuck
915 1.1 chuck s = splbio();
916 1.1 chuck
917 1.6 bouyer my_id = dev->sc_link.scsipi_scsi.adapter_target & SBIC_ID_MASK;
918 1.1 chuck
919 1.1 chuck if (dev->sc_clkfreq < 110)
920 1.1 chuck my_id |= SBIC_ID_FS_8_10;
921 1.1 chuck else if (dev->sc_clkfreq < 160)
922 1.1 chuck my_id |= SBIC_ID_FS_12_15;
923 1.1 chuck else if (dev->sc_clkfreq < 210)
924 1.1 chuck my_id |= SBIC_ID_FS_16_20;
925 1.1 chuck
926 1.1 chuck SET_SBIC_myid(regs, my_id);
927 1.1 chuck
928 1.1 chuck /*
929 1.1 chuck * Reset the chip
930 1.1 chuck */
931 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_RESET);
932 1.1 chuck DELAY(25);
933 1.1 chuck
934 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, 0);
935 1.1 chuck GET_SBIC_csr(regs, csr); /* clears interrupt also */
936 1.1 chuck
937 1.1 chuck /*
938 1.1 chuck * Set up various chip parameters
939 1.1 chuck */
940 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
941 1.1 chuck
942 1.1 chuck /*
943 1.1 chuck * don't allow Selection (SBIC_RID_ES)
944 1.1 chuck * until we can handle target mode!!
945 1.1 chuck */
946 1.1 chuck SET_SBIC_rselid(regs, SBIC_RID_ER);
947 1.1 chuck
948 1.1 chuck /*
949 1.1 chuck * Asynchronous for now
950 1.1 chuck */
951 1.1 chuck SET_SBIC_syn(regs, 0);
952 1.1 chuck
953 1.1 chuck /*
954 1.1 chuck * Anything else was zeroed by reset
955 1.1 chuck */
956 1.1 chuck splx(s);
957 1.1 chuck
958 1.1 chuck dev->sc_flags &= ~SBICF_SELECTED;
959 1.1 chuck }
960 1.1 chuck
961 1.1 chuck void
962 1.1 chuck sbicerror(dev, csr)
963 1.1 chuck struct sbic_softc *dev;
964 1.1 chuck u_char csr;
965 1.1 chuck {
966 1.6 bouyer struct scsipi_xfer *xs = dev->sc_xs;
967 1.1 chuck
968 1.1 chuck #ifdef DIAGNOSTIC
969 1.1 chuck if ( xs == NULL )
970 1.1 chuck panic("sbicerror: dev->sc_xs == NULL");
971 1.1 chuck #endif
972 1.1 chuck
973 1.1 chuck if ( xs->flags & SCSI_SILENT )
974 1.1 chuck return;
975 1.1 chuck
976 1.5 christos printf("%s: csr == 0x%02x\n", dev->sc_dev.dv_xname, csr);
977 1.1 chuck }
978 1.1 chuck
979 1.1 chuck /*
980 1.1 chuck * select the bus, return when selected or error.
981 1.1 chuck *
982 1.1 chuck * Returns the current CSR following selection and optionally MSG out phase.
983 1.1 chuck * i.e. the returned CSR *should* indicate CMD phase...
984 1.1 chuck * If the return value is 0, some error happened.
985 1.1 chuck */
986 1.1 chuck u_char
987 1.1 chuck sbicselectbus(dev)
988 1.1 chuck struct sbic_softc *dev;
989 1.1 chuck {
990 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
991 1.1 chuck u_char target = dev->target,
992 1.1 chuck lun = dev->lun,
993 1.1 chuck asr,
994 1.1 chuck csr,
995 1.1 chuck id;
996 1.1 chuck
997 1.1 chuck /*
998 1.1 chuck * if we're already selected, return (XXXX panic maybe?)
999 1.1 chuck */
1000 1.1 chuck if ( dev->sc_flags & SBICF_SELECTED )
1001 1.1 chuck return(0);
1002 1.1 chuck
1003 1.1 chuck QPRINTF(("sbicselectbus %d: ", target));
1004 1.1 chuck
1005 1.1 chuck /*
1006 1.1 chuck * issue select
1007 1.1 chuck */
1008 1.1 chuck SET_SBIC_selid(regs, target);
1009 1.1 chuck SET_SBIC_timeo(regs, SBIC_TIMEOUT(250, dev->sc_clkfreq));
1010 1.1 chuck
1011 1.1 chuck GET_SBIC_asr(regs, asr);
1012 1.1 chuck
1013 1.1 chuck if ( asr & (SBIC_ASR_INT|SBIC_ASR_BSY) ) {
1014 1.1 chuck /*
1015 1.1 chuck * This means we got ourselves reselected upon
1016 1.1 chuck */
1017 1.1 chuck QPRINTF(("WD busy (reselect?)\n"));
1018 1.1 chuck return 0;
1019 1.1 chuck }
1020 1.1 chuck
1021 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN);
1022 1.1 chuck
1023 1.1 chuck /*
1024 1.1 chuck * wait for select (merged from seperate function may need
1025 1.1 chuck * cleanup)
1026 1.1 chuck */
1027 1.1 chuck WAIT_CIP(regs);
1028 1.1 chuck
1029 1.1 chuck do {
1030 1.1 chuck
1031 1.1 chuck asr = SBIC_WAIT(regs, SBIC_ASR_INT | SBIC_ASR_LCI, 0);
1032 1.1 chuck
1033 1.1 chuck if ( asr & SBIC_ASR_LCI ) {
1034 1.1 chuck QPRINTF(("late LCI: asr %02x\n", asr));
1035 1.1 chuck return 0;
1036 1.1 chuck }
1037 1.1 chuck
1038 1.1 chuck /*
1039 1.1 chuck * Clear interrupt
1040 1.1 chuck */
1041 1.1 chuck GET_SBIC_csr (regs, csr);
1042 1.1 chuck
1043 1.1 chuck QPRINTF(("%02x ", csr));
1044 1.1 chuck
1045 1.1 chuck /*
1046 1.1 chuck * Reselected from under our feet?
1047 1.1 chuck */
1048 1.1 chuck if ( csr == SBIC_CSR_RSLT_NI || csr == SBIC_CSR_RSLT_IFY ) {
1049 1.1 chuck QPRINTF(("got reselected, asr %02x\n", asr));
1050 1.1 chuck /*
1051 1.1 chuck * We need to handle this now so we don't lock up later
1052 1.1 chuck */
1053 1.1 chuck sbicnextstate(dev, csr, asr);
1054 1.1 chuck
1055 1.1 chuck return 0;
1056 1.1 chuck }
1057 1.1 chuck
1058 1.1 chuck /*
1059 1.1 chuck * Whoops!
1060 1.1 chuck */
1061 1.1 chuck if ( csr == SBIC_CSR_SLT || csr == SBIC_CSR_SLT_ATN ) {
1062 1.1 chuck panic("sbicselectbus: target issued select!");
1063 1.1 chuck return 0;
1064 1.1 chuck }
1065 1.1 chuck
1066 1.1 chuck } while (csr != (SBIC_CSR_MIS_2 | MESG_OUT_PHASE) &&
1067 1.1 chuck csr != (SBIC_CSR_MIS_2 | CMD_PHASE) &&
1068 1.1 chuck csr != SBIC_CSR_SEL_TIMEO);
1069 1.1 chuck
1070 1.1 chuck /*
1071 1.1 chuck * Anyone at home?
1072 1.1 chuck */
1073 1.1 chuck if ( csr == SBIC_CSR_SEL_TIMEO ) {
1074 1.1 chuck dev->sc_xs->error = XS_SELTIMEOUT;
1075 1.1 chuck QPRINTF(("Selection Timeout\n"));
1076 1.1 chuck return 0;
1077 1.1 chuck }
1078 1.1 chuck
1079 1.1 chuck QPRINTF(("Selection Complete\n"));
1080 1.1 chuck
1081 1.1 chuck /*
1082 1.1 chuck * Assume we're now selected
1083 1.1 chuck */
1084 1.1 chuck GET_SBIC_selid(regs, id);
1085 1.1 chuck dev->target = id;
1086 1.1 chuck dev->lun = lun;
1087 1.1 chuck dev->sc_flags |= SBICF_SELECTED;
1088 1.1 chuck
1089 1.1 chuck /*
1090 1.1 chuck * Enable (or not) reselection
1091 1.1 chuck * XXXSCW This is probably not necessary since we don't use use the
1092 1.2 chuck * Select-and-Xfer-with-ATN command to initiate a selection...
1093 1.1 chuck */
1094 1.1 chuck if ( !sbic_enable_reselect && dev->nexus_list.tqh_first == NULL)
1095 1.1 chuck SET_SBIC_rselid (regs, 0);
1096 1.1 chuck else
1097 1.1 chuck SET_SBIC_rselid (regs, SBIC_RID_ER);
1098 1.1 chuck
1099 1.1 chuck /*
1100 1.1 chuck * We only really need to do anything when the target goes to MSG out
1101 1.1 chuck * If the device ignored ATN, it's probably old and brain-dead,
1102 1.1 chuck * but we'll try to support it anyhow.
1103 1.1 chuck * If it doesn't support message out, it definately doesn't
1104 1.1 chuck * support synchronous transfers, so no point in even asking...
1105 1.1 chuck */
1106 1.1 chuck if ( csr == (SBIC_CSR_MIS_2 | MESG_OUT_PHASE) ) {
1107 1.1 chuck /*
1108 1.1 chuck * Send identify message (SCSI-2 requires an identify msg)
1109 1.1 chuck */
1110 1.1 chuck if ( sbic_inhibit_sync[id] && dev->sc_sync[id].state == SYNC_START ) {
1111 1.1 chuck /*
1112 1.1 chuck * Handle drives that don't want to be asked
1113 1.1 chuck * whether to go sync at all.
1114 1.1 chuck */
1115 1.1 chuck dev->sc_sync[id].offset = 0;
1116 1.1 chuck dev->sc_sync[id].period = sbic_min_period;
1117 1.1 chuck dev->sc_sync[id].state = SYNC_DONE;
1118 1.1 chuck }
1119 1.1 chuck
1120 1.1 chuck /*
1121 1.1 chuck * Do we need to negotiate Synchronous Xfers for this target?
1122 1.1 chuck */
1123 1.1 chuck if ( dev->sc_sync[id].state != SYNC_START ) {
1124 1.1 chuck /*
1125 1.1 chuck * Nope, we've already negotiated.
1126 1.1 chuck * Now see if we should allow the target to disconnect/reselect...
1127 1.1 chuck */
1128 1.1 chuck if ( dev->sc_xs->flags & SCSI_POLL || dev->sc_flags & SBICF_ICMD ||
1129 1.1 chuck !sbic_enable_reselect )
1130 1.1 chuck SEND_BYTE (regs, MSG_IDENTIFY | lun);
1131 1.1 chuck else
1132 1.1 chuck SEND_BYTE (regs, MSG_IDENTIFY_DR | lun);
1133 1.1 chuck
1134 1.1 chuck } else {
1135 1.1 chuck /*
1136 1.1 chuck * try to initiate a sync transfer.
1137 1.1 chuck * So compose the sync message we're going
1138 1.1 chuck * to send to the target
1139 1.1 chuck */
1140 1.1 chuck #ifdef DEBUG
1141 1.1 chuck if ( sync_debug )
1142 1.5 christos printf("\nSending sync request to target %d ... ", id);
1143 1.1 chuck #endif
1144 1.1 chuck /*
1145 1.1 chuck * setup scsi message sync message request
1146 1.1 chuck */
1147 1.1 chuck dev->sc_msg[0] = MSG_IDENTIFY | lun;
1148 1.1 chuck dev->sc_msg[1] = MSG_EXT_MESSAGE;
1149 1.1 chuck dev->sc_msg[2] = 3;
1150 1.1 chuck dev->sc_msg[3] = MSG_SYNC_REQ;
1151 1.1 chuck dev->sc_msg[4] = sbictoscsiperiod(dev, sbic_min_period);
1152 1.1 chuck dev->sc_msg[5] = sbic_max_offset;
1153 1.1 chuck
1154 1.1 chuck sbicxfout(regs, 6, dev->sc_msg);
1155 1.1 chuck
1156 1.1 chuck dev->sc_sync[id].state = SYNC_SENT;
1157 1.1 chuck #ifdef DEBUG
1158 1.1 chuck if ( sync_debug )
1159 1.5 christos printf ("sent\n");
1160 1.1 chuck #endif
1161 1.1 chuck }
1162 1.1 chuck
1163 1.1 chuck /*
1164 1.1 chuck * There's one interrupt still to come: the change to CMD phase...
1165 1.1 chuck */
1166 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT , 0);
1167 1.1 chuck GET_SBIC_csr(regs, csr);
1168 1.1 chuck }
1169 1.1 chuck
1170 1.2 chuck /*
1171 1.2 chuck * set sync or async
1172 1.2 chuck */
1173 1.2 chuck if ( dev->sc_sync[target].state == SYNC_DONE ) {
1174 1.2 chuck #ifdef DEBUG
1175 1.2 chuck if ( sync_debug )
1176 1.5 christos printf("select(%d): sync reg = 0x%02x\n", target,
1177 1.2 chuck SBIC_SYN(dev->sc_sync[target].offset,
1178 1.2 chuck dev->sc_sync[target].period));
1179 1.2 chuck #endif
1180 1.2 chuck SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[target].offset,
1181 1.2 chuck dev->sc_sync[target].period));
1182 1.2 chuck } else {
1183 1.2 chuck #ifdef DEBUG
1184 1.2 chuck if ( sync_debug )
1185 1.5 christos printf("select(%d): sync reg = 0x%02x\n", target,
1186 1.2 chuck SBIC_SYN(0,sbic_min_period));
1187 1.2 chuck #endif
1188 1.2 chuck SET_SBIC_syn(regs, SBIC_SYN(0, sbic_min_period));
1189 1.2 chuck }
1190 1.2 chuck
1191 1.1 chuck return csr;
1192 1.1 chuck }
1193 1.1 chuck
1194 1.1 chuck /*
1195 1.2 chuck * Information Transfer *to* a Scsi Target.
1196 1.2 chuck *
1197 1.2 chuck * Note: Don't expect there to be an interrupt immediately after all
1198 1.2 chuck * the data is transferred out. The WD spec sheet says that the Transfer-
1199 1.2 chuck * Info command for non-MSG_IN phases only completes when the target
1200 1.2 chuck * next asserts 'REQ'. That is, when the SCSI bus changes to a new state.
1201 1.2 chuck *
1202 1.2 chuck * This can have a nasty effect on commands which take a relatively long
1203 1.2 chuck * time to complete, for example a START/STOP unit command may remain in
1204 1.2 chuck * CMD phase until the disk has spun up. Only then will the target change
1205 1.2 chuck * to STATUS phase. This is really only a problem for immediate commands
1206 1.2 chuck * since we don't allow disconnection for them (yet).
1207 1.1 chuck */
1208 1.1 chuck int
1209 1.1 chuck sbicxfout(regs, len, bp)
1210 1.1 chuck sbic_regmap_p regs;
1211 1.1 chuck int len;
1212 1.1 chuck void *bp;
1213 1.1 chuck {
1214 1.1 chuck int wait = sbic_data_wait;
1215 1.1 chuck u_char asr,
1216 1.1 chuck *buf = bp;
1217 1.1 chuck
1218 1.1 chuck QPRINTF(("sbicxfout {%d} %02x %02x %02x %02x %02x "
1219 1.1 chuck "%02x %02x %02x %02x %02x\n", len, buf[0], buf[1], buf[2],
1220 1.1 chuck buf[3], buf[4], buf[5], buf[6], buf[7], buf[8], buf[9]));
1221 1.1 chuck
1222 1.1 chuck /*
1223 1.1 chuck * sigh.. WD-PROTO strikes again.. sending the command in one go
1224 1.1 chuck * causes the chip to lock up if talking to certain (misbehaving?)
1225 1.1 chuck * targets. Anyway, this procedure should work for all targets, but
1226 1.1 chuck * it's slightly slower due to the overhead
1227 1.1 chuck */
1228 1.1 chuck WAIT_CIP (regs);
1229 1.1 chuck
1230 1.1 chuck SBIC_TC_PUT (regs, 0);
1231 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
1232 1.1 chuck SBIC_TC_PUT (regs, (unsigned)len);
1233 1.1 chuck SET_SBIC_cmd (regs, SBIC_CMD_XFER_INFO);
1234 1.1 chuck
1235 1.1 chuck /*
1236 1.1 chuck * Loop for each byte transferred
1237 1.1 chuck */
1238 1.1 chuck do {
1239 1.1 chuck
1240 1.1 chuck GET_SBIC_asr (regs, asr);
1241 1.1 chuck
1242 1.1 chuck if ( asr & SBIC_ASR_DBR ) {
1243 1.1 chuck if ( len ) {
1244 1.1 chuck SET_SBIC_data (regs, *buf);
1245 1.1 chuck buf++;
1246 1.1 chuck len--;
1247 1.1 chuck } else {
1248 1.1 chuck SET_SBIC_data (regs, 0);
1249 1.1 chuck }
1250 1.1 chuck wait = sbic_data_wait;
1251 1.1 chuck }
1252 1.1 chuck
1253 1.2 chuck } while ( len && (asr & SBIC_ASR_INT) == 0 && wait-- > 0 );
1254 1.1 chuck
1255 1.1 chuck #ifdef DEBUG
1256 1.1 chuck QPRINTF(("sbicxfout done: %d bytes remaining (wait:%d)\n", len, wait));
1257 1.1 chuck #endif
1258 1.1 chuck
1259 1.1 chuck /*
1260 1.2 chuck * Normally, an interrupt will be pending when this routing returns.
1261 1.1 chuck */
1262 1.1 chuck return(len);
1263 1.1 chuck }
1264 1.1 chuck
1265 1.1 chuck /*
1266 1.1 chuck * Information Transfer *from* a Scsi Target
1267 1.1 chuck * returns # bytes left to read
1268 1.1 chuck */
1269 1.1 chuck int
1270 1.1 chuck sbicxfin(regs, len, bp)
1271 1.1 chuck sbic_regmap_p regs;
1272 1.1 chuck int len;
1273 1.1 chuck void *bp;
1274 1.1 chuck {
1275 1.1 chuck int wait = sbic_data_wait;
1276 1.1 chuck u_char *buf = bp;
1277 1.1 chuck u_char asr;
1278 1.1 chuck #ifdef DEBUG
1279 1.1 chuck u_char *obp = bp;
1280 1.1 chuck #endif
1281 1.1 chuck
1282 1.1 chuck WAIT_CIP (regs);
1283 1.1 chuck
1284 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
1285 1.1 chuck SBIC_TC_PUT (regs, (unsigned)len);
1286 1.1 chuck SET_SBIC_cmd (regs, SBIC_CMD_XFER_INFO);
1287 1.1 chuck
1288 1.1 chuck /*
1289 1.1 chuck * Loop for each byte transferred
1290 1.1 chuck */
1291 1.1 chuck do {
1292 1.1 chuck
1293 1.1 chuck GET_SBIC_asr (regs, asr);
1294 1.1 chuck
1295 1.1 chuck if ( asr & SBIC_ASR_DBR ) {
1296 1.1 chuck if ( len ) {
1297 1.1 chuck GET_SBIC_data (regs, *buf);
1298 1.1 chuck buf++;
1299 1.1 chuck len--;
1300 1.1 chuck } else {
1301 1.1 chuck u_char foo;
1302 1.1 chuck GET_SBIC_data (regs, foo);
1303 1.1 chuck }
1304 1.1 chuck wait = sbic_data_wait;
1305 1.1 chuck }
1306 1.1 chuck
1307 1.1 chuck } while ( (asr & SBIC_ASR_INT) == 0 && wait-- > 0 );
1308 1.1 chuck
1309 1.1 chuck QPRINTF(("sbicxfin {%d} %02x %02x %02x %02x %02x %02x "
1310 1.1 chuck "%02x %02x %02x %02x\n", len, obp[0], obp[1], obp[2],
1311 1.1 chuck obp[3], obp[4], obp[5], obp[6], obp[7], obp[8], obp[9]));
1312 1.1 chuck
1313 1.1 chuck SBIC_TC_PUT (regs, 0);
1314 1.1 chuck
1315 1.1 chuck /*
1316 1.1 chuck * this leaves with one csr to be read
1317 1.1 chuck */
1318 1.1 chuck return len;
1319 1.1 chuck }
1320 1.1 chuck
1321 1.1 chuck /*
1322 1.1 chuck * SCSI 'immediate' command: issue a command to some SCSI device
1323 1.1 chuck * and get back an 'immediate' response (i.e., do programmed xfer
1324 1.1 chuck * to get the response data). 'cbuf' is a buffer containing a scsi
1325 1.1 chuck * command of length clen bytes. 'buf' is a buffer of length 'len'
1326 1.1 chuck * bytes for data. The transfer direction is determined by the device
1327 1.1 chuck * (i.e., by the scsi bus data xfer phase). If 'len' is zero, the
1328 1.1 chuck * command must supply no data.
1329 1.2 chuck *
1330 1.2 chuck * Note that although this routine looks like it can handle disconnect/
1331 1.2 chuck * reselect, the fact is that it can't. There is still some work to be
1332 1.2 chuck * done to clean this lot up.
1333 1.1 chuck */
1334 1.1 chuck int
1335 1.1 chuck sbicicmd(dev, cbuf, clen, buf, len)
1336 1.1 chuck struct sbic_softc *dev;
1337 1.1 chuck void *cbuf,
1338 1.1 chuck *buf;
1339 1.1 chuck int clen,
1340 1.1 chuck len;
1341 1.1 chuck {
1342 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
1343 1.1 chuck struct sbic_acb *acb = dev->sc_nexus;
1344 1.1 chuck u_char csr,
1345 1.1 chuck asr;
1346 1.2 chuck int still_busy = SBIC_STATE_RUNNING;
1347 1.2 chuck #ifdef DEBUG
1348 1.2 chuck int counter = 0;
1349 1.2 chuck #endif
1350 1.1 chuck
1351 1.1 chuck /*
1352 1.1 chuck * Make sure pointers are OK
1353 1.1 chuck */
1354 1.1 chuck dev->sc_last = dev->sc_cur = &acb->sc_pa;
1355 1.1 chuck dev->sc_tcnt = acb->sc_tcnt = 0;
1356 1.1 chuck
1357 1.1 chuck acb->sc_dmacmd = 0;
1358 1.1 chuck acb->sc_pa.dc_count = 0; /* No DMA */
1359 1.1 chuck acb->sc_kv.dc_addr = buf;
1360 1.1 chuck acb->sc_kv.dc_count = len;
1361 1.1 chuck
1362 1.1 chuck #ifdef DEBUG
1363 1.1 chuck if ( data_pointer_debug > 1 )
1364 1.5 christos printf("sbicicmd(%d,%d):%d\n", dev->target, dev->lun, acb->sc_kv.dc_count);
1365 1.1 chuck #endif
1366 1.1 chuck
1367 1.1 chuck /*
1368 1.1 chuck * set the sbic into non-DMA mode
1369 1.1 chuck */
1370 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
1371 1.1 chuck
1372 1.1 chuck dev->sc_stat[0] = 0xff;
1373 1.1 chuck dev->sc_msg[0] = 0xff;
1374 1.1 chuck
1375 1.1 chuck /*
1376 1.1 chuck * We're stealing the SCSI bus
1377 1.1 chuck */
1378 1.1 chuck dev->sc_flags |= SBICF_ICMD;
1379 1.1 chuck
1380 1.1 chuck do {
1381 1.1 chuck GET_SBIC_asr (regs, asr);
1382 1.1 chuck
1383 1.1 chuck /*
1384 1.1 chuck * select the SCSI bus (it's an error if bus isn't free)
1385 1.1 chuck */
1386 1.2 chuck if ( (dev->sc_flags & SBICF_SELECTED) == 0 &&
1387 1.2 chuck still_busy != SBIC_STATE_DISCONNECT ) {
1388 1.1 chuck if ( (csr = sbicselectbus(dev)) == 0 ) {
1389 1.1 chuck dev->sc_flags &= ~SBICF_ICMD;
1390 1.1 chuck return(-1);
1391 1.1 chuck }
1392 1.1 chuck } else
1393 1.2 chuck if ( (asr & (SBIC_ASR_BSY | SBIC_ASR_INT)) == SBIC_ASR_INT )
1394 1.1 chuck GET_SBIC_csr(regs, csr);
1395 1.2 chuck else
1396 1.2 chuck csr = 0;
1397 1.2 chuck
1398 1.2 chuck if ( csr ) {
1399 1.2 chuck
1400 1.2 chuck QPRINTF((">ASR:0x%02x CSR:0x%02x< ", asr, csr));
1401 1.1 chuck
1402 1.2 chuck switch ( csr ) {
1403 1.1 chuck
1404 1.2 chuck case SBIC_CSR_S_XFERRED:
1405 1.2 chuck case SBIC_CSR_DISC:
1406 1.2 chuck case SBIC_CSR_DISC_1:
1407 1.2 chuck {
1408 1.2 chuck u_char phase;
1409 1.1 chuck
1410 1.2 chuck dev->sc_flags &= ~SBICF_SELECTED;
1411 1.2 chuck GET_SBIC_cmd_phase (regs, phase);
1412 1.2 chuck
1413 1.2 chuck if ( phase == 0x60 ) {
1414 1.2 chuck GET_SBIC_tlun (regs, dev->sc_stat[0]);
1415 1.2 chuck still_busy = SBIC_STATE_DONE; /* done */
1416 1.2 chuck } else {
1417 1.1 chuck #ifdef DEBUG
1418 1.2 chuck if ( reselect_debug > 1 )
1419 1.5 christos printf("sbicicmd: handling disconnect\n");
1420 1.1 chuck #endif
1421 1.2 chuck still_busy = SBIC_STATE_DISCONNECT;
1422 1.2 chuck }
1423 1.1 chuck }
1424 1.2 chuck break;
1425 1.1 chuck
1426 1.2 chuck case SBIC_CSR_XFERRED | CMD_PHASE:
1427 1.2 chuck case SBIC_CSR_MIS | CMD_PHASE:
1428 1.2 chuck case SBIC_CSR_MIS_1 | CMD_PHASE:
1429 1.2 chuck case SBIC_CSR_MIS_2 | CMD_PHASE:
1430 1.2 chuck {
1431 1.2 chuck if ( sbicxfout(regs, clen, cbuf) )
1432 1.2 chuck still_busy = sbicabort(dev, "icmd sending cmd");
1433 1.2 chuck }
1434 1.2 chuck break;
1435 1.1 chuck
1436 1.2 chuck case SBIC_CSR_XFERRED | STATUS_PHASE:
1437 1.2 chuck case SBIC_CSR_MIS | STATUS_PHASE:
1438 1.2 chuck case SBIC_CSR_MIS_1 | STATUS_PHASE:
1439 1.2 chuck case SBIC_CSR_MIS_2 | STATUS_PHASE:
1440 1.2 chuck {
1441 1.2 chuck /*
1442 1.2 chuck * The sbic does the status/cmd-complete reading ok,
1443 1.2 chuck * so do this with its hi-level commands.
1444 1.2 chuck */
1445 1.1 chuck #ifdef DEBUG
1446 1.2 chuck if ( sbic_debug )
1447 1.5 christos printf("SBICICMD status phase (bsy=%d)\n", still_busy);
1448 1.1 chuck #endif
1449 1.2 chuck SET_SBIC_cmd_phase(regs, 0x46);
1450 1.2 chuck SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN_XFER);
1451 1.2 chuck }
1452 1.2 chuck break;
1453 1.1 chuck
1454 1.2 chuck default:
1455 1.2 chuck {
1456 1.2 chuck still_busy = sbicnextstate(dev, csr, asr);
1457 1.2 chuck }
1458 1.2 chuck break;
1459 1.1 chuck }
1460 1.1 chuck
1461 1.2 chuck /*
1462 1.2 chuck * make sure the last command was taken,
1463 1.2 chuck * ie. we're not hunting after an ignored command..
1464 1.2 chuck */
1465 1.2 chuck GET_SBIC_asr(regs, asr);
1466 1.1 chuck
1467 1.2 chuck /*
1468 1.2 chuck * tapes may take a loooong time..
1469 1.2 chuck */
1470 1.2 chuck while (asr & SBIC_ASR_BSY ) {
1471 1.1 chuck
1472 1.2 chuck if ( asr & SBIC_ASR_DBR ) {
1473 1.2 chuck int i;
1474 1.1 chuck
1475 1.5 christos printf("sbicicmd: Waiting while sbic is jammed, CSR:%02x,ASR:%02x\n", csr,asr);
1476 1.1 chuck #ifdef DDB
1477 1.2 chuck Debugger();
1478 1.1 chuck #endif
1479 1.2 chuck /*
1480 1.2 chuck * SBIC is jammed
1481 1.2 chuck * DUNNO which direction
1482 1.2 chuck * Try old direction
1483 1.2 chuck */
1484 1.2 chuck GET_SBIC_data(regs, i);
1485 1.2 chuck GET_SBIC_asr(regs, asr);
1486 1.2 chuck
1487 1.2 chuck if ( asr & SBIC_ASR_DBR ) /* Wants us to write */
1488 1.2 chuck SET_SBIC_data(regs, i);
1489 1.2 chuck }
1490 1.2 chuck
1491 1.1 chuck GET_SBIC_asr(regs, asr);
1492 1.1 chuck }
1493 1.1 chuck }
1494 1.1 chuck
1495 1.1 chuck /*
1496 1.1 chuck * wait for last command to complete
1497 1.1 chuck */
1498 1.1 chuck if ( asr & SBIC_ASR_LCI ) {
1499 1.5 christos printf("sbicicmd: last command ignored\n");
1500 1.1 chuck }
1501 1.1 chuck else
1502 1.2 chuck if ( still_busy >= SBIC_STATE_RUNNING ) /* Bsy */
1503 1.1 chuck SBIC_WAIT (regs, SBIC_ASR_INT, sbic_cmd_wait);
1504 1.1 chuck
1505 1.1 chuck /*
1506 1.1 chuck * do it again
1507 1.1 chuck */
1508 1.2 chuck } while ( still_busy >= SBIC_STATE_RUNNING && dev->sc_stat[0] == 0xff );
1509 1.1 chuck
1510 1.1 chuck /*
1511 1.1 chuck * Sometimes we need to do an extra read of the CSR
1512 1.1 chuck */
1513 1.1 chuck GET_SBIC_csr(regs, csr);
1514 1.1 chuck
1515 1.1 chuck #ifdef DEBUG
1516 1.1 chuck if ( data_pointer_debug > 1 )
1517 1.5 christos printf("sbicicmd done(%d,%d):%d =%d=\n", dev->target, dev->lun,
1518 1.1 chuck acb->sc_kv.dc_count,
1519 1.1 chuck dev->sc_stat[0]);
1520 1.1 chuck #endif
1521 1.1 chuck
1522 1.1 chuck dev->sc_flags &= ~SBICF_ICMD;
1523 1.1 chuck
1524 1.1 chuck return(dev->sc_stat[0]);
1525 1.1 chuck }
1526 1.1 chuck
1527 1.1 chuck /*
1528 1.1 chuck * Finish SCSI xfer command: After the completion interrupt from
1529 1.1 chuck * a read/write operation, sequence through the final phases in
1530 1.1 chuck * programmed i/o. This routine is a lot like sbicicmd except we
1531 1.1 chuck * skip (and don't allow) the select, cmd out and data in/out phases.
1532 1.1 chuck */
1533 1.1 chuck void
1534 1.1 chuck sbicxfdone(dev)
1535 1.1 chuck struct sbic_softc *dev;
1536 1.1 chuck {
1537 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
1538 1.1 chuck u_char phase,
1539 1.1 chuck csr;
1540 1.1 chuck int s;
1541 1.1 chuck
1542 1.1 chuck QPRINTF(("{"));
1543 1.1 chuck s = splbio();
1544 1.1 chuck
1545 1.1 chuck /*
1546 1.1 chuck * have the sbic complete on its own
1547 1.1 chuck */
1548 1.1 chuck SBIC_TC_PUT(regs, 0);
1549 1.1 chuck SET_SBIC_cmd_phase(regs, 0x46);
1550 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN_XFER);
1551 1.1 chuck
1552 1.1 chuck do {
1553 1.1 chuck
1554 1.1 chuck SBIC_WAIT (regs, SBIC_ASR_INT, 0);
1555 1.1 chuck GET_SBIC_csr (regs, csr);
1556 1.1 chuck QPRINTF(("%02x:", csr));
1557 1.1 chuck
1558 1.1 chuck } while ( (csr != SBIC_CSR_DISC) && (csr != SBIC_CSR_DISC_1) &&
1559 1.1 chuck (csr != SBIC_CSR_S_XFERRED));
1560 1.1 chuck
1561 1.1 chuck dev->sc_flags &= ~SBICF_SELECTED;
1562 1.1 chuck
1563 1.1 chuck GET_SBIC_cmd_phase (regs, phase);
1564 1.1 chuck QPRINTF(("}%02x", phase));
1565 1.1 chuck
1566 1.1 chuck if ( phase == 0x60 )
1567 1.1 chuck GET_SBIC_tlun(regs, dev->sc_stat[0]);
1568 1.1 chuck else
1569 1.1 chuck sbicerror(dev, csr);
1570 1.1 chuck
1571 1.1 chuck QPRINTF(("=STS:%02x=\n", dev->sc_stat[0]));
1572 1.1 chuck
1573 1.1 chuck splx(s);
1574 1.1 chuck }
1575 1.1 chuck
1576 1.1 chuck /*
1577 1.1 chuck * No DMA chains
1578 1.1 chuck */
1579 1.1 chuck int
1580 1.1 chuck sbicgo(dev, xs)
1581 1.1 chuck struct sbic_softc *dev;
1582 1.6 bouyer struct scsipi_xfer *xs;
1583 1.1 chuck {
1584 1.1 chuck struct sbic_acb *acb = dev->sc_nexus;
1585 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
1586 1.1 chuck int i,
1587 1.1 chuck dmaflags,
1588 1.1 chuck count,
1589 1.1 chuck usedma;
1590 1.1 chuck u_char csr,
1591 1.1 chuck asr,
1592 1.1 chuck *addr;
1593 1.1 chuck
1594 1.6 bouyer dev->target = xs->sc_link->scsipi_scsi.target;
1595 1.6 bouyer dev->lun = xs->sc_link->scsipi_scsi.lun;
1596 1.1 chuck
1597 1.1 chuck usedma = sbicdmaok(dev, xs);
1598 1.1 chuck
1599 1.1 chuck #ifdef DEBUG
1600 1.1 chuck if ( data_pointer_debug > 1 )
1601 1.5 christos printf("sbicgo(%d,%d): usedma=%d\n", dev->target, dev->lun, usedma);
1602 1.1 chuck #endif
1603 1.1 chuck
1604 1.1 chuck /*
1605 1.1 chuck * select the SCSI bus (it's an error if bus isn't free)
1606 1.1 chuck */
1607 1.1 chuck if ( (csr = sbicselectbus(dev)) == 0 )
1608 1.1 chuck return(0); /* Not done: needs to be rescheduled */
1609 1.1 chuck
1610 1.1 chuck dev->sc_stat[0] = 0xff;
1611 1.1 chuck
1612 1.1 chuck /*
1613 1.1 chuck * Calculate DMA chains now
1614 1.1 chuck */
1615 1.1 chuck if ( acb->flags & ACB_DATAIN )
1616 1.1 chuck dmaflags = DMAGO_READ;
1617 1.1 chuck else
1618 1.1 chuck dmaflags = 0;
1619 1.1 chuck
1620 1.1 chuck addr = acb->sc_kv.dc_addr;
1621 1.1 chuck count = acb->sc_kv.dc_count;
1622 1.1 chuck
1623 1.1 chuck if ( count && ((char *)kvtop(addr) != acb->sc_pa.dc_addr) ) {
1624 1.5 christos printf("sbic: DMA buffer mapping changed %x->%x\n",
1625 1.1 chuck acb->sc_pa.dc_addr, kvtop(addr));
1626 1.1 chuck #ifdef DDB
1627 1.1 chuck Debugger();
1628 1.1 chuck #endif
1629 1.1 chuck }
1630 1.1 chuck
1631 1.1 chuck #ifdef DEBUG
1632 1.1 chuck ++sbicdma_ops; /* count total DMA operations */
1633 1.1 chuck #endif
1634 1.1 chuck
1635 1.1 chuck /*
1636 1.1 chuck * Allocate the DMA chain
1637 1.1 chuck * Mark end of segment...
1638 1.1 chuck */
1639 1.1 chuck acb->sc_tcnt = dev->sc_tcnt = 0;
1640 1.1 chuck acb->sc_pa.dc_count = 0;
1641 1.1 chuck
1642 1.1 chuck sbic_load_ptrs(dev);
1643 1.1 chuck
1644 1.1 chuck /*
1645 1.1 chuck * Enable interrupts but don't do any DMA
1646 1.1 chuck * enintr() also enables interrupts for the sbic
1647 1.1 chuck */
1648 1.1 chuck dev->sc_enintr(dev);
1649 1.1 chuck
1650 1.1 chuck if ( usedma ) {
1651 1.1 chuck dev->sc_tcnt = dev->sc_dmago(dev, acb->sc_pa.dc_addr,
1652 1.1 chuck acb->sc_pa.dc_count, dmaflags);
1653 1.1 chuck #ifdef DEBUG
1654 1.1 chuck dev->sc_dmatimo = dev->sc_tcnt ? 1 : 0;
1655 1.1 chuck #endif
1656 1.1 chuck } else
1657 1.1 chuck dev->sc_dmacmd = 0; /* Don't use DMA */
1658 1.1 chuck
1659 1.1 chuck acb->sc_dmacmd = dev->sc_dmacmd;
1660 1.1 chuck
1661 1.1 chuck #ifdef DEBUG
1662 1.1 chuck if ( data_pointer_debug > 1 ) {
1663 1.5 christos printf("sbicgo dmago:%d(%x:%x) dmacmd=0x%02x\n", dev->target,
1664 1.1 chuck dev->sc_cur->dc_addr,
1665 1.1 chuck dev->sc_tcnt,
1666 1.1 chuck dev->sc_dmacmd);
1667 1.1 chuck }
1668 1.1 chuck #endif
1669 1.1 chuck
1670 1.1 chuck /*
1671 1.1 chuck * Lets cycle a while then let the interrupt handler take over.
1672 1.1 chuck */
1673 1.1 chuck GET_SBIC_asr(regs, asr);
1674 1.1 chuck
1675 1.1 chuck do {
1676 1.1 chuck
1677 1.1 chuck QPRINTF(("go "));
1678 1.1 chuck
1679 1.1 chuck /*
1680 1.1 chuck * Handle the new phase
1681 1.1 chuck */
1682 1.1 chuck i = sbicnextstate(dev, csr, asr);
1683 1.1 chuck #if 0
1684 1.1 chuck WAIT_CIP(regs);
1685 1.1 chuck #endif
1686 1.1 chuck if ( i == SBIC_STATE_RUNNING ) {
1687 1.1 chuck GET_SBIC_asr(regs, asr);
1688 1.1 chuck
1689 1.1 chuck if ( asr & SBIC_ASR_LCI )
1690 1.5 christos printf("sbicgo: LCI asr:%02x csr:%02x\n", asr, csr);
1691 1.1 chuck
1692 1.1 chuck if ( asr & SBIC_ASR_INT )
1693 1.1 chuck GET_SBIC_csr(regs, csr);
1694 1.1 chuck }
1695 1.1 chuck
1696 1.1 chuck } while ( i == SBIC_STATE_RUNNING && asr & (SBIC_ASR_INT|SBIC_ASR_LCI) );
1697 1.1 chuck
1698 1.1 chuck if ( i == SBIC_STATE_DONE ) {
1699 1.1 chuck if ( dev->sc_stat[0] == 0xff )
1700 1.1 chuck #if 0
1701 1.5 christos printf("sbicgo: done & stat = 0xff\n");
1702 1.1 chuck #else
1703 1.1 chuck ;
1704 1.1 chuck #endif
1705 1.1 chuck else
1706 1.1 chuck return 1; /* Did we really finish that fast? */
1707 1.1 chuck }
1708 1.1 chuck
1709 1.1 chuck return 0;
1710 1.1 chuck }
1711 1.1 chuck
1712 1.1 chuck
1713 1.1 chuck int
1714 1.1 chuck sbicintr(dev)
1715 1.1 chuck struct sbic_softc *dev;
1716 1.1 chuck {
1717 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
1718 1.1 chuck u_char asr,
1719 1.1 chuck csr;
1720 1.1 chuck int i;
1721 1.1 chuck
1722 1.1 chuck /*
1723 1.1 chuck * pending interrupt?
1724 1.1 chuck */
1725 1.1 chuck GET_SBIC_asr (regs, asr);
1726 1.1 chuck if ( (asr & SBIC_ASR_INT) == 0 )
1727 1.1 chuck return(0);
1728 1.1 chuck
1729 1.2 chuck GET_SBIC_csr(regs, csr);
1730 1.2 chuck
1731 1.1 chuck do {
1732 1.1 chuck
1733 1.1 chuck QPRINTF(("intr[0x%x]", csr));
1734 1.1 chuck
1735 1.1 chuck i = sbicnextstate(dev, csr, asr);
1736 1.1 chuck #if 0
1737 1.1 chuck WAIT_CIP(regs);
1738 1.1 chuck #endif
1739 1.2 chuck if ( i == SBIC_STATE_RUNNING ) {
1740 1.2 chuck GET_SBIC_asr(regs, asr);
1741 1.2 chuck
1742 1.2 chuck if ( asr & SBIC_ASR_LCI )
1743 1.5 christos printf("sbicgo: LCI asr:%02x csr:%02x\n", asr, csr);
1744 1.2 chuck
1745 1.2 chuck if ( asr & SBIC_ASR_INT )
1746 1.2 chuck GET_SBIC_csr(regs, csr);
1747 1.2 chuck }
1748 1.1 chuck
1749 1.1 chuck } while ( i == SBIC_STATE_RUNNING && asr & (SBIC_ASR_INT|SBIC_ASR_LCI) );
1750 1.1 chuck
1751 1.1 chuck QPRINTF(("intr done. state=%d, asr=0x%02x\n", i, asr));
1752 1.1 chuck
1753 1.1 chuck return(1);
1754 1.1 chuck }
1755 1.1 chuck
1756 1.1 chuck /*
1757 1.1 chuck * Run commands and wait for disconnect.
1758 1.1 chuck * This is only ever called when a command is in progress, when we
1759 1.1 chuck * want to busy wait for it to finish.
1760 1.1 chuck */
1761 1.1 chuck int
1762 1.1 chuck sbicpoll(dev)
1763 1.1 chuck struct sbic_softc *dev;
1764 1.1 chuck {
1765 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
1766 1.1 chuck u_char asr,
1767 1.1 chuck csr;
1768 1.1 chuck int i;
1769 1.1 chuck
1770 1.1 chuck /*
1771 1.1 chuck * Wait for the next interrupt
1772 1.1 chuck */
1773 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, sbic_cmd_wait);
1774 1.1 chuck
1775 1.1 chuck do {
1776 1.1 chuck GET_SBIC_asr (regs, asr);
1777 1.1 chuck
1778 1.1 chuck if ( asr & SBIC_ASR_INT )
1779 1.1 chuck GET_SBIC_csr(regs, csr);
1780 1.1 chuck
1781 1.1 chuck QPRINTF(("poll[0x%x]", csr));
1782 1.1 chuck
1783 1.1 chuck /*
1784 1.1 chuck * Handle it
1785 1.1 chuck */
1786 1.1 chuck i = sbicnextstate(dev, csr, asr);
1787 1.1 chuck
1788 1.1 chuck WAIT_CIP(regs);
1789 1.1 chuck GET_SBIC_asr(regs, asr);
1790 1.1 chuck
1791 1.1 chuck /*
1792 1.1 chuck * tapes may take a loooong time..
1793 1.1 chuck */
1794 1.1 chuck while ( asr & SBIC_ASR_BSY ) {
1795 1.2 chuck u_char z = 0;
1796 1.1 chuck
1797 1.1 chuck if ( asr & SBIC_ASR_DBR ) {
1798 1.5 christos printf("sbipoll: Waiting while sbic is jammed, CSR:%02x,ASR:%02x\n", csr,asr);
1799 1.1 chuck #ifdef DDB
1800 1.1 chuck Debugger();
1801 1.1 chuck #endif
1802 1.1 chuck /*
1803 1.1 chuck * SBIC is jammed
1804 1.1 chuck * DUNNO which direction
1805 1.1 chuck * Try old direction
1806 1.1 chuck */
1807 1.2 chuck GET_SBIC_data(regs, z);
1808 1.1 chuck GET_SBIC_asr(regs, asr);
1809 1.1 chuck
1810 1.1 chuck if ( asr & SBIC_ASR_DBR ) /* Wants us to write */
1811 1.2 chuck SET_SBIC_data(regs, z);
1812 1.1 chuck }
1813 1.1 chuck
1814 1.1 chuck GET_SBIC_asr(regs, asr);
1815 1.1 chuck }
1816 1.1 chuck
1817 1.1 chuck if ( asr & SBIC_ASR_LCI )
1818 1.5 christos printf("sbicpoll: LCI asr:%02x csr:%02x\n", asr,csr);
1819 1.1 chuck else
1820 1.2 chuck if ( i == SBIC_STATE_RUNNING ) /* BSY */
1821 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, sbic_cmd_wait);
1822 1.1 chuck
1823 1.1 chuck } while ( i == SBIC_STATE_RUNNING );
1824 1.1 chuck
1825 1.1 chuck return(1);
1826 1.1 chuck }
1827 1.1 chuck
1828 1.1 chuck /*
1829 1.1 chuck * Handle a single msgin
1830 1.1 chuck */
1831 1.1 chuck int
1832 1.1 chuck sbicmsgin(dev)
1833 1.1 chuck struct sbic_softc *dev;
1834 1.1 chuck {
1835 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
1836 1.1 chuck int recvlen = 1;
1837 1.1 chuck u_char asr,
1838 1.1 chuck csr,
1839 1.1 chuck *tmpaddr,
1840 1.1 chuck *msgaddr;
1841 1.1 chuck
1842 1.1 chuck tmpaddr = msgaddr = dev->sc_msg;
1843 1.1 chuck
1844 1.1 chuck tmpaddr[0] = 0xff;
1845 1.1 chuck tmpaddr[1] = 0xff;
1846 1.1 chuck
1847 1.1 chuck GET_SBIC_asr(regs, asr);
1848 1.1 chuck
1849 1.1 chuck #ifdef DEBUG
1850 1.1 chuck if ( reselect_debug > 1 )
1851 1.5 christos printf("sbicmsgin asr=%02x\n", asr);
1852 1.1 chuck #endif
1853 1.1 chuck
1854 1.1 chuck GET_SBIC_selid (regs, csr);
1855 1.1 chuck SET_SBIC_selid (regs, csr | SBIC_SID_FROM_SCSI);
1856 1.1 chuck
1857 1.1 chuck SBIC_TC_PUT(regs, 0);
1858 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
1859 1.1 chuck
1860 1.1 chuck do {
1861 1.1 chuck while( recvlen-- ) {
1862 1.1 chuck
1863 1.1 chuck /*
1864 1.1 chuck * Fetch the next byte of the message
1865 1.1 chuck */
1866 1.1 chuck RECV_BYTE(regs, *tmpaddr);
1867 1.1 chuck
1868 1.1 chuck /*
1869 1.1 chuck * get the command completion interrupt, or we
1870 1.1 chuck * can't send a new command (LCI)
1871 1.1 chuck */
1872 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, 0);
1873 1.1 chuck GET_SBIC_csr(regs, csr);
1874 1.1 chuck
1875 1.1 chuck #ifdef DEBUG
1876 1.1 chuck if ( reselect_debug > 1 )
1877 1.5 christos printf("sbicmsgin: got %02x csr %02x\n", *tmpaddr, csr);
1878 1.1 chuck #endif
1879 1.1 chuck
1880 1.1 chuck tmpaddr++;
1881 1.1 chuck
1882 1.1 chuck if ( recvlen ) {
1883 1.1 chuck /*
1884 1.1 chuck * Clear ACK, and wait for the interrupt for the next byte
1885 1.1 chuck */
1886 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
1887 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, 0);
1888 1.1 chuck GET_SBIC_csr(regs, csr);
1889 1.1 chuck }
1890 1.1 chuck }
1891 1.1 chuck
1892 1.1 chuck if ( msgaddr[0] == 0xff ) {
1893 1.5 christos printf("sbicmsgin: sbic swallowed our message\n");
1894 1.1 chuck break;
1895 1.1 chuck }
1896 1.1 chuck
1897 1.1 chuck #ifdef DEBUG
1898 1.1 chuck if ( sync_debug ) {
1899 1.1 chuck GET_SBIC_asr(regs, asr);
1900 1.5 christos printf("msgin done csr 0x%x asr 0x%x msg 0x%x\n", csr, asr, msgaddr[0]);
1901 1.1 chuck }
1902 1.1 chuck #endif
1903 1.1 chuck /*
1904 1.1 chuck * test whether this is a reply to our sync
1905 1.1 chuck * request
1906 1.1 chuck */
1907 1.1 chuck if ( MSG_ISIDENTIFY(msgaddr[0]) ) {
1908 1.1 chuck
1909 1.1 chuck /*
1910 1.1 chuck * Got IFFY msg -- ack it
1911 1.1 chuck */
1912 1.1 chuck QPRINTF(("IFFY"));
1913 1.1 chuck
1914 1.1 chuck } else
1915 1.1 chuck if ( msgaddr[0] == MSG_REJECT &&
1916 1.1 chuck dev->sc_sync[dev->target].state == SYNC_SENT) {
1917 1.1 chuck
1918 1.1 chuck /*
1919 1.1 chuck * Target probably rejected our Sync negotiation.
1920 1.1 chuck */
1921 1.1 chuck QPRINTF(("REJECT of SYN"));
1922 1.1 chuck
1923 1.1 chuck #ifdef DEBUG
1924 1.1 chuck if ( sync_debug )
1925 1.5 christos printf("target %d rejected sync, going async\n", dev->target);
1926 1.1 chuck #endif
1927 1.1 chuck
1928 1.1 chuck dev->sc_sync[dev->target].period = sbic_min_period;
1929 1.1 chuck dev->sc_sync[dev->target].offset = 0;
1930 1.1 chuck dev->sc_sync[dev->target].state = SYNC_DONE;
1931 1.1 chuck SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[dev->target].offset,
1932 1.1 chuck dev->sc_sync[dev->target].period));
1933 1.1 chuck
1934 1.1 chuck } else
1935 1.1 chuck if ( msgaddr[0] == MSG_REJECT ) {
1936 1.1 chuck
1937 1.1 chuck /*
1938 1.1 chuck * we'll never REJECt a REJECT message..
1939 1.1 chuck */
1940 1.1 chuck QPRINTF(("REJECT"));
1941 1.1 chuck
1942 1.1 chuck } else
1943 1.1 chuck if ( msgaddr[0] == MSG_SAVE_DATA_PTR ) {
1944 1.1 chuck
1945 1.1 chuck /*
1946 1.1 chuck * don't reject this either.
1947 1.1 chuck */
1948 1.1 chuck QPRINTF(("MSG_SAVE_DATA_PTR"));
1949 1.1 chuck
1950 1.1 chuck } else
1951 1.1 chuck if ( msgaddr[0] == MSG_RESTORE_PTR ) {
1952 1.1 chuck
1953 1.1 chuck /*
1954 1.1 chuck * don't reject this either.
1955 1.1 chuck */
1956 1.1 chuck QPRINTF(("MSG_RESTORE_PTR"));
1957 1.1 chuck
1958 1.1 chuck } else
1959 1.1 chuck if ( msgaddr[0] == MSG_DISCONNECT ) {
1960 1.1 chuck
1961 1.1 chuck /*
1962 1.1 chuck * Target is disconnecting...
1963 1.1 chuck */
1964 1.1 chuck QPRINTF(("DISCONNECT"));
1965 1.1 chuck
1966 1.1 chuck #ifdef DEBUG
1967 1.1 chuck if ( reselect_debug > 1 && msgaddr[0] == MSG_DISCONNECT )
1968 1.5 christos printf("sbicmsgin: got disconnect msg %s\n",
1969 1.1 chuck (dev->sc_flags & SBICF_ICMD) ? "rejecting" : "");
1970 1.1 chuck #endif
1971 1.1 chuck
1972 1.1 chuck if ( dev->sc_flags & SBICF_ICMD ) {
1973 1.1 chuck /*
1974 1.1 chuck * We're in immediate mode. Prevent disconnects.
1975 1.1 chuck * prepare to reject the message, NACK
1976 1.1 chuck */
1977 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_SET_ATN);
1978 1.1 chuck WAIT_CIP(regs);
1979 1.1 chuck }
1980 1.1 chuck
1981 1.1 chuck } else
1982 1.1 chuck if ( msgaddr[0] == MSG_CMD_COMPLETE ) {
1983 1.1 chuck
1984 1.1 chuck /*
1985 1.1 chuck * !! KLUDGE ALERT !! quite a few drives don't seem to
1986 1.1 chuck * really like the current way of sending the
1987 1.1 chuck * sync-handshake together with the ident-message, and
1988 1.1 chuck * they react by sending command-complete and
1989 1.1 chuck * disconnecting right after returning the valid sync
1990 1.1 chuck * handshake. So, all I can do is reselect the drive,
1991 1.1 chuck * and hope it won't disconnect again. I don't think
1992 1.1 chuck * this is valid behavior, but I can't help fixing a
1993 1.1 chuck * problem that apparently exists.
1994 1.1 chuck *
1995 1.1 chuck * Note: we should not get here on `normal' command
1996 1.1 chuck * completion, as that condition is handled by the
1997 1.1 chuck * high-level sel&xfer resume command used to walk
1998 1.1 chuck * thru status/cc-phase.
1999 1.1 chuck */
2000 1.1 chuck QPRINTF(("CMD_COMPLETE"));
2001 1.1 chuck
2002 1.1 chuck #ifdef DEBUG
2003 1.1 chuck if ( sync_debug )
2004 1.5 christos printf ("GOT MSG %d! target %d acting weird.."
2005 1.1 chuck " waiting for disconnect...\n", msgaddr[0], dev->target);
2006 1.1 chuck #endif
2007 1.1 chuck
2008 1.1 chuck /*
2009 1.1 chuck * Check to see if sbic is handling this
2010 1.1 chuck */
2011 1.1 chuck GET_SBIC_asr(regs, asr);
2012 1.1 chuck
2013 1.1 chuck /*
2014 1.1 chuck * XXXSCW: I'm not convinced of this, we haven't negated ACK yet...
2015 1.1 chuck */
2016 1.1 chuck if ( asr & SBIC_ASR_BSY )
2017 1.1 chuck return SBIC_STATE_RUNNING;
2018 1.1 chuck
2019 1.1 chuck /*
2020 1.1 chuck * Let's try this: Assume it works and set status to 00
2021 1.1 chuck */
2022 1.1 chuck dev->sc_stat[0] = 0;
2023 1.1 chuck
2024 1.1 chuck } else
2025 1.1 chuck if ( msgaddr[0] == MSG_EXT_MESSAGE && tmpaddr == &(msgaddr[1]) ) {
2026 1.1 chuck
2027 1.1 chuck /*
2028 1.1 chuck * Target is sending us an extended message. We'll assume it's
2029 1.1 chuck * the response to our Sync. negotiation.
2030 1.1 chuck */
2031 1.1 chuck QPRINTF(("ExtMSG\n"));
2032 1.1 chuck
2033 1.1 chuck /*
2034 1.1 chuck * Read in whole extended message. First, negate ACK to accept
2035 1.1 chuck * the MSG_EXT_MESSAGE byte...
2036 1.1 chuck */
2037 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
2038 1.1 chuck
2039 1.1 chuck /*
2040 1.1 chuck * Wait for the interrupt for the next byte (length)
2041 1.1 chuck */
2042 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, 0);
2043 1.1 chuck GET_SBIC_csr(regs, csr);
2044 1.1 chuck
2045 1.1 chuck #ifdef DEBUG
2046 1.1 chuck QPRINTF(("CLR ACK csr %02x\n", csr));
2047 1.1 chuck #endif
2048 1.1 chuck
2049 1.1 chuck /*
2050 1.1 chuck * Read the length byte
2051 1.1 chuck */
2052 1.1 chuck RECV_BYTE(regs, *tmpaddr);
2053 1.1 chuck
2054 1.1 chuck /*
2055 1.1 chuck * Wait for command completion IRQ
2056 1.1 chuck */
2057 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, 0);
2058 1.1 chuck GET_SBIC_csr(regs, csr);
2059 1.1 chuck
2060 1.1 chuck /*
2061 1.1 chuck * Reload the loop counter
2062 1.1 chuck */
2063 1.1 chuck recvlen = *tmpaddr++;
2064 1.1 chuck
2065 1.1 chuck QPRINTF(("Recving ext msg, csr %02x len %02x\n", csr, recvlen));
2066 1.1 chuck
2067 1.1 chuck } else
2068 1.1 chuck if ( msgaddr[0] == MSG_EXT_MESSAGE && msgaddr[1] == 3 &&
2069 1.1 chuck msgaddr[2] == MSG_SYNC_REQ ) {
2070 1.1 chuck
2071 1.1 chuck /*
2072 1.1 chuck * We've received the complete Extended Message Sync. Request...
2073 1.1 chuck */
2074 1.1 chuck QPRINTF(("SYN"));
2075 1.1 chuck
2076 1.1 chuck /*
2077 1.1 chuck * Compute the required Transfer Period for the WD chip...
2078 1.1 chuck */
2079 1.1 chuck dev->sc_sync[dev->target].period = sbicfromscsiperiod(dev, msgaddr[3]);
2080 1.1 chuck dev->sc_sync[dev->target].offset = msgaddr[4];
2081 1.1 chuck dev->sc_sync[dev->target].state = SYNC_DONE;
2082 1.1 chuck
2083 1.1 chuck /*
2084 1.1 chuck * Put the WD chip in synchronous mode
2085 1.1 chuck */
2086 1.1 chuck SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[dev->target].offset,
2087 1.1 chuck dev->sc_sync[dev->target].period));
2088 1.2 chuck #ifdef DEBUG
2089 1.2 chuck if ( sync_debug )
2090 1.5 christos printf("msgin(%d): sync reg = 0x%02x\n", dev->target,
2091 1.2 chuck SBIC_SYN(dev->sc_sync[dev->target].offset,
2092 1.2 chuck dev->sc_sync[dev->target].period));
2093 1.2 chuck #endif
2094 1.1 chuck
2095 1.5 christos printf("%s: target %d now synchronous, period=%dns, offset=%d.\n",
2096 1.1 chuck dev->sc_dev.dv_xname, dev->target,
2097 1.1 chuck msgaddr[3] * 4, msgaddr[4]);
2098 1.1 chuck
2099 1.1 chuck } else {
2100 1.1 chuck
2101 1.1 chuck /*
2102 1.1 chuck * We don't support whatever this message is...
2103 1.1 chuck */
2104 1.1 chuck #ifdef DEBUG
2105 1.1 chuck if ( sbic_debug || sync_debug )
2106 1.5 christos printf ("sbicmsgin: Rejecting message 0x%02x\n", msgaddr[0]);
2107 1.1 chuck #endif
2108 1.1 chuck
2109 1.1 chuck /*
2110 1.1 chuck * prepare to reject the message, NACK
2111 1.1 chuck */
2112 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_SET_ATN);
2113 1.1 chuck WAIT_CIP(regs);
2114 1.1 chuck }
2115 1.1 chuck
2116 1.1 chuck /*
2117 1.1 chuck * Negate ACK to complete the transfer
2118 1.1 chuck */
2119 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
2120 1.1 chuck
2121 1.1 chuck /*
2122 1.1 chuck * Wait for the interrupt for the next byte, or phase change.
2123 1.1 chuck * Only read the CSR if we have more data to transfer.
2124 1.1 chuck * XXXSCW: We should really verify that we're still in MSG IN phase
2125 1.1 chuck * before blindly going back around this loop, but that would mean
2126 1.1 chuck * we read the CSR... <sigh>
2127 1.1 chuck */
2128 1.1 chuck SBIC_WAIT(regs, SBIC_ASR_INT, 0);
2129 1.1 chuck if ( recvlen > 0 )
2130 1.1 chuck GET_SBIC_csr(regs, csr);
2131 1.1 chuck
2132 1.1 chuck } while ( recvlen > 0 );
2133 1.1 chuck
2134 1.1 chuck /*
2135 1.1 chuck * Should still have one CSR to read
2136 1.1 chuck */
2137 1.1 chuck return SBIC_STATE_RUNNING;
2138 1.1 chuck }
2139 1.1 chuck
2140 1.1 chuck
2141 1.1 chuck /*
2142 1.1 chuck * sbicnextstate()
2143 1.1 chuck * return:
2144 1.2 chuck * SBIC_STATE_DONE == done
2145 1.2 chuck * SBIC_STATE_RUNNING == working
2146 1.2 chuck * SBIC_STATE_DISCONNECT == disconnected
2147 1.2 chuck * SBIC_STATE_ERROR == error
2148 1.1 chuck */
2149 1.1 chuck int
2150 1.1 chuck sbicnextstate(dev, csr, asr)
2151 1.1 chuck struct sbic_softc *dev;
2152 1.1 chuck u_char csr,
2153 1.1 chuck asr;
2154 1.1 chuck {
2155 1.1 chuck sbic_regmap_p regs = dev->sc_sbicp;
2156 1.1 chuck struct sbic_acb *acb = dev->sc_nexus;
2157 1.1 chuck
2158 1.1 chuck QPRINTF(("next[%02x,%02x]: ",asr,csr));
2159 1.1 chuck
2160 1.1 chuck switch (csr) {
2161 1.1 chuck
2162 1.1 chuck case SBIC_CSR_XFERRED | CMD_PHASE:
2163 1.1 chuck case SBIC_CSR_MIS | CMD_PHASE:
2164 1.1 chuck case SBIC_CSR_MIS_1 | CMD_PHASE:
2165 1.1 chuck case SBIC_CSR_MIS_2 | CMD_PHASE:
2166 1.1 chuck {
2167 1.1 chuck if ( sbicxfout(regs, acb->clen, &acb->cmd) )
2168 1.1 chuck goto abort;
2169 1.1 chuck }
2170 1.1 chuck break;
2171 1.1 chuck
2172 1.1 chuck case SBIC_CSR_XFERRED | STATUS_PHASE:
2173 1.1 chuck case SBIC_CSR_MIS | STATUS_PHASE:
2174 1.1 chuck case SBIC_CSR_MIS_1 | STATUS_PHASE:
2175 1.1 chuck case SBIC_CSR_MIS_2 | STATUS_PHASE:
2176 1.1 chuck {
2177 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
2178 1.1 chuck
2179 1.1 chuck /*
2180 1.1 chuck * this should be the normal i/o completion case.
2181 1.1 chuck * get the status & cmd complete msg then let the
2182 1.1 chuck * device driver look at what happened.
2183 1.1 chuck */
2184 1.1 chuck sbicxfdone(dev);
2185 1.1 chuck
2186 1.1 chuck #ifdef DEBUG
2187 1.1 chuck dev->sc_dmatimo = 0;
2188 1.1 chuck if ( data_pointer_debug > 1 )
2189 1.5 christos printf("next dmastop: %d(%x:%x)\n", dev->target,
2190 1.1 chuck dev->sc_cur->dc_addr,
2191 1.1 chuck dev->sc_tcnt);
2192 1.1 chuck #endif
2193 1.1 chuck /*
2194 1.1 chuck * Stop the DMA chip
2195 1.1 chuck */
2196 1.1 chuck dev->sc_dmastop(dev);
2197 1.1 chuck
2198 1.1 chuck dev->sc_flags &= ~(SBICF_INDMA | SBICF_DCFLUSH);
2199 1.1 chuck
2200 1.1 chuck /*
2201 1.1 chuck * Indicate to the upper layers that the command is done
2202 1.1 chuck */
2203 1.1 chuck sbic_scsidone(acb, dev->sc_stat[0]);
2204 1.1 chuck
2205 1.1 chuck return SBIC_STATE_DONE;
2206 1.1 chuck }
2207 1.1 chuck
2208 1.1 chuck case SBIC_CSR_XFERRED | DATA_OUT_PHASE:
2209 1.1 chuck case SBIC_CSR_XFERRED | DATA_IN_PHASE:
2210 1.1 chuck case SBIC_CSR_MIS | DATA_OUT_PHASE:
2211 1.1 chuck case SBIC_CSR_MIS | DATA_IN_PHASE:
2212 1.1 chuck case SBIC_CSR_MIS_1 | DATA_OUT_PHASE:
2213 1.1 chuck case SBIC_CSR_MIS_1 | DATA_IN_PHASE:
2214 1.1 chuck case SBIC_CSR_MIS_2 | DATA_OUT_PHASE:
2215 1.1 chuck case SBIC_CSR_MIS_2 | DATA_IN_PHASE:
2216 1.1 chuck {
2217 1.1 chuck /*
2218 1.1 chuck * Verify that we expected to transfer data...
2219 1.1 chuck */
2220 1.1 chuck if ( acb->sc_kv.dc_count <= 0 ) {
2221 1.5 christos printf("next: DATA phase with xfer count == %d, asr:0x%02x csr:0x%02x\n",
2222 1.1 chuck acb->sc_kv.dc_count, asr, csr);
2223 1.1 chuck goto abort;
2224 1.1 chuck }
2225 1.1 chuck
2226 1.1 chuck /*
2227 1.1 chuck * Should we transfer using PIO or DMA ?
2228 1.1 chuck */
2229 1.1 chuck if ( dev->sc_xs->flags & SCSI_POLL || dev->sc_flags & SBICF_ICMD ||
2230 1.1 chuck acb->sc_dmacmd == 0 ) {
2231 1.1 chuck
2232 1.1 chuck /*
2233 1.1 chuck * Do PIO transfer
2234 1.1 chuck */
2235 1.1 chuck int i;
2236 1.1 chuck
2237 1.1 chuck #ifdef DEBUG
2238 1.1 chuck if ( data_pointer_debug > 1 )
2239 1.5 christos printf("next PIO: %d(%x:%x)\n", dev->target,
2240 1.1 chuck acb->sc_kv.dc_addr,
2241 1.1 chuck acb->sc_kv.dc_count);
2242 1.1 chuck #endif
2243 1.1 chuck
2244 1.1 chuck if ( SBIC_PHASE(csr) == DATA_IN_PHASE )
2245 1.1 chuck /*
2246 1.1 chuck * data in
2247 1.1 chuck */
2248 1.1 chuck i = sbicxfin(regs, acb->sc_kv.dc_count,
2249 1.1 chuck acb->sc_kv.dc_addr);
2250 1.1 chuck else
2251 1.1 chuck /*
2252 1.1 chuck * data out
2253 1.1 chuck */
2254 1.1 chuck i = sbicxfout(regs, acb->sc_kv.dc_count,
2255 1.1 chuck acb->sc_kv.dc_addr);
2256 1.1 chuck
2257 1.1 chuck acb->sc_kv.dc_addr += (acb->sc_kv.dc_count - i);
2258 1.1 chuck acb->sc_kv.dc_count = i;
2259 1.1 chuck
2260 1.1 chuck /*
2261 1.1 chuck * Update current count...
2262 1.1 chuck */
2263 1.1 chuck acb->sc_tcnt = dev->sc_tcnt = i;
2264 1.1 chuck
2265 1.1 chuck dev->sc_flags &= ~SBICF_INDMA;
2266 1.1 chuck
2267 1.1 chuck } else {
2268 1.1 chuck
2269 1.1 chuck /*
2270 1.1 chuck * Do DMA transfer
2271 1.1 chuck * set next dma addr and dec count
2272 1.1 chuck */
2273 1.1 chuck sbic_save_ptrs(dev);
2274 1.1 chuck sbic_load_ptrs(dev);
2275 1.1 chuck
2276 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI |
2277 1.1 chuck SBIC_MACHINE_DMA_MODE);
2278 1.1 chuck
2279 1.1 chuck #ifdef DEBUG
2280 1.1 chuck dev->sc_dmatimo = 1;
2281 1.1 chuck if ( data_pointer_debug > 1 )
2282 1.5 christos printf("next DMA: %d(%x:%x)\n", dev->target,
2283 1.1 chuck dev->sc_cur->dc_addr,
2284 1.1 chuck dev->sc_tcnt);
2285 1.1 chuck #endif
2286 1.1 chuck /*
2287 1.1 chuck * Start the DMA chip going
2288 1.1 chuck */
2289 1.1 chuck dev->sc_tcnt = dev->sc_dmanext(dev);
2290 1.1 chuck
2291 1.1 chuck /*
2292 1.1 chuck * Tell the WD chip how much to transfer this time around
2293 1.1 chuck */
2294 1.1 chuck SBIC_TC_PUT(regs, (unsigned)dev->sc_tcnt);
2295 1.1 chuck
2296 1.1 chuck /*
2297 1.1 chuck * Start the transfer
2298 1.1 chuck */
2299 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_XFER_INFO);
2300 1.1 chuck
2301 1.1 chuck /*
2302 1.1 chuck * Indicate that we're in DMA mode
2303 1.1 chuck */
2304 1.1 chuck dev->sc_flags |= SBICF_INDMA;
2305 1.1 chuck }
2306 1.1 chuck }
2307 1.1 chuck break;
2308 1.1 chuck
2309 1.1 chuck case SBIC_CSR_XFERRED | MESG_IN_PHASE:
2310 1.1 chuck case SBIC_CSR_MIS | MESG_IN_PHASE:
2311 1.1 chuck case SBIC_CSR_MIS_1 | MESG_IN_PHASE:
2312 1.1 chuck case SBIC_CSR_MIS_2 | MESG_IN_PHASE:
2313 1.1 chuck {
2314 1.1 chuck sbic_save_ptrs(dev);
2315 1.1 chuck
2316 1.1 chuck /*
2317 1.1 chuck * Handle a single message in...
2318 1.1 chuck */
2319 1.1 chuck return sbicmsgin(dev);
2320 1.1 chuck }
2321 1.1 chuck
2322 1.1 chuck case SBIC_CSR_MSGIN_W_ACK:
2323 1.1 chuck {
2324 1.1 chuck /*
2325 1.1 chuck * We should never see this since it's handled in 'sbicmsgin()'
2326 1.1 chuck * but just for the sake of paranoia...
2327 1.1 chuck */
2328 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK); /* Dunno what I'm ACKing */
2329 1.5 christos printf("Acking unknown msgin CSR:%02x",csr);
2330 1.1 chuck }
2331 1.1 chuck break;
2332 1.1 chuck
2333 1.1 chuck case SBIC_CSR_XFERRED | MESG_OUT_PHASE:
2334 1.1 chuck case SBIC_CSR_MIS | MESG_OUT_PHASE:
2335 1.1 chuck case SBIC_CSR_MIS_1 | MESG_OUT_PHASE:
2336 1.1 chuck case SBIC_CSR_MIS_2 | MESG_OUT_PHASE:
2337 1.1 chuck {
2338 1.1 chuck /*
2339 1.1 chuck * We only ever handle a message out phase here for sending a
2340 1.1 chuck * REJECT message.
2341 1.1 chuck */
2342 1.1 chuck sbic_save_ptrs(dev);
2343 1.1 chuck
2344 1.1 chuck #ifdef DEBUG
2345 1.1 chuck if (sync_debug)
2346 1.5 christos printf ("sending REJECT msg to last msg.\n");
2347 1.1 chuck #endif
2348 1.1 chuck
2349 1.1 chuck SEND_BYTE(regs, MSG_REJECT);
2350 1.1 chuck WAIT_CIP(regs);
2351 1.1 chuck }
2352 1.1 chuck break;
2353 1.1 chuck
2354 1.1 chuck case SBIC_CSR_DISC:
2355 1.1 chuck case SBIC_CSR_DISC_1:
2356 1.1 chuck {
2357 1.1 chuck /*
2358 1.1 chuck * Try to schedule another target
2359 1.1 chuck */
2360 1.1 chuck sbic_save_ptrs(dev);
2361 1.1 chuck
2362 1.1 chuck dev->sc_flags &= ~SBICF_SELECTED;
2363 1.1 chuck
2364 1.1 chuck #ifdef DEBUG
2365 1.1 chuck if ( reselect_debug > 1 )
2366 1.5 christos printf("sbicnext target %d disconnected\n", dev->target);
2367 1.1 chuck #endif
2368 1.1 chuck
2369 1.1 chuck TAILQ_INSERT_HEAD(&dev->nexus_list, acb, chain);
2370 1.1 chuck
2371 1.1 chuck ++dev->sc_tinfo[dev->target].dconns;
2372 1.1 chuck
2373 1.1 chuck dev->sc_nexus = NULL;
2374 1.1 chuck dev->sc_xs = NULL;
2375 1.1 chuck
2376 1.1 chuck if ( acb->xs->flags & SCSI_POLL || dev->sc_flags & SBICF_ICMD ||
2377 1.1 chuck !sbic_parallel_operations )
2378 1.1 chuck return SBIC_STATE_DISCONNECT;
2379 1.1 chuck
2380 1.1 chuck QPRINTF(("sbicnext: calling sbic_sched\n"));
2381 1.1 chuck
2382 1.1 chuck sbic_sched(dev);
2383 1.1 chuck
2384 1.1 chuck QPRINTF(("sbicnext: sbic_sched returned\n"));
2385 1.1 chuck
2386 1.1 chuck return SBIC_STATE_DISCONNECT;
2387 1.1 chuck }
2388 1.1 chuck
2389 1.1 chuck case SBIC_CSR_RSLT_NI:
2390 1.1 chuck case SBIC_CSR_RSLT_IFY:
2391 1.1 chuck {
2392 1.1 chuck /*
2393 1.1 chuck * A reselection.
2394 1.1 chuck * Note that since we don't enable Advanced Features (assuming
2395 1.1 chuck * the WD chip is at least the 'A' revision), we're only ever
2396 1.1 chuck * likely to see the 'SBIC_CSR_RSLT_NI' status. But for the
2397 1.1 chuck * hell of it, we'll handle it anyway, for all the extra code
2398 1.1 chuck * it needs...
2399 1.1 chuck */
2400 1.1 chuck u_char newtarget,
2401 1.1 chuck newlun;
2402 1.1 chuck
2403 1.1 chuck GET_SBIC_rselid(regs, newtarget);
2404 1.1 chuck
2405 1.1 chuck /*
2406 1.1 chuck * check SBIC_RID_SIV?
2407 1.1 chuck */
2408 1.1 chuck newtarget &= SBIC_RID_MASK;
2409 1.1 chuck
2410 1.1 chuck if ( csr == SBIC_CSR_RSLT_IFY ) {
2411 1.1 chuck
2412 1.1 chuck /*
2413 1.1 chuck * Read Identify msg to avoid lockup
2414 1.1 chuck */
2415 1.1 chuck GET_SBIC_data(regs, newlun);
2416 1.1 chuck WAIT_CIP(regs);
2417 1.1 chuck newlun &= SBIC_TLUN_MASK;
2418 1.1 chuck
2419 1.1 chuck } else {
2420 1.1 chuck
2421 1.1 chuck /*
2422 1.1 chuck * Need to read Identify message the hard way, assuming
2423 1.1 chuck * the target even sends us one...
2424 1.1 chuck */
2425 1.1 chuck for (newlun = 255; newlun; --newlun) {
2426 1.1 chuck GET_SBIC_asr(regs, asr);
2427 1.1 chuck if (asr & SBIC_ASR_INT)
2428 1.1 chuck break;
2429 1.2 chuck delay(10);
2430 1.1 chuck }
2431 1.1 chuck
2432 1.1 chuck /*
2433 1.1 chuck * If we didn't get an interrupt, somethink's up
2434 1.1 chuck */
2435 1.1 chuck if ( (asr & SBIC_ASR_INT) == 0 ) {
2436 1.5 christos printf("%s: Reselect without identify? asr %x\n",
2437 1.2 chuck dev->sc_dev.dv_xname, asr);
2438 1.1 chuck newlun = 0; /* XXXX */
2439 1.1 chuck } else {
2440 1.1 chuck /*
2441 1.1 chuck * We got an interrupt, verify that it's a change to
2442 1.1 chuck * message in phase, and if so read the message.
2443 1.1 chuck */
2444 1.1 chuck GET_SBIC_csr(regs,csr);
2445 1.1 chuck
2446 1.1 chuck if ( csr == SBIC_CSR_MIS | MESG_IN_PHASE ||
2447 1.1 chuck csr == SBIC_CSR_MIS_1 | MESG_IN_PHASE ||
2448 1.1 chuck csr == SBIC_CSR_MIS_2 | MESG_IN_PHASE ) {
2449 1.1 chuck /*
2450 1.1 chuck * Yup, gone to message in. Fetch the target LUN
2451 1.1 chuck */
2452 1.1 chuck sbicmsgin(dev);
2453 1.1 chuck newlun = dev->sc_msg[0] & 0x07;
2454 1.1 chuck
2455 1.1 chuck } else {
2456 1.1 chuck /*
2457 1.1 chuck * Whoops! Target didn't go to message in phase!!
2458 1.1 chuck */
2459 1.5 christos printf("RSLT_NI - not MESG_IN_PHASE %x\n", csr);
2460 1.1 chuck newlun = 0; /* XXXSCW */
2461 1.1 chuck }
2462 1.1 chuck }
2463 1.1 chuck }
2464 1.1 chuck
2465 1.1 chuck /*
2466 1.1 chuck * Ok, we have the identity of the reselecting target.
2467 1.1 chuck */
2468 1.1 chuck #ifdef DEBUG
2469 1.1 chuck if ( reselect_debug > 1 ||
2470 1.1 chuck (reselect_debug && csr == SBIC_CSR_RSLT_NI) ) {
2471 1.5 christos printf("sbicnext: reselect %s from targ %d lun %d\n",
2472 1.1 chuck csr == SBIC_CSR_RSLT_NI ? "NI" : "IFY", newtarget, newlun);
2473 1.1 chuck }
2474 1.1 chuck #endif
2475 1.1 chuck
2476 1.1 chuck if ( dev->sc_nexus ) {
2477 1.1 chuck /*
2478 1.1 chuck * Whoops! We've been reselected with an command in progress!
2479 1.1 chuck * The best we can do is to put the current command back on the
2480 1.1 chuck * ready list and hope for the best.
2481 1.1 chuck */
2482 1.1 chuck #ifdef DEBUG
2483 1.1 chuck if ( reselect_debug > 1 ) {
2484 1.5 christos printf("%s: reselect %s with active command\n",
2485 1.1 chuck dev->sc_dev.dv_xname,
2486 1.1 chuck csr == SBIC_CSR_RSLT_NI ? "NI" : "IFY");
2487 1.1 chuck }
2488 1.1 chuck #endif
2489 1.1 chuck
2490 1.1 chuck TAILQ_INSERT_HEAD(&dev->ready_list, dev->sc_nexus, chain);
2491 1.1 chuck
2492 1.1 chuck dev->sc_tinfo[dev->target].lubusy &= ~(1 << dev->lun);
2493 1.1 chuck
2494 1.1 chuck dev->sc_nexus = NULL;
2495 1.1 chuck dev->sc_xs = NULL;
2496 1.1 chuck }
2497 1.1 chuck
2498 1.1 chuck /*
2499 1.1 chuck * Reload sync values for this target
2500 1.1 chuck */
2501 1.1 chuck if ( dev->sc_sync[newtarget].state == SYNC_DONE )
2502 1.1 chuck SET_SBIC_syn(regs, SBIC_SYN (dev->sc_sync[newtarget].offset,
2503 1.1 chuck dev->sc_sync[newtarget].period));
2504 1.1 chuck else
2505 1.1 chuck SET_SBIC_syn(regs, SBIC_SYN (0, sbic_min_period));
2506 1.1 chuck
2507 1.1 chuck /*
2508 1.1 chuck * Loop through the nexus list until we find the saved entry
2509 1.1 chuck * for the reselecting target...
2510 1.1 chuck */
2511 1.1 chuck for (acb = dev->nexus_list.tqh_first; acb;
2512 1.1 chuck acb = acb->chain.tqe_next) {
2513 1.1 chuck
2514 1.6 bouyer if ( acb->xs->sc_link->scsipi_scsi.target == newtarget &&
2515 1.6 bouyer acb->xs->sc_link->scsipi_scsi.lun == newlun) {
2516 1.1 chuck /*
2517 1.1 chuck * We've found the saved entry. Dequeue it, and
2518 1.1 chuck * make it current again.
2519 1.1 chuck */
2520 1.1 chuck TAILQ_REMOVE(&dev->nexus_list, acb, chain);
2521 1.1 chuck
2522 1.1 chuck dev->sc_nexus = acb;
2523 1.1 chuck dev->sc_xs = acb->xs;
2524 1.1 chuck dev->sc_flags |= SBICF_SELECTED;
2525 1.1 chuck dev->target = newtarget;
2526 1.1 chuck dev->lun = newlun;
2527 1.1 chuck break;
2528 1.1 chuck }
2529 1.1 chuck }
2530 1.1 chuck
2531 1.1 chuck if ( acb == NULL ) {
2532 1.5 christos printf("%s: reselect %s targ %d not in nexus_list %x\n",
2533 1.1 chuck dev->sc_dev.dv_xname,
2534 1.1 chuck csr == SBIC_CSR_RSLT_NI ? "NI" : "IFY", newtarget,
2535 1.1 chuck &dev->nexus_list.tqh_first);
2536 1.1 chuck panic("bad reselect in sbic");
2537 1.1 chuck }
2538 1.1 chuck
2539 1.1 chuck if ( csr == SBIC_CSR_RSLT_IFY )
2540 1.1 chuck SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
2541 1.1 chuck }
2542 1.1 chuck break;
2543 1.1 chuck
2544 1.1 chuck default:
2545 1.1 chuck abort:
2546 1.1 chuck {
2547 1.1 chuck /*
2548 1.1 chuck * Something unexpected happened -- deal with it.
2549 1.1 chuck */
2550 1.5 christos printf("next: aborting asr 0x%02x csr 0x%02x\n", asr, csr);
2551 1.1 chuck
2552 1.1 chuck #ifdef DDB
2553 1.1 chuck Debugger();
2554 1.1 chuck #endif
2555 1.1 chuck
2556 1.1 chuck #ifdef DEBUG
2557 1.1 chuck dev->sc_dmatimo = 0;
2558 1.1 chuck if ( data_pointer_debug > 1 )
2559 1.5 christos printf("next dmastop: %d(%x:%x)\n", dev->target,
2560 1.1 chuck dev->sc_cur->dc_addr,
2561 1.1 chuck dev->sc_tcnt);
2562 1.1 chuck #endif
2563 1.1 chuck
2564 1.1 chuck dev->sc_dmastop(dev);
2565 1.1 chuck SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
2566 1.1 chuck if ( dev->sc_xs ) sbicerror(dev, csr);
2567 1.1 chuck sbicabort(dev, "next");
2568 1.1 chuck
2569 1.1 chuck if ( dev->sc_flags & SBICF_INDMA ) {
2570 1.1 chuck dev->sc_flags &= ~(SBICF_INDMA | SBICF_DCFLUSH);
2571 1.1 chuck
2572 1.1 chuck #ifdef DEBUG
2573 1.1 chuck dev->sc_dmatimo = 0;
2574 1.1 chuck if ( data_pointer_debug > 1 )
2575 1.5 christos printf("next dmastop: %d(%x:%x)\n", dev->target,
2576 1.1 chuck dev->sc_cur->dc_addr,
2577 1.1 chuck dev->sc_tcnt);
2578 1.1 chuck #endif
2579 1.1 chuck sbic_scsidone(acb, -1);
2580 1.1 chuck }
2581 1.1 chuck
2582 1.1 chuck return SBIC_STATE_ERROR;
2583 1.1 chuck }
2584 1.1 chuck }
2585 1.1 chuck
2586 1.1 chuck return(SBIC_STATE_RUNNING);
2587 1.1 chuck }
2588 1.1 chuck
2589 1.1 chuck
2590 1.1 chuck /*
2591 1.1 chuck * Check if DMA can not be used with specified buffer
2592 1.1 chuck */
2593 1.1 chuck int
2594 1.1 chuck sbiccheckdmap(bp, len, mask)
2595 1.1 chuck void *bp;
2596 1.1 chuck u_long len,
2597 1.1 chuck mask;
2598 1.1 chuck {
2599 1.1 chuck u_char *buffer;
2600 1.1 chuck u_long phy_buf;
2601 1.1 chuck u_long phy_len;
2602 1.1 chuck
2603 1.1 chuck buffer = bp;
2604 1.1 chuck
2605 1.1 chuck if ( len == 0 )
2606 1.1 chuck return(1);
2607 1.1 chuck
2608 1.1 chuck while ( len ) {
2609 1.1 chuck
2610 1.1 chuck phy_buf = kvtop(buffer);
2611 1.1 chuck phy_len = NBPG - ((int) buffer & PGOFSET);
2612 1.1 chuck
2613 1.1 chuck if ( len < phy_len )
2614 1.1 chuck phy_len = len;
2615 1.1 chuck
2616 1.1 chuck if ( phy_buf & mask )
2617 1.1 chuck return(1);
2618 1.1 chuck
2619 1.1 chuck buffer += phy_len;
2620 1.1 chuck len -= phy_len;
2621 1.1 chuck }
2622 1.1 chuck
2623 1.1 chuck return(0);
2624 1.1 chuck }
2625 1.1 chuck
2626 1.1 chuck int
2627 1.1 chuck sbictoscsiperiod(dev, a)
2628 1.1 chuck struct sbic_softc *dev;
2629 1.1 chuck int a;
2630 1.1 chuck {
2631 1.1 chuck unsigned int fs;
2632 1.1 chuck
2633 1.1 chuck /*
2634 1.1 chuck * cycle = DIV / (2 * CLK)
2635 1.1 chuck * DIV = FS + 2
2636 1.1 chuck * best we can do is 200ns at 20Mhz, 2 cycles
2637 1.1 chuck */
2638 1.1 chuck
2639 1.1 chuck GET_SBIC_myid(dev->sc_sbicp, fs);
2640 1.1 chuck
2641 1.1 chuck fs = (fs >> 6) + 2; /* DIV */
2642 1.1 chuck
2643 1.1 chuck fs = (fs * 10000) / (dev->sc_clkfreq << 1); /* Cycle, in ns */
2644 1.1 chuck
2645 1.1 chuck if ( a < 2 )
2646 1.1 chuck a = 8; /* map to Cycles */
2647 1.1 chuck
2648 1.1 chuck return ( (fs * a) >> 2 ); /* in 4 ns units */
2649 1.1 chuck }
2650 1.1 chuck
2651 1.1 chuck int
2652 1.1 chuck sbicfromscsiperiod(dev, p)
2653 1.1 chuck struct sbic_softc *dev;
2654 1.1 chuck int p;
2655 1.1 chuck {
2656 1.1 chuck unsigned fs,
2657 1.1 chuck ret;
2658 1.1 chuck
2659 1.1 chuck /*
2660 1.1 chuck * Just the inverse of the above
2661 1.1 chuck */
2662 1.1 chuck GET_SBIC_myid(dev->sc_sbicp, fs);
2663 1.1 chuck
2664 1.1 chuck fs = (fs >> 6) + 2; /* DIV */
2665 1.1 chuck
2666 1.1 chuck fs = (fs * 10000) / (dev->sc_clkfreq << 1); /* Cycle, in ns */
2667 1.1 chuck
2668 1.1 chuck ret = p << 2; /* in ns units */
2669 1.1 chuck ret = ret / fs; /* in Cycles */
2670 1.1 chuck
2671 1.1 chuck if ( ret < sbic_min_period )
2672 1.1 chuck return(sbic_min_period);
2673 1.1 chuck
2674 1.1 chuck /*
2675 1.1 chuck * verify rounding
2676 1.1 chuck */
2677 1.1 chuck if ( sbictoscsiperiod(dev, ret) < p )
2678 1.1 chuck ret++;
2679 1.1 chuck
2680 1.1 chuck return( (ret >= 8) ? 0 : ret );
2681 1.1 chuck }
2682 1.1 chuck
2683 1.1 chuck #ifdef DEBUG
2684 1.1 chuck void
2685 1.1 chuck sbictimeout(dev)
2686 1.1 chuck struct sbic_softc *dev;
2687 1.1 chuck {
2688 1.1 chuck int s,
2689 1.1 chuck asr;
2690 1.1 chuck
2691 1.1 chuck s = splbio();
2692 1.1 chuck
2693 1.1 chuck if ( dev->sc_dmatimo ) {
2694 1.1 chuck
2695 1.1 chuck if ( dev->sc_dmatimo > 1 ) {
2696 1.1 chuck
2697 1.5 christos printf("%s: dma timeout #%d\n", dev->sc_dev.dv_xname,
2698 1.1 chuck dev->sc_dmatimo - 1);
2699 1.1 chuck
2700 1.1 chuck GET_SBIC_asr(dev->sc_sbicp, asr);
2701 1.1 chuck
2702 1.1 chuck if ( asr & SBIC_ASR_INT ) {
2703 1.1 chuck /*
2704 1.1 chuck * We need to service a missed IRQ
2705 1.1 chuck */
2706 1.1 chuck sbicintr(dev);
2707 1.2 chuck } else {
2708 1.2 chuck (void) sbicabort(dev, "timeout");
2709 1.2 chuck splx(s);
2710 1.2 chuck return;
2711 1.1 chuck }
2712 1.1 chuck }
2713 1.1 chuck
2714 1.1 chuck dev->sc_dmatimo++;
2715 1.1 chuck }
2716 1.1 chuck
2717 1.1 chuck splx(s);
2718 1.1 chuck
2719 1.1 chuck timeout((void *)sbictimeout, dev, 30 * hz);
2720 1.1 chuck }
2721 1.1 chuck #endif
2722