[ARM] 4127/1: Flush the prefetch buffer after changing the DACR
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / ide / ide-lib.c
CommitLineData
1da177e4
LT
1#include <linux/module.h>
2#include <linux/types.h>
3#include <linux/string.h>
4#include <linux/kernel.h>
5#include <linux/timer.h>
6#include <linux/mm.h>
7#include <linux/interrupt.h>
8#include <linux/major.h>
9#include <linux/errno.h>
10#include <linux/genhd.h>
11#include <linux/blkpg.h>
12#include <linux/slab.h>
13#include <linux/pci.h>
14#include <linux/delay.h>
15#include <linux/hdreg.h>
16#include <linux/ide.h>
17#include <linux/bitops.h>
18
19#include <asm/byteorder.h>
20#include <asm/irq.h>
21#include <asm/uaccess.h>
22#include <asm/io.h>
23
24/*
25 * IDE library routines. These are plug in code that most
26 * drivers can use but occasionally may be weird enough
27 * to want to do their own thing with
28 *
29 * Add common non I/O op stuff here. Make sure it has proper
30 * kernel-doc function headers or your patch will be rejected
31 */
32
33
34/**
35 * ide_xfer_verbose - return IDE mode names
36 * @xfer_rate: rate to name
37 *
38 * Returns a constant string giving the name of the mode
39 * requested.
40 */
41
42char *ide_xfer_verbose (u8 xfer_rate)
43{
44 switch(xfer_rate) {
45 case XFER_UDMA_7: return("UDMA 7");
46 case XFER_UDMA_6: return("UDMA 6");
47 case XFER_UDMA_5: return("UDMA 5");
48 case XFER_UDMA_4: return("UDMA 4");
49 case XFER_UDMA_3: return("UDMA 3");
50 case XFER_UDMA_2: return("UDMA 2");
51 case XFER_UDMA_1: return("UDMA 1");
52 case XFER_UDMA_0: return("UDMA 0");
53 case XFER_MW_DMA_2: return("MW DMA 2");
54 case XFER_MW_DMA_1: return("MW DMA 1");
55 case XFER_MW_DMA_0: return("MW DMA 0");
56 case XFER_SW_DMA_2: return("SW DMA 2");
57 case XFER_SW_DMA_1: return("SW DMA 1");
58 case XFER_SW_DMA_0: return("SW DMA 0");
59 case XFER_PIO_4: return("PIO 4");
60 case XFER_PIO_3: return("PIO 3");
61 case XFER_PIO_2: return("PIO 2");
62 case XFER_PIO_1: return("PIO 1");
63 case XFER_PIO_0: return("PIO 0");
64 case XFER_PIO_SLOW: return("PIO SLOW");
65 default: return("XFER ERROR");
66 }
67}
68
69EXPORT_SYMBOL(ide_xfer_verbose);
70
71/**
72 * ide_dma_speed - compute DMA speed
73 * @drive: drive
0750508a 74 * @mode: modes available
1da177e4
LT
75 *
76 * Checks the drive capabilities and returns the speed to use
0750508a
SS
77 * for the DMA transfer. Returns 0 if the drive is incapable
78 * of DMA transfers.
1da177e4
LT
79 */
80
81u8 ide_dma_speed(ide_drive_t *drive, u8 mode)
82{
83 struct hd_driveid *id = drive->id;
84 ide_hwif_t *hwif = HWIF(drive);
0750508a 85 u8 ultra_mask, mwdma_mask, swdma_mask;
1da177e4
LT
86 u8 speed = 0;
87
88 if (drive->media != ide_disk && hwif->atapi_dma == 0)
89 return 0;
90
0750508a
SS
91 /* Capable of UltraDMA modes? */
92 ultra_mask = id->dma_ultra & hwif->ultra_mask;
93
94 if (!(id->field_valid & 4))
95 mode = 0; /* fallback to MW/SW DMA if no UltraDMA */
96
97 switch (mode) {
98 case 4:
99 if (ultra_mask & 0x40) {
100 speed = XFER_UDMA_6;
101 break;
102 }
103 case 3:
104 if (ultra_mask & 0x20) {
105 speed = XFER_UDMA_5;
106 break;
107 }
108 case 2:
109 if (ultra_mask & 0x10) {
110 speed = XFER_UDMA_4;
111 break;
112 }
113 if (ultra_mask & 0x08) {
114 speed = XFER_UDMA_3;
115 break;
116 }
117 case 1:
118 if (ultra_mask & 0x04) {
119 speed = XFER_UDMA_2;
120 break;
121 }
122 if (ultra_mask & 0x02) {
123 speed = XFER_UDMA_1;
124 break;
125 }
126 if (ultra_mask & 0x01) {
127 speed = XFER_UDMA_0;
128 break;
129 }
130 case 0:
131 mwdma_mask = id->dma_mword & hwif->mwdma_mask;
132
133 if (mwdma_mask & 0x04) {
134 speed = XFER_MW_DMA_2;
135 break;
136 }
137 if (mwdma_mask & 0x02) {
138 speed = XFER_MW_DMA_1;
139 break;
140 }
141 if (mwdma_mask & 0x01) {
142 speed = XFER_MW_DMA_0;
143 break;
144 }
1da177e4 145
0750508a
SS
146 swdma_mask = id->dma_1word & hwif->swdma_mask;
147
148 if (swdma_mask & 0x04) {
149 speed = XFER_SW_DMA_2;
150 break;
151 }
152 if (swdma_mask & 0x02) {
153 speed = XFER_SW_DMA_1;
154 break;
155 }
156 if (swdma_mask & 0x01) {
157 speed = XFER_SW_DMA_0;
158 break;
159 }
160 }
1da177e4
LT
161
162 return speed;
163}
1da177e4
LT
164EXPORT_SYMBOL(ide_dma_speed);
165
166
167/**
168 * ide_rate_filter - return best speed for mode
169 * @mode: modes available
170 * @speed: desired speed
171 *
172 * Given the available DMA/UDMA mode this function returns
173 * the best available speed at or below the speed requested.
174 */
175
176u8 ide_rate_filter (u8 mode, u8 speed)
177{
178#ifdef CONFIG_BLK_DEV_IDEDMA
179 static u8 speed_max[] = {
180 XFER_MW_DMA_2, XFER_UDMA_2, XFER_UDMA_4,
181 XFER_UDMA_5, XFER_UDMA_6
182 };
183
184// printk("%s: mode 0x%02x, speed 0x%02x\n", __FUNCTION__, mode, speed);
185
186 /* So that we remember to update this if new modes appear */
125e1874 187 BUG_ON(mode > 4);
1da177e4
LT
188 return min(speed, speed_max[mode]);
189#else /* !CONFIG_BLK_DEV_IDEDMA */
190 return min(speed, (u8)XFER_PIO_4);
191#endif /* CONFIG_BLK_DEV_IDEDMA */
192}
193
194EXPORT_SYMBOL(ide_rate_filter);
195
196int ide_dma_enable (ide_drive_t *drive)
197{
198 ide_hwif_t *hwif = HWIF(drive);
199 struct hd_driveid *id = drive->id;
200
201 return ((int) ((((id->dma_ultra >> 8) & hwif->ultra_mask) ||
202 ((id->dma_mword >> 8) & hwif->mwdma_mask) ||
203 ((id->dma_1word >> 8) & hwif->swdma_mask)) ? 1 : 0));
204}
205
206EXPORT_SYMBOL(ide_dma_enable);
207
208/*
209 * Standard (generic) timings for PIO modes, from ATA2 specification.
210 * These timings are for access to the IDE data port register *only*.
211 * Some drives may specify a mode, while also specifying a different
212 * value for cycle_time (from drive identification data).
213 */
214const ide_pio_timings_t ide_pio_timings[6] = {
215 { 70, 165, 600 }, /* PIO Mode 0 */
216 { 50, 125, 383 }, /* PIO Mode 1 */
217 { 30, 100, 240 }, /* PIO Mode 2 */
218 { 30, 80, 180 }, /* PIO Mode 3 with IORDY */
219 { 25, 70, 120 }, /* PIO Mode 4 with IORDY */
220 { 20, 50, 100 } /* PIO Mode 5 with IORDY (nonstandard) */
221};
222
223EXPORT_SYMBOL_GPL(ide_pio_timings);
224
225/*
226 * Shared data/functions for determining best PIO mode for an IDE drive.
227 * Most of this stuff originally lived in cmd640.c, and changes to the
228 * ide_pio_blacklist[] table should be made with EXTREME CAUTION to avoid
229 * breaking the fragile cmd640.c support.
230 */
231
232/*
233 * Black list. Some drives incorrectly report their maximal PIO mode,
234 * at least in respect to CMD640. Here we keep info on some known drives.
235 */
236static struct ide_pio_info {
237 const char *name;
238 int pio;
239} ide_pio_blacklist [] = {
240/* { "Conner Peripherals 1275MB - CFS1275A", 4 }, */
241 { "Conner Peripherals 540MB - CFS540A", 3 },
242
243 { "WDC AC2700", 3 },
244 { "WDC AC2540", 3 },
245 { "WDC AC2420", 3 },
246 { "WDC AC2340", 3 },
247 { "WDC AC2250", 0 },
248 { "WDC AC2200", 0 },
249 { "WDC AC21200", 4 },
250 { "WDC AC2120", 0 },
251 { "WDC AC2850", 3 },
252 { "WDC AC1270", 3 },
253 { "WDC AC1170", 1 },
254 { "WDC AC1210", 1 },
255 { "WDC AC280", 0 },
256/* { "WDC AC21000", 4 }, */
257 { "WDC AC31000", 3 },
258 { "WDC AC31200", 3 },
259/* { "WDC AC31600", 4 }, */
260
261 { "Maxtor 7131 AT", 1 },
262 { "Maxtor 7171 AT", 1 },
263 { "Maxtor 7213 AT", 1 },
264 { "Maxtor 7245 AT", 1 },
265 { "Maxtor 7345 AT", 1 },
266 { "Maxtor 7546 AT", 3 },
267 { "Maxtor 7540 AV", 3 },
268
269 { "SAMSUNG SHD-3121A", 1 },
270 { "SAMSUNG SHD-3122A", 1 },
271 { "SAMSUNG SHD-3172A", 1 },
272
273/* { "ST51080A", 4 },
274 * { "ST51270A", 4 },
275 * { "ST31220A", 4 },
276 * { "ST31640A", 4 },
277 * { "ST32140A", 4 },
278 * { "ST3780A", 4 },
279 */
280 { "ST5660A", 3 },
281 { "ST3660A", 3 },
282 { "ST3630A", 3 },
283 { "ST3655A", 3 },
284 { "ST3391A", 3 },
285 { "ST3390A", 1 },
286 { "ST3600A", 1 },
287 { "ST3290A", 0 },
288 { "ST3144A", 0 },
289 { "ST3491A", 1 }, /* reports 3, should be 1 or 2 (depending on */
290 /* drive) according to Seagates FIND-ATA program */
291
292 { "QUANTUM ELS127A", 0 },
293 { "QUANTUM ELS170A", 0 },
294 { "QUANTUM LPS240A", 0 },
295 { "QUANTUM LPS210A", 3 },
296 { "QUANTUM LPS270A", 3 },
297 { "QUANTUM LPS365A", 3 },
298 { "QUANTUM LPS540A", 3 },
299 { "QUANTUM LIGHTNING 540A", 3 },
300 { "QUANTUM LIGHTNING 730A", 3 },
301
302 { "QUANTUM FIREBALL_540", 3 }, /* Older Quantum Fireballs don't work */
303 { "QUANTUM FIREBALL_640", 3 },
304 { "QUANTUM FIREBALL_1080", 3 },
305 { "QUANTUM FIREBALL_1280", 3 },
306 { NULL, 0 }
307};
308
309/**
310 * ide_scan_pio_blacklist - check for a blacklisted drive
311 * @model: Drive model string
312 *
313 * This routine searches the ide_pio_blacklist for an entry
314 * matching the start/whole of the supplied model name.
315 *
316 * Returns -1 if no match found.
317 * Otherwise returns the recommended PIO mode from ide_pio_blacklist[].
318 */
319
320static int ide_scan_pio_blacklist (char *model)
321{
322 struct ide_pio_info *p;
323
324 for (p = ide_pio_blacklist; p->name != NULL; p++) {
325 if (strncmp(p->name, model, strlen(p->name)) == 0)
326 return p->pio;
327 }
328 return -1;
329}
330
331/**
332 * ide_get_best_pio_mode - get PIO mode from drive
333 * @driver: drive to consider
334 * @mode_wanted: preferred mode
335 * @max_mode: highest allowed
336 * @d: pio data
337 *
338 * This routine returns the recommended PIO settings for a given drive,
339 * based on the drive->id information and the ide_pio_blacklist[].
340 * This is used by most chipset support modules when "auto-tuning".
341 *
342 * Drive PIO mode auto selection
343 */
344
345u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_pio_data_t *d)
346{
347 int pio_mode;
348 int cycle_time = 0;
349 int use_iordy = 0;
350 struct hd_driveid* id = drive->id;
351 int overridden = 0;
352 int blacklisted = 0;
353
354 if (mode_wanted != 255) {
355 pio_mode = mode_wanted;
356 } else if (!drive->id) {
357 pio_mode = 0;
358 } else if ((pio_mode = ide_scan_pio_blacklist(id->model)) != -1) {
359 overridden = 1;
360 blacklisted = 1;
361 use_iordy = (pio_mode > 2);
362 } else {
363 pio_mode = id->tPIO;
364 if (pio_mode > 2) { /* 2 is maximum allowed tPIO value */
365 pio_mode = 2;
366 overridden = 1;
367 }
368 if (id->field_valid & 2) { /* drive implements ATA2? */
369 if (id->capability & 8) { /* drive supports use_iordy? */
370 use_iordy = 1;
371 cycle_time = id->eide_pio_iordy;
372 if (id->eide_pio_modes & 7) {
373 overridden = 0;
374 if (id->eide_pio_modes & 4)
375 pio_mode = 5;
376 else if (id->eide_pio_modes & 2)
377 pio_mode = 4;
378 else
379 pio_mode = 3;
380 }
381 } else {
382 cycle_time = id->eide_pio;
383 }
384 }
385
386#if 0
387 if (drive->id->major_rev_num & 0x0004) printk("ATA-2 ");
388#endif
389
390 /*
391 * Conservative "downgrade" for all pre-ATA2 drives
392 */
393 if (pio_mode && pio_mode < 4) {
394 pio_mode--;
395 overridden = 1;
396#if 0
397 use_iordy = (pio_mode > 2);
398#endif
399 if (cycle_time && cycle_time < ide_pio_timings[pio_mode].cycle_time)
400 cycle_time = 0; /* use standard timing */
401 }
402 }
403 if (pio_mode > max_mode) {
404 pio_mode = max_mode;
405 cycle_time = 0;
406 }
407 if (d) {
408 d->pio_mode = pio_mode;
409 d->cycle_time = cycle_time ? cycle_time : ide_pio_timings[pio_mode].cycle_time;
410 d->use_iordy = use_iordy;
411 d->overridden = overridden;
412 d->blacklisted = blacklisted;
413 }
414 return pio_mode;
415}
416
417EXPORT_SYMBOL_GPL(ide_get_best_pio_mode);
418
419/**
420 * ide_toggle_bounce - handle bounce buffering
421 * @drive: drive to update
422 * @on: on/off boolean
423 *
424 * Enable or disable bounce buffering for the device. Drives move
425 * between PIO and DMA and that changes the rules we need.
426 */
427
428void ide_toggle_bounce(ide_drive_t *drive, int on)
429{
430 u64 addr = BLK_BOUNCE_HIGH; /* dma64_addr_t */
431
6593178d
JB
432 if (!PCI_DMA_BUS_IS_PHYS) {
433 addr = BLK_BOUNCE_ANY;
434 } else if (on && drive->media == ide_disk) {
435 if (HWIF(drive)->pci_dev)
1da177e4
LT
436 addr = HWIF(drive)->pci_dev->dma_mask;
437 }
438
439 if (drive->queue)
440 blk_queue_bounce_limit(drive->queue, addr);
441}
442
443/**
444 * ide_set_xfer_rate - set transfer rate
445 * @drive: drive to set
446 * @speed: speed to attempt to set
447 *
448 * General helper for setting the speed of an IDE device. This
449 * function knows about user enforced limits from the configuration
450 * which speedproc() does not. High level drivers should never
451 * invoke speedproc() directly.
452 */
453
454int ide_set_xfer_rate(ide_drive_t *drive, u8 rate)
455{
456#ifndef CONFIG_BLK_DEV_IDEDMA
457 rate = min(rate, (u8) XFER_PIO_4);
458#endif
459 if(HWIF(drive)->speedproc)
460 return HWIF(drive)->speedproc(drive, rate);
461 else
462 return -1;
463}
464
465EXPORT_SYMBOL_GPL(ide_set_xfer_rate);
466
467static void ide_dump_opcode(ide_drive_t *drive)
468{
469 struct request *rq;
470 u8 opcode = 0;
471 int found = 0;
472
473 spin_lock(&ide_lock);
474 rq = NULL;
475 if (HWGROUP(drive))
476 rq = HWGROUP(drive)->rq;
477 spin_unlock(&ide_lock);
478 if (!rq)
479 return;
4aff5e23
JA
480 if (rq->cmd_type == REQ_TYPE_ATA_CMD ||
481 rq->cmd_type == REQ_TYPE_ATA_TASK) {
1da177e4
LT
482 char *args = rq->buffer;
483 if (args) {
484 opcode = args[0];
485 found = 1;
486 }
4aff5e23 487 } else if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE) {
1da177e4
LT
488 ide_task_t *args = rq->special;
489 if (args) {
490 task_struct_t *tf = (task_struct_t *) args->tfRegister;
491 opcode = tf->command;
492 found = 1;
493 }
494 }
495
496 printk("ide: failed opcode was: ");
497 if (!found)
498 printk("unknown\n");
499 else
500 printk("0x%02x\n", opcode);
501}
502
503static u8 ide_dump_ata_status(ide_drive_t *drive, const char *msg, u8 stat)
504{
505 ide_hwif_t *hwif = HWIF(drive);
506 unsigned long flags;
507 u8 err = 0;
508
3d1c1cc9 509 local_irq_save(flags);
13bbbf28 510 printk("%s: %s: status=0x%02x { ", drive->name, msg, stat);
1da177e4
LT
511 if (stat & BUSY_STAT)
512 printk("Busy ");
513 else {
514 if (stat & READY_STAT) printk("DriveReady ");
515 if (stat & WRERR_STAT) printk("DeviceFault ");
516 if (stat & SEEK_STAT) printk("SeekComplete ");
517 if (stat & DRQ_STAT) printk("DataRequest ");
518 if (stat & ECC_STAT) printk("CorrectedError ");
519 if (stat & INDEX_STAT) printk("Index ");
520 if (stat & ERR_STAT) printk("Error ");
521 }
13bbbf28 522 printk("}\n");
1da177e4
LT
523 if ((stat & (BUSY_STAT|ERR_STAT)) == ERR_STAT) {
524 err = hwif->INB(IDE_ERROR_REG);
13bbbf28 525 printk("%s: %s: error=0x%02x { ", drive->name, msg, err);
1da177e4
LT
526 if (err & ABRT_ERR) printk("DriveStatusError ");
527 if (err & ICRC_ERR)
13bbbf28 528 printk((err & ABRT_ERR) ? "BadCRC " : "BadSector ");
1da177e4
LT
529 if (err & ECC_ERR) printk("UncorrectableError ");
530 if (err & ID_ERR) printk("SectorIdNotFound ");
531 if (err & TRK0_ERR) printk("TrackZeroNotFound ");
532 if (err & MARK_ERR) printk("AddrMarkNotFound ");
533 printk("}");
534 if ((err & (BBD_ERR | ABRT_ERR)) == BBD_ERR ||
535 (err & (ECC_ERR|ID_ERR|MARK_ERR))) {
536 if (drive->addressing == 1) {
537 __u64 sectors = 0;
538 u32 low = 0, high = 0;
539 low = ide_read_24(drive);
540 hwif->OUTB(drive->ctl|0x80, IDE_CONTROL_REG);
541 high = ide_read_24(drive);
542 sectors = ((__u64)high << 24) | low;
543 printk(", LBAsect=%llu, high=%d, low=%d",
544 (unsigned long long) sectors,
545 high, low);
546 } else {
547 u8 cur = hwif->INB(IDE_SELECT_REG);
548 if (cur & 0x40) { /* using LBA? */
549 printk(", LBAsect=%ld", (unsigned long)
550 ((cur&0xf)<<24)
551 |(hwif->INB(IDE_HCYL_REG)<<16)
552 |(hwif->INB(IDE_LCYL_REG)<<8)
553 | hwif->INB(IDE_SECTOR_REG));
554 } else {
555 printk(", CHS=%d/%d/%d",
556 (hwif->INB(IDE_HCYL_REG)<<8) +
557 hwif->INB(IDE_LCYL_REG),
558 cur & 0xf,
559 hwif->INB(IDE_SECTOR_REG));
560 }
561 }
562 if (HWGROUP(drive) && HWGROUP(drive)->rq)
563 printk(", sector=%llu",
564 (unsigned long long)HWGROUP(drive)->rq->sector);
565 }
13bbbf28 566 printk("\n");
1da177e4 567 }
1da177e4
LT
568 ide_dump_opcode(drive);
569 local_irq_restore(flags);
570 return err;
571}
572
573/**
574 * ide_dump_atapi_status - print human readable atapi status
575 * @drive: drive that status applies to
576 * @msg: text message to print
577 * @stat: status byte to decode
578 *
579 * Error reporting, in human readable form (luxurious, but a memory hog).
580 */
581
582static u8 ide_dump_atapi_status(ide_drive_t *drive, const char *msg, u8 stat)
583{
584 unsigned long flags;
585
586 atapi_status_t status;
587 atapi_error_t error;
588
589 status.all = stat;
590 error.all = 0;
3d1c1cc9 591 local_irq_save(flags);
1da177e4
LT
592 printk("%s: %s: status=0x%02x { ", drive->name, msg, stat);
593 if (status.b.bsy)
594 printk("Busy ");
595 else {
596 if (status.b.drdy) printk("DriveReady ");
597 if (status.b.df) printk("DeviceFault ");
598 if (status.b.dsc) printk("SeekComplete ");
599 if (status.b.drq) printk("DataRequest ");
600 if (status.b.corr) printk("CorrectedError ");
601 if (status.b.idx) printk("Index ");
602 if (status.b.check) printk("Error ");
603 }
604 printk("}\n");
605 if (status.b.check && !status.b.bsy) {
606 error.all = HWIF(drive)->INB(IDE_ERROR_REG);
607 printk("%s: %s: error=0x%02x { ", drive->name, msg, error.all);
608 if (error.b.ili) printk("IllegalLengthIndication ");
609 if (error.b.eom) printk("EndOfMedia ");
610 if (error.b.abrt) printk("AbortedCommand ");
611 if (error.b.mcr) printk("MediaChangeRequested ");
612 if (error.b.sense_key) printk("LastFailedSense=0x%02x ",
613 error.b.sense_key);
614 printk("}\n");
615 }
616 ide_dump_opcode(drive);
617 local_irq_restore(flags);
618 return error.all;
619}
620
621/**
622 * ide_dump_status - translate ATA/ATAPI error
623 * @drive: drive the error occured on
624 * @msg: information string
625 * @stat: status byte
626 *
627 * Error reporting, in human readable form (luxurious, but a memory hog).
628 * Combines the drive name, message and status byte to provide a
629 * user understandable explanation of the device error.
630 */
631
632u8 ide_dump_status(ide_drive_t *drive, const char *msg, u8 stat)
633{
634 if (drive->media == ide_disk)
635 return ide_dump_ata_status(drive, msg, stat);
636 return ide_dump_atapi_status(drive, msg, stat);
637}
638
639EXPORT_SYMBOL(ide_dump_status);