si.c revision 1.1 1 1.1 glass /*
2 1.1 glass * Copyright (C) 1994 Adam Glass
3 1.1 glass * Copyright (C) 1993 Allen K. Briggs, Chris P. Caputo,
4 1.1 glass * Michael L. Finch, Bradley A. Grantham, and
5 1.1 glass * Lawrence A. Kesteloot
6 1.1 glass * All rights reserved.
7 1.1 glass *
8 1.1 glass * Redistribution and use in source and binary forms, with or without
9 1.1 glass * modification, are permitted provided that the following conditions
10 1.1 glass * are met:
11 1.1 glass * 1. Redistributions of source code must retain the above copyright
12 1.1 glass * notice, this list of conditions and the following disclaimer.
13 1.1 glass * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 glass * notice, this list of conditions and the following disclaimer in the
15 1.1 glass * documentation and/or other materials provided with the distribution.
16 1.1 glass * 3. All advertising materials mentioning features or use of this software
17 1.1 glass * must display the following acknowledgement:
18 1.1 glass * This product includes software developed by the Alice Group.
19 1.1 glass * 4. The names of the Alice Group or any of its members may not be used
20 1.1 glass * to endorse or promote products derived from this software without
21 1.1 glass * specific prior written permission.
22 1.1 glass *
23 1.1 glass * THIS SOFTWARE IS PROVIDED BY THE ALICE GROUP ``AS IS'' AND ANY EXPRESS OR
24 1.1 glass * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25 1.1 glass * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 1.1 glass * IN NO EVENT SHALL THE ALICE GROUP BE LIABLE FOR ANY DIRECT, INDIRECT,
27 1.1 glass * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
28 1.1 glass * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 1.1 glass * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 1.1 glass * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 1.1 glass * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
32 1.1 glass * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 glass *
34 1.1 glass * $Id: si.c,v 1.1 1994/02/23 08:28:56 glass Exp $
35 1.1 glass *
36 1.1 glass */
37 1.1 glass
38 1.1 glass #define PSEUDO_DMA 1
39 1.1 glass
40 1.1 glass static int pdebug=0;
41 1.1 glass
42 1.1 glass #include <sys/types.h>
43 1.1 glass #include <sys/malloc.h>
44 1.1 glass #include <sys/param.h>
45 1.1 glass #include <sys/systm.h>
46 1.1 glass #include <sys/errno.h>
47 1.1 glass #include <sys/buf.h>
48 1.1 glass #include <sys/proc.h>
49 1.1 glass #include <sys/user.h>
50 1.1 glass #include <sys/device.h>
51 1.1 glass
52 1.1 glass #include <machine/autoconf.h>
53 1.1 glass #include <machine/isr.h>
54 1.1 glass #include <machine/mtpr.h>
55 1.1 glass #include <machine/obio.h>
56 1.1 glass
57 1.1 glass #include "../scsi/scsi_all.h"
58 1.1 glass #include "../scsi/scsi_debug.h"
59 1.1 glass #include "../scsi/scsiconf.h"
60 1.1 glass #include "scsi_defs.h"
61 1.1 glass #include "scsi_5380.h"
62 1.1 glass
63 1.1 glass #define SCI_PHASE_DISC 0 /* sort of ... */
64 1.1 glass #define SCI_CLR_INTR(regs) {register int temp = regs->sci_iack;}
65 1.1 glass #define SCI_ACK(ptr,phase) (ptr)->sci_tcmd = (phase)
66 1.1 glass #define SCSI_TIMEOUT_VAL 10000000
67 1.1 glass #define WAIT_FOR_NOT_REQ(ptr) { \
68 1.1 glass int scsi_timeout = SCSI_TIMEOUT_VAL; \
69 1.1 glass while ( ((ptr)->sci_bus_csr & SCI_BUS_REQ) && \
70 1.1 glass ((ptr)->sci_bus_csr & SCI_BUS_REQ) && \
71 1.1 glass ((ptr)->sci_bus_csr & SCI_BUS_REQ) && \
72 1.1 glass (--scsi_timeout) ); \
73 1.1 glass if (!scsi_timeout) { \
74 1.1 glass printf("scsi timeout--WAIT_FOR_NOT_REQ---scsi.c, line %d.\n", __LINE__); \
75 1.1 glass goto scsi_timeout_error; \
76 1.1 glass } \
77 1.1 glass }
78 1.1 glass #define WAIT_FOR_REQ(ptr) { \
79 1.1 glass int scsi_timeout = SCSI_TIMEOUT_VAL; \
80 1.1 glass while ( (((ptr)->sci_bus_csr & SCI_BUS_REQ) == 0) && \
81 1.1 glass (((ptr)->sci_bus_csr & SCI_BUS_REQ) == 0) && \
82 1.1 glass (((ptr)->sci_bus_csr & SCI_BUS_REQ) == 0) && \
83 1.1 glass (--scsi_timeout) ); \
84 1.1 glass if (!scsi_timeout) { \
85 1.1 glass printf("scsi timeout--WAIT_FOR_REQ---scsi.c, line %d.\n", __LINE__); \
86 1.1 glass goto scsi_timeout_error; \
87 1.1 glass } \
88 1.1 glass }
89 1.1 glass #define WAIT_FOR_BSY(ptr) { \
90 1.1 glass int scsi_timeout = SCSI_TIMEOUT_VAL; \
91 1.1 glass while ( (((ptr)->sci_bus_csr & SCI_BUS_BSY) == 0) && \
92 1.1 glass (((ptr)->sci_bus_csr & SCI_BUS_BSY) == 0) && \
93 1.1 glass (((ptr)->sci_bus_csr & SCI_BUS_BSY) == 0) && \
94 1.1 glass (--scsi_timeout) ); \
95 1.1 glass if (!scsi_timeout) { \
96 1.1 glass printf("scsi timeout--WAIT_FOR_BSY---scsi.c, line %d.\n", __LINE__); \
97 1.1 glass goto scsi_timeout_error; \
98 1.1 glass } \
99 1.1 glass }
100 1.1 glass
101 1.1 glass #ifdef DDB
102 1.1 glass int Debugger();
103 1.1 glass #else
104 1.1 glass #define Debugger() panic("Should call Debugger here (sun3/dev/scsi.c).")
105 1.1 glass #endif
106 1.1 glass
107 1.1 glass struct ncr5380_softc {
108 1.1 glass struct device sc_dev;
109 1.1 glass void *sc_regs;
110 1.1 glass int sc_adapter_target;
111 1.1 glass struct scsi_link sc_link;
112 1.1 glass };
113 1.1 glass
114 1.1 glass #if 0
115 1.1 glass In your dreams dude...
116 1.1 glass /* From Guide to Mac II family hardware, p. 137 */
117 1.1 glass static volatile sci_padded_regmap_t *ncr = (sci_regmap_t *) 0x50F10000;
118 1.1 glass static volatile long *sci_4byte_addr= (long *) 0x50F06000;
119 1.1 glass static volatile u_char *sci_1byte_addr=(u_char *) 0x50F12000;
120 1.1 glass #endif
121 1.1 glass
122 1.1 glass static unsigned int ncr5380_adapter_info(struct ncr5380_softc *ncr5380);
123 1.1 glass static void ncr5380_minphys(struct buf *bp);
124 1.1 glass static int ncr5380_scsi_cmd(struct scsi_xfer *xs);
125 1.1 glass
126 1.1 glass static int ncr5380_show_scsi_cmd(struct scsi_xfer *xs);
127 1.1 glass static int ncr5380_reset_target(int adapter, int target);
128 1.1 glass static int ncr5380_poll(int adapter, int timeout);
129 1.1 glass static int ncr5380_send_cmd(struct scsi_xfer *xs);
130 1.1 glass
131 1.1 glass extern void ncr5380_intr(int adapter);
132 1.1 glass extern void spinwait(int);
133 1.1 glass
134 1.1 glass static void delay(int);
135 1.1 glass
136 1.1 glass static int scsi_gen(int adapter, int id, int lun,
137 1.1 glass struct scsi_generic *cmd, int cmdlen,
138 1.1 glass void *databuf, int datalen);
139 1.1 glass static int scsi_group0(int adapter, int id, int lun,
140 1.1 glass int opcode, int addr, int len,
141 1.1 glass int flags, caddr_t databuf, int datalen);
142 1.1 glass
143 1.1 glass static char scsi_name[] = "si";
144 1.1 glass
145 1.1 glass struct scsi_adapter ncr5380_switch = {
146 1.1 glass ncr5380_scsi_cmd, /* scsi_cmd() */
147 1.1 glass ncr5380_minphys, /* scsi_minphys() */
148 1.1 glass 0, /* open_target_lu() */
149 1.1 glass 0, /* close_target_lu() */
150 1.1 glass ncr5380_adapter_info, /* adapter_info() */
151 1.1 glass scsi_name, /* name */
152 1.1 glass {0, 0} /* spare[3] */
153 1.1 glass };
154 1.1 glass
155 1.1 glass /* This is copied from julian's bt driver */
156 1.1 glass /* "so we have a default dev struct for our link struct." */
157 1.1 glass struct scsi_device ncr_dev = {
158 1.1 glass NULL, /* Use default error handler. */
159 1.1 glass NULL, /* have a queue, served by this (?) */
160 1.1 glass NULL, /* have no async handler. */
161 1.1 glass NULL, /* Use default "done" routine. */
162 1.1 glass "si",
163 1.1 glass 0,
164 1.1 glass 0, 0
165 1.1 glass };
166 1.1 glass
167 1.1 glass extern int matchbyname();
168 1.1 glass static int ncrprobe();
169 1.1 glass static void ncrattach();
170 1.1 glass
171 1.1 glass struct cfdriver ncrcd =
172 1.1 glass { NULL, "si", ncrprobe, ncrattach,
173 1.1 glass DV_DULL, sizeof(struct ncr5380_softc), NULL, 0 };
174 1.1 glass
175 1.1 glass static int
176 1.1 glass ncr_print(aux, name)
177 1.1 glass void *aux;
178 1.1 glass char *name;
179 1.1 glass {
180 1.1 glass /* printf("%s: (sc_link = 0x%x)", name, (int) aux);
181 1.1 glass return UNCONF;*/
182 1.1 glass }
183 1.1 glass
184 1.1 glass static int
185 1.1 glass ncrprobe(parent, cf, aux)
186 1.1 glass struct device *parent;
187 1.1 glass struct cfdata *cf;
188 1.1 glass void *aux;
189 1.1 glass {
190 1.1 glass caddr_t si_addr;
191 1.1 glass struct obio_cf_loc *obio_loc = (struct obio_cf_loc *) CFDATA_LOC(cf);
192 1.1 glass
193 1.1 glass si_addr = OBIO_DEFAULT_PARAM(caddr_t, obio_loc->obio_addr, OBIO_NCR_SCSI);
194 1.1 glass return /* !obio_probe_byte(si_addr)*/ 1;
195 1.1 glass }
196 1.1 glass
197 1.1 glass static void
198 1.1 glass ncrattach(parent, self, aux)
199 1.1 glass struct device *parent, *self;
200 1.1 glass void *aux;
201 1.1 glass {
202 1.1 glass caddr_t dvma_malloc(), si_addr;
203 1.1 glass int level, ncr_intr(), unit = DEVICE_UNIT(self);
204 1.1 glass struct ncr5380_softc *ncr5380 = (struct ncr5380_softc *) self;
205 1.1 glass struct obio_cf_loc *obio_loc = OBIO_LOC(self);
206 1.1 glass
207 1.1 glass si_addr = OBIO_DEFAULT_PARAM(caddr_t, obio_loc->obio_addr, OBIO_NCR_SCSI);
208 1.1 glass ncr5380->sc_regs = (sci_regmap_t *)
209 1.1 glass obio_alloc(si_addr, OBIO_AMD_ETHER_SIZE, OBIO_WRITE);
210 1.1 glass
211 1.1 glass level = OBIO_DEFAULT_PARAM(int, obio_loc->obio_level, 3);
212 1.1 glass
213 1.1 glass ncr5380->sc_link.scsibus = unit;
214 1.1 glass ncr5380->sc_link.adapter_targ = 7;
215 1.1 glass ncr5380->sc_link.adapter = &ncr5380_switch;
216 1.1 glass ncr5380->sc_link.device = &ncr_dev;
217 1.1 glass
218 1.1 glass obio_print(si_addr, level);
219 1.1 glass printf("\n");
220 1.1 glass
221 1.1 glass config_found(self, &(ncr5380->sc_link), ncr_print);
222 1.1 glass }
223 1.1 glass
224 1.1 glass static unsigned int
225 1.1 glass ncr5380_adapter_info(struct ncr5380_softc *ncr5380)
226 1.1 glass {
227 1.1 glass return 1;
228 1.1 glass }
229 1.1 glass
230 1.1 glass #define MIN_PHYS 65536 /*BARF!!!!*/
231 1.1 glass static void
232 1.1 glass ncr5380_minphys(struct buf *bp)
233 1.1 glass {
234 1.1 glass if (bp->b_bcount > MIN_PHYS) {
235 1.1 glass printf("Uh-oh... ncr5380_minphys setting bp->b_bcount = %x.\n", MIN_PHYS);
236 1.1 glass bp->b_bcount = MIN_PHYS;
237 1.1 glass }
238 1.1 glass }
239 1.1 glass #undef MIN_PHYS
240 1.1 glass
241 1.1 glass static int
242 1.1 glass ncr5380_scsi_cmd(struct scsi_xfer *xs)
243 1.1 glass {
244 1.1 glass int flags, s, r;
245 1.1 glass
246 1.1 glass flags = xs->flags;
247 1.1 glass if (xs->bp) flags |= (SCSI_NOSLEEP);
248 1.1 glass if ( flags & ITSDONE ) {
249 1.1 glass printf("Already done?");
250 1.1 glass xs->flags &= ~ITSDONE;
251 1.1 glass }
252 1.1 glass if ( ! ( flags & INUSE ) ) {
253 1.1 glass printf("Not in use?");
254 1.1 glass xs->flags |= INUSE;
255 1.1 glass }
256 1.1 glass
257 1.1 glass if ( flags & SCSI_RESET ) {
258 1.1 glass printf("flags & SCSIRESET.\n");
259 1.1 glass if ( ! ( flags & SCSI_NOSLEEP ) ) {
260 1.1 glass s = splbio();
261 1.1 glass ncr5380_reset_target(xs->sc_link->scsibus, xs->sc_link->target);
262 1.1 glass splx(s);
263 1.1 glass return(SUCCESSFULLY_QUEUED);
264 1.1 glass } else {
265 1.1 glass ncr5380_reset_target(xs->sc_link->scsibus, xs->sc_link->target);
266 1.1 glass if (ncr5380_poll(xs->sc_link->scsibus, xs->timeout)) {
267 1.1 glass return (HAD_ERROR);
268 1.1 glass }
269 1.1 glass return (COMPLETE);
270 1.1 glass }
271 1.1 glass }
272 1.1 glass /*
273 1.1 glass * OK. Now that that's over with, let's pack up that
274 1.1 glass * SCSI puppy and send it off. If we can, we'll just
275 1.1 glass * queue and go; otherwise, we'll wait for the command
276 1.1 glass * to finish.
277 1.1 glass if ( ! ( flags & SCSI_NOSLEEP ) ) {
278 1.1 glass s = splbio();
279 1.1 glass ncr5380_send_cmd(xs);
280 1.1 glass splx(s);
281 1.1 glass return(SUCCESSFULLY_QUEUED);
282 1.1 glass }
283 1.1 glass */
284 1.1 glass
285 1.1 glass r = ncr5380_send_cmd(xs);
286 1.1 glass xs->flags |= ITSDONE;
287 1.1 glass scsi_done(xs);
288 1.1 glass switch(r) {
289 1.1 glass case COMPLETE: case SUCCESSFULLY_QUEUED:
290 1.1 glass r = SUCCESSFULLY_QUEUED;
291 1.1 glass if (xs->flags&SCSI_NOMASK)
292 1.1 glass r = COMPLETE;
293 1.1 glass break;
294 1.1 glass default:
295 1.1 glass break;
296 1.1 glass }
297 1.1 glass return r;
298 1.1 glass /*
299 1.1 glass do {
300 1.1 glass if (ncr5380_poll(xs->sc_link->scsibus, xs->timeout)) {
301 1.1 glass if ( ! ( xs->flags & SCSI_SILENT ) )
302 1.1 glass printf("cmd fail.\n");
303 1.1 glass cmd_cleanup
304 1.1 glass xs->error = XS_DRIVER_STUFFUP;
305 1.1 glass splx(s);
306 1.1 glass }
307 1.1 glass } while ( ! ( xs->flags & ITSDONE ) );
308 1.1 glass */
309 1.1 glass }
310 1.1 glass
311 1.1 glass static int
312 1.1 glass ncr5380_show_scsi_cmd(struct scsi_xfer *xs)
313 1.1 glass {
314 1.1 glass u_char *b = (u_char *) xs->cmd;
315 1.1 glass int i = 0;
316 1.1 glass
317 1.1 glass if ( ! ( xs->flags & SCSI_RESET ) ) {
318 1.1 glass printf("si(%d:%d:%d)-",
319 1.1 glass xs->sc_link->scsibus, xs->sc_link->target, xs->sc_link->lun);
320 1.1 glass while (i < xs->cmdlen) {
321 1.1 glass if (i) printf(",");
322 1.1 glass printf("%x",b[i++]);
323 1.1 glass }
324 1.1 glass printf("-\n");
325 1.1 glass } else {
326 1.1 glass printf("si(%d:%d:%d)-RESET-\n",
327 1.1 glass xs->sc_link->scsibus, xs->sc_link->target, xs->sc_link->lun);
328 1.1 glass }
329 1.1 glass }
330 1.1 glass
331 1.1 glass /*
332 1.1 glass * Actual chip control.
333 1.1 glass */
334 1.1 glass
335 1.1 glass static void
336 1.1 glass delay(int timeo)
337 1.1 glass {
338 1.1 glass int len;
339 1.1 glass for (len=0;len<timeo*2;len++);
340 1.1 glass }
341 1.1 glass
342 1.1 glass extern void
343 1.1 glass spinwait(int ms)
344 1.1 glass {
345 1.1 glass while (ms--)
346 1.1 glass delay(500);
347 1.1 glass }
348 1.1 glass
349 1.1 glass extern void
350 1.1 glass ncr5380_intr(int adapter)
351 1.1 glass {
352 1.1 glass register struct ncr5380_softc *ncr5380 = ncrcd.cd_devs[adapter];
353 1.1 glass register volatile sci_regmap_t *regs = ncr5380->sc_regs;
354 1.1 glass
355 1.1 glass SCI_CLR_INTR(regs);
356 1.1 glass regs->sci_mode = 0x00;
357 1.1 glass }
358 1.1 glass
359 1.1 glass #if 0
360 1.1 glass extern int
361 1.1 glass scsi_irq_intr(void)
362 1.1 glass {
363 1.1 glass register volatile sci_regmap_t *regs = ncr;
364 1.1 glass
365 1.1 glass /* if (regs->sci_csr != SCI_CSR_PHASE_MATCH)
366 1.1 glass printf("scsi_irq_intr called (not just phase match -- "
367 1.1 glass "csr = 0x%x, bus_csr = 0x%x).\n",
368 1.1 glass regs->sci_csr, regs->sci_bus_csr);
369 1.1 glass ncr5380_intr(0); */
370 1.1 glass return 1;
371 1.1 glass }
372 1.1 glass #endif
373 1.1 glass
374 1.1 glass #if 0
375 1.1 glass extern int
376 1.1 glass scsi_drq_intr(void)
377 1.1 glass {
378 1.1 glass /* printf("scsi_drq_intr called.\n"); */
379 1.1 glass /* ncr5380_intr(0); */
380 1.1 glass return 1;
381 1.1 glass }
382 1.1 glass #endif
383 1.1 glass
384 1.1 glass static int
385 1.1 glass ncr5380_reset_target(int adapter, int target)
386 1.1 glass {
387 1.1 glass register struct ncr5380_softc *ncr5380 = ncrcd.cd_devs[adapter];
388 1.1 glass register volatile sci_regmap_t *regs = ncr5380->sc_regs;
389 1.1 glass int dummy;
390 1.1 glass
391 1.1 glass regs->sci_icmd = SCI_ICMD_TEST;
392 1.1 glass regs->sci_icmd = SCI_ICMD_TEST | SCI_ICMD_RST;
393 1.1 glass delay(2500);
394 1.1 glass regs->sci_icmd = 0;
395 1.1 glass
396 1.1 glass regs->sci_mode = 0;
397 1.1 glass regs->sci_tcmd = SCI_PHASE_DISC;
398 1.1 glass regs->sci_sel_enb = 0;
399 1.1 glass
400 1.1 glass SCI_CLR_INTR(regs);
401 1.1 glass SCI_CLR_INTR(regs);
402 1.1 glass }
403 1.1 glass
404 1.1 glass static int
405 1.1 glass ncr5380_poll(int adapter, int timeout)
406 1.1 glass {
407 1.1 glass }
408 1.1 glass
409 1.1 glass static int
410 1.1 glass ncr5380_send_cmd(struct scsi_xfer *xs)
411 1.1 glass {
412 1.1 glass int s;
413 1.1 glass int sense;
414 1.1 glass
415 1.1 glass /* ncr5380_show_scsi_cmd(xs); */
416 1.1 glass s = splbio();
417 1.1 glass sense = scsi_gen( xs->sc_link->scsibus, xs->sc_link->target,
418 1.1 glass xs->sc_link->lun, xs->cmd, xs->cmdlen,
419 1.1 glass xs->data, xs->datalen );
420 1.1 glass splx(s);
421 1.1 glass if (sense) {
422 1.1 glass switch (sense) {
423 1.1 glass case 0x02: /* Check condition */
424 1.1 glass /* printf("check cond. target %d.\n", xs->targ);*/
425 1.1 glass s = splbio();
426 1.1 glass scsi_group0(xs->sc_link->scsibus,
427 1.1 glass xs->sc_link->target,
428 1.1 glass xs->sc_link->lun,
429 1.1 glass 0x3, 0x0,
430 1.1 glass sizeof(struct scsi_sense_data),
431 1.1 glass 0, (caddr_t) &(xs->sense),
432 1.1 glass sizeof(struct scsi_sense_data));
433 1.1 glass splx(s);
434 1.1 glass xs->error = XS_SENSE;
435 1.1 glass return HAD_ERROR;
436 1.1 glass case 0x08: /* Busy */
437 1.1 glass xs->error = XS_BUSY;
438 1.1 glass return HAD_ERROR;
439 1.1 glass default:
440 1.1 glass xs->error = XS_DRIVER_STUFFUP;
441 1.1 glass return HAD_ERROR;
442 1.1 glass }
443 1.1 glass }
444 1.1 glass xs->error = XS_NOERROR;
445 1.1 glass return (COMPLETE);
446 1.1 glass }
447 1.1 glass
448 1.1 glass static int
449 1.1 glass select_target(register volatile sci_regmap_t *regs,
450 1.1 glass u_char myid, u_char tid, int with_atn)
451 1.1 glass {
452 1.1 glass register u_char bid, icmd;
453 1.1 glass int ret = SCSI_RET_RETRY;
454 1.1 glass
455 1.1 glass if ((regs->sci_bus_csr & (SCI_BUS_BSY|SCI_BUS_SEL)) &&
456 1.1 glass (regs->sci_bus_csr & (SCI_BUS_BSY|SCI_BUS_SEL)) &&
457 1.1 glass (regs->sci_bus_csr & (SCI_BUS_BSY|SCI_BUS_SEL)))
458 1.1 glass return ret;
459 1.1 glass
460 1.1 glass /* for our purposes.. */
461 1.1 glass myid = 1 << myid;
462 1.1 glass tid = 1 << tid;
463 1.1 glass
464 1.1 glass regs->sci_sel_enb = 0; /*myid; we don't want any interrupts. */
465 1.1 glass
466 1.1 glass regs->sci_odata = myid;
467 1.1 glass regs->sci_mode = SCI_MODE_ARB;
468 1.1 glass /* regs->sci_mode |= SCI_MODE_ARB; */
469 1.1 glass /* AIP might not set if BSY went true after we checked */
470 1.1 glass for (bid = 0; bid < 20; bid++) /* 20usec circa */
471 1.1 glass if (regs->sci_icmd & SCI_ICMD_AIP)
472 1.1 glass break;
473 1.1 glass if ((regs->sci_icmd & SCI_ICMD_AIP) == 0) {
474 1.1 glass goto lost;
475 1.1 glass }
476 1.1 glass
477 1.1 glass spinwait(2); /* 2.2us arb delay */
478 1.1 glass
479 1.1 glass if (regs->sci_icmd & SCI_ICMD_LST) {
480 1.1 glass goto lost;
481 1.1 glass }
482 1.1 glass
483 1.1 glass regs->sci_mode &= ~SCI_MODE_PAR_CHK;
484 1.1 glass bid = regs->sci_data;
485 1.1 glass
486 1.1 glass if ((bid & ~myid) > myid) {
487 1.1 glass goto lost;
488 1.1 glass }
489 1.1 glass if (regs->sci_icmd & SCI_ICMD_LST) {
490 1.1 glass goto lost;
491 1.1 glass }
492 1.1 glass
493 1.1 glass /* Won arbitration, enter selection phase now */
494 1.1 glass icmd = regs->sci_icmd & ~(SCI_ICMD_DIFF|SCI_ICMD_TEST);
495 1.1 glass icmd |= (with_atn ? (SCI_ICMD_SEL|SCI_ICMD_ATN) : SCI_ICMD_SEL);
496 1.1 glass icmd |= SCI_ICMD_BSY;
497 1.1 glass regs->sci_icmd = icmd;
498 1.1 glass
499 1.1 glass if (regs->sci_icmd & SCI_ICMD_LST) {
500 1.1 glass goto nosel;
501 1.1 glass }
502 1.1 glass
503 1.1 glass /* XXX a target that violates specs might still drive the bus XXX */
504 1.1 glass /* XXX should put our id out, and after the delay check nothi XXX */
505 1.1 glass /* XXX ng else is out there. XXX */
506 1.1 glass
507 1.1 glass delay(0);
508 1.1 glass
509 1.1 glass regs->sci_tcmd = 0;
510 1.1 glass regs->sci_odata = myid | tid;
511 1.1 glass regs->sci_sel_enb = 0;
512 1.1 glass
513 1.1 glass /* regs->sci_mode &= ~SCI_MODE_ARB; 2 deskew delays, too */
514 1.1 glass regs->sci_mode = 0; /* 2 deskew delays, too */
515 1.1 glass
516 1.1 glass icmd |= SCI_ICMD_DATA;
517 1.1 glass icmd &= ~(SCI_ICMD_BSY);
518 1.1 glass
519 1.1 glass regs->sci_icmd = icmd;
520 1.1 glass
521 1.1 glass /* bus settle delay, 400ns */
522 1.1 glass delay(2); /* too much (was 2) ? */
523 1.1 glass
524 1.1 glass /* regs->sci_mode |= SCI_MODE_PAR_CHK; */
525 1.1 glass
526 1.1 glass {
527 1.1 glass register int timeo = 2500;/* 250 msecs in 100 usecs chunks */
528 1.1 glass while ((regs->sci_bus_csr & SCI_BUS_BSY) == 0) {
529 1.1 glass if (--timeo > 0) {
530 1.1 glass delay(100);
531 1.1 glass } else {
532 1.1 glass goto nodev;
533 1.1 glass }
534 1.1 glass }
535 1.1 glass }
536 1.1 glass
537 1.1 glass icmd &= ~(SCI_ICMD_DATA|SCI_ICMD_SEL);
538 1.1 glass regs->sci_icmd = icmd;
539 1.1 glass /* regs->sci_sel_enb = myid;*/ /* looks like we should NOT have it */
540 1.1 glass return SCSI_RET_SUCCESS;
541 1.1 glass nodev:
542 1.1 glass ret = SCSI_RET_DEVICE_DOWN;
543 1.1 glass regs->sci_sel_enb = myid;
544 1.1 glass nosel:
545 1.1 glass icmd &= ~(SCI_ICMD_DATA|SCI_ICMD_SEL|SCI_ICMD_ATN);
546 1.1 glass regs->sci_icmd = icmd;
547 1.1 glass lost:
548 1.1 glass regs->sci_mode = 0;
549 1.1 glass
550 1.1 glass return ret;
551 1.1 glass }
552 1.1 glass
553 1.1 glass sci_data_out(regs, phase, count, data)
554 1.1 glass register sci_regmap_t *regs;
555 1.1 glass unsigned char *data;
556 1.1 glass {
557 1.1 glass register unsigned char icmd;
558 1.1 glass register int cnt=0;
559 1.1 glass
560 1.1 glass /* ..checks.. */
561 1.1 glass
562 1.1 glass icmd = regs->sci_icmd & ~(SCI_ICMD_DIFF|SCI_ICMD_TEST);
563 1.1 glass loop:
564 1.1 glass if (SCI_CUR_PHASE(regs->sci_bus_csr) != phase)
565 1.1 glass return cnt;
566 1.1 glass
567 1.1 glass WAIT_FOR_REQ(regs);
568 1.1 glass icmd |= SCI_ICMD_DATA;
569 1.1 glass regs->sci_icmd = icmd;
570 1.1 glass regs->sci_odata = *data++;
571 1.1 glass icmd |= SCI_ICMD_ACK;
572 1.1 glass regs->sci_icmd = icmd;
573 1.1 glass
574 1.1 glass icmd &= ~(SCI_ICMD_DATA|SCI_ICMD_ACK);
575 1.1 glass WAIT_FOR_NOT_REQ(regs);
576 1.1 glass regs->sci_icmd = icmd;
577 1.1 glass ++cnt;
578 1.1 glass if (--count > 0)
579 1.1 glass goto loop;
580 1.1 glass scsi_timeout_error:
581 1.1 glass return cnt;
582 1.1 glass }
583 1.1 glass
584 1.1 glass sci_data_in(regs, phase, count, data)
585 1.1 glass register sci_regmap_t *regs;
586 1.1 glass unsigned char *data;
587 1.1 glass {
588 1.1 glass register unsigned char icmd;
589 1.1 glass register int cnt=0;
590 1.1 glass
591 1.1 glass /* ..checks.. */
592 1.1 glass
593 1.1 glass icmd = regs->sci_icmd & ~(SCI_ICMD_DIFF|SCI_ICMD_TEST);
594 1.1 glass
595 1.1 glass loop:
596 1.1 glass if (SCI_CUR_PHASE(regs->sci_bus_csr) != phase)
597 1.1 glass return cnt;
598 1.1 glass
599 1.1 glass WAIT_FOR_REQ(regs);
600 1.1 glass *data++ = regs->sci_data;
601 1.1 glass icmd |= SCI_ICMD_ACK;
602 1.1 glass regs->sci_icmd = icmd;
603 1.1 glass
604 1.1 glass icmd &= ~SCI_ICMD_ACK;
605 1.1 glass WAIT_FOR_NOT_REQ(regs);
606 1.1 glass regs->sci_icmd = icmd;
607 1.1 glass ++cnt;
608 1.1 glass if (--count > 0)
609 1.1 glass goto loop;
610 1.1 glass
611 1.1 glass scsi_timeout_error:
612 1.1 glass return cnt;
613 1.1 glass }
614 1.1 glass
615 1.1 glass static int
616 1.1 glass command_transfer(register volatile sci_regmap_t *regs,
617 1.1 glass int maxlen, u_char *data, u_char *status, u_char *msg)
618 1.1 glass {
619 1.1 glass int xfer=0, phase;
620 1.1 glass
621 1.1 glass /* printf("command_transfer called for 0x%x.\n", *data); */
622 1.1 glass
623 1.1 glass regs->sci_icmd = 0;
624 1.1 glass
625 1.1 glass while (1) {
626 1.1 glass
627 1.1 glass WAIT_FOR_REQ(regs);
628 1.1 glass
629 1.1 glass phase = SCI_CUR_PHASE(regs->sci_bus_csr);
630 1.1 glass
631 1.1 glass switch (phase) {
632 1.1 glass case SCSI_PHASE_CMD:
633 1.1 glass SCI_ACK(regs,SCSI_PHASE_CMD);
634 1.1 glass xfer += sci_data_out(regs, SCSI_PHASE_CMD,
635 1.1 glass maxlen, data);
636 1.1 glass return xfer;
637 1.1 glass case SCSI_PHASE_DATA_IN:
638 1.1 glass printf("Data in phase in command_transfer?\n");
639 1.1 glass return 0;
640 1.1 glass case SCSI_PHASE_DATA_OUT:
641 1.1 glass printf("Data out phase in command_transfer?\n");
642 1.1 glass return 0;
643 1.1 glass case SCSI_PHASE_STATUS:
644 1.1 glass SCI_ACK(regs,SCSI_PHASE_STATUS);
645 1.1 glass printf("status in command_transfer.\n");
646 1.1 glass sci_data_in(regs, SCSI_PHASE_STATUS,
647 1.1 glass 1, status);
648 1.1 glass break;
649 1.1 glass case SCSI_PHASE_MESSAGE_IN:
650 1.1 glass SCI_ACK(regs,SCSI_PHASE_MESSAGE_IN);
651 1.1 glass printf("msgin in command_transfer.\n");
652 1.1 glass sci_data_in(regs, SCSI_PHASE_MESSAGE_IN,
653 1.1 glass 1, msg);
654 1.1 glass break;
655 1.1 glass case SCSI_PHASE_MESSAGE_OUT:
656 1.1 glass SCI_ACK(regs,SCSI_PHASE_MESSAGE_OUT);
657 1.1 glass sci_data_out(regs, SCSI_PHASE_MESSAGE_OUT,
658 1.1 glass 1, msg);
659 1.1 glass break;
660 1.1 glass default:
661 1.1 glass printf("Unexpected phase 0x%x in "
662 1.1 glass "command_transfer().\n", phase);
663 1.1 glass scsi_timeout_error:
664 1.1 glass return xfer;
665 1.1 glass break;
666 1.1 glass }
667 1.1 glass }
668 1.1 glass }
669 1.1 glass
670 1.1 glass static int
671 1.1 glass data_transfer(register volatile sci_regmap_t *regs,
672 1.1 glass int maxlen, u_char *data, u_char *status, u_char *msg)
673 1.1 glass {
674 1.1 glass int retlen = 0, xfer, phase;
675 1.1 glass
676 1.1 glass regs->sci_icmd = 0;
677 1.1 glass
678 1.1 glass *status = 0;
679 1.1 glass
680 1.1 glass while (1) {
681 1.1 glass
682 1.1 glass WAIT_FOR_REQ(regs);
683 1.1 glass
684 1.1 glass phase = SCI_CUR_PHASE(regs->sci_bus_csr);
685 1.1 glass
686 1.1 glass switch (phase) {
687 1.1 glass case SCSI_PHASE_CMD:
688 1.1 glass printf("Command phase in data_transfer().\n");
689 1.1 glass return retlen;
690 1.1 glass case SCSI_PHASE_DATA_IN:
691 1.1 glass SCI_ACK(regs,SCSI_PHASE_DATA_IN);
692 1.1 glass #if PSEUDO_DMA
693 1.1 glass xfer = sci_pdma_in(regs, SCSI_PHASE_DATA_IN,
694 1.1 glass maxlen, data);
695 1.1 glass #else
696 1.1 glass xfer = sci_data_in(regs, SCSI_PHASE_DATA_IN,
697 1.1 glass maxlen, data);
698 1.1 glass #endif
699 1.1 glass retlen += xfer;
700 1.1 glass maxlen -= xfer;
701 1.1 glass break;
702 1.1 glass case SCSI_PHASE_DATA_OUT:
703 1.1 glass SCI_ACK(regs,SCSI_PHASE_DATA_OUT);
704 1.1 glass #if PSEUDO_DMA
705 1.1 glass xfer = sci_pdma_out(regs, SCSI_PHASE_DATA_OUT,
706 1.1 glass maxlen, data);
707 1.1 glass #else
708 1.1 glass xfer = sci_data_out(regs, SCSI_PHASE_DATA_OUT,
709 1.1 glass maxlen, data);
710 1.1 glass #endif
711 1.1 glass retlen += xfer;
712 1.1 glass maxlen -= xfer;
713 1.1 glass break;
714 1.1 glass case SCSI_PHASE_STATUS:
715 1.1 glass SCI_ACK(regs,SCSI_PHASE_STATUS);
716 1.1 glass sci_data_in(regs, SCSI_PHASE_STATUS,
717 1.1 glass 1, status);
718 1.1 glass break;
719 1.1 glass case SCSI_PHASE_MESSAGE_IN:
720 1.1 glass SCI_ACK(regs,SCSI_PHASE_MESSAGE_IN);
721 1.1 glass sci_data_in(regs, SCSI_PHASE_MESSAGE_IN,
722 1.1 glass 1, msg);
723 1.1 glass if (*msg == 0) {
724 1.1 glass return retlen;
725 1.1 glass } else {
726 1.1 glass printf( "message 0x%x in "
727 1.1 glass "data_transfer.\n", *msg);
728 1.1 glass }
729 1.1 glass break;
730 1.1 glass case SCSI_PHASE_MESSAGE_OUT:
731 1.1 glass SCI_ACK(regs,SCSI_PHASE_MESSAGE_OUT);
732 1.1 glass sci_data_out(regs, SCSI_PHASE_MESSAGE_OUT,
733 1.1 glass 1, msg);
734 1.1 glass break;
735 1.1 glass default:
736 1.1 glass printf( "Unexpected phase 0x%x in "
737 1.1 glass "data_transfer().\n", phase);
738 1.1 glass scsi_timeout_error:
739 1.1 glass return retlen;
740 1.1 glass break;
741 1.1 glass }
742 1.1 glass }
743 1.1 glass }
744 1.1 glass
745 1.1 glass static int
746 1.1 glass scsi_request(register volatile sci_regmap_t *regs,
747 1.1 glass int target, int lun, u_char *cmd, int cmdlen,
748 1.1 glass char *databuf, int datalen, int *sent, int *ret)
749 1.1 glass {
750 1.1 glass /* Returns 0 on success, -1 on internal error, or the status byte */
751 1.1 glass int cmd_bytes_sent, r;
752 1.1 glass u_char stat, msg, c;
753 1.1 glass
754 1.1 glass *sent = 0;
755 1.1 glass
756 1.1 glass if ( ( r = select_target(regs, 7, target, 1) ) != SCSI_RET_SUCCESS) {
757 1.1 glass *ret = r;
758 1.1 glass SCI_CLR_INTR(regs);
759 1.1 glass switch (r) {
760 1.1 glass case SCSI_RET_RETRY:
761 1.1 glass return 0x08;
762 1.1 glass default:
763 1.1 glass printf("select_target(target %d, lun %d) failed(%d).\n",
764 1.1 glass target, lun, r);
765 1.1 glass case SCSI_RET_DEVICE_DOWN:
766 1.1 glass return -1;
767 1.1 glass }
768 1.1 glass }
769 1.1 glass
770 1.1 glass c = 0x80 | lun;
771 1.1 glass
772 1.1 glass if ((cmd_bytes_sent = command_transfer(regs, cmdlen,
773 1.1 glass (u_char *) cmd, &stat, &c))
774 1.1 glass != cmdlen) {
775 1.1 glass SCI_CLR_INTR(regs);
776 1.1 glass *ret = SCSI_RET_COMMAND_FAIL;
777 1.1 glass printf("Data underrun sending CCB (%d bytes of %d, sent).\n",
778 1.1 glass cmd_bytes_sent, cmdlen);
779 1.1 glass return -1;
780 1.1 glass }
781 1.1 glass
782 1.1 glass *sent=data_transfer(regs, datalen, (u_char *)databuf,
783 1.1 glass &stat, &msg);
784 1.1 glass
785 1.1 glass *ret = 0;
786 1.1 glass
787 1.1 glass return stat;
788 1.1 glass }
789 1.1 glass
790 1.1 glass static int
791 1.1 glass scsi_gen(int adapter, int id, int lun, struct scsi_generic *cmd,
792 1.1 glass int cmdlen, void *databuf, int datalen)
793 1.1 glass {
794 1.1 glass register struct ncr5380_softc *ncr5380 = ncrcd.cd_devs[adapter];
795 1.1 glass register volatile sci_regmap_t *regs = ncr5380->sc_regs;
796 1.1 glass int i,j,sent,ret;
797 1.1 glass
798 1.1 glass cmd->bytes[0] = ((u_char) lun << 5);
799 1.1 glass
800 1.1 glass i = scsi_request(regs, id, lun, (u_char *) cmd, cmdlen,
801 1.1 glass databuf, datalen, &sent, &ret);
802 1.1 glass
803 1.1 glass return i;
804 1.1 glass }
805 1.1 glass
806 1.1 glass static int
807 1.1 glass scsi_group0(int adapter, int id, int lun, int opcode, int addr, int len,
808 1.1 glass int flags, caddr_t databuf, int datalen)
809 1.1 glass {
810 1.1 glass register struct ncr5380_softc *ncr5380 = ncrcd.cd_devs[adapter];
811 1.1 glass register volatile sci_regmap_t *regs = ncr5380->sc_regs;
812 1.1 glass unsigned char cmd[6];
813 1.1 glass int i,j,sent,ret;
814 1.1 glass
815 1.1 glass cmd[0] = opcode; /* Operation code */
816 1.1 glass cmd[1] = (lun << 5) | ((addr >> 16) & 0x1F); /* Lun & MSB of addr */
817 1.1 glass cmd[2] = (addr >> 8) & 0xFF; /* addr */
818 1.1 glass cmd[3] = addr & 0xFF; /* LSB of addr */
819 1.1 glass cmd[4] = len; /* Allocation length */
820 1.1 glass cmd[5] = flags; /* Link/Flag */
821 1.1 glass
822 1.1 glass i = scsi_request(regs, id, lun, cmd, 6, databuf, datalen, &sent, &ret);
823 1.1 glass
824 1.1 glass return i;
825 1.1 glass }
826 1.1 glass
827 1.1 glass /* pseudo-dma action */
828 1.1 glass
829 1.1 glass #if PSEUDO_DMA
830 1.1 glass
831 1.1 glass #define TIMEOUT 1000000
832 1.1 glass #define READY(poll) \
833 1.1 glass i = TIMEOUT; \
834 1.1 glass while ((regs->sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) \
835 1.1 glass !=(SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH)) \
836 1.1 glass if ( !(regs->sci_csr & SCI_CSR_PHASE_MATCH) \
837 1.1 glass || !(regs->sci_bus_csr & SCI_BUS_BSY) \
838 1.1 glass || (i-- < 0) ) { \
839 1.1 glass printf("scsi.c: timeout counter = %d, len = %d count=%d (count-len %d).\n", \
840 1.1 glass i, len,count,count-len); \
841 1.1 glass printf("pdebug = %d, 1=out, 2=in",pdebug); \
842 1.1 glass /*dump_regs();*/ \
843 1.1 glass if (poll && !(regs->sci_csr & SCI_CSR_PHASE_MATCH)) { \
844 1.1 glass regs->sci_icmd &= ~SCI_ICMD_DATA; \
845 1.1 glass len--; \
846 1.1 glass } else { \
847 1.1 glass regs->sci_mode &= ~SCI_MODE_DMA; \
848 1.1 glass } \
849 1.1 glass return count-len; \
850 1.1 glass }
851 1.1 glass
852 1.1 glass #define W1 *byte_data = *data++
853 1.1 glass #define W4 W1; W1; W1; W1;
854 1.1 glass /*#define W4 *long_data = *((long*)data)++*/
855 1.1 glass
856 1.1 glass sci_pdma_out(regs, phase, count, data)
857 1.1 glass register volatile sci_regmap_t *regs;
858 1.1 glass int phase;
859 1.1 glass int count;
860 1.1 glass u_char *data;
861 1.1 glass {
862 1.1 glass register volatile u_char *byte_data = (u_char *)®s->sci_data;
863 1.1 glass register int len = count, i;
864 1.1 glass
865 1.1 glass pdebug=1;
866 1.1 glass
867 1.1 glass if (count < 128)
868 1.1 glass return sci_data_out(regs, phase, count, data);
869 1.1 glass
870 1.1 glass WAIT_FOR_BSY(regs);
871 1.1 glass regs->sci_mode |= SCI_MODE_DMA;
872 1.1 glass regs->sci_icmd |= SCI_ICMD_DATA;
873 1.1 glass regs->sci_dma_send = 0;
874 1.1 glass
875 1.1 glass while ( len >= 64 ) {
876 1.1 glass READY(1); W1; READY(1); W1; READY(1); W1; READY(1); W1;
877 1.1 glass READY(1);
878 1.1 glass W4;W4;W4; W4;W4;W4;W4; W4;W4;W4;W4; W4;W4;W4;W4;
879 1.1 glass len -= 64;
880 1.1 glass }
881 1.1 glass while (len) {
882 1.1 glass READY(1);
883 1.1 glass W1;
884 1.1 glass len--;
885 1.1 glass }
886 1.1 glass i = TIMEOUT;
887 1.1 glass while ( ((regs->sci_csr & (SCI_CSR_DREQ|SCI_CSR_PHASE_MATCH))
888 1.1 glass == SCI_CSR_PHASE_MATCH) && --i);
889 1.1 glass if (!i)
890 1.1 glass printf("scsi.c:%d: timeout waiting for SCI_CSR_DREQ.\n", __LINE__);
891 1.1 glass *byte_data = 0;
892 1.1 glass scsi_timeout_error:
893 1.1 glass regs->sci_mode &= ~SCI_MODE_DMA;
894 1.1 glass return count-len;
895 1.1 glass }
896 1.1 glass
897 1.1 glass #undef W1
898 1.1 glass #undef W4
899 1.1 glass
900 1.1 glass
901 1.1 glass #define R1 *data++ = *byte_data
902 1.1 glass #define R4 R1; R1; R1; R1;
903 1.1 glass /*#define R4 (*((long *)data)++ = *long_data*/
904 1.1 glass sci_pdma_in(regs, phase, count, data)
905 1.1 glass register volatile sci_regmap_t *regs;
906 1.1 glass int phase;
907 1.1 glass int count;
908 1.1 glass u_char *data;
909 1.1 glass {
910 1.1 glass register volatile u_char *byte_data = (u_char *) ®s->sci_data;
911 1.1 glass register int len = count, i;
912 1.1 glass
913 1.1 glass pdebug=2;
914 1.1 glass if (count < 128)
915 1.1 glass return sci_data_in(regs, phase, count, data);
916 1.1 glass
917 1.1 glass /* printf("Called sci_pdma_in(0x%x, 0x%x, %d, 0x%x.\n", regs, phase, count, data); */
918 1.1 glass
919 1.1 glass WAIT_FOR_BSY(regs);
920 1.1 glass regs->sci_mode |= SCI_MODE_DMA;
921 1.1 glass regs->sci_icmd |= SCI_ICMD_DATA;
922 1.1 glass regs->sci_irecv = 0;
923 1.1 glass
924 1.1 glass while (len >= 1024) {
925 1.1 glass READY(0);
926 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
927 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 128 */
928 1.1 glass READY(0);
929 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
930 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 256 */
931 1.1 glass READY(0);
932 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
933 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 384 */
934 1.1 glass READY(0);
935 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
936 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 512 */
937 1.1 glass READY(0);
938 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
939 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 640 */
940 1.1 glass READY(0);
941 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
942 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 768 */
943 1.1 glass READY(0);
944 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
945 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 896 */
946 1.1 glass READY(0);
947 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
948 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /*1024 */
949 1.1 glass len -= 1024;
950 1.1 glass }
951 1.1 glass while (len >= 128) {
952 1.1 glass READY(0);
953 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4;
954 1.1 glass R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; R4;R4;R4;R4; /* 128 */
955 1.1 glass len -= 128;
956 1.1 glass }
957 1.1 glass while (len) {
958 1.1 glass READY(0);
959 1.1 glass R1;
960 1.1 glass len--;
961 1.1 glass }
962 1.1 glass scsi_timeout_error:
963 1.1 glass regs->sci_mode &= ~SCI_MODE_DMA;
964 1.1 glass return count - len;
965 1.1 glass }
966 1.1 glass #undef R4
967 1.1 glass #undef R1
968 1.1 glass #endif
969