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