sbic.c revision 1.1 1 1.1 chopps /*
2 1.1 chopps * Copyright (c) 1994 Christian E. Hopps
3 1.1 chopps * Copyright (c) 1990 The Regents of the University of California.
4 1.1 chopps * All rights reserved.
5 1.1 chopps *
6 1.1 chopps * This code is derived from software contributed to Berkeley by
7 1.1 chopps * Van Jacobson of Lawrence Berkeley Laboratory.
8 1.1 chopps *
9 1.1 chopps * Redistribution and use in source and binary forms, with or without
10 1.1 chopps * modification, are permitted provided that the following conditions
11 1.1 chopps * are met:
12 1.1 chopps * 1. Redistributions of source code must retain the above copyright
13 1.1 chopps * notice, this list of conditions and the following disclaimer.
14 1.1 chopps * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 chopps * notice, this list of conditions and the following disclaimer in the
16 1.1 chopps * documentation and/or other materials provided with the distribution.
17 1.1 chopps * 3. All advertising materials mentioning features or use of this software
18 1.1 chopps * must display the following acknowledgement:
19 1.1 chopps * This product includes software developed by the University of
20 1.1 chopps * California, Berkeley and its contributors.
21 1.1 chopps * 4. Neither the name of the University nor the names of its contributors
22 1.1 chopps * may be used to endorse or promote products derived from this software
23 1.1 chopps * without specific prior written permission.
24 1.1 chopps *
25 1.1 chopps * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
26 1.1 chopps * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
27 1.1 chopps * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
28 1.1 chopps * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
29 1.1 chopps * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
30 1.1 chopps * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
31 1.1 chopps * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
32 1.1 chopps * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
33 1.1 chopps * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
34 1.1 chopps * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
35 1.1 chopps * SUCH DAMAGE.
36 1.1 chopps *
37 1.1 chopps * @(#)scsi.c 7.5 (Berkeley) 5/4/91
38 1.1 chopps * $Id: sbic.c,v 1.1 1994/05/08 05:53:36 chopps Exp $
39 1.1 chopps */
40 1.1 chopps
41 1.1 chopps /*
42 1.1 chopps * AMIGA AMD 33C93 scsi adaptor driver
43 1.1 chopps */
44 1.1 chopps
45 1.1 chopps /* need to know if any tapes have been configured */
46 1.1 chopps #include "st.h"
47 1.1 chopps
48 1.1 chopps #include <sys/param.h>
49 1.1 chopps #include <sys/systm.h>
50 1.1 chopps #include <sys/device.h>
51 1.1 chopps #include <sys/buf.h>
52 1.1 chopps #include <scsi/scsi_all.h>
53 1.1 chopps #include <scsi/scsiconf.h>
54 1.1 chopps #include <vm/vm.h>
55 1.1 chopps #include <vm/vm_kern.h>
56 1.1 chopps #include <vm/vm_page.h>
57 1.1 chopps #include <machine/pmap.h>
58 1.1 chopps #include <machine/cpu.h>
59 1.1 chopps #include <amiga/amiga/device.h>
60 1.1 chopps #include <amiga/amiga/custom.h>
61 1.1 chopps #include <amiga/dev/dmavar.h>
62 1.1 chopps #include <amiga/dev/sbicreg.h>
63 1.1 chopps #include <amiga/dev/sbicvar.h>
64 1.1 chopps
65 1.1 chopps /*
66 1.1 chopps * SCSI delays
67 1.1 chopps * In u-seconds, primarily for state changes on the SPC.
68 1.1 chopps */
69 1.1 chopps #define SBIC_CMD_WAIT 50000 /* wait per step of 'immediate' cmds */
70 1.1 chopps #define SBIC_DATA_WAIT 50000 /* wait per data in/out step */
71 1.1 chopps #define SBIC_INIT_WAIT 50000 /* wait per step (both) during init */
72 1.1 chopps
73 1.1 chopps #define b_cylin b_resid
74 1.1 chopps #define SBIC_WAIT(regs, until, timeo) sbicwait(regs, until, timeo, __LINE__)
75 1.1 chopps
76 1.1 chopps extern u_int kvtop();
77 1.1 chopps
78 1.1 chopps int sbicicmd __P((struct sbic_softc *, int, void *, int, void *, int,u_char));
79 1.1 chopps int sbicgo __P((struct sbic_softc *, struct scsi_xfer *));
80 1.1 chopps int sbicdmaok __P((struct sbic_softc *, struct scsi_xfer *));
81 1.1 chopps int sbicgetsense __P((struct sbic_softc *, struct scsi_xfer *));
82 1.1 chopps int sbicwait __P((sbic_regmap_p, char, int , int));
83 1.1 chopps int sbiccheckdmap __P((void *, u_long, u_long));
84 1.1 chopps int sbicselectbus __P((struct sbic_softc *, sbic_regmap_p, u_char, u_char));
85 1.1 chopps int sbicxfstart __P((sbic_regmap_p, int, u_char, int));
86 1.1 chopps int sbicxfout __P((sbic_regmap_p regs, int, void *, int));
87 1.1 chopps int sbicfromscsiperiod __P((struct sbic_softc *, sbic_regmap_p, int));
88 1.1 chopps int sbictoscsiperiod __P((struct sbic_softc *, sbic_regmap_p, int));
89 1.1 chopps int sbicintr __P((struct sbic_softc *));
90 1.1 chopps void sbicxfin __P((sbic_regmap_p regs, int, void *));
91 1.1 chopps void sbicxfdone __P((struct sbic_softc *, sbic_regmap_p, int));
92 1.1 chopps void sbicabort __P((struct sbic_softc *, sbic_regmap_p, char *));
93 1.1 chopps void sbicerror __P((struct sbic_softc *, sbic_regmap_p, u_char));
94 1.1 chopps void sbicstart __P((struct sbic_softc *));
95 1.1 chopps void sbicreset __P((struct sbic_softc *));
96 1.1 chopps void sbicsetdelay __P((int));
97 1.1 chopps void sbic_scsidone __P((struct sbic_softc *, int));
98 1.1 chopps void sbic_donextcmd __P((struct sbic_softc *));
99 1.1 chopps
100 1.1 chopps /*
101 1.1 chopps * Synch xfer parameters, and timing conversions
102 1.1 chopps */
103 1.1 chopps int sbic_min_period = SBIC_SYN_MIN_PERIOD; /* in cycles = f(ICLK,FSn) */
104 1.1 chopps int sbic_max_offset = SBIC_SYN_MAX_OFFSET; /* pure number */
105 1.1 chopps
106 1.1 chopps int sbic_cmd_wait = SBIC_CMD_WAIT;
107 1.1 chopps int sbic_data_wait = SBIC_DATA_WAIT;
108 1.1 chopps int sbic_init_wait = SBIC_INIT_WAIT;
109 1.1 chopps
110 1.1 chopps /*
111 1.1 chopps * was broken before.. now if you want this you get it for all drives
112 1.1 chopps * on sbic controllers.
113 1.1 chopps */
114 1.1 chopps int sbic_inhibit_sync = 1;
115 1.1 chopps int sbic_clock_override = 0;
116 1.1 chopps int sbic_no_dma = 0;
117 1.1 chopps
118 1.1 chopps #ifdef DEBUG
119 1.1 chopps #define QPRINTF(a) if (sbic_debug > 1) printf a
120 1.1 chopps int sbic_debug = 0;
121 1.1 chopps int sync_debug = 0;
122 1.1 chopps int sbic_dma_debug = 0;
123 1.1 chopps #else
124 1.1 chopps #define QPRINTF
125 1.1 chopps #endif
126 1.1 chopps
127 1.1 chopps /*
128 1.1 chopps * default minphys routine for sbic based controllers
129 1.1 chopps */
130 1.1 chopps void
131 1.1 chopps sbic_minphys(bp)
132 1.1 chopps struct buf *bp;
133 1.1 chopps {
134 1.1 chopps /*
135 1.1 chopps * no max transfer at this level
136 1.1 chopps */
137 1.1 chopps }
138 1.1 chopps
139 1.1 chopps /*
140 1.1 chopps * must be used
141 1.1 chopps */
142 1.1 chopps u_int
143 1.1 chopps sbic_adinfo()
144 1.1 chopps {
145 1.1 chopps /*
146 1.1 chopps * one request at a time please
147 1.1 chopps */
148 1.1 chopps return(1);
149 1.1 chopps }
150 1.1 chopps
151 1.1 chopps /*
152 1.1 chopps * used by specific sbic controller
153 1.1 chopps *
154 1.1 chopps * it appears that the higher level code does nothing with LUN's
155 1.1 chopps * so I will too. I could plug it in, however so could they
156 1.1 chopps * in scsi_scsi_cmd().
157 1.1 chopps */
158 1.1 chopps int
159 1.1 chopps sbic_scsicmd(xs)
160 1.1 chopps struct scsi_xfer *xs;
161 1.1 chopps {
162 1.1 chopps struct sbic_pending *pendp;
163 1.1 chopps struct sbic_softc *dev;
164 1.1 chopps struct scsi_link *slp;
165 1.1 chopps int flags, s;
166 1.1 chopps
167 1.1 chopps slp = xs->sc_link;
168 1.1 chopps dev = slp->adapter_softc;
169 1.1 chopps flags = xs->flags;
170 1.1 chopps
171 1.1 chopps if (flags & SCSI_DATA_UIO)
172 1.1 chopps panic("sbic: scsi data uio requested");
173 1.1 chopps
174 1.1 chopps if (dev->sc_xs && flags & SCSI_NOMASK)
175 1.1 chopps panic("sbic_scsicmd: busy");
176 1.1 chopps
177 1.1 chopps s = splbio();
178 1.1 chopps pendp = &dev->sc_xsstore[slp->target][slp->lun];
179 1.1 chopps if (pendp->xs) {
180 1.1 chopps splx(s);
181 1.1 chopps return(TRY_AGAIN_LATER);
182 1.1 chopps }
183 1.1 chopps
184 1.1 chopps if (dev->sc_xs) {
185 1.1 chopps pendp->xs = xs;
186 1.1 chopps TAILQ_INSERT_TAIL(&dev->sc_xslist, pendp, link);
187 1.1 chopps splx(s);
188 1.1 chopps return(SUCCESSFULLY_QUEUED);
189 1.1 chopps }
190 1.1 chopps pendp->xs = NULL;
191 1.1 chopps dev->sc_xs = xs;
192 1.1 chopps splx(s);
193 1.1 chopps
194 1.1 chopps /*
195 1.1 chopps * nothing is pending do it now.
196 1.1 chopps */
197 1.1 chopps sbic_donextcmd(dev);
198 1.1 chopps
199 1.1 chopps if (flags & SCSI_NOMASK)
200 1.1 chopps return(COMPLETE);
201 1.1 chopps return(SUCCESSFULLY_QUEUED);
202 1.1 chopps }
203 1.1 chopps
204 1.1 chopps /*
205 1.1 chopps * entered with dev->sc_xs pointing to the next xfer to perform
206 1.1 chopps */
207 1.1 chopps void
208 1.1 chopps sbic_donextcmd(dev)
209 1.1 chopps struct sbic_softc *dev;
210 1.1 chopps {
211 1.1 chopps struct scsi_xfer *xs;
212 1.1 chopps struct scsi_link *slp;
213 1.1 chopps int flags, phase, stat;
214 1.1 chopps
215 1.1 chopps xs = dev->sc_xs;
216 1.1 chopps slp = xs->sc_link;
217 1.1 chopps flags = xs->flags;
218 1.1 chopps
219 1.1 chopps if (flags & SCSI_DATA_IN)
220 1.1 chopps phase = DATA_IN_PHASE;
221 1.1 chopps else if (flags & SCSI_DATA_OUT)
222 1.1 chopps phase = DATA_OUT_PHASE;
223 1.1 chopps else
224 1.1 chopps phase = STATUS_PHASE;
225 1.1 chopps
226 1.1 chopps if (flags & SCSI_RESET)
227 1.1 chopps sbicreset(dev);
228 1.1 chopps
229 1.1 chopps dev->sc_stat[0] = -1;
230 1.1 chopps if (phase == STATUS_PHASE || flags & SCSI_NOMASK ||
231 1.1 chopps sbicdmaok(dev, xs) == 0)
232 1.1 chopps stat = sbicicmd(dev, slp->target, xs->cmd, xs->cmdlen,
233 1.1 chopps xs->data, xs->datalen, phase);
234 1.1 chopps else if (sbicgo(dev, xs) == 0)
235 1.1 chopps return;
236 1.1 chopps else
237 1.1 chopps stat = dev->sc_stat[0];
238 1.1 chopps
239 1.1 chopps sbic_scsidone(dev, stat);
240 1.1 chopps }
241 1.1 chopps
242 1.1 chopps void
243 1.1 chopps sbic_scsidone(dev, stat)
244 1.1 chopps struct sbic_softc *dev;
245 1.1 chopps int stat;
246 1.1 chopps {
247 1.1 chopps struct sbic_pending *pendp;
248 1.1 chopps struct scsi_xfer *xs;
249 1.1 chopps int s, donext;
250 1.1 chopps
251 1.1 chopps xs = dev->sc_xs;
252 1.1 chopps #ifdef DIAGNOSTIC
253 1.1 chopps if (xs == NULL)
254 1.1 chopps panic("sbic_scsidone");
255 1.1 chopps #endif
256 1.1 chopps /*
257 1.1 chopps * is this right?
258 1.1 chopps */
259 1.1 chopps xs->status = stat;
260 1.1 chopps
261 1.1 chopps if (stat == 0 || xs->flags & SCSI_ERR_OK)
262 1.1 chopps xs->resid = 0;
263 1.1 chopps else {
264 1.1 chopps switch(stat) {
265 1.1 chopps case SCSI_CHECK:
266 1.1 chopps if (stat = sbicgetsense(dev, xs))
267 1.1 chopps goto bad_sense;
268 1.1 chopps xs->error = XS_SENSE;
269 1.1 chopps break;
270 1.1 chopps case SCSI_BUSY:
271 1.1 chopps xs->error = XS_BUSY;
272 1.1 chopps break;
273 1.1 chopps bad_sense:
274 1.1 chopps default:
275 1.1 chopps xs->error = XS_DRIVER_STUFFUP;
276 1.1 chopps QPRINTF(("sbic_scsicmd() bad %x\n", stat));
277 1.1 chopps break;
278 1.1 chopps }
279 1.1 chopps }
280 1.1 chopps xs->flags |= ITSDONE;
281 1.1 chopps
282 1.1 chopps /*
283 1.1 chopps * grab next command before scsi_done()
284 1.1 chopps * this way no single device can hog scsi resources.
285 1.1 chopps */
286 1.1 chopps s = splbio();
287 1.1 chopps pendp = dev->sc_xslist.tqh_first;
288 1.1 chopps if (pendp == NULL) {
289 1.1 chopps donext = 0;
290 1.1 chopps dev->sc_xs = NULL;
291 1.1 chopps } else {
292 1.1 chopps donext = 1;
293 1.1 chopps TAILQ_REMOVE(&dev->sc_xslist, pendp, link);
294 1.1 chopps dev->sc_xs = pendp->xs;
295 1.1 chopps pendp->xs = NULL;
296 1.1 chopps }
297 1.1 chopps splx(s);
298 1.1 chopps scsi_done(xs);
299 1.1 chopps
300 1.1 chopps if (donext)
301 1.1 chopps sbic_donextcmd(dev);
302 1.1 chopps }
303 1.1 chopps
304 1.1 chopps int
305 1.1 chopps sbicgetsense(dev, xs)
306 1.1 chopps struct sbic_softc *dev;
307 1.1 chopps struct scsi_xfer *xs;
308 1.1 chopps {
309 1.1 chopps struct scsi_sense rqs;
310 1.1 chopps struct scsi_link *slp;
311 1.1 chopps int stat;
312 1.1 chopps
313 1.1 chopps slp = xs->sc_link;
314 1.1 chopps
315 1.1 chopps rqs.op_code = REQUEST_SENSE;
316 1.1 chopps rqs.byte2 = slp->lun << 5;
317 1.1 chopps rqs.length = xs->req_sense_length ? xs->req_sense_length :
318 1.1 chopps sizeof(xs->sense);
319 1.1 chopps rqs.unused[0] = rqs.unused[1] = rqs.control = 0;
320 1.1 chopps
321 1.1 chopps return(sbicicmd(dev, slp->target, &rqs, sizeof(rqs), &xs->sense,
322 1.1 chopps rqs.length, DATA_IN_PHASE));
323 1.1 chopps }
324 1.1 chopps
325 1.1 chopps int
326 1.1 chopps sbicdmaok(dev, xs)
327 1.1 chopps struct sbic_softc *dev;
328 1.1 chopps struct scsi_xfer *xs;
329 1.1 chopps {
330 1.1 chopps if (sbic_no_dma || xs->datalen & 0x1 || (u_int)xs->data & 0x3)
331 1.1 chopps return(0);
332 1.1 chopps /*
333 1.1 chopps * controller supports dma to any addresses?
334 1.1 chopps */
335 1.1 chopps else if ((dev->sc_flags & SBICF_BADDMA) == 0)
336 1.1 chopps return(1);
337 1.1 chopps /*
338 1.1 chopps * this address is ok for dma?
339 1.1 chopps */
340 1.1 chopps else if (sbiccheckdmap(xs->data, xs->datalen, dev->sc_dmamask) == 0)
341 1.1 chopps return(1);
342 1.1 chopps /*
343 1.1 chopps * we have a bounce buffer?
344 1.1 chopps */
345 1.1 chopps else if (dev->sc_dmabuffer)
346 1.1 chopps return(1);
347 1.1 chopps return(0);
348 1.1 chopps }
349 1.1 chopps
350 1.1 chopps
351 1.1 chopps int
352 1.1 chopps sbicwait(regs, until, timeo, line)
353 1.1 chopps sbic_regmap_p regs;
354 1.1 chopps char until;
355 1.1 chopps int timeo;
356 1.1 chopps int line;
357 1.1 chopps {
358 1.1 chopps u_char val;
359 1.1 chopps int csr;
360 1.1 chopps
361 1.1 chopps if (timeo == 0)
362 1.1 chopps timeo = 1000000; /* some large value.. */
363 1.1 chopps
364 1.1 chopps GET_SBIC_asr(regs,val);
365 1.1 chopps while ((val & until) == 0) {
366 1.1 chopps if (timeo-- == 0) {
367 1.1 chopps GET_SBIC_csr(regs, csr);
368 1.1 chopps printf("sbicwait TIMEO @%d with asr=x%x csr=x%x\n",
369 1.1 chopps line, val, csr);
370 1.1 chopps break;
371 1.1 chopps }
372 1.1 chopps DELAY(1);
373 1.1 chopps GET_SBIC_asr(regs,val);
374 1.1 chopps }
375 1.1 chopps return(val);
376 1.1 chopps }
377 1.1 chopps
378 1.1 chopps void
379 1.1 chopps sbicabort(dev, regs, where)
380 1.1 chopps struct sbic_softc *dev;
381 1.1 chopps sbic_regmap_p regs;
382 1.1 chopps char *where;
383 1.1 chopps {
384 1.1 chopps u_char csr, asr;
385 1.1 chopps
386 1.1 chopps GET_SBIC_csr(regs, csr);
387 1.1 chopps GET_SBIC_asr(regs, asr);
388 1.1 chopps
389 1.1 chopps printf ("%s: abort %s: csr = 0x%02x, asr = 0x%02x\n",
390 1.1 chopps dev->sc_dev.dv_xname, where, csr, asr);
391 1.1 chopps
392 1.1 chopps if (dev->sc_flags & SBICF_SELECTED) {
393 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_ABORT);
394 1.1 chopps WAIT_CIP(regs);
395 1.1 chopps
396 1.1 chopps GET_SBIC_asr(regs, asr);
397 1.1 chopps if (asr & (SBIC_ASR_BSY|SBIC_ASR_LCI)) {
398 1.1 chopps /* ok, get more drastic.. */
399 1.1 chopps
400 1.1 chopps SET_SBIC_cmd (regs, SBIC_CMD_RESET);
401 1.1 chopps DELAY(25);
402 1.1 chopps SBIC_WAIT(regs, SBIC_ASR_INT, 0);
403 1.1 chopps /* clears interrupt also */
404 1.1 chopps GET_SBIC_csr (regs, csr);
405 1.1 chopps
406 1.1 chopps dev->sc_flags &= ~SBICF_SELECTED;
407 1.1 chopps return;
408 1.1 chopps }
409 1.1 chopps
410 1.1 chopps do {
411 1.1 chopps SBIC_WAIT (regs, SBIC_ASR_INT, 0);
412 1.1 chopps GET_SBIC_csr (regs, csr);
413 1.1 chopps } while ((csr != SBIC_CSR_DISC) && (csr != SBIC_CSR_DISC_1)
414 1.1 chopps && (csr != SBIC_CSR_CMD_INVALID));
415 1.1 chopps
416 1.1 chopps /* lets just hope it worked.. */
417 1.1 chopps dev->sc_flags &= ~SBICF_SELECTED;
418 1.1 chopps }
419 1.1 chopps }
420 1.1 chopps
421 1.1 chopps /*
422 1.1 chopps * XXX Set/reset long delays.
423 1.1 chopps *
424 1.1 chopps * if delay == 0, reset default delays
425 1.1 chopps * if delay < 0, set both delays to default long initialization values
426 1.1 chopps * if delay > 0, set both delays to this value
427 1.1 chopps *
428 1.1 chopps * Used when a devices is expected to respond slowly (e.g. during
429 1.1 chopps * initialization).
430 1.1 chopps */
431 1.1 chopps void
432 1.1 chopps sbicsetdelay(del)
433 1.1 chopps int del;
434 1.1 chopps {
435 1.1 chopps static int saved_cmd_wait, saved_data_wait;
436 1.1 chopps
437 1.1 chopps if (del) {
438 1.1 chopps saved_cmd_wait = sbic_cmd_wait;
439 1.1 chopps saved_data_wait = sbic_data_wait;
440 1.1 chopps if (del > 0)
441 1.1 chopps sbic_cmd_wait = sbic_data_wait = del;
442 1.1 chopps else
443 1.1 chopps sbic_cmd_wait = sbic_data_wait = sbic_init_wait;
444 1.1 chopps } else {
445 1.1 chopps sbic_cmd_wait = saved_cmd_wait;
446 1.1 chopps sbic_data_wait = saved_data_wait;
447 1.1 chopps }
448 1.1 chopps }
449 1.1 chopps
450 1.1 chopps void
451 1.1 chopps sbicreset(dev)
452 1.1 chopps struct sbic_softc *dev;
453 1.1 chopps {
454 1.1 chopps sbic_regmap_p regs;
455 1.1 chopps u_int i, s;
456 1.1 chopps u_char my_id, csr;
457 1.1 chopps
458 1.1 chopps regs = dev->sc_sbicp;
459 1.1 chopps
460 1.1 chopps if (dev->sc_flags & SBICF_ALIVE)
461 1.1 chopps sbicabort(dev, regs, "reset");
462 1.1 chopps
463 1.1 chopps s = splbio();
464 1.1 chopps /* preserve our ID for now */
465 1.1 chopps GET_SBIC_myid (regs, my_id);
466 1.1 chopps my_id &= SBIC_ID_MASK;
467 1.1 chopps
468 1.1 chopps if (dev->sc_clkfreq < 110)
469 1.1 chopps my_id |= SBIC_ID_FS_8_10;
470 1.1 chopps else if (dev->sc_clkfreq < 160)
471 1.1 chopps my_id |= SBIC_ID_FS_12_15;
472 1.1 chopps else if (dev->sc_clkfreq < 210)
473 1.1 chopps my_id |= SBIC_ID_FS_16_20;
474 1.1 chopps
475 1.1 chopps my_id |= SBIC_ID_EAF /*| SBIC_ID_EHP*/ ;
476 1.1 chopps
477 1.1 chopps SET_SBIC_myid(regs, my_id);
478 1.1 chopps
479 1.1 chopps /*
480 1.1 chopps * Disable interrupts (in dmainit) then reset the chip
481 1.1 chopps */
482 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_RESET);
483 1.1 chopps DELAY(25);
484 1.1 chopps SBIC_WAIT(regs, SBIC_ASR_INT, 0);
485 1.1 chopps GET_SBIC_csr(regs, csr); /* clears interrupt also */
486 1.1 chopps
487 1.1 chopps /*
488 1.1 chopps * Set up various chip parameters
489 1.1 chopps */
490 1.1 chopps SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI
491 1.1 chopps | SBIC_MACHINE_DMA_MODE);
492 1.1 chopps /*
493 1.1 chopps * don't allow (re)selection (SBIC_RID_ES)
494 1.1 chopps * until we can handle target mode!!
495 1.1 chopps */
496 1.1 chopps SET_SBIC_rselid(regs, 0);
497 1.1 chopps SET_SBIC_syn(regs, 0); /* asynch for now */
498 1.1 chopps
499 1.1 chopps /*
500 1.1 chopps * anything else was zeroed by reset
501 1.1 chopps */
502 1.1 chopps splx(s);
503 1.1 chopps
504 1.1 chopps dev->sc_flags |= SBICF_ALIVE;
505 1.1 chopps dev->sc_flags &= ~SBICF_SELECTED;
506 1.1 chopps }
507 1.1 chopps
508 1.1 chopps void
509 1.1 chopps sbicerror(dev, regs, csr)
510 1.1 chopps struct sbic_softc *dev;
511 1.1 chopps sbic_regmap_p regs;
512 1.1 chopps u_char csr;
513 1.1 chopps {
514 1.1 chopps struct scsi_xfer *xs;
515 1.1 chopps
516 1.1 chopps xs = dev->sc_xs;
517 1.1 chopps
518 1.1 chopps #ifdef DIAGNOSTIC
519 1.1 chopps if (xs == NULL)
520 1.1 chopps panic("sbicerror");
521 1.1 chopps #endif
522 1.1 chopps if (xs->flags & SCSI_SILENT)
523 1.1 chopps return;
524 1.1 chopps
525 1.1 chopps printf("%s: ", dev->sc_dev.dv_xname);
526 1.1 chopps printf("csr == 0x%02i\n", csr); /* XXX */
527 1.1 chopps }
528 1.1 chopps
529 1.1 chopps /*
530 1.1 chopps * select the bus, return when selected or error.
531 1.1 chopps */
532 1.1 chopps int
533 1.1 chopps sbicselectbus(dev, regs, target, our_addr)
534 1.1 chopps struct sbic_softc *dev;
535 1.1 chopps sbic_regmap_p regs;
536 1.1 chopps u_char target, our_addr;
537 1.1 chopps {
538 1.1 chopps u_char asr, csr, id;
539 1.1 chopps
540 1.1 chopps QPRINTF(("sbicselectbus %d\n", target));
541 1.1 chopps
542 1.1 chopps /*
543 1.1 chopps * if we're already selected, return (XXXX panic maybe?)
544 1.1 chopps */
545 1.1 chopps if (dev->sc_flags & SBICF_SELECTED)
546 1.1 chopps return(1);
547 1.1 chopps
548 1.1 chopps /*
549 1.1 chopps * issue select
550 1.1 chopps */
551 1.1 chopps SBIC_TC_PUT(regs, 0);
552 1.1 chopps SET_SBIC_selid(regs, target);
553 1.1 chopps SET_SBIC_timeo(regs, SBIC_TIMEOUT(250,dev->sc_clkfreq));
554 1.1 chopps
555 1.1 chopps /*
556 1.1 chopps * set sync or async
557 1.1 chopps */
558 1.1 chopps if (dev->sc_sync[target].state == SYNC_DONE)
559 1.1 chopps SET_SBIC_syn(regs, SBIC_SYN (dev->sc_sync[target].offset,
560 1.1 chopps dev->sc_sync[target].period));
561 1.1 chopps else
562 1.1 chopps SET_SBIC_syn(regs, SBIC_SYN (0, sbic_min_period));
563 1.1 chopps
564 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN);
565 1.1 chopps
566 1.1 chopps /*
567 1.1 chopps * wait for select (merged from seperate function may need
568 1.1 chopps * cleanup)
569 1.1 chopps */
570 1.1 chopps WAIT_CIP(regs);
571 1.1 chopps do {
572 1.1 chopps SBIC_WAIT(regs, SBIC_ASR_INT, 0);
573 1.1 chopps GET_SBIC_csr (regs, csr);
574 1.1 chopps QPRINTF(("%02x ", csr));
575 1.1 chopps } while (csr != (SBIC_CSR_MIS_2|MESG_OUT_PHASE)
576 1.1 chopps && csr != (SBIC_CSR_MIS_2|CMD_PHASE) && csr != SBIC_CSR_SEL_TIMEO);
577 1.1 chopps
578 1.1 chopps if (csr == (SBIC_CSR_MIS_2|CMD_PHASE))
579 1.1 chopps dev->sc_flags |= SBICF_SELECTED; /* device ignored ATN */
580 1.1 chopps else if (csr == (SBIC_CSR_MIS_2|MESG_OUT_PHASE)) {
581 1.1 chopps /*
582 1.1 chopps * Send identify message
583 1.1 chopps * (SCSI-2 requires an identify msg (?))
584 1.1 chopps */
585 1.1 chopps GET_SBIC_selid(regs, id);
586 1.1 chopps
587 1.1 chopps /*
588 1.1 chopps * handle drives that don't want to be asked
589 1.1 chopps * whether to go sync at all.
590 1.1 chopps */
591 1.1 chopps if (sbic_inhibit_sync && dev->sc_sync[id].state == SYNC_START) {
592 1.1 chopps #ifdef DEBUG
593 1.1 chopps if (sync_debug)
594 1.1 chopps printf("Forcing target %d asynchronous.\n", id);
595 1.1 chopps #endif
596 1.1 chopps dev->sc_sync[id].offset = 0;
597 1.1 chopps dev->sc_sync[id].period = sbic_min_period;
598 1.1 chopps dev->sc_sync[id].state = SYNC_DONE;
599 1.1 chopps }
600 1.1 chopps
601 1.1 chopps
602 1.1 chopps if (dev->sc_sync[id].state != SYNC_START)
603 1.1 chopps SEND_BYTE (regs, MSG_IDENTIFY);
604 1.1 chopps else {
605 1.1 chopps /*
606 1.1 chopps * try to initiate a sync transfer.
607 1.1 chopps * So compose the sync message we're going
608 1.1 chopps * to send to the target
609 1.1 chopps */
610 1.1 chopps
611 1.1 chopps #ifdef DEBUG
612 1.1 chopps if (sync_debug)
613 1.1 chopps printf("Sending sync request to target %d ... ",
614 1.1 chopps id);
615 1.1 chopps #endif
616 1.1 chopps /*
617 1.1 chopps * setup scsi message sync message request
618 1.1 chopps */
619 1.1 chopps dev->sc_msg[0] = MSG_IDENTIFY;
620 1.1 chopps dev->sc_msg[1] = MSG_EXT_MESSAGE;
621 1.1 chopps dev->sc_msg[2] = 3;
622 1.1 chopps dev->sc_msg[3] = MSG_SYNC_REQ;
623 1.1 chopps dev->sc_msg[4] = sbictoscsiperiod(dev, regs,
624 1.1 chopps sbic_min_period);
625 1.1 chopps dev->sc_msg[5] = sbic_max_offset;
626 1.1 chopps
627 1.1 chopps if (sbicxfstart(regs, 6, MESG_OUT_PHASE, sbic_cmd_wait))
628 1.1 chopps sbicxfout(regs, 6, dev->sc_msg, MESG_OUT_PHASE);
629 1.1 chopps
630 1.1 chopps dev->sc_sync[id].state = SYNC_SENT;
631 1.1 chopps #ifdef DEBUG
632 1.1 chopps if (sync_debug)
633 1.1 chopps printf ("sent\n");
634 1.1 chopps #endif
635 1.1 chopps }
636 1.1 chopps
637 1.1 chopps SBIC_WAIT (regs, SBIC_ASR_INT, 0);
638 1.1 chopps GET_SBIC_csr (regs, csr);
639 1.1 chopps QPRINTF(("[%02x]", csr));
640 1.1 chopps #ifdef DEBUG
641 1.1 chopps if (sync_debug && dev->sc_sync[id].state == SYNC_SENT)
642 1.1 chopps printf("csr-result of last msgout: 0x%x\n", csr);
643 1.1 chopps #endif
644 1.1 chopps
645 1.1 chopps if (csr != SBIC_CSR_SEL_TIMEO)
646 1.1 chopps dev->sc_flags |= SBICF_SELECTED;
647 1.1 chopps }
648 1.1 chopps
649 1.1 chopps QPRINTF(("\n"));
650 1.1 chopps
651 1.1 chopps return(csr == SBIC_CSR_SEL_TIMEO);
652 1.1 chopps }
653 1.1 chopps
654 1.1 chopps int
655 1.1 chopps sbicxfstart(regs, len, phase, wait)
656 1.1 chopps sbic_regmap_p regs;
657 1.1 chopps int len, wait;
658 1.1 chopps u_char phase;
659 1.1 chopps {
660 1.1 chopps u_char id;
661 1.1 chopps
662 1.1 chopps if (phase == DATA_IN_PHASE || phase == MESG_IN_PHASE) {
663 1.1 chopps GET_SBIC_selid (regs, id);
664 1.1 chopps id |= SBIC_SID_FROM_SCSI;
665 1.1 chopps SET_SBIC_selid (regs, id);
666 1.1 chopps SBIC_TC_PUT (regs, (unsigned)len);
667 1.1 chopps } else if (phase == DATA_OUT_PHASE || phase == MESG_OUT_PHASE
668 1.1 chopps || phase == CMD_PHASE)
669 1.1 chopps SBIC_TC_PUT (regs, (unsigned)len);
670 1.1 chopps else
671 1.1 chopps SBIC_TC_PUT (regs, 0);
672 1.1 chopps QPRINTF(("sbicxfstart %d, %d, %d\n", len, phase, wait));
673 1.1 chopps
674 1.1 chopps return(1);
675 1.1 chopps }
676 1.1 chopps
677 1.1 chopps int
678 1.1 chopps sbicxfout(regs, len, bp, phase)
679 1.1 chopps sbic_regmap_p regs;
680 1.1 chopps int len;
681 1.1 chopps void *bp;
682 1.1 chopps int phase;
683 1.1 chopps {
684 1.1 chopps u_char orig_csr, csr, asr, *buf;
685 1.1 chopps int wait;
686 1.1 chopps
687 1.1 chopps buf = bp;
688 1.1 chopps wait = sbic_data_wait;
689 1.1 chopps
690 1.1 chopps QPRINTF(("sbicxfout {%d} %02x %02x %02x %02x %02x "
691 1.1 chopps "%02x %02x %02x %02x %02x\n", len, buf[0], buf[1], buf[2],
692 1.1 chopps buf[3], buf[4], buf[5], buf[6], buf[7], buf[8], buf[9]));
693 1.1 chopps
694 1.1 chopps GET_SBIC_csr (regs, orig_csr);
695 1.1 chopps
696 1.1 chopps /*
697 1.1 chopps * sigh.. WD-PROTO strikes again.. sending the command in one go
698 1.1 chopps * causes the chip to lock up if talking to certain (misbehaving?)
699 1.1 chopps * targets. Anyway, this procedure should work for all targets, but
700 1.1 chopps * it's slightly slower due to the overhead
701 1.1 chopps */
702 1.1 chopps WAIT_CIP (regs);
703 1.1 chopps SET_SBIC_cmd (regs, SBIC_CMD_XFER_INFO);
704 1.1 chopps for (;len > 0; len--) {
705 1.1 chopps GET_SBIC_asr (regs, asr);
706 1.1 chopps while ((asr & SBIC_ASR_DBR) == 0) {
707 1.1 chopps if ((asr & SBIC_ASR_INT) || --wait < 0) {
708 1.1 chopps #ifdef DEBUG
709 1.1 chopps if (sbic_debug)
710 1.1 chopps printf("sbicxfout fail: l%d i%x w%d\n",
711 1.1 chopps len, asr, wait);
712 1.1 chopps #endif
713 1.1 chopps return (len);
714 1.1 chopps }
715 1.1 chopps DELAY(1);
716 1.1 chopps GET_SBIC_asr (regs, asr);
717 1.1 chopps }
718 1.1 chopps
719 1.1 chopps SET_SBIC_data (regs, *buf);
720 1.1 chopps buf++;
721 1.1 chopps }
722 1.1 chopps
723 1.1 chopps QPRINTF(("sbicxfout done\n"));
724 1.1 chopps /*
725 1.1 chopps * this leaves with one csr to be read
726 1.1 chopps */
727 1.1 chopps return(0);
728 1.1 chopps }
729 1.1 chopps
730 1.1 chopps void
731 1.1 chopps sbicxfin(regs, len, bp)
732 1.1 chopps sbic_regmap_p regs;
733 1.1 chopps int len;
734 1.1 chopps void *bp;
735 1.1 chopps {
736 1.1 chopps int wait;
737 1.1 chopps u_char *obp, *buf;
738 1.1 chopps u_char orig_csr, csr, asr;
739 1.1 chopps
740 1.1 chopps wait = sbic_data_wait;
741 1.1 chopps obp = bp;
742 1.1 chopps buf = bp;
743 1.1 chopps
744 1.1 chopps GET_SBIC_csr (regs, orig_csr);
745 1.1 chopps
746 1.1 chopps QPRINTF(("sbicxfin %d, csr=%02x\n", len, orig_csr));
747 1.1 chopps
748 1.1 chopps WAIT_CIP (regs);
749 1.1 chopps SET_SBIC_cmd (regs, SBIC_CMD_XFER_INFO);
750 1.1 chopps for (;len > 0; len--) {
751 1.1 chopps GET_SBIC_asr (regs, asr);
752 1.1 chopps while ((asr & SBIC_ASR_DBR) == 0) {
753 1.1 chopps if ((asr & SBIC_ASR_INT) || --wait < 0) {
754 1.1 chopps #ifdef DEBUG
755 1.1 chopps if (sbic_debug)
756 1.1 chopps printf("sbicxfin fail: l%d i%x w%d\n",
757 1.1 chopps len, asr, wait);
758 1.1 chopps #endif
759 1.1 chopps return;
760 1.1 chopps }
761 1.1 chopps
762 1.1 chopps DELAY(1);
763 1.1 chopps GET_SBIC_asr (regs, asr);
764 1.1 chopps }
765 1.1 chopps
766 1.1 chopps GET_SBIC_data (regs, *buf);
767 1.1 chopps buf++;
768 1.1 chopps }
769 1.1 chopps
770 1.1 chopps QPRINTF(("sbicxfin {%d} %02x %02x %02x %02x %02x %02x "
771 1.1 chopps "%02x %02x %02x %02x\n", len, obp[0], obp[1], obp[2],
772 1.1 chopps obp[3], obp[4], obp[5], obp[6], obp[7], obp[8], obp[9]));
773 1.1 chopps
774 1.1 chopps /* this leaves with one csr to be read */
775 1.1 chopps }
776 1.1 chopps
777 1.1 chopps
778 1.1 chopps /*
779 1.1 chopps * SCSI 'immediate' command: issue a command to some SCSI device
780 1.1 chopps * and get back an 'immediate' response (i.e., do programmed xfer
781 1.1 chopps * to get the response data). 'cbuf' is a buffer containing a scsi
782 1.1 chopps * command of length clen bytes. 'buf' is a buffer of length 'len'
783 1.1 chopps * bytes for data. The transfer direction is determined by the device
784 1.1 chopps * (i.e., by the scsi bus data xfer phase). If 'len' is zero, the
785 1.1 chopps * command must supply no data. 'xferphase' is the bus phase the
786 1.1 chopps * caller expects to happen after the command is issued. It should
787 1.1 chopps * be one of DATA_IN_PHASE, DATA_OUT_PHASE or STATUS_PHASE.
788 1.1 chopps */
789 1.1 chopps int
790 1.1 chopps sbicicmd(dev, target, cbuf, clen, buf, len, xferphase)
791 1.1 chopps struct sbic_softc *dev;
792 1.1 chopps void *cbuf, *buf;
793 1.1 chopps int clen, len;
794 1.1 chopps u_char xferphase;
795 1.1 chopps {
796 1.1 chopps sbic_regmap_p regs;
797 1.1 chopps u_char phase, csr, asr;
798 1.1 chopps int wait;
799 1.1 chopps
800 1.1 chopps regs = dev->sc_sbicp;
801 1.1 chopps
802 1.1 chopps /*
803 1.1 chopps * set the sbic into non-DMA mode
804 1.1 chopps */
805 1.1 chopps SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI);
806 1.1 chopps
807 1.1 chopps retry_selection:
808 1.1 chopps /*
809 1.1 chopps * select the SCSI bus (it's an error if bus isn't free)
810 1.1 chopps */
811 1.1 chopps if (sbicselectbus(dev, regs, target, dev->sc_scsiaddr))
812 1.1 chopps return(-1);
813 1.1 chopps /*
814 1.1 chopps * Wait for a phase change (or error) then let the device sequence
815 1.1 chopps * us through the various SCSI phases.
816 1.1 chopps */
817 1.1 chopps dev->sc_stat[0] = 0xff;
818 1.1 chopps dev->sc_msg[0] = 0xff;
819 1.1 chopps phase = CMD_PHASE;
820 1.1 chopps
821 1.1 chopps new_phase:
822 1.1 chopps wait = sbic_cmd_wait;
823 1.1 chopps
824 1.1 chopps GET_SBIC_csr (regs, csr);
825 1.1 chopps QPRINTF((">CSR:%02x<", csr));
826 1.1 chopps
827 1.1 chopps /*
828 1.1 chopps * requesting some new phase
829 1.1 chopps */
830 1.1 chopps if ((csr != 0xff) && (csr & 0xf0) && (csr & 0x08))
831 1.1 chopps phase = csr & PHASE;
832 1.1 chopps else if ((csr == SBIC_CSR_DISC) || (csr == SBIC_CSR_DISC_1)
833 1.1 chopps || (csr == SBIC_CSR_S_XFERRED)) {
834 1.1 chopps dev->sc_flags &= ~SBICF_SELECTED;
835 1.1 chopps GET_SBIC_cmd_phase (regs, phase);
836 1.1 chopps if (phase == 0x60)
837 1.1 chopps GET_SBIC_tlun (regs, dev->sc_stat[0]);
838 1.1 chopps else
839 1.1 chopps return(-1);
840 1.1 chopps goto out;
841 1.1 chopps } else {
842 1.1 chopps sbicerror(dev, regs, csr);
843 1.1 chopps goto abort;
844 1.1 chopps }
845 1.1 chopps
846 1.1 chopps switch (phase) {
847 1.1 chopps case CMD_PHASE:
848 1.1 chopps if (sbicxfstart (regs, clen, phase, wait))
849 1.1 chopps if (sbicxfout (regs, clen, cbuf, phase))
850 1.1 chopps goto abort;
851 1.1 chopps phase = xferphase;
852 1.1 chopps break;
853 1.1 chopps case DATA_IN_PHASE:
854 1.1 chopps if (len <= 0)
855 1.1 chopps goto abort;
856 1.1 chopps wait = sbic_data_wait;
857 1.1 chopps if (sbicxfstart(regs, len, phase, wait))
858 1.1 chopps sbicxfin(regs, len, buf);
859 1.1 chopps phase = STATUS_PHASE;
860 1.1 chopps break;
861 1.1 chopps case MESG_IN_PHASE:
862 1.1 chopps if (sbicxfstart(regs, sizeof(dev->sc_msg), phase, wait) == 0)
863 1.1 chopps break;
864 1.1 chopps dev->sc_msg[0] = 0xff;
865 1.1 chopps sbicxfin(regs, sizeof(dev->sc_msg), dev->sc_msg);
866 1.1 chopps /*
867 1.1 chopps * get the command completion interrupt, or we
868 1.1 chopps * can't send a new command (LCI)
869 1.1 chopps */
870 1.1 chopps SBIC_WAIT(regs, SBIC_ASR_INT, wait);
871 1.1 chopps GET_SBIC_csr(regs, csr);
872 1.1 chopps #ifdef DEBUG
873 1.1 chopps if (sync_debug)
874 1.1 chopps printf("msgin done csr 0x%x\n", csr);
875 1.1 chopps #endif
876 1.1 chopps /*
877 1.1 chopps * test whether this is a reply to our sync
878 1.1 chopps * request
879 1.1 chopps */
880 1.1 chopps if (dev->sc_msg[0] == MSG_EXT_MESSAGE && dev->sc_msg[1] == 3
881 1.1 chopps && dev->sc_msg[2] == MSG_SYNC_REQ) {
882 1.1 chopps
883 1.1 chopps dev->sc_sync[target].period = sbicfromscsiperiod(dev,
884 1.1 chopps regs, dev->sc_msg[3]);
885 1.1 chopps dev->sc_sync[target].offset = dev->sc_msg[4];
886 1.1 chopps dev->sc_sync[target].state = SYNC_DONE;
887 1.1 chopps SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[target].offset,
888 1.1 chopps dev->sc_sync[target].period));
889 1.1 chopps /* ACK the message */
890 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
891 1.1 chopps WAIT_CIP(regs);
892 1.1 chopps phase = CMD_PHASE; /* or whatever */
893 1.1 chopps printf("%s: target %d now synchronous,"
894 1.1 chopps " period=%dns, offset=%d.\n",
895 1.1 chopps dev->sc_dev.dv_xname, target, dev->sc_msg[3] * 4,
896 1.1 chopps dev->sc_msg[4]);
897 1.1 chopps } else if (dev->sc_msg[0] == MSG_REJECT
898 1.1 chopps && dev->sc_sync[target].state == SYNC_SENT) {
899 1.1 chopps #ifdef DEBUG
900 1.1 chopps if (sync_debug)
901 1.1 chopps printf("target %d rejected sync, going async\n",
902 1.1 chopps target);
903 1.1 chopps #endif
904 1.1 chopps dev->sc_sync[target].period = sbic_min_period;
905 1.1 chopps dev->sc_sync[target].offset = 0;
906 1.1 chopps dev->sc_sync[target].state = SYNC_DONE;
907 1.1 chopps SET_SBIC_syn(regs, SBIC_SYN(dev->sc_sync[target].offset,
908 1.1 chopps dev->sc_sync[target].period));
909 1.1 chopps /* ACK the message */
910 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
911 1.1 chopps WAIT_CIP(regs);
912 1.1 chopps phase = CMD_PHASE; /* or whatever */
913 1.1 chopps } else if (dev->sc_msg[0] == MSG_REJECT) {
914 1.1 chopps /*
915 1.1 chopps * we'll never REJECt a REJECT message..
916 1.1 chopps */
917 1.1 chopps /* ACK the message */
918 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
919 1.1 chopps WAIT_CIP(regs);
920 1.1 chopps phase = CMD_PHASE; /* or whatever */
921 1.1 chopps } else if (dev->sc_msg[0] == MSG_CMD_COMPLETE) {
922 1.1 chopps /* !! KLUDGE ALERT !! quite a few drives don't seem to
923 1.1 chopps * really like the current way of sending the
924 1.1 chopps * sync-handshake together with the ident-message, and
925 1.1 chopps * they react by sending command-complete and
926 1.1 chopps * disconnecting right after returning the valid sync
927 1.1 chopps * handshake. So, all I can do is reselect the drive,
928 1.1 chopps * and hope it won't disconnect again. I don't think
929 1.1 chopps * this is valid behavior, but I can't help fixing a
930 1.1 chopps * problem that apparently exists.
931 1.1 chopps *
932 1.1 chopps * Note: we should not get here on `normal' command
933 1.1 chopps * completion, as that condition is handled by the
934 1.1 chopps * high-level sel&xfer resume command used to walk
935 1.1 chopps * thru status/cc-phase.
936 1.1 chopps */
937 1.1 chopps
938 1.1 chopps #ifdef DEBUG
939 1.1 chopps if (sync_debug)
940 1.1 chopps printf ("GOT CMD-COMPLETE! %d acting weird.."
941 1.1 chopps " waiting for disconnect...\n", target);
942 1.1 chopps #endif
943 1.1 chopps /* ACK the message */
944 1.1 chopps SET_SBIC_cmd (regs, SBIC_CMD_CLR_ACK);
945 1.1 chopps WAIT_CIP(regs);
946 1.1 chopps
947 1.1 chopps /* wait for disconnect */
948 1.1 chopps while (csr != SBIC_CSR_DISC &&
949 1.1 chopps csr != SBIC_CSR_DISC_1) {
950 1.1 chopps DELAY(1);
951 1.1 chopps GET_SBIC_csr(regs, csr);
952 1.1 chopps }
953 1.1 chopps #ifdef DEBUG
954 1.1 chopps if (sync_debug)
955 1.1 chopps printf ("ok.\nRetrying selection.\n");
956 1.1 chopps #endif
957 1.1 chopps dev->sc_flags &= ~SBICF_SELECTED;
958 1.1 chopps goto retry_selection;
959 1.1 chopps } else {
960 1.1 chopps #ifdef DEBUG
961 1.1 chopps if (sbic_debug || sync_debug)
962 1.1 chopps printf ("Rejecting message 0x%02x\n",
963 1.1 chopps dev->sc_msg[0]);
964 1.1 chopps #endif
965 1.1 chopps /* prepare to reject the message, NACK */
966 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_SET_ATN);
967 1.1 chopps WAIT_CIP(regs);
968 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
969 1.1 chopps WAIT_CIP(regs);
970 1.1 chopps phase = MESG_OUT_PHASE;
971 1.1 chopps }
972 1.1 chopps break;
973 1.1 chopps
974 1.1 chopps case MESG_OUT_PHASE:
975 1.1 chopps #ifdef DEBUG
976 1.1 chopps if (sync_debug)
977 1.1 chopps printf ("sending REJECT msg to last msg.\n");
978 1.1 chopps #endif
979 1.1 chopps /*
980 1.1 chopps * should only get here on reject,
981 1.1 chopps * since it's always US that
982 1.1 chopps * initiate a sync transfer
983 1.1 chopps */
984 1.1 chopps SEND_BYTE(regs, MSG_REJECT);
985 1.1 chopps phase = STATUS_PHASE;
986 1.1 chopps break;
987 1.1 chopps case DATA_OUT_PHASE:
988 1.1 chopps if (len <= 0)
989 1.1 chopps goto abort;
990 1.1 chopps wait = sbic_data_wait;
991 1.1 chopps if (sbicxfstart(regs, len, phase, wait))
992 1.1 chopps if (sbicxfout (regs, len, buf, phase))
993 1.1 chopps goto abort;
994 1.1 chopps phase = STATUS_PHASE;
995 1.1 chopps break;
996 1.1 chopps case STATUS_PHASE:
997 1.1 chopps /*
998 1.1 chopps * the sbic does the status/cmd-complete reading ok,
999 1.1 chopps * so do this with its hi-level commands.
1000 1.1 chopps */
1001 1.1 chopps SBIC_TC_PUT(regs, 0);
1002 1.1 chopps SET_SBIC_cmd_phase(regs, 0x46);
1003 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN_XFER);
1004 1.1 chopps phase = BUS_FREE_PHASE;
1005 1.1 chopps break;
1006 1.1 chopps case BUS_FREE_PHASE:
1007 1.1 chopps goto out;
1008 1.1 chopps default:
1009 1.1 chopps printf("%s: unexpected phase %d in icmd from %d\n",
1010 1.1 chopps dev->sc_dev.dv_xname, phase, target);
1011 1.1 chopps goto abort;
1012 1.1 chopps }
1013 1.1 chopps
1014 1.1 chopps /*
1015 1.1 chopps * make sure the last command was taken,
1016 1.1 chopps * ie. we're not hunting after an ignored command..
1017 1.1 chopps */
1018 1.1 chopps GET_SBIC_asr(regs, asr);
1019 1.1 chopps if (asr & SBIC_ASR_LCI)
1020 1.1 chopps goto abort;
1021 1.1 chopps
1022 1.1 chopps /* tapes may take a loooong time.. */
1023 1.1 chopps while (asr & SBIC_ASR_BSY) {
1024 1.1 chopps DELAY(1);
1025 1.1 chopps GET_SBIC_asr(regs, asr);
1026 1.1 chopps }
1027 1.1 chopps
1028 1.1 chopps /*
1029 1.1 chopps * wait for last command to complete
1030 1.1 chopps */
1031 1.1 chopps SBIC_WAIT (regs, SBIC_ASR_INT, wait);
1032 1.1 chopps
1033 1.1 chopps /*
1034 1.1 chopps * do it again
1035 1.1 chopps */
1036 1.1 chopps goto new_phase;
1037 1.1 chopps abort:
1038 1.1 chopps sbicabort(dev, regs, "icmd");
1039 1.1 chopps out:
1040 1.1 chopps QPRINTF(("=STS:%02x=", dev->sc_stat[0]));
1041 1.1 chopps return(dev->sc_stat[0]);
1042 1.1 chopps }
1043 1.1 chopps
1044 1.1 chopps /*
1045 1.1 chopps * Finish SCSI xfer command: After the completion interrupt from
1046 1.1 chopps * a read/write operation, sequence through the final phases in
1047 1.1 chopps * programmed i/o. This routine is a lot like sbicicmd except we
1048 1.1 chopps * skip (and don't allow) the select, cmd out and data in/out phases.
1049 1.1 chopps */
1050 1.1 chopps void
1051 1.1 chopps sbicxfdone(dev, regs, target)
1052 1.1 chopps struct sbic_softc *dev;
1053 1.1 chopps sbic_regmap_p regs;
1054 1.1 chopps int target;
1055 1.1 chopps {
1056 1.1 chopps u_char phase, csr;
1057 1.1 chopps int s;
1058 1.1 chopps
1059 1.1 chopps QPRINTF(("{"));
1060 1.1 chopps s = splbio();
1061 1.1 chopps
1062 1.1 chopps /*
1063 1.1 chopps * have the sbic complete on its own
1064 1.1 chopps */
1065 1.1 chopps SBIC_TC_PUT(regs, 0);
1066 1.1 chopps SET_SBIC_cmd_phase(regs, 0x46);
1067 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_SEL_ATN_XFER);
1068 1.1 chopps
1069 1.1 chopps do {
1070 1.1 chopps SBIC_WAIT (regs, SBIC_ASR_INT, 0);
1071 1.1 chopps GET_SBIC_csr (regs, csr);
1072 1.1 chopps QPRINTF(("%02x:", csr));
1073 1.1 chopps } while ((csr != SBIC_CSR_DISC) && (csr != SBIC_CSR_DISC_1)
1074 1.1 chopps && (csr != SBIC_CSR_S_XFERRED));
1075 1.1 chopps
1076 1.1 chopps dev->sc_flags &= ~SBICF_SELECTED;
1077 1.1 chopps
1078 1.1 chopps GET_SBIC_cmd_phase (regs, phase);
1079 1.1 chopps QPRINTF(("}%02x", phase));
1080 1.1 chopps if (phase == 0x60)
1081 1.1 chopps GET_SBIC_tlun(regs, dev->sc_stat[0]);
1082 1.1 chopps else
1083 1.1 chopps sbicerror(dev, regs, csr);
1084 1.1 chopps
1085 1.1 chopps QPRINTF(("=STS:%02x=\n", dev->sc_stat[0]));
1086 1.1 chopps splx(s);
1087 1.1 chopps }
1088 1.1 chopps
1089 1.1 chopps int
1090 1.1 chopps sbicgo(dev, xs)
1091 1.1 chopps struct sbic_softc *dev;
1092 1.1 chopps struct scsi_xfer *xs;
1093 1.1 chopps {
1094 1.1 chopps int i, dmaflags, count, tcount, target;
1095 1.1 chopps u_char phase, csr, asr, cmd, *addr;
1096 1.1 chopps sbic_regmap_p regs;
1097 1.1 chopps struct dma_chain *dcp;
1098 1.1 chopps char *dmaend;
1099 1.1 chopps int wait;
1100 1.1 chopps
1101 1.1 chopps target = xs->sc_link->target;
1102 1.1 chopps count = xs->datalen;
1103 1.1 chopps addr = xs->data;
1104 1.1 chopps
1105 1.1 chopps regs = dev->sc_sbicp;
1106 1.1 chopps dmaend = NULL;
1107 1.1 chopps
1108 1.1 chopps /*
1109 1.1 chopps * set the sbic into DMA mode
1110 1.1 chopps */
1111 1.1 chopps SET_SBIC_control(regs, SBIC_CTL_EDI | SBIC_CTL_IDI |
1112 1.1 chopps SBIC_MACHINE_DMA_MODE);
1113 1.1 chopps
1114 1.1 chopps /*
1115 1.1 chopps * select the SCSI bus (it's an error if bus isn't free)
1116 1.1 chopps */
1117 1.1 chopps if (sbicselectbus(dev, regs, target, dev->sc_scsiaddr)) {
1118 1.1 chopps dev->sc_dmafree(dev);
1119 1.1 chopps return(-1);
1120 1.1 chopps }
1121 1.1 chopps
1122 1.1 chopps /*
1123 1.1 chopps * Wait for a phase change (or error) then let the device
1124 1.1 chopps * sequence us through command phase (we may have to take
1125 1.1 chopps * a msg in/out before doing the command). If the disk has
1126 1.1 chopps * to do a seek, it may be a long time until we get a change
1127 1.1 chopps * to data phase so, in the absense of an explicit phase
1128 1.1 chopps * change, we assume data phase will be coming up and tell
1129 1.1 chopps * the SPC to start a transfer whenever it does. We'll get
1130 1.1 chopps * a service required interrupt later if this assumption is
1131 1.1 chopps * wrong. Otherwise we'll get a service required int when
1132 1.1 chopps * the transfer changes to status phase.
1133 1.1 chopps */
1134 1.1 chopps phase = CMD_PHASE;
1135 1.1 chopps
1136 1.1 chopps new_phase:
1137 1.1 chopps wait = sbic_cmd_wait;
1138 1.1 chopps switch (phase) {
1139 1.1 chopps case CMD_PHASE:
1140 1.1 chopps if (sbicxfstart(regs, xs->cmdlen, phase, wait))
1141 1.1 chopps if (sbicxfout(regs, xs->cmdlen, xs->cmd, phase))
1142 1.1 chopps goto abort;
1143 1.1 chopps break;
1144 1.1 chopps case MESG_IN_PHASE:
1145 1.1 chopps if (sbicxfstart(regs, sizeof(dev->sc_msg), phase, wait) == 0)
1146 1.1 chopps break;
1147 1.1 chopps
1148 1.1 chopps sbicxfin(regs, sizeof(dev->sc_msg), dev->sc_msg);
1149 1.1 chopps /*
1150 1.1 chopps * prepare to reject any mesgin,
1151 1.1 chopps * no matter what it might be..
1152 1.1 chopps */
1153 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_SET_ATN);
1154 1.1 chopps WAIT_CIP(regs);
1155 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_CLR_ACK);
1156 1.1 chopps phase = MESG_OUT_PHASE;
1157 1.1 chopps break;
1158 1.1 chopps case MESG_OUT_PHASE:
1159 1.1 chopps SEND_BYTE(regs, MSG_REJECT);
1160 1.1 chopps phase = STATUS_PHASE;
1161 1.1 chopps break;
1162 1.1 chopps case DATA_IN_PHASE:
1163 1.1 chopps case DATA_OUT_PHASE:
1164 1.1 chopps goto out;
1165 1.1 chopps /*
1166 1.1 chopps * status phase can happen, if the issued read/write command
1167 1.1 chopps * is illegal (for example, reading after EOT on tape) and the
1168 1.1 chopps * device doesn't even go to data in/out phase. So handle this
1169 1.1 chopps * here normally, instead of going thru abort-handling.
1170 1.1 chopps */
1171 1.1 chopps case STATUS_PHASE:
1172 1.1 chopps dev->sc_dmafree(dev);
1173 1.1 chopps sbicxfdone(dev, regs, target);
1174 1.1 chopps dev->sc_flags &= ~(SBICF_INDMA | SBICF_BBUF);
1175 1.1 chopps sbic_scsidone(dev, dev->sc_stat[0]);
1176 1.1 chopps return(0);
1177 1.1 chopps default:
1178 1.1 chopps printf("%s: unexpected phase %d in go from %d\n", phase,
1179 1.1 chopps dev->sc_dev.dv_xname, target);
1180 1.1 chopps goto abort;
1181 1.1 chopps }
1182 1.1 chopps
1183 1.1 chopps /*
1184 1.1 chopps * make sure the last command was taken,
1185 1.1 chopps * ie. we're not hunting after an ignored command..
1186 1.1 chopps */
1187 1.1 chopps GET_SBIC_asr(regs, asr);
1188 1.1 chopps if (asr & SBIC_ASR_LCI)
1189 1.1 chopps goto abort;
1190 1.1 chopps
1191 1.1 chopps /*
1192 1.1 chopps * tapes may take a loooong time..
1193 1.1 chopps */
1194 1.1 chopps while (asr & SBIC_ASR_BSY) {
1195 1.1 chopps DELAY(1);
1196 1.1 chopps GET_SBIC_asr(regs, asr);
1197 1.1 chopps }
1198 1.1 chopps
1199 1.1 chopps if (wait <= 0)
1200 1.1 chopps goto abort;
1201 1.1 chopps
1202 1.1 chopps /*
1203 1.1 chopps * wait for last command to complete
1204 1.1 chopps */
1205 1.1 chopps SBIC_WAIT(regs, SBIC_ASR_INT, wait);
1206 1.1 chopps
1207 1.1 chopps GET_SBIC_csr(regs, csr);
1208 1.1 chopps QPRINTF((">CSR:%02x<", csr));
1209 1.1 chopps
1210 1.1 chopps /*
1211 1.1 chopps * requesting some new phase
1212 1.1 chopps */
1213 1.1 chopps if ((csr != 0xff) && (csr & 0xf0) && (csr & 0x08))
1214 1.1 chopps phase = csr & PHASE;
1215 1.1 chopps else {
1216 1.1 chopps sbicerror(dev, regs, csr);
1217 1.1 chopps goto abort;
1218 1.1 chopps }
1219 1.1 chopps /*
1220 1.1 chopps * start again with for new phase
1221 1.1 chopps */
1222 1.1 chopps goto new_phase;
1223 1.1 chopps out:
1224 1.1 chopps dmaflags = 0;
1225 1.1 chopps if (xs->flags & SCSI_DATA_IN)
1226 1.1 chopps dmaflags |= DMAGO_READ;
1227 1.1 chopps
1228 1.1 chopps if (count > MAXPHYS)
1229 1.1 chopps printf("sbicgo: bp->b_bcount > MAXPHYS %08x\n", count);
1230 1.1 chopps
1231 1.1 chopps if (dev->sc_flags & SBICF_BADDMA &&
1232 1.1 chopps sbiccheckdmap(addr, count, dev->sc_dmamask)) {
1233 1.1 chopps /*
1234 1.1 chopps * need to bounce the dma.
1235 1.1 chopps */
1236 1.1 chopps if (dmaflags & DMAGO_READ) {
1237 1.1 chopps dev->sc_flags |= SBICF_BBUF;
1238 1.1 chopps dev->sc_dmausrbuf = addr;
1239 1.1 chopps dev->sc_dmausrlen = count;
1240 1.1 chopps } else { /* write: copy to dma buffer */
1241 1.1 chopps bcopy (addr, dev->sc_dmabuffer, count);
1242 1.1 chopps }
1243 1.1 chopps addr = dev->sc_dmabuffer; /* and use dma buffer */
1244 1.1 chopps }
1245 1.1 chopps
1246 1.1 chopps #ifdef DEBUG
1247 1.1 chopps if (sbic_dma_debug & DDB_FOLLOW)
1248 1.1 chopps printf("sbicgo(%d, %x, %x, %x)\n", dev->sc_dev.dv_unit,
1249 1.1 chopps addr, count, dmaflags);
1250 1.1 chopps #endif
1251 1.1 chopps /*
1252 1.1 chopps * Build the DMA chain
1253 1.1 chopps */
1254 1.1 chopps for (dcp = dev->sc_chain; count > 0; dcp++) {
1255 1.1 chopps dcp->dc_addr = (char *) kvtop(addr);
1256 1.1 chopps if (count < (tcount = NBPG - ((int)addr & PGOFSET)))
1257 1.1 chopps tcount = count;
1258 1.1 chopps addr += tcount;
1259 1.1 chopps count -= tcount;
1260 1.1 chopps dcp->dc_count = tcount >> 1;
1261 1.1 chopps
1262 1.1 chopps /*
1263 1.1 chopps * check if contigous, if not mark new end
1264 1.1 chopps * else increment end and count on previous.
1265 1.1 chopps */
1266 1.1 chopps if (dcp->dc_addr != dmaend)
1267 1.1 chopps dmaend = dcp->dc_addr + tcount;
1268 1.1 chopps else {
1269 1.1 chopps dcp--;
1270 1.1 chopps dmaend += tcount;
1271 1.1 chopps dcp->dc_count += tcount >> 1;
1272 1.1 chopps }
1273 1.1 chopps }
1274 1.1 chopps
1275 1.1 chopps dev->sc_cur = dev->sc_chain;
1276 1.1 chopps dev->sc_last = --dcp;
1277 1.1 chopps dev->sc_tcnt = dev->sc_cur->dc_count << 1;
1278 1.1 chopps
1279 1.1 chopps #ifdef DEBUG
1280 1.1 chopps if (sbic_dma_debug & DDB_IO) {
1281 1.1 chopps for (dcp = dev->sc_chain; dcp <= dev->sc_last; dcp++)
1282 1.1 chopps printf(" %d: %d@%x\n", dcp-dev->sc_chain,
1283 1.1 chopps dcp->dc_count, dcp->dc_addr);
1284 1.1 chopps }
1285 1.1 chopps #endif
1286 1.1 chopps
1287 1.1 chopps /*
1288 1.1 chopps * push the data cash
1289 1.1 chopps */
1290 1.1 chopps DCIS();
1291 1.1 chopps
1292 1.1 chopps /*
1293 1.1 chopps * dmago() also enables interrupts for the sbic
1294 1.1 chopps */
1295 1.1 chopps i = dev->sc_dmago(dev, addr, xs->datalen, dmaflags);
1296 1.1 chopps
1297 1.1 chopps SBIC_TC_PUT(regs, (unsigned)i);
1298 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_XFER_INFO);
1299 1.1 chopps
1300 1.1 chopps return(0);
1301 1.1 chopps
1302 1.1 chopps abort:
1303 1.1 chopps sbicabort(dev, regs, "go");
1304 1.1 chopps dev->sc_dmafree(dev);
1305 1.1 chopps return(-1);
1306 1.1 chopps }
1307 1.1 chopps
1308 1.1 chopps
1309 1.1 chopps int
1310 1.1 chopps sbicintr(dev)
1311 1.1 chopps struct sbic_softc *dev;
1312 1.1 chopps {
1313 1.1 chopps sbic_regmap_p regs;
1314 1.1 chopps u_char asr, csr;
1315 1.1 chopps int i;
1316 1.1 chopps
1317 1.1 chopps regs = dev->sc_sbicp;
1318 1.1 chopps
1319 1.1 chopps /*
1320 1.1 chopps * pending interrupt?
1321 1.1 chopps */
1322 1.1 chopps GET_SBIC_asr (regs, asr);
1323 1.1 chopps if ((asr & SBIC_ASR_INT) == 0)
1324 1.1 chopps return(0);
1325 1.1 chopps
1326 1.1 chopps GET_SBIC_csr(regs, csr);
1327 1.1 chopps QPRINTF(("[0x%x]", csr));
1328 1.1 chopps
1329 1.1 chopps if (csr == (SBIC_CSR_XFERRED|STATUS_PHASE)
1330 1.1 chopps || csr == (SBIC_CSR_MIS|STATUS_PHASE)
1331 1.1 chopps || csr == (SBIC_CSR_MIS_1|STATUS_PHASE)
1332 1.1 chopps || csr == (SBIC_CSR_MIS_2|STATUS_PHASE)) {
1333 1.1 chopps /*
1334 1.1 chopps * this should be the normal i/o completion case.
1335 1.1 chopps * get the status & cmd complete msg then let the
1336 1.1 chopps * device driver look at what happened.
1337 1.1 chopps */
1338 1.1 chopps sbicxfdone(dev, regs, dev->sc_xs->sc_link->target);
1339 1.1 chopps if (dev->sc_flags & SBICF_BBUF)
1340 1.1 chopps bcopy(dev->sc_dmabuffer, dev->sc_dmausrbuf,
1341 1.1 chopps dev->sc_dmausrlen);
1342 1.1 chopps dev->sc_flags &= ~(SBICF_INDMA | SBICF_BBUF);
1343 1.1 chopps dev->sc_dmafree(dev);
1344 1.1 chopps sbic_scsidone(dev, dev->sc_stat[0]);
1345 1.1 chopps } else if (csr == (SBIC_CSR_XFERRED|DATA_OUT_PHASE)
1346 1.1 chopps || csr == (SBIC_CSR_XFERRED|DATA_IN_PHASE)
1347 1.1 chopps || csr == (SBIC_CSR_MIS|DATA_OUT_PHASE)
1348 1.1 chopps || csr == (SBIC_CSR_MIS|DATA_IN_PHASE)
1349 1.1 chopps || csr == (SBIC_CSR_MIS_1|DATA_OUT_PHASE)
1350 1.1 chopps || csr == (SBIC_CSR_MIS_1|DATA_IN_PHASE)
1351 1.1 chopps || csr == (SBIC_CSR_MIS_2|DATA_OUT_PHASE)
1352 1.1 chopps || csr == (SBIC_CSR_MIS_2|DATA_IN_PHASE)) {
1353 1.1 chopps /*
1354 1.1 chopps * do scatter-gather dma
1355 1.1 chopps * hacking the controller chip, ouch..
1356 1.1 chopps */
1357 1.1 chopps /*
1358 1.1 chopps * set next dma addr and dec count
1359 1.1 chopps */
1360 1.1 chopps dev->sc_cur->dc_addr += dev->sc_tcnt;
1361 1.1 chopps dev->sc_cur->dc_count -= (dev->sc_tcnt >> 1);
1362 1.1 chopps
1363 1.1 chopps if (dev->sc_cur->dc_count == 0)
1364 1.1 chopps ++dev->sc_cur; /* advance to next segment */
1365 1.1 chopps
1366 1.1 chopps i = dev->sc_dmanext(dev);
1367 1.1 chopps SBIC_TC_PUT(regs, (unsigned)i);
1368 1.1 chopps SET_SBIC_cmd(regs, SBIC_CMD_XFER_INFO);
1369 1.1 chopps } else {
1370 1.1 chopps /*
1371 1.1 chopps * Something unexpected happened -- deal with it.
1372 1.1 chopps */
1373 1.1 chopps dev->sc_dmastop(dev);
1374 1.1 chopps sbicerror(dev, regs, csr);
1375 1.1 chopps sbicabort(dev, regs, "intr");
1376 1.1 chopps if (dev->sc_flags & SBICF_INDMA) {
1377 1.1 chopps dev->sc_flags &= ~(SBICF_INDMA | SBICF_BBUF);
1378 1.1 chopps dev->sc_dmafree(dev);
1379 1.1 chopps sbic_scsidone(dev, -1);
1380 1.1 chopps }
1381 1.1 chopps }
1382 1.1 chopps return(1);
1383 1.1 chopps }
1384 1.1 chopps
1385 1.1 chopps /*
1386 1.1 chopps * Check if DMA can not be used with specified buffer
1387 1.1 chopps */
1388 1.1 chopps
1389 1.1 chopps int
1390 1.1 chopps sbiccheckdmap(bp, len, mask)
1391 1.1 chopps void *bp;
1392 1.1 chopps u_long len, mask;
1393 1.1 chopps {
1394 1.1 chopps u_char *buffer;
1395 1.1 chopps u_long phy_buf;
1396 1.1 chopps u_long phy_len;
1397 1.1 chopps
1398 1.1 chopps buffer = bp;
1399 1.1 chopps
1400 1.1 chopps if (len == 0)
1401 1.1 chopps return(0);
1402 1.1 chopps
1403 1.1 chopps while (len) {
1404 1.1 chopps phy_buf = kvtop(buffer);
1405 1.1 chopps if (len < (phy_len = NBPG - ((int) buffer & PGOFSET)))
1406 1.1 chopps phy_len = len;
1407 1.1 chopps if (phy_buf & mask)
1408 1.1 chopps return(1);
1409 1.1 chopps buffer += phy_len;
1410 1.1 chopps len -= phy_len;
1411 1.1 chopps }
1412 1.1 chopps return(0);
1413 1.1 chopps }
1414 1.1 chopps
1415 1.1 chopps int
1416 1.1 chopps sbictoscsiperiod(dev, regs, a)
1417 1.1 chopps struct sbic_softc *dev;
1418 1.1 chopps sbic_regmap_p regs;
1419 1.1 chopps int a;
1420 1.1 chopps {
1421 1.1 chopps unsigned int fs;
1422 1.1 chopps
1423 1.1 chopps /*
1424 1.1 chopps * cycle = DIV / (2*CLK)
1425 1.1 chopps * DIV = FS+2
1426 1.1 chopps * best we can do is 200ns at 20Mhz, 2 cycles
1427 1.1 chopps */
1428 1.1 chopps
1429 1.1 chopps GET_SBIC_myid(regs,fs);
1430 1.1 chopps fs = (fs >>6) + 2; /* DIV */
1431 1.1 chopps fs = (fs * 10000) / (dev->sc_clkfreq<<1); /* Cycle, in ns */
1432 1.1 chopps if (a < 2) a = 8; /* map to Cycles */
1433 1.1 chopps return ((fs*a)>>2); /* in 4 ns units */
1434 1.1 chopps }
1435 1.1 chopps
1436 1.1 chopps int
1437 1.1 chopps sbicfromscsiperiod(dev, regs, p)
1438 1.1 chopps struct sbic_softc *dev;
1439 1.1 chopps sbic_regmap_p regs;
1440 1.1 chopps int p;
1441 1.1 chopps {
1442 1.1 chopps register unsigned int fs, ret;
1443 1.1 chopps
1444 1.1 chopps /* Just the inverse of the above */
1445 1.1 chopps
1446 1.1 chopps GET_SBIC_myid(regs,fs);
1447 1.1 chopps fs = (fs >>6) + 2; /* DIV */
1448 1.1 chopps fs = (fs * 10000) / (dev->sc_clkfreq<<1); /* Cycle, in ns */
1449 1.1 chopps
1450 1.1 chopps ret = p << 2; /* in ns units */
1451 1.1 chopps ret = ret / fs; /* in Cycles */
1452 1.1 chopps if (ret < sbic_min_period)
1453 1.1 chopps return(sbic_min_period);
1454 1.1 chopps
1455 1.1 chopps /* verify rounding */
1456 1.1 chopps if (sbictoscsiperiod(dev, regs, ret) < p)
1457 1.1 chopps ret++;
1458 1.1 chopps return (ret >= 8) ? 0 : ret;
1459 1.1 chopps }
1460 1.1 chopps
1461