flsc.c revision 1.32.2.3 1 /* $NetBSD: flsc.c,v 1.32.2.3 2004/09/21 13:12:26 skrll Exp $ */
2
3 /*
4 * Copyright (c) 1997 Michael L. Hitch
5 * Copyright (c) 1995 Daniel Widenfalk
6 * Copyright (c) 1994 Christian E. Hopps
7 * Copyright (c) 1982, 1990 The Regents of the University of California.
8 * All rights reserved.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 * 3. All advertising materials mentioning features or use of this software
19 * must display the following acknowledgement:
20 * This product includes software developed by Daniel Widenfalk
21 * and Michael L. Hitch.
22 * 4. Neither the name of the University nor the names of its contributors
23 * may be used to endorse or promote products derived from this software
24 * without specific prior written permission.
25 *
26 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
27 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
28 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
29 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
30 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
31 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
32 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
33 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
34 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
35 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
36 * SUCH DAMAGE.
37 */
38
39 /*
40 * Initial amiga Fastlane driver by Daniel Widenfalk. Conversion to
41 * 53c9x MI driver by Michael L. Hitch (mhitch (at) montana.edu).
42 */
43
44 #include "opt_ddb.h"
45
46 #include <sys/cdefs.h>
47 __KERNEL_RCSID(0, "$NetBSD: flsc.c,v 1.32.2.3 2004/09/21 13:12:26 skrll Exp $");
48
49 #include <sys/types.h>
50 #include <sys/param.h>
51 #include <sys/systm.h>
52 #include <sys/kernel.h>
53 #include <sys/errno.h>
54 #include <sys/ioctl.h>
55 #include <sys/device.h>
56 #include <sys/buf.h>
57 #include <sys/proc.h>
58 #include <sys/user.h>
59 #include <sys/queue.h>
60
61 #include <uvm/uvm_extern.h>
62
63 #include <dev/scsipi/scsi_all.h>
64 #include <dev/scsipi/scsipi_all.h>
65 #include <dev/scsipi/scsiconf.h>
66 #include <dev/scsipi/scsi_message.h>
67
68 #include <machine/cpu.h>
69 #include <machine/param.h>
70
71 #include <dev/ic/ncr53c9xreg.h>
72 #include <dev/ic/ncr53c9xvar.h>
73
74 #include <amiga/amiga/isr.h>
75 #include <amiga/dev/flscvar.h>
76 #include <amiga/dev/zbusvar.h>
77
78 void flscattach(struct device *, struct device *, void *);
79 int flscmatch(struct device *, struct cfdata *, void *);
80
81 /* Linkup to the rest of the kernel */
82 CFATTACH_DECL(flsc, sizeof(struct flsc_softc),
83 flscmatch, flscattach, NULL, NULL);
84
85 /*
86 * Functions and the switch for the MI code.
87 */
88 u_char flsc_read_reg(struct ncr53c9x_softc *, int);
89 void flsc_write_reg(struct ncr53c9x_softc *, int, u_char);
90 int flsc_dma_isintr(struct ncr53c9x_softc *);
91 void flsc_dma_reset(struct ncr53c9x_softc *);
92 int flsc_dma_intr(struct ncr53c9x_softc *);
93 int flsc_dma_setup(struct ncr53c9x_softc *, caddr_t *,
94 size_t *, int, size_t *);
95 void flsc_dma_go(struct ncr53c9x_softc *);
96 void flsc_dma_stop(struct ncr53c9x_softc *);
97 int flsc_dma_isactive(struct ncr53c9x_softc *);
98 void flsc_clear_latched_intr(struct ncr53c9x_softc *);
99
100 struct ncr53c9x_glue flsc_glue = {
101 flsc_read_reg,
102 flsc_write_reg,
103 flsc_dma_isintr,
104 flsc_dma_reset,
105 flsc_dma_intr,
106 flsc_dma_setup,
107 flsc_dma_go,
108 flsc_dma_stop,
109 flsc_dma_isactive,
110 flsc_clear_latched_intr,
111 };
112
113 /* Maximum DMA transfer length to reduce impact on high-speed serial input */
114 u_long flsc_max_dma = 1024;
115 extern int ser_open_speed;
116
117 extern int ncr53c9x_debug;
118 extern u_long scsi_nosync;
119 extern int shift_nosync;
120
121 /*
122 * if we are an Advanced Systems & Software FastlaneZ3
123 */
124 int
125 flscmatch(struct device *parent, struct cfdata *cf, void *aux)
126 {
127 struct zbus_args *zap;
128
129 if (!is_a4000() && !is_a3000())
130 return(0);
131
132 zap = aux;
133 if (zap->manid == 0x2140 && zap->prodid == 11
134 && iszthreepa(zap->pa))
135 return(1);
136
137 return(0);
138 }
139
140 /*
141 * Attach this instance, and then all the sub-devices
142 */
143 void
144 flscattach(struct device *parent, struct device *self, void *aux)
145 {
146 struct flsc_softc *fsc = (void *)self;
147 struct ncr53c9x_softc *sc = &fsc->sc_ncr53c9x;
148 struct zbus_args *zap;
149
150 /*
151 * Set up the glue for MI code early; we use some of it here.
152 */
153 sc->sc_glue = &flsc_glue;
154
155 /*
156 * Save the regs
157 */
158 zap = aux;
159 fsc->sc_dmabase = (volatile u_char *)zap->va;
160 fsc->sc_reg = &((volatile u_char *)zap->va)[0x1000001];
161
162 sc->sc_freq = 40; /* Clocked at 40Mhz */
163
164 printf(": address %p", fsc->sc_reg);
165
166 sc->sc_id = 7;
167
168 /*
169 * It is necessary to try to load the 2nd config register here,
170 * to find out what rev the flsc chip is, else the flsc_reset
171 * will not set up the defaults correctly.
172 */
173 sc->sc_cfg1 = sc->sc_id | NCRCFG1_PARENB;
174 sc->sc_cfg2 = NCRCFG2_SCSI2 | NCRCFG2_FE;
175 sc->sc_cfg3 = 0x08 /*FCLK*/ | NCRESPCFG3_FSCSI | NCRESPCFG3_CDB;
176 sc->sc_rev = NCR_VARIANT_FAS216;
177
178 /*
179 * This is the value used to start sync negotiations
180 * Note that the NCR register "SYNCTP" is programmed
181 * in "clocks per byte", and has a minimum value of 4.
182 * The SCSI period used in negotiation is one-fourth
183 * of the time (in nanoseconds) needed to transfer one byte.
184 * Since the chip's clock is given in MHz, we have the following
185 * formula: 4 * period = (1000 / freq) * 4
186 */
187 sc->sc_minsync = 1000 / sc->sc_freq;
188
189 if (((scsi_nosync >> shift_nosync) & 0xff00) == 0xff00)
190 sc->sc_minsync = 0;
191
192 /* Really no limit, but since we want to fit into the TCR... */
193 sc->sc_maxxfer = 64 * 1024;
194
195 fsc->sc_portbits = 0xa0 | FLSC_PB_EDI | FLSC_PB_ESI;
196 fsc->sc_hardbits = fsc->sc_reg[0x40];
197
198 fsc->sc_alignbuf = (char *)((u_long)fsc->sc_unalignbuf & -4);
199
200 sc->sc_dev.dv_cfdata->cf_flags |= (scsi_nosync >> shift_nosync) & 0xffff;
201 shift_nosync += 16;
202 ncr53c9x_debug |= (scsi_nosync >> shift_nosync) & 0xffff;
203 shift_nosync += 16;
204
205 /*
206 * Configure interrupts.
207 */
208 fsc->sc_isr.isr_intr = ncr53c9x_intr;
209 fsc->sc_isr.isr_arg = sc;
210 fsc->sc_isr.isr_ipl = 2;
211 add_isr(&fsc->sc_isr);
212
213 fsc->sc_reg[0x40] = fsc->sc_portbits;
214
215 /*
216 * Now try to attach all the sub-devices
217 */
218 sc->sc_adapter.adapt_request = ncr53c9x_scsipi_request;
219 sc->sc_adapter.adapt_minphys = minphys;
220 ncr53c9x_attach(sc);
221 }
222
223 /*
224 * Glue functions.
225 */
226
227 u_char
228 flsc_read_reg(struct ncr53c9x_softc *sc, int reg)
229 {
230 struct flsc_softc *fsc = (struct flsc_softc *)sc;
231
232 return fsc->sc_reg[reg * 4];
233 }
234
235 void
236 flsc_write_reg(struct ncr53c9x_softc *sc, int reg, u_char val)
237 {
238 struct flsc_softc *fsc = (struct flsc_softc *)sc;
239 struct ncr53c9x_tinfo *ti;
240 u_char v = val;
241
242 if (fsc->sc_piomode && reg == NCR_CMD &&
243 v == (NCRCMD_TRANS|NCRCMD_DMA)) {
244 v = NCRCMD_TRANS;
245 }
246 /*
247 * Can't do synchronous transfers in XS_CTL_POLL mode:
248 * If starting XS_CTL_POLL command, clear defer sync negotiation
249 * by clearing the T_NEGOTIATE flag. If starting XS_CTL_POLL and
250 * the device is currently running synchronous, force another
251 * T_NEGOTIATE with 0 offset.
252 */
253 if (reg == NCR_SELID) {
254 ti = &sc->sc_tinfo[
255 sc->sc_nexus->xs->xs_periph->periph_target];
256 if (sc->sc_nexus->xs->xs_control & XS_CTL_POLL) {
257 if (ti->flags & T_SYNCMODE) {
258 ti->flags ^= T_SYNCMODE | T_NEGOTIATE;
259 } else if (ti->flags & T_NEGOTIATE) {
260 ti->flags ^= T_NEGOTIATE | T_SYNCHOFF;
261 /* save T_NEGOTIATE in private flags? */
262 }
263 } else {
264 /*
265 * If we haven't attempted sync negotiation yet,
266 * do it now.
267 */
268 if ((ti->flags & (T_SYNCMODE | T_SYNCHOFF)) ==
269 T_SYNCHOFF &&
270 sc->sc_minsync != 0) /* XXX */
271 ti->flags ^= T_NEGOTIATE | T_SYNCHOFF;
272 }
273 }
274 if (reg == NCR_CMD && v == NCRCMD_SETATN &&
275 sc->sc_flags & NCR_SYNCHNEGO &&
276 sc->sc_nexus->xs->xs_control & XS_CTL_POLL) {
277 ti = &sc->sc_tinfo[
278 sc->sc_nexus->xs->xs_periph->periph_target];
279 ti->offset = 0;
280 }
281 fsc->sc_reg[reg * 4] = v;
282 }
283
284 int
285 flsc_dma_isintr(struct ncr53c9x_softc *sc)
286 {
287 struct flsc_softc *fsc = (struct flsc_softc *)sc;
288 unsigned hardbits;
289
290 hardbits = fsc->sc_reg[0x40];
291 if (hardbits & FLSC_HB_IACT)
292 return (fsc->sc_csr = 0);
293
294 if (sc->sc_state == NCR_CONNECTED || sc->sc_state == NCR_SELECTING)
295 fsc->sc_portbits |= FLSC_PB_LED;
296 else
297 fsc->sc_portbits &= ~FLSC_PB_LED;
298
299 if ((hardbits & FLSC_HB_CREQ) && !(hardbits & FLSC_HB_MINT) &&
300 fsc->sc_reg[NCR_STAT * 4] & NCRSTAT_INT) {
301 return 1;
302 }
303 /* Do I still need this? */
304 if (fsc->sc_piomode && fsc->sc_reg[NCR_STAT * 4] & NCRSTAT_INT &&
305 !(hardbits & FLSC_HB_MINT))
306 return 1;
307
308 fsc->sc_reg[0x40] = fsc->sc_portbits & ~FLSC_PB_INT_BITS;
309 fsc->sc_reg[0x40] = fsc->sc_portbits;
310 return 0;
311 }
312
313 void
314 flsc_clear_latched_intr(struct ncr53c9x_softc *sc)
315 {
316 struct flsc_softc *fsc = (struct flsc_softc *)sc;
317
318 fsc->sc_reg[0x40] = fsc->sc_portbits & ~FLSC_PB_INT_BITS;
319 fsc->sc_reg[0x40] = fsc->sc_portbits;
320 }
321
322 void
323 flsc_dma_reset(struct ncr53c9x_softc *sc)
324 {
325 struct flsc_softc *fsc = (struct flsc_softc *)sc;
326 struct ncr53c9x_tinfo *ti;
327
328 if (sc->sc_nexus)
329 ti = &sc->sc_tinfo[sc->sc_nexus->xs->xs_periph->periph_target];
330 else
331 ti = &sc->sc_tinfo[1]; /* XXX */
332 if (fsc->sc_active) {
333 printf("dmaaddr %p dmasize %d stat %x flags %x off %d per %d ff %x",
334 *fsc->sc_dmaaddr, fsc->sc_dmasize, fsc->sc_reg[NCR_STAT * 4],
335 ti->flags, ti->offset, ti->period, fsc->sc_reg[NCR_FFLAG * 4]);
336 printf(" intr %x\n", fsc->sc_reg[NCR_INTR * 4]);
337 #ifdef DDB
338 Debugger();
339 #endif
340 }
341 fsc->sc_portbits &= ~FLSC_PB_DMA_BITS;
342 fsc->sc_reg[0x40] = fsc->sc_portbits;
343 fsc->sc_reg[0x80] = 0;
344 *((u_long *)fsc->sc_dmabase) = 0;
345 fsc->sc_active = 0;
346 fsc->sc_piomode = 0;
347 }
348
349 int
350 flsc_dma_intr(struct ncr53c9x_softc *sc)
351 {
352 register struct flsc_softc *fsc = (struct flsc_softc *)sc;
353 register u_char *p;
354 volatile u_char *cmdreg, *intrreg, *statreg, *fiforeg;
355 register u_int flscphase, flscstat, flscintr;
356 register int cnt;
357
358 NCR_DMA(("flsc_dma_intr: pio %d cnt %d int %x stat %x fifo %d ",
359 fsc->sc_piomode, fsc->sc_dmasize, sc->sc_espintr, sc->sc_espstat,
360 fsc->sc_reg[NCR_FFLAG * 4] & NCRFIFO_FF));
361 if (!(fsc->sc_reg[0x40] & FLSC_HB_CREQ))
362 printf("flsc_dma_intr: csr %x stat %x intr %x\n", fsc->sc_csr,
363 sc->sc_espstat, sc->sc_espintr);
364 if (fsc->sc_active == 0) {
365 printf("flsc_intr--inactive DMA\n");
366 return -1;
367 }
368
369 /* if DMA transfer, update sc_dmaaddr and sc_pdmalen, else PIO xfer */
370 if (fsc->sc_piomode == 0) {
371 fsc->sc_portbits &= ~FLSC_PB_DMA_BITS;
372 fsc->sc_reg[0x40] = fsc->sc_portbits;
373 fsc->sc_reg[0x80] = 0;
374 *((u_long *)fsc->sc_dmabase) = 0;
375 cnt = fsc->sc_reg[NCR_TCL * 4];
376 cnt += fsc->sc_reg[NCR_TCM * 4] << 8;
377 cnt += fsc->sc_reg[NCR_TCH * 4] << 16;
378 if (!fsc->sc_datain) {
379 cnt += fsc->sc_reg[NCR_FFLAG * 4] & NCRFIFO_FF;
380 fsc->sc_reg[NCR_CMD * 4] = NCRCMD_FLUSH;
381 }
382 cnt = fsc->sc_dmasize - cnt; /* number of bytes transferred */
383 NCR_DMA(("DMA xferred %d\n", cnt));
384 if (fsc->sc_xfr_align) {
385 int i;
386 for (i = 0; i < cnt; ++i)
387 (*fsc->sc_dmaaddr)[i] = fsc->sc_alignbuf[i];
388 fsc->sc_xfr_align = 0;
389 }
390 *fsc->sc_dmaaddr += cnt;
391 *fsc->sc_pdmalen -= cnt;
392 fsc->sc_active = 0;
393 return 0;
394 }
395
396 if ((sc->sc_espintr & NCRINTR_BS) == 0) {
397 fsc->sc_active = 0;
398 fsc->sc_piomode = 0;
399 NCR_DMA(("no NCRINTR_BS\n"));
400 return 0;
401 }
402
403 cnt = fsc->sc_dmasize;
404 #if 0
405 if (cnt == 0) {
406 printf("data interrupt, but no count left.");
407 }
408 #endif
409
410 p = *fsc->sc_dmaaddr;
411 flscphase = sc->sc_phase;
412 flscstat = (u_int) sc->sc_espstat;
413 flscintr = (u_int) sc->sc_espintr;
414 cmdreg = fsc->sc_reg + NCR_CMD * 4;
415 fiforeg = fsc->sc_reg + NCR_FIFO * 4;
416 statreg = fsc->sc_reg + NCR_STAT * 4;
417 intrreg = fsc->sc_reg + NCR_INTR * 4;
418 NCR_DMA(("PIO %d datain %d phase %d stat %x intr %x\n",
419 cnt, fsc->sc_datain, flscphase, flscstat, flscintr));
420 do {
421 if (fsc->sc_datain) {
422 *p++ = *fiforeg;
423 cnt--;
424 if (flscphase == DATA_IN_PHASE) {
425 *cmdreg = NCRCMD_TRANS;
426 } else {
427 fsc->sc_active = 0;
428 }
429 } else {
430 NCR_DMA(("flsc_dma_intr: PIO out- phase %d cnt %d active %d\n", flscphase, cnt,
431 fsc->sc_active));
432 if ( (flscphase == DATA_OUT_PHASE)
433 || (flscphase == MESSAGE_OUT_PHASE)) {
434 int n;
435 n = 16 - (fsc->sc_reg[NCR_FFLAG * 4] & NCRFIFO_FF);
436 if (n > cnt)
437 n = cnt;
438 cnt -= n;
439 while (n-- > 0)
440 *fiforeg = *p++;
441 *cmdreg = NCRCMD_TRANS;
442 } else {
443 fsc->sc_active = 0;
444 }
445 }
446
447 if (fsc->sc_active && cnt) {
448 while (!(*statreg & 0x80));
449 flscstat = *statreg;
450 flscintr = *intrreg;
451 flscphase = (flscintr & NCRINTR_DIS)
452 ? /* Disconnected */ BUSFREE_PHASE
453 : flscstat & PHASE_MASK;
454 }
455 } while (cnt && fsc->sc_active && (flscintr & NCRINTR_BS));
456 #if 1
457 if (fsc->sc_dmasize < 8 && cnt)
458 printf("flsc_dma_intr: short transfer: dmasize %d cnt %d\n",
459 fsc->sc_dmasize, cnt);
460 #endif
461 NCR_DMA(("flsc_dma_intr: PIO transfer [%d], %d->%d phase %d stat %x intr %x\n",
462 *fsc->sc_pdmalen, fsc->sc_dmasize, cnt, flscphase, flscstat, flscintr));
463 sc->sc_phase = flscphase;
464 sc->sc_espstat = (u_char) flscstat;
465 sc->sc_espintr = (u_char) flscintr;
466 *fsc->sc_dmaaddr = p;
467 *fsc->sc_pdmalen -= fsc->sc_dmasize - cnt;
468 fsc->sc_dmasize = cnt;
469
470 if (*fsc->sc_pdmalen == 0) {
471 sc->sc_espstat |= NCRSTAT_TC;
472 fsc->sc_piomode = 0;
473 }
474 return 0;
475 }
476
477 int
478 flsc_dma_setup(struct ncr53c9x_softc *sc, caddr_t *addr, size_t *len,
479 int datain, size_t *dmasize)
480 {
481 struct flsc_softc *fsc = (struct flsc_softc *)sc;
482 paddr_t pa;
483 u_char *ptr;
484 size_t xfer;
485
486 fsc->sc_dmaaddr = addr;
487 fsc->sc_pdmalen = len;
488 fsc->sc_datain = datain;
489 fsc->sc_dmasize = *dmasize;
490 if (sc->sc_nexus->xs->xs_control & XS_CTL_POLL) {
491 /* polling mode, use PIO */
492 *dmasize = fsc->sc_dmasize;
493 NCR_DMA(("pfsc_dma_setup: PIO %p/%d [%d]\n", *addr,
494 fsc->sc_dmasize, *len));
495 fsc->sc_piomode = 1;
496 if (datain == 0) {
497 int n;
498 n = fsc->sc_dmasize;
499 if (n > 16)
500 n = 16;
501 while (n-- > 0) {
502 fsc->sc_reg[NCR_FIFO * 4] = **fsc->sc_dmaaddr;
503 (*fsc->sc_pdmalen)--;
504 (*fsc->sc_dmaaddr)++;
505 --fsc->sc_dmasize;
506 }
507 }
508 return 0;
509 }
510 /*
511 * DMA can be nasty for high-speed serial input, so limit the
512 * size of this DMA operation if the serial port is running at
513 * a high speed (higher than 19200 for now - should be adjusted
514 * based on CPU type and speed?).
515 * XXX - add serial speed check XXX
516 */
517 if (ser_open_speed > 19200 && flsc_max_dma != 0 &&
518 fsc->sc_dmasize > flsc_max_dma)
519 fsc->sc_dmasize = flsc_max_dma;
520 ptr = *addr; /* Kernel virtual address */
521 pa = kvtop(ptr); /* Physical address of DMA */
522 xfer = min(fsc->sc_dmasize, PAGE_SIZE - (pa & (PAGE_SIZE - 1)));
523 fsc->sc_xfr_align = 0;
524 fsc->sc_piomode = 0;
525 fsc->sc_portbits &= ~FLSC_PB_DMA_BITS;
526 fsc->sc_reg[0x40] = fsc->sc_portbits;
527 fsc->sc_reg[0x80] = 0;
528 *((u_long *)fsc->sc_dmabase) = 0;
529
530 /*
531 * If output and length < 16, copy to fifo
532 */
533 if (datain == 0 && fsc->sc_dmasize < 16) {
534 int n;
535 for (n = 0; n < fsc->sc_dmasize; ++n)
536 fsc->sc_reg[NCR_FIFO * 4] = *ptr++;
537 NCR_DMA(("flsc_dma_setup: %d bytes written to fifo\n", n));
538 fsc->sc_piomode = 1;
539 fsc->sc_active = 1;
540 *fsc->sc_pdmalen -= fsc->sc_dmasize;
541 *fsc->sc_dmaaddr += fsc->sc_dmasize;
542 *dmasize = fsc->sc_dmasize;
543 fsc->sc_dmasize = 0;
544 return 0; /* All done */
545 }
546 /*
547 * If output and unaligned, copy unaligned data to fifo
548 */
549 else if (datain == 0 && (int)ptr & 3) {
550 int n = 4 - ((int)ptr & 3);
551 NCR_DMA(("flsc_dma_setup: align %d bytes written to fifo\n", n));
552 pa += n;
553 xfer -= n;
554 while (n--)
555 fsc->sc_reg[NCR_FIFO * 4] = *ptr++;
556 }
557 /*
558 * If unaligned address, read unaligned bytes into alignment buffer
559 */
560 else if ((int)ptr & 3 || xfer & 3) {
561 pa = kvtop((caddr_t)fsc->sc_alignbuf);
562 xfer = fsc->sc_dmasize = min(xfer, sizeof (fsc->sc_unalignbuf));
563 NCR_DMA(("flsc_dma_setup: align read by %d bytes\n", xfer));
564 fsc->sc_xfr_align = 1;
565 }
566 /*
567 * If length smaller than longword, read into alignment buffer
568 * XXX doesn't work for 1 or 2 bytes !!!!
569 */
570 else if (fsc->sc_dmasize < 4) {
571 NCR_DMA(("flsc_dma_setup: read remaining %d bytes\n",
572 fsc->sc_dmasize));
573 pa = kvtop((caddr_t)fsc->sc_alignbuf);
574 fsc->sc_xfr_align = 1;
575 }
576 /*
577 * Finally, limit transfer length to multiple of 4 bytes.
578 */
579 else {
580 fsc->sc_dmasize &= -4;
581 xfer &= -4;
582 }
583
584 while (xfer < fsc->sc_dmasize) {
585 if ((pa + xfer) != kvtop(*addr + xfer))
586 break;
587 if ((fsc->sc_dmasize - xfer) < PAGE_SIZE)
588 xfer = fsc->sc_dmasize;
589 else
590 xfer += PAGE_SIZE;
591 }
592
593 fsc->sc_dmasize = xfer;
594 *dmasize = fsc->sc_dmasize;
595 fsc->sc_pa = pa;
596 #if defined(M68040) || defined(M68060)
597 if (mmutype == MMU_68040) {
598 if (fsc->sc_xfr_align) {
599 int n;
600 for (n = 0; n < sizeof (fsc->sc_unalignbuf); ++n)
601 fsc->sc_alignbuf[n] = n | 0x80;
602 dma_cachectl(fsc->sc_alignbuf,
603 sizeof(fsc->sc_unalignbuf));
604 }
605 else
606 dma_cachectl(*fsc->sc_dmaaddr, fsc->sc_dmasize);
607 }
608 #endif
609 fsc->sc_reg[0x80] = 0;
610 *((u_long *)(fsc->sc_dmabase + (pa & 0x00fffffc))) = pa;
611 fsc->sc_portbits &= ~FLSC_PB_DMA_BITS;
612 fsc->sc_portbits |= FLSC_PB_ENABLE_DMA |
613 (fsc->sc_datain ? FLSC_PB_DMA_READ : FLSC_PB_DMA_WRITE);
614 fsc->sc_reg[0x40] = fsc->sc_portbits;
615 NCR_DMA(("flsc_dma_setup: DMA %p->%lx/%d [%d]\n",
616 ptr, pa, fsc->sc_dmasize, *len));
617 fsc->sc_active = 1;
618 return 0;
619 }
620
621 void
622 flsc_dma_go(struct ncr53c9x_softc *sc)
623 {
624 struct flsc_softc *fsc = (struct flsc_softc *)sc;
625
626 NCR_DMA(("flsc_dma_go: datain %d size %d\n", fsc->sc_datain,
627 fsc->sc_dmasize));
628 if (sc->sc_nexus->xs->xs_control & XS_CTL_POLL) {
629 fsc->sc_active = 1;
630 return;
631 } else if (fsc->sc_piomode == 0) {
632 fsc->sc_portbits &= ~FLSC_PB_DMA_BITS;
633 fsc->sc_portbits |= FLSC_PB_ENABLE_DMA |
634 (fsc->sc_datain ? FLSC_PB_DMA_READ : FLSC_PB_DMA_WRITE);
635 fsc->sc_reg[0x40] = fsc->sc_portbits;
636 }
637 }
638
639 void
640 flsc_dma_stop(struct ncr53c9x_softc *sc)
641 {
642 struct flsc_softc *fsc = (struct flsc_softc *)sc;
643
644 fsc->sc_portbits &= ~FLSC_PB_DMA_BITS;
645 fsc->sc_reg[0x40] = fsc->sc_portbits;
646
647 fsc->sc_reg[0x80] = 0;
648 *((u_long *)fsc->sc_dmabase) = 0;
649 fsc->sc_piomode = 0;
650 }
651
652 int
653 flsc_dma_isactive(struct ncr53c9x_softc *sc)
654 {
655 struct flsc_softc *fsc = (struct flsc_softc *)sc;
656
657 return fsc->sc_active;
658 }
659