1/*-
2 * Copyright (c) 1998,1999,2000 S�ren Schmidt
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
--- 11 unchanged lines hidden (view full) ---
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 * $FreeBSD: head/sys/dev/ata/ata-dma.c 56138 2000-01-17 02:04:19Z sos $
29 */
30
31#include "pci.h"
32#include "apm.h"
33#include <sys/param.h>
34#include <sys/systm.h>
35#include <sys/buf.h>
36#include <sys/malloc.h>
--- 11 unchanged lines hidden (view full) ---
48#include <dev/ata/ata-all.h>
49#include <dev/ata/ata-disk.h>
50
51/* prototypes */
52static void promise_timing(struct ata_softc *, int32_t, int32_t);
53static void hpt366_timing(struct ata_softc *, int32_t, int32_t);
54
55/* misc defines */
56#define MIN(a,b) ((a)>(b)?(b):(a))
57#ifdef __alpha__
58#undef vtophys
59#define vtophys(va) alpha_XXX_dmamap((vm_offset_t)va)
60#endif
61
62#if NPCI > 0
63
64int32_t
65ata_dmainit(struct ata_softc *scp, int32_t device,
66 int32_t apiomode, int32_t wdmamode, int32_t udmamode)
67{
68 int32_t devno = (scp->unit << 1) + ((device == ATA_MASTER) ? 0 : 1);
69 int32_t error;
70 void *dmatab;
71
72 if (!scp->bmaddr)
73 return -1;
74
75 /* if simplex controller, only allow DMA on primary channel */
76 if (scp->unit == 1) {
77 outb(scp->bmaddr + ATA_BMSTAT_PORT, inb(scp->bmaddr + ATA_BMSTAT_PORT) &
78 (ATA_BMSTAT_DMA_MASTER | ATA_BMSTAT_DMA_SLAVE));
79 if (inb(scp->bmaddr + ATA_BMSTAT_PORT) & ATA_BMSTAT_DMA_SIMPLEX) {
80 printf("ata%d: simplex device, DMA on primary channel only\n",
81 scp->lun);
82 return -1;
83 }
84 }
85
86 if (!(dmatab = malloc(PAGE_SIZE, M_DEVBUF, M_NOWAIT)))
87 return -1;
88
89 if (((uintptr_t)dmatab >> PAGE_SHIFT) ^
90 (((uintptr_t)dmatab + PAGE_SIZE - 1) >> PAGE_SHIFT)) {
91 printf("ata%d-%s: dmatab crosses page boundary, no DMA\n",
92 scp->lun, (device == ATA_MASTER) ? "master" : "slave");
93 free(dmatab, M_DEVBUF);
94 return -1;
95 }
96 scp->dmatab[(device == ATA_MASTER) ? 0 : 1] = dmatab;
97
98 switch (scp->chiptype) {
99
100 case 0x71118086: /* Intel PIIX4 */
101 case 0x71998086: /* Intel PIIX4e */
102 case 0x24118086: /* Intel ICH */
103 case 0x24218086: /* Intel ICH0 */
104 if (udmamode >= 2) {
105 int32_t mask48, new48;
106
107 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
108 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
109 if (bootverbose)
110 printf("ata%d-%s: %s setting up UDMA2 mode on %s chip\n",
111 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
112 (error) ? "failed" : "success",
113 (scp->chiptype == 0x24118086) ? "ICH" :
114 (scp->chiptype == 0x24218086) ? "ICH0" :"PIIX4");
115 if (!error) {
116 mask48 = (1 << devno) + (3 << (16 + (devno << 2)));
117 new48 = (1 << devno) + (2 << (16 + (devno << 2)));
118 pci_write_config(scp->dev, 0x48,
119 (pci_read_config(scp->dev, 0x48, 4) &
120 ~mask48) | new48, 4);
121 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
122 return 0;
123 }
124 }
125 /* FALLTHROUGH */
126
127 case 0x70108086: /* Intel PIIX3 */
128 if (wdmamode >= 2 && apiomode >= 4) {
129 int32_t mask40, new40, mask44, new44;
--- 12 unchanged lines hidden (view full) ---
142 }
143 new40 |= 0x40004000;
144 pci_write_config(scp->dev, 0x40, new40, 4);
145 pci_write_config(scp->dev, 0x44, new44, 4);
146 }
147 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
148 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
149 if (bootverbose)
150 printf("ata%d-%s: %s setting up WDMA2 mode on %s chip\n",
151 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
152 (error) ? "failed" : "success",
153 (scp->chiptype == 0x70108086) ? "PIIX3" :
154 (scp->chiptype == 0x24118086) ? "ICH" :
155 (scp->chiptype == 0x24218086) ? "ICH0" :"PIIX4");
156 if (!error) {
157 if (device == ATA_MASTER) {
158 mask40 = 0x0000330f;
159 new40 = 0x00002307;
160 mask44 = 0;
161 new44 = 0;
162 }
163 else {
--- 9 unchanged lines hidden (view full) ---
173 new44 <<= 4;
174 }
175 pci_write_config(scp->dev, 0x40,
176 (pci_read_config(scp->dev, 0x40, 4) & ~mask40)|
177 new40, 4);
178 pci_write_config(scp->dev, 0x44,
179 (pci_read_config(scp->dev, 0x44, 4) & ~mask44)|
180 new44, 4);
181 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
182 return 0;
183 }
184 }
185 /* we could set PIO mode timings, but we assume the BIOS did that */
186 break;
187
188 case 0x12308086: /* Intel PIIX */
189 if (wdmamode >= 2 && apiomode >= 4) {
--- 5 unchanged lines hidden (view full) ---
195 /* Check for timing config usable for DMA on controller */
196 if (!((word40 & 0x3300) == 0x2300 &&
197 ((word40 >> (device == ATA_MASTER ? 0 : 4)) & 1) == 1))
198 break;
199
200 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
201 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
202 if (bootverbose)
203 printf("ata%d-%s: %s setting up WDMA2 mode on PIIX chip\n",
204 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
205 (error) ? "failed" : "success");
206 if (!error) {
207 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
208 return 0;
209 }
210 }
211 break;
212
213 case 0x522910b9: /* AcerLabs Aladdin IV/V */
214 /* the Aladdin doesn't support ATAPI DMA on both master & slave */
215 if (scp->devices & ATA_ATAPI_MASTER && scp->devices & ATA_ATAPI_SLAVE) {
216 printf("ata%d: Aladdin: two atapi devices on this channel, "
217 "DMA disabled\n", scp->lun);
218 break;
219 }
220 if (udmamode >= 2) {
221 int32_t word54 = pci_read_config(scp->dev, 0x54, 4);
222
223 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
224 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
225 if (bootverbose)
226 printf("ata%d-%s: %s setting up UDMA2 mode on Aladdin chip\n",
227 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
228 (error) ? "failed" : "success");
229 if (!error) {
230 word54 |= 0x5555;
231 word54 |= (0x0a << (16 + (scp->unit << 3) + (device << 2)));
232 pci_write_config(scp->dev, 0x54, word54, 4);
233 pci_write_config(scp->dev, 0x53,
234 pci_read_config(scp->dev, 0x53, 1) | 0x03, 1);
235 scp->flags |= ATA_ATAPI_DMA_RO;
236 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
237 return 0;
238 }
239 }
240 if (wdmamode >= 2 && apiomode >= 4) {
241 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
242 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
243 if (bootverbose)
244 printf("ata%d-%s: %s setting up WDMA2 mode on Aladdin chip\n",
245 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
246 (error) ? "failed" : "success");
247 if (!error) {
248 pci_write_config(scp->dev, 0x53,
249 pci_read_config(scp->dev, 0x53, 1) | 0x03, 1);
250 scp->flags |= ATA_ATAPI_DMA_RO;
251 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
252 return 0;
253 }
254 }
255 /* we could set PIO mode timings, but we assume the BIOS did that */
256 break;
257
258 case 0x05711106: /* VIA 82C571, 82C586, 82C596 & 82C686 */
259 case 0x74091022: /* AMD 756 */
260 /* UDMA modes on 82C686 */
261 if (ata_find_dev(scp->dev, 0x06861106)) {
262 if (udmamode >= 4) {
263 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
264 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
265 if (bootverbose)
266 printf("ata%d-%s: %s setting up UDMA4 mode on VIA chip\n",
267 scp->lun, (device == ATA_MASTER) ? "master":"slave",
268 (error) ? "failed" : "success");
269 if (!error) {
270 pci_write_config(scp->dev, 0x53 - devno, 0xe8, 1);
271 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
272 return 0;
273 }
274 }
275 if (udmamode >= 2) {
276 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
277 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
278 if (bootverbose)
279 printf("ata%d-%s: %s setting up UDMA2 mode on VIA chip\n",
280 scp->lun, (device == ATA_MASTER) ? "master":"slave",
281 (error) ? "failed" : "success");
282 if (!error) {
283 pci_write_config(scp->dev, 0x53 - devno, 0xea, 1);
284 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
285 return 0;
286 }
287 }
288 }
289
290 /* UDMA4 mode on AMD 756 */
291 if (udmamode >= 4 && scp->chiptype == 0x74091022) {
292 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
293 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
294 if (bootverbose)
295 printf("ata%d-%s: %s setting up UDMA4 mode on AMD chip\n",
296 scp->lun, (device == ATA_MASTER) ? "master":"slave",
297 (error) ? "failed" : "success");
298 if (!error) {
299 pci_write_config(scp->dev, 0x53 - devno, 0xc3, 1);
300 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
301 return 0;
302 }
303 }
304
305 /* UDMA2 mode only on 82C586 > rev1, 82C596, AMD 756 */
306 if ((udmamode >= 2 && ata_find_dev(scp->dev, 0x05861106) &&
307 pci_read_config(scp->dev, 0x08, 1) >= 0x01) ||
308 (udmamode >= 2 && ata_find_dev(scp->dev, 0x05961106)) ||
309 (udmamode >= 2 && scp->chiptype == 0x74091022)) {
310 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
311 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
312 if (bootverbose)
313 printf("ata%d-%s: %s setting up UDMA2 mode on %s chip\n",
314 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
315 (error) ? "failed" : "success",
316 (scp->chiptype == 0x74091022) ? "AMD" : "VIA");
317 if (!error) {
318 pci_write_config(scp->dev, 0x53 - devno, 0xc0, 1);
319 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
320 return 0;
321 }
322 }
323 if (wdmamode >= 2 && apiomode >= 4) {
324 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
325 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
326 if (bootverbose)
327 printf("ata%d-%s: %s setting up WDMA2 mode on %s chip\n",
328 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
329 (error) ? "failed" : "success",
330 (scp->chiptype == 0x74091022) ? "AMD" : "VIA");
331 if (!error) {
332 pci_write_config(scp->dev, 0x53 - devno, 0x82, 1);
333 pci_write_config(scp->dev, 0x4b - devno, 0x31, 1);
334 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
335 return 0;
336 }
337 }
338 /* we could set PIO mode timings, but we assume the BIOS did that */
339 break;
340
341 case 0x55131039: /* SiS 5591 */
342 if (udmamode >= 2) {
343 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
344 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
345 if (bootverbose)
346 printf("ata%d-%s: %s setting up UDMA2 mode on SiS chip\n",
347 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
348 (error) ? "failed" : "success");
349 if (!error) {
350 pci_write_config(scp->dev, 0x40 + (devno << 1), 0xa301, 2);
351 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
352 return 0;
353 }
354 }
355 if (wdmamode >=2 && apiomode >= 4) {
356 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
357 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
358 if (bootverbose)
359 printf("ata%d-%s: %s setting up WDMA2 mode on SiS chip\n",
360 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
361 (error) ? "failed" : "success");
362 if (!error) {
363 pci_write_config(scp->dev, 0x40 + (devno << 1), 0x0301, 2);
364 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
365 return 0;
366 }
367 }
368 /* we could set PIO mode timings, but we assume the BIOS did that */
369 break;
370
371 case 0x4d33105a: /* Promise Ultra33 / FastTrak33 controllers */
372 case 0x4d38105a: /* Promise Ultra66 / FastTrak66 controllers */
373 /* the Promise can only do DMA on ATA disks not on ATAPI devices */
374 if ((device == ATA_MASTER && scp->devices & ATA_ATAPI_MASTER) ||
375 (device == ATA_SLAVE && scp->devices & ATA_ATAPI_SLAVE))
376 break;
377
378 if (udmamode >=4 && scp->chiptype == 0x4d38105a &&
379 !(pci_read_config(scp->dev, 0x50, 2)&(scp->unit ? 1<<11 : 1<<10))) {
380 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
381 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
382 if (bootverbose)
383 printf("ata%d-%s: %s setting up UDMA4 mode on Promise chip\n",
384 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
385 (error) ? "failed" : "success");
386 if (!error) {
387 outb(scp->bmaddr+0x11, inl(scp->bmaddr+0x11) | scp->unit ? 8:2);
388 promise_timing(scp, devno, ATA_UDMA4);
389 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
390 return 0;
391 }
392 }
393 if (udmamode >= 2) {
394 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
395 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
396 if (bootverbose)
397 printf("ata%d-%s: %s setting up UDMA2 mode on Promise chip\n",
398 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
399 (error) ? "failed" : "success");
400 if (!error) {
401 promise_timing(scp, devno, ATA_UDMA2);
402 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
403 return 0;
404 }
405 }
406 if (wdmamode >= 2 && apiomode >= 4) {
407 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
408 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
409 if (bootverbose)
410 printf("ata%d-%s: %s setting up WDMA2 mode on Promise chip\n",
411 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
412 (error) ? "failed" : "success");
413 if (!error) {
414 promise_timing(scp, devno, ATA_WDMA2);
415 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
416 return 0;
417 }
418 }
419 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
420 ata_pio2mode(apiomode),
421 ATA_C_F_SETXFER, ATA_WAIT_READY);
422 if (bootverbose)
423 printf("ata%d-%s: %s setting up PIO%d mode on Promise chip\n",
424 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
425 (error) ? "failed" : "success",
426 (apiomode >= 0) ? apiomode : 0);
427 if (!error) {
428 promise_timing(scp, devno, ata_pio2mode(apiomode));
429 return 0;
430 }
431 break;
432
433 case 0x00041103: /* HighPoint HPT366 controller */
434 /* no ATAPI devices for now */
435 if ((device == ATA_MASTER && scp->devices & ATA_ATAPI_MASTER) ||
436 (device == ATA_SLAVE && scp->devices & ATA_ATAPI_SLAVE))
437 break;
438
439 if (udmamode >=4 && !(pci_read_config(scp->dev, 0x5a, 1) & 0x2)) {
440 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
441 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
442 if (bootverbose)
443 printf("ata%d-%s: %s setting up UDMA4 mode on HPT366 chip\n",
444 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
445 (error) ? "failed" : "success");
446 if (!error) {
447 hpt366_timing(scp, devno, ATA_UDMA4);
448 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
449 return 0;
450 }
451 }
452 if (udmamode >= 2) {
453 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
454 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
455 if (bootverbose)
456 printf("ata%d-%s: %s setting up UDMA2 mode on HPT366 chip\n",
457 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
458 (error) ? "failed" : "success");
459 if (!error) {
460 hpt366_timing(scp, devno, ATA_UDMA2);
461 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
462 return 0;
463 }
464 }
465 if (wdmamode >= 2 && apiomode >= 4) {
466 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
467 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
468 if (bootverbose)
469 printf("ata%d-%s: %s setting up WDMA2 mode on HPT366 chip\n",
470 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
471 (error) ? "failed" : "success");
472 if (!error) {
473 hpt366_timing(scp, devno, ATA_WDMA2);
474 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
475 return 0;
476 }
477 }
478 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
479 ata_pio2mode(apiomode),
480 ATA_C_F_SETXFER, ATA_WAIT_READY);
481 if (bootverbose)
482 printf("ata%d-%s: %s setting up PIO%d mode on HPT366 chip\n",
483 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
484 (error) ? "failed" : "success",
485 (apiomode >= 0) ? apiomode : 0);
486 if (!error) {
487 hpt366_timing(scp, devno, ata_pio2mode(apiomode));
488 return 0;
489 }
490 break;
491
492 default: /* unknown controller chip */
493 /* better not try generic DMA on ATAPI devices it almost never works */
--- 6 unchanged lines hidden (view full) ---
500#if MAYBE_NOT
501 && (inb(scp->bmaddr + ATA_BMSTAT_PORT) &
502 ((device == ATA_MASTER) ?
503 ATA_BMSTAT_DMA_MASTER : ATA_BMSTAT_DMA_SLAVE))) {
504#endif
505 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
506 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
507 if (bootverbose)
508 printf("ata%d-%s: %s setting up WDMA2 mode on generic chip\n",
509 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
510 (error) ? "failed" : "success");
511 if (!error) {
512 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
513 return 0;
514 }
515 }
516 }
517 free(dmatab, M_DEVBUF);
518 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
519 ata_pio2mode(apiomode), ATA_C_F_SETXFER,ATA_WAIT_READY);
520 if (bootverbose)
521 printf("ata%d-%s: %s setting up PIO%d mode on generic chip\n",
522 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
523 (error) ? "failed" : "success", (apiomode >= 0) ? apiomode : 0);
524 if (!error)
525 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ata_pio2mode(apiomode);
526 return -1;
527}
528
529int32_t
530ata_dmasetup(struct ata_softc *scp, int32_t device,
531 int8_t *data, int32_t count, int32_t flags)
532{
533 struct ata_dmaentry *dmatab;
534 u_int32_t dma_count, dma_base;
535 int32_t i = 0;
536
537 if (((uintptr_t)data & 1) || (count & 1))
538 return -1;
539
540 if (!count) {
541 printf("ata%d-%s: zero length DMA transfer attempted\n",
542 scp->lun, ((device == ATA_MASTER) ? "master" : "slave"));
543 return -1;
544 }
545
546 dmatab = scp->dmatab[(device == ATA_MASTER) ? 0 : 1];
547 dma_base = vtophys(data);
548 dma_count = MIN(count, (PAGE_SIZE - ((uintptr_t)data & PAGE_MASK)));
549 data += dma_count;
550 count -= dma_count;
551
552 while (count) {
553 dmatab[i].base = dma_base;
554 dmatab[i].count = (dma_count & 0xffff);
555 i++;
556 if (i >= ATA_DMA_ENTRIES) {
557 printf("ata%d-%s: too many segments in DMA table\n",
558 scp->lun, (device ? "slave" : "master"));
559 return -1;
560 }
561 dma_base = vtophys(data);
562 dma_count = MIN(count, PAGE_SIZE);
563 data += MIN(count, PAGE_SIZE);
564 count -= MIN(count, PAGE_SIZE);
565 }
566 dmatab[i].base = dma_base;
567 dmatab[i].count = (dma_count & 0xffff) | ATA_DMA_EOT;
568 outl(scp->bmaddr + ATA_BMDTP_PORT, vtophys(dmatab));
569 outb(scp->bmaddr + ATA_BMCMD_PORT, flags ? ATA_BMCMD_WRITE_READ:0);
570 outb(scp->bmaddr + ATA_BMSTAT_PORT, (inb(scp->bmaddr + ATA_BMSTAT_PORT) |
571 (ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR)));
572 return 0;
--- 126 unchanged lines hidden ---
2 * Copyright (c) 1998,1999,2000 S�ren Schmidt
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
--- 11 unchanged lines hidden (view full) ---
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 *
28 * $FreeBSD: head/sys/dev/ata/ata-dma.c 56138 2000-01-17 02:04:19Z sos $
29 */
30
31#include "pci.h"
32#include "apm.h"
33#include <sys/param.h>
34#include <sys/systm.h>
35#include <sys/buf.h>
36#include <sys/malloc.h>
--- 11 unchanged lines hidden (view full) ---
48#include <dev/ata/ata-all.h>
49#include <dev/ata/ata-disk.h>
50
51/* prototypes */
52static void promise_timing(struct ata_softc *, int32_t, int32_t);
53static void hpt366_timing(struct ata_softc *, int32_t, int32_t);
54
55/* misc defines */
56#define MIN(a,b) ((a)>(b)?(b):(a))
57#ifdef __alpha__
58#undef vtophys
59#define vtophys(va) alpha_XXX_dmamap((vm_offset_t)va)
60#endif
61
62#if NPCI > 0
63
64int32_t
65ata_dmainit(struct ata_softc *scp, int32_t device,
66 int32_t apiomode, int32_t wdmamode, int32_t udmamode)
67{
68 int32_t devno = (scp->unit << 1) + ((device == ATA_MASTER) ? 0 : 1);
69 int32_t error;
70 void *dmatab;
71
72 if (!scp->bmaddr)
73 return -1;
74
75 /* if simplex controller, only allow DMA on primary channel */
76 if (scp->unit == 1) {
77 outb(scp->bmaddr + ATA_BMSTAT_PORT, inb(scp->bmaddr + ATA_BMSTAT_PORT) &
78 (ATA_BMSTAT_DMA_MASTER | ATA_BMSTAT_DMA_SLAVE));
79 if (inb(scp->bmaddr + ATA_BMSTAT_PORT) & ATA_BMSTAT_DMA_SIMPLEX) {
80 printf("ata%d: simplex device, DMA on primary channel only\n",
81 scp->lun);
82 return -1;
83 }
84 }
85
86 if (!(dmatab = malloc(PAGE_SIZE, M_DEVBUF, M_NOWAIT)))
87 return -1;
88
89 if (((uintptr_t)dmatab >> PAGE_SHIFT) ^
90 (((uintptr_t)dmatab + PAGE_SIZE - 1) >> PAGE_SHIFT)) {
91 printf("ata%d-%s: dmatab crosses page boundary, no DMA\n",
92 scp->lun, (device == ATA_MASTER) ? "master" : "slave");
93 free(dmatab, M_DEVBUF);
94 return -1;
95 }
96 scp->dmatab[(device == ATA_MASTER) ? 0 : 1] = dmatab;
97
98 switch (scp->chiptype) {
99
100 case 0x71118086: /* Intel PIIX4 */
101 case 0x71998086: /* Intel PIIX4e */
102 case 0x24118086: /* Intel ICH */
103 case 0x24218086: /* Intel ICH0 */
104 if (udmamode >= 2) {
105 int32_t mask48, new48;
106
107 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
108 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
109 if (bootverbose)
110 printf("ata%d-%s: %s setting up UDMA2 mode on %s chip\n",
111 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
112 (error) ? "failed" : "success",
113 (scp->chiptype == 0x24118086) ? "ICH" :
114 (scp->chiptype == 0x24218086) ? "ICH0" :"PIIX4");
115 if (!error) {
116 mask48 = (1 << devno) + (3 << (16 + (devno << 2)));
117 new48 = (1 << devno) + (2 << (16 + (devno << 2)));
118 pci_write_config(scp->dev, 0x48,
119 (pci_read_config(scp->dev, 0x48, 4) &
120 ~mask48) | new48, 4);
121 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
122 return 0;
123 }
124 }
125 /* FALLTHROUGH */
126
127 case 0x70108086: /* Intel PIIX3 */
128 if (wdmamode >= 2 && apiomode >= 4) {
129 int32_t mask40, new40, mask44, new44;
--- 12 unchanged lines hidden (view full) ---
142 }
143 new40 |= 0x40004000;
144 pci_write_config(scp->dev, 0x40, new40, 4);
145 pci_write_config(scp->dev, 0x44, new44, 4);
146 }
147 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
148 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
149 if (bootverbose)
150 printf("ata%d-%s: %s setting up WDMA2 mode on %s chip\n",
151 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
152 (error) ? "failed" : "success",
153 (scp->chiptype == 0x70108086) ? "PIIX3" :
154 (scp->chiptype == 0x24118086) ? "ICH" :
155 (scp->chiptype == 0x24218086) ? "ICH0" :"PIIX4");
156 if (!error) {
157 if (device == ATA_MASTER) {
158 mask40 = 0x0000330f;
159 new40 = 0x00002307;
160 mask44 = 0;
161 new44 = 0;
162 }
163 else {
--- 9 unchanged lines hidden (view full) ---
173 new44 <<= 4;
174 }
175 pci_write_config(scp->dev, 0x40,
176 (pci_read_config(scp->dev, 0x40, 4) & ~mask40)|
177 new40, 4);
178 pci_write_config(scp->dev, 0x44,
179 (pci_read_config(scp->dev, 0x44, 4) & ~mask44)|
180 new44, 4);
181 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
182 return 0;
183 }
184 }
185 /* we could set PIO mode timings, but we assume the BIOS did that */
186 break;
187
188 case 0x12308086: /* Intel PIIX */
189 if (wdmamode >= 2 && apiomode >= 4) {
--- 5 unchanged lines hidden (view full) ---
195 /* Check for timing config usable for DMA on controller */
196 if (!((word40 & 0x3300) == 0x2300 &&
197 ((word40 >> (device == ATA_MASTER ? 0 : 4)) & 1) == 1))
198 break;
199
200 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
201 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
202 if (bootverbose)
203 printf("ata%d-%s: %s setting up WDMA2 mode on PIIX chip\n",
204 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
205 (error) ? "failed" : "success");
206 if (!error) {
207 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
208 return 0;
209 }
210 }
211 break;
212
213 case 0x522910b9: /* AcerLabs Aladdin IV/V */
214 /* the Aladdin doesn't support ATAPI DMA on both master & slave */
215 if (scp->devices & ATA_ATAPI_MASTER && scp->devices & ATA_ATAPI_SLAVE) {
216 printf("ata%d: Aladdin: two atapi devices on this channel, "
217 "DMA disabled\n", scp->lun);
218 break;
219 }
220 if (udmamode >= 2) {
221 int32_t word54 = pci_read_config(scp->dev, 0x54, 4);
222
223 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
224 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
225 if (bootverbose)
226 printf("ata%d-%s: %s setting up UDMA2 mode on Aladdin chip\n",
227 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
228 (error) ? "failed" : "success");
229 if (!error) {
230 word54 |= 0x5555;
231 word54 |= (0x0a << (16 + (scp->unit << 3) + (device << 2)));
232 pci_write_config(scp->dev, 0x54, word54, 4);
233 pci_write_config(scp->dev, 0x53,
234 pci_read_config(scp->dev, 0x53, 1) | 0x03, 1);
235 scp->flags |= ATA_ATAPI_DMA_RO;
236 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
237 return 0;
238 }
239 }
240 if (wdmamode >= 2 && apiomode >= 4) {
241 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
242 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
243 if (bootverbose)
244 printf("ata%d-%s: %s setting up WDMA2 mode on Aladdin chip\n",
245 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
246 (error) ? "failed" : "success");
247 if (!error) {
248 pci_write_config(scp->dev, 0x53,
249 pci_read_config(scp->dev, 0x53, 1) | 0x03, 1);
250 scp->flags |= ATA_ATAPI_DMA_RO;
251 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
252 return 0;
253 }
254 }
255 /* we could set PIO mode timings, but we assume the BIOS did that */
256 break;
257
258 case 0x05711106: /* VIA 82C571, 82C586, 82C596 & 82C686 */
259 case 0x74091022: /* AMD 756 */
260 /* UDMA modes on 82C686 */
261 if (ata_find_dev(scp->dev, 0x06861106)) {
262 if (udmamode >= 4) {
263 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
264 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
265 if (bootverbose)
266 printf("ata%d-%s: %s setting up UDMA4 mode on VIA chip\n",
267 scp->lun, (device == ATA_MASTER) ? "master":"slave",
268 (error) ? "failed" : "success");
269 if (!error) {
270 pci_write_config(scp->dev, 0x53 - devno, 0xe8, 1);
271 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
272 return 0;
273 }
274 }
275 if (udmamode >= 2) {
276 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
277 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
278 if (bootverbose)
279 printf("ata%d-%s: %s setting up UDMA2 mode on VIA chip\n",
280 scp->lun, (device == ATA_MASTER) ? "master":"slave",
281 (error) ? "failed" : "success");
282 if (!error) {
283 pci_write_config(scp->dev, 0x53 - devno, 0xea, 1);
284 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
285 return 0;
286 }
287 }
288 }
289
290 /* UDMA4 mode on AMD 756 */
291 if (udmamode >= 4 && scp->chiptype == 0x74091022) {
292 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
293 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
294 if (bootverbose)
295 printf("ata%d-%s: %s setting up UDMA4 mode on AMD chip\n",
296 scp->lun, (device == ATA_MASTER) ? "master":"slave",
297 (error) ? "failed" : "success");
298 if (!error) {
299 pci_write_config(scp->dev, 0x53 - devno, 0xc3, 1);
300 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
301 return 0;
302 }
303 }
304
305 /* UDMA2 mode only on 82C586 > rev1, 82C596, AMD 756 */
306 if ((udmamode >= 2 && ata_find_dev(scp->dev, 0x05861106) &&
307 pci_read_config(scp->dev, 0x08, 1) >= 0x01) ||
308 (udmamode >= 2 && ata_find_dev(scp->dev, 0x05961106)) ||
309 (udmamode >= 2 && scp->chiptype == 0x74091022)) {
310 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
311 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
312 if (bootverbose)
313 printf("ata%d-%s: %s setting up UDMA2 mode on %s chip\n",
314 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
315 (error) ? "failed" : "success",
316 (scp->chiptype == 0x74091022) ? "AMD" : "VIA");
317 if (!error) {
318 pci_write_config(scp->dev, 0x53 - devno, 0xc0, 1);
319 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
320 return 0;
321 }
322 }
323 if (wdmamode >= 2 && apiomode >= 4) {
324 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
325 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
326 if (bootverbose)
327 printf("ata%d-%s: %s setting up WDMA2 mode on %s chip\n",
328 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
329 (error) ? "failed" : "success",
330 (scp->chiptype == 0x74091022) ? "AMD" : "VIA");
331 if (!error) {
332 pci_write_config(scp->dev, 0x53 - devno, 0x82, 1);
333 pci_write_config(scp->dev, 0x4b - devno, 0x31, 1);
334 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
335 return 0;
336 }
337 }
338 /* we could set PIO mode timings, but we assume the BIOS did that */
339 break;
340
341 case 0x55131039: /* SiS 5591 */
342 if (udmamode >= 2) {
343 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
344 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
345 if (bootverbose)
346 printf("ata%d-%s: %s setting up UDMA2 mode on SiS chip\n",
347 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
348 (error) ? "failed" : "success");
349 if (!error) {
350 pci_write_config(scp->dev, 0x40 + (devno << 1), 0xa301, 2);
351 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
352 return 0;
353 }
354 }
355 if (wdmamode >=2 && apiomode >= 4) {
356 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
357 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
358 if (bootverbose)
359 printf("ata%d-%s: %s setting up WDMA2 mode on SiS chip\n",
360 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
361 (error) ? "failed" : "success");
362 if (!error) {
363 pci_write_config(scp->dev, 0x40 + (devno << 1), 0x0301, 2);
364 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
365 return 0;
366 }
367 }
368 /* we could set PIO mode timings, but we assume the BIOS did that */
369 break;
370
371 case 0x4d33105a: /* Promise Ultra33 / FastTrak33 controllers */
372 case 0x4d38105a: /* Promise Ultra66 / FastTrak66 controllers */
373 /* the Promise can only do DMA on ATA disks not on ATAPI devices */
374 if ((device == ATA_MASTER && scp->devices & ATA_ATAPI_MASTER) ||
375 (device == ATA_SLAVE && scp->devices & ATA_ATAPI_SLAVE))
376 break;
377
378 if (udmamode >=4 && scp->chiptype == 0x4d38105a &&
379 !(pci_read_config(scp->dev, 0x50, 2)&(scp->unit ? 1<<11 : 1<<10))) {
380 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
381 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
382 if (bootverbose)
383 printf("ata%d-%s: %s setting up UDMA4 mode on Promise chip\n",
384 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
385 (error) ? "failed" : "success");
386 if (!error) {
387 outb(scp->bmaddr+0x11, inl(scp->bmaddr+0x11) | scp->unit ? 8:2);
388 promise_timing(scp, devno, ATA_UDMA4);
389 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
390 return 0;
391 }
392 }
393 if (udmamode >= 2) {
394 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
395 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
396 if (bootverbose)
397 printf("ata%d-%s: %s setting up UDMA2 mode on Promise chip\n",
398 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
399 (error) ? "failed" : "success");
400 if (!error) {
401 promise_timing(scp, devno, ATA_UDMA2);
402 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
403 return 0;
404 }
405 }
406 if (wdmamode >= 2 && apiomode >= 4) {
407 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
408 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
409 if (bootverbose)
410 printf("ata%d-%s: %s setting up WDMA2 mode on Promise chip\n",
411 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
412 (error) ? "failed" : "success");
413 if (!error) {
414 promise_timing(scp, devno, ATA_WDMA2);
415 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
416 return 0;
417 }
418 }
419 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
420 ata_pio2mode(apiomode),
421 ATA_C_F_SETXFER, ATA_WAIT_READY);
422 if (bootverbose)
423 printf("ata%d-%s: %s setting up PIO%d mode on Promise chip\n",
424 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
425 (error) ? "failed" : "success",
426 (apiomode >= 0) ? apiomode : 0);
427 if (!error) {
428 promise_timing(scp, devno, ata_pio2mode(apiomode));
429 return 0;
430 }
431 break;
432
433 case 0x00041103: /* HighPoint HPT366 controller */
434 /* no ATAPI devices for now */
435 if ((device == ATA_MASTER && scp->devices & ATA_ATAPI_MASTER) ||
436 (device == ATA_SLAVE && scp->devices & ATA_ATAPI_SLAVE))
437 break;
438
439 if (udmamode >=4 && !(pci_read_config(scp->dev, 0x5a, 1) & 0x2)) {
440 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
441 ATA_UDMA4, ATA_C_F_SETXFER, ATA_WAIT_READY);
442 if (bootverbose)
443 printf("ata%d-%s: %s setting up UDMA4 mode on HPT366 chip\n",
444 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
445 (error) ? "failed" : "success");
446 if (!error) {
447 hpt366_timing(scp, devno, ATA_UDMA4);
448 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA4;
449 return 0;
450 }
451 }
452 if (udmamode >= 2) {
453 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
454 ATA_UDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
455 if (bootverbose)
456 printf("ata%d-%s: %s setting up UDMA2 mode on HPT366 chip\n",
457 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
458 (error) ? "failed" : "success");
459 if (!error) {
460 hpt366_timing(scp, devno, ATA_UDMA2);
461 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_UDMA2;
462 return 0;
463 }
464 }
465 if (wdmamode >= 2 && apiomode >= 4) {
466 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
467 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
468 if (bootverbose)
469 printf("ata%d-%s: %s setting up WDMA2 mode on HPT366 chip\n",
470 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
471 (error) ? "failed" : "success");
472 if (!error) {
473 hpt366_timing(scp, devno, ATA_WDMA2);
474 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
475 return 0;
476 }
477 }
478 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
479 ata_pio2mode(apiomode),
480 ATA_C_F_SETXFER, ATA_WAIT_READY);
481 if (bootverbose)
482 printf("ata%d-%s: %s setting up PIO%d mode on HPT366 chip\n",
483 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
484 (error) ? "failed" : "success",
485 (apiomode >= 0) ? apiomode : 0);
486 if (!error) {
487 hpt366_timing(scp, devno, ata_pio2mode(apiomode));
488 return 0;
489 }
490 break;
491
492 default: /* unknown controller chip */
493 /* better not try generic DMA on ATAPI devices it almost never works */
--- 6 unchanged lines hidden (view full) ---
500#if MAYBE_NOT
501 && (inb(scp->bmaddr + ATA_BMSTAT_PORT) &
502 ((device == ATA_MASTER) ?
503 ATA_BMSTAT_DMA_MASTER : ATA_BMSTAT_DMA_SLAVE))) {
504#endif
505 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
506 ATA_WDMA2, ATA_C_F_SETXFER, ATA_WAIT_READY);
507 if (bootverbose)
508 printf("ata%d-%s: %s setting up WDMA2 mode on generic chip\n",
509 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
510 (error) ? "failed" : "success");
511 if (!error) {
512 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ATA_WDMA2;
513 return 0;
514 }
515 }
516 }
517 free(dmatab, M_DEVBUF);
518 error = ata_command(scp, device, ATA_C_SETFEATURES, 0, 0, 0,
519 ata_pio2mode(apiomode), ATA_C_F_SETXFER,ATA_WAIT_READY);
520 if (bootverbose)
521 printf("ata%d-%s: %s setting up PIO%d mode on generic chip\n",
522 scp->lun, (device == ATA_MASTER) ? "master" : "slave",
523 (error) ? "failed" : "success", (apiomode >= 0) ? apiomode : 0);
524 if (!error)
525 scp->mode[(device == ATA_MASTER) ? 0 : 1] = ata_pio2mode(apiomode);
526 return -1;
527}
528
529int32_t
530ata_dmasetup(struct ata_softc *scp, int32_t device,
531 int8_t *data, int32_t count, int32_t flags)
532{
533 struct ata_dmaentry *dmatab;
534 u_int32_t dma_count, dma_base;
535 int32_t i = 0;
536
537 if (((uintptr_t)data & 1) || (count & 1))
538 return -1;
539
540 if (!count) {
541 printf("ata%d-%s: zero length DMA transfer attempted\n",
542 scp->lun, ((device == ATA_MASTER) ? "master" : "slave"));
543 return -1;
544 }
545
546 dmatab = scp->dmatab[(device == ATA_MASTER) ? 0 : 1];
547 dma_base = vtophys(data);
548 dma_count = MIN(count, (PAGE_SIZE - ((uintptr_t)data & PAGE_MASK)));
549 data += dma_count;
550 count -= dma_count;
551
552 while (count) {
553 dmatab[i].base = dma_base;
554 dmatab[i].count = (dma_count & 0xffff);
555 i++;
556 if (i >= ATA_DMA_ENTRIES) {
557 printf("ata%d-%s: too many segments in DMA table\n",
558 scp->lun, (device ? "slave" : "master"));
559 return -1;
560 }
561 dma_base = vtophys(data);
562 dma_count = MIN(count, PAGE_SIZE);
563 data += MIN(count, PAGE_SIZE);
564 count -= MIN(count, PAGE_SIZE);
565 }
566 dmatab[i].base = dma_base;
567 dmatab[i].count = (dma_count & 0xffff) | ATA_DMA_EOT;
568 outl(scp->bmaddr + ATA_BMDTP_PORT, vtophys(dmatab));
569 outb(scp->bmaddr + ATA_BMCMD_PORT, flags ? ATA_BMCMD_WRITE_READ:0);
570 outb(scp->bmaddr + ATA_BMSTAT_PORT, (inb(scp->bmaddr + ATA_BMSTAT_PORT) |
571 (ATA_BMSTAT_INTERRUPT | ATA_BMSTAT_ERROR)));
572 return 0;
--- 126 unchanged lines hidden ---