ide: add ide_pio_cycle_time() helper (take 2)

* Add ide_pio_cycle_time() helper.

* Use it in ali14xx/ht6560b/qd65xx/cmd64{0,x}/sl82c105 and pmac host drivers
  (previously cycle time given by the device was only used for "pio" == 255).

* Remove no longer needed ide_pio_data_t.cycle_time field.

v2:
* Fix "ata_" prefix (Noticed by Jeff).
Acked-by: default avatarSergei Shtylyov <sshtylyov@ru.mvista.com>
Cc: Jeff Garzik <jeff@garzik.org>
Signed-off-by: default avatarBartlomiej Zolnierkiewicz <bzolnier@gmail.com>
parent 31c4df44
...@@ -249,6 +249,29 @@ static int ide_scan_pio_blacklist (char *model) ...@@ -249,6 +249,29 @@ static int ide_scan_pio_blacklist (char *model)
return -1; return -1;
} }
unsigned int ide_pio_cycle_time(ide_drive_t *drive, u8 pio)
{
struct hd_driveid *id = drive->id;
int cycle_time = 0;
if (id->field_valid & 2) {
if (id->capability & 8)
cycle_time = id->eide_pio_iordy;
else
cycle_time = id->eide_pio;
}
/* conservative "downgrade" for all pre-ATA2 drives */
if (pio < 3) {
if (cycle_time && cycle_time < ide_pio_timings[pio].cycle_time)
cycle_time = 0; /* use standard timing */
}
return cycle_time ? cycle_time : ide_pio_timings[pio].cycle_time;
}
EXPORT_SYMBOL_GPL(ide_pio_cycle_time);
/** /**
* ide_get_best_pio_mode - get PIO mode from drive * ide_get_best_pio_mode - get PIO mode from drive
* @drive: drive to consider * @drive: drive to consider
...@@ -266,7 +289,6 @@ static int ide_scan_pio_blacklist (char *model) ...@@ -266,7 +289,6 @@ static int ide_scan_pio_blacklist (char *model)
u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_pio_data_t *d) u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_pio_data_t *d)
{ {
int pio_mode; int pio_mode;
int cycle_time = 0;
struct hd_driveid* id = drive->id; struct hd_driveid* id = drive->id;
int overridden = 0; int overridden = 0;
...@@ -284,7 +306,6 @@ u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_p ...@@ -284,7 +306,6 @@ u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_p
} }
if (id->field_valid & 2) { /* drive implements ATA2? */ if (id->field_valid & 2) { /* drive implements ATA2? */
if (id->capability & 8) { /* IORDY supported? */ if (id->capability & 8) { /* IORDY supported? */
cycle_time = id->eide_pio_iordy;
if (id->eide_pio_modes & 7) { if (id->eide_pio_modes & 7) {
overridden = 0; overridden = 0;
if (id->eide_pio_modes & 4) if (id->eide_pio_modes & 4)
...@@ -294,8 +315,6 @@ u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_p ...@@ -294,8 +315,6 @@ u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_p
else else
pio_mode = 3; pio_mode = 3;
} }
} else {
cycle_time = id->eide_pio;
} }
} }
...@@ -310,18 +329,15 @@ u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_p ...@@ -310,18 +329,15 @@ u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_p
pio_mode--; pio_mode--;
printk(KERN_INFO "%s: applying conservative " printk(KERN_INFO "%s: applying conservative "
"PIO \"downgrade\"\n", drive->name); "PIO \"downgrade\"\n", drive->name);
if (cycle_time && cycle_time < ide_pio_timings[pio_mode].cycle_time)
cycle_time = 0; /* use standard timing */
} }
} }
if (pio_mode > max_mode) {
if (pio_mode > max_mode)
pio_mode = max_mode; pio_mode = max_mode;
cycle_time = 0;
} if (d)
if (d) {
d->pio_mode = pio_mode; d->pio_mode = pio_mode;
d->cycle_time = cycle_time ? cycle_time : ide_pio_timings[pio_mode].cycle_time;
}
return pio_mode; return pio_mode;
} }
......
...@@ -115,13 +115,12 @@ static void ali14xx_tune_drive (ide_drive_t *drive, u8 pio) ...@@ -115,13 +115,12 @@ static void ali14xx_tune_drive (ide_drive_t *drive, u8 pio)
int time1, time2; int time1, time2;
u8 param1, param2, param3, param4; u8 param1, param2, param3, param4;
unsigned long flags; unsigned long flags;
ide_pio_data_t d;
int bus_speed = system_bus_clock(); int bus_speed = system_bus_clock();
pio = ide_get_best_pio_mode(drive, pio, ALI_MAX_PIO, &d); pio = ide_get_best_pio_mode(drive, pio, ALI_MAX_PIO, NULL);
/* calculate timing, according to PIO mode */ /* calculate timing, according to PIO mode */
time1 = d.cycle_time; time1 = ide_pio_cycle_time(drive, pio);
time2 = ide_pio_timings[pio].active_time; time2 = ide_pio_timings[pio].active_time;
param3 = param1 = (time2 * bus_speed + 999) / 1000; param3 = param1 = (time2 * bus_speed + 999) / 1000;
param4 = param2 = (time1 * bus_speed + 999) / 1000 - param1; param4 = param2 = (time1 * bus_speed + 999) / 1000 - param1;
......
...@@ -203,19 +203,21 @@ static u8 ht_pio2timings(ide_drive_t *drive, u8 pio) ...@@ -203,19 +203,21 @@ static u8 ht_pio2timings(ide_drive_t *drive, u8 pio)
{ {
int active_time, recovery_time; int active_time, recovery_time;
int active_cycles, recovery_cycles; int active_cycles, recovery_cycles;
ide_pio_data_t d;
int bus_speed = system_bus_clock(); int bus_speed = system_bus_clock();
if (pio) { if (pio) {
pio = ide_get_best_pio_mode(drive, pio, 5, &d); unsigned int cycle_time;
pio = ide_get_best_pio_mode(drive, pio, 5, NULL);
cycle_time = ide_pio_cycle_time(drive, pio);
/* /*
* Just like opti621.c we try to calculate the * Just like opti621.c we try to calculate the
* actual cycle time for recovery and activity * actual cycle time for recovery and activity
* according system bus speed. * according system bus speed.
*/ */
active_time = ide_pio_timings[pio].active_time; active_time = ide_pio_timings[pio].active_time;
recovery_time = d.cycle_time recovery_time = cycle_time
- active_time - active_time
- ide_pio_timings[pio].setup_time; - ide_pio_timings[pio].setup_time;
/* /*
......
...@@ -252,38 +252,38 @@ static void qd6500_tune_drive (ide_drive_t *drive, u8 pio) ...@@ -252,38 +252,38 @@ static void qd6500_tune_drive (ide_drive_t *drive, u8 pio)
static void qd6580_tune_drive (ide_drive_t *drive, u8 pio) static void qd6580_tune_drive (ide_drive_t *drive, u8 pio)
{ {
ide_pio_data_t d;
int base = HWIF(drive)->select_data; int base = HWIF(drive)->select_data;
unsigned int cycle_time;
int active_time = 175; int active_time = 175;
int recovery_time = 415; /* worst case values from the dos driver */ int recovery_time = 415; /* worst case values from the dos driver */
if (drive->id && !qd_find_disk_type(drive, &active_time, &recovery_time)) { if (drive->id && !qd_find_disk_type(drive, &active_time, &recovery_time)) {
pio = ide_get_best_pio_mode(drive, pio, 4, &d); pio = ide_get_best_pio_mode(drive, pio, 4, NULL);
cycle_time = ide_pio_cycle_time(drive, pio);
switch (pio) { switch (pio) {
case 0: break; case 0: break;
case 3: case 3:
if (d.cycle_time >= 110) { if (cycle_time >= 110) {
active_time = 86; active_time = 86;
recovery_time = d.cycle_time - 102; recovery_time = cycle_time - 102;
} else } else
printk(KERN_WARNING "%s: Strange recovery time !\n",drive->name); printk(KERN_WARNING "%s: Strange recovery time !\n",drive->name);
break; break;
case 4: case 4:
if (d.cycle_time >= 69) { if (cycle_time >= 69) {
active_time = 70; active_time = 70;
recovery_time = d.cycle_time - 61; recovery_time = cycle_time - 61;
} else } else
printk(KERN_WARNING "%s: Strange recovery time !\n",drive->name); printk(KERN_WARNING "%s: Strange recovery time !\n",drive->name);
break; break;
default: default:
if (d.cycle_time >= 180) { if (cycle_time >= 180) {
active_time = 110; active_time = 110;
recovery_time = d.cycle_time - 120; recovery_time = cycle_time - 120;
} else { } else {
active_time = ide_pio_timings[pio].active_time; active_time = ide_pio_timings[pio].active_time;
recovery_time = d.cycle_time recovery_time = cycle_time - active_time;
-active_time;
} }
} }
printk(KERN_INFO "%s: PIO mode%d\n", drive->name,pio); printk(KERN_INFO "%s: PIO mode%d\n", drive->name,pio);
......
...@@ -633,9 +633,8 @@ static void cmd640_set_mode (unsigned int index, u8 pio_mode, unsigned int cycle ...@@ -633,9 +633,8 @@ static void cmd640_set_mode (unsigned int index, u8 pio_mode, unsigned int cycle
*/ */
static void cmd640_tune_drive (ide_drive_t *drive, u8 mode_wanted) static void cmd640_tune_drive (ide_drive_t *drive, u8 mode_wanted)
{ {
unsigned int index = 0, cycle_time;
u8 b; u8 b;
ide_pio_data_t d;
unsigned int index = 0;
while (drive != cmd_drives[index]) { while (drive != cmd_drives[index]) {
if (++index > 3) { if (++index > 3) {
...@@ -662,13 +661,12 @@ static void cmd640_tune_drive (ide_drive_t *drive, u8 mode_wanted) ...@@ -662,13 +661,12 @@ static void cmd640_tune_drive (ide_drive_t *drive, u8 mode_wanted)
return; return;
} }
(void) ide_get_best_pio_mode (drive, mode_wanted, 5, &d); mode_wanted = ide_get_best_pio_mode(drive, mode_wanted, 5, NULL);
cmd640_set_mode (index, d.pio_mode, d.cycle_time); cycle_time = ide_pio_cycle_time(drive, mode_wanted);
cmd640_set_mode(index, mode_wanted, cycle_time);
printk("%s: selected cmd640 PIO mode%d (%dns)", printk("%s: selected cmd640 PIO mode%d (%dns)",
drive->name, drive->name, mode_wanted, cycle_time);
d.pio_mode,
d.cycle_time);
display_clocks(index); display_clocks(index);
} }
......
...@@ -221,16 +221,18 @@ static u8 cmd64x_tune_pio (ide_drive_t *drive, u8 mode_wanted) ...@@ -221,16 +221,18 @@ static u8 cmd64x_tune_pio (ide_drive_t *drive, u8 mode_wanted)
{ {
ide_hwif_t *hwif = HWIF(drive); ide_hwif_t *hwif = HWIF(drive);
struct pci_dev *dev = hwif->pci_dev; struct pci_dev *dev = hwif->pci_dev;
ide_pio_data_t pio; unsigned int cycle_time;
u8 pio_mode, setup_count, arttim = 0; u8 pio_mode, setup_count, arttim = 0;
static const u8 setup_values[] = {0x40, 0x40, 0x40, 0x80, 0, 0xc0}; static const u8 setup_values[] = {0x40, 0x40, 0x40, 0x80, 0, 0xc0};
static const u8 arttim_regs[4] = {ARTTIM0, ARTTIM1, ARTTIM23, ARTTIM23}; static const u8 arttim_regs[4] = {ARTTIM0, ARTTIM1, ARTTIM23, ARTTIM23};
pio_mode = ide_get_best_pio_mode(drive, mode_wanted, 5, &pio);
pio_mode = ide_get_best_pio_mode(drive, mode_wanted, 5, NULL);
cycle_time = ide_pio_cycle_time(drive, pio_mode);
cmdprintk("%s: PIO mode wanted %d, selected %d (%d ns)\n", cmdprintk("%s: PIO mode wanted %d, selected %d (%d ns)\n",
drive->name, mode_wanted, pio_mode, pio.cycle_time); drive->name, mode_wanted, pio_mode, cycle_time);
program_cycle_times(drive, pio.cycle_time, program_cycle_times(drive, cycle_time,
ide_pio_timings[pio_mode].active_time); ide_pio_timings[pio_mode].active_time);
setup_count = quantize_timing(ide_pio_timings[pio_mode].setup_time, setup_count = quantize_timing(ide_pio_timings[pio_mode].setup_time,
......
...@@ -52,13 +52,13 @@ ...@@ -52,13 +52,13 @@
* Convert a PIO mode and cycle time to the required on/off times * Convert a PIO mode and cycle time to the required on/off times
* for the interface. This has protection against runaway timings. * for the interface. This has protection against runaway timings.
*/ */
static unsigned int get_pio_timings(ide_drive_t *drive, ide_pio_data_t *p) static unsigned int get_pio_timings(ide_drive_t *drive, u8 pio)
{ {
unsigned int cmd_on, cmd_off; unsigned int cmd_on, cmd_off;
u8 iordy = 0; u8 iordy = 0;
cmd_on = (ide_pio_timings[p->pio_mode].active_time + 29) / 30; cmd_on = (ide_pio_timings[pio].active_time + 29) / 30;
cmd_off = (p->cycle_time - 30 * cmd_on + 29) / 30; cmd_off = (ide_pio_cycle_time(drive, pio) - 30 * cmd_on + 29) / 30;
if (cmd_on == 0) if (cmd_on == 0)
cmd_on = 1; cmd_on = 1;
...@@ -66,7 +66,7 @@ static unsigned int get_pio_timings(ide_drive_t *drive, ide_pio_data_t *p) ...@@ -66,7 +66,7 @@ static unsigned int get_pio_timings(ide_drive_t *drive, ide_pio_data_t *p)
if (cmd_off == 0) if (cmd_off == 0)
cmd_off = 1; cmd_off = 1;
if (p->pio_mode > 2 || ide_dev_has_iordy(drive->id)) if (pio > 2 || ide_dev_has_iordy(drive->id))
iordy = 0x40; iordy = 0x40;
return (cmd_on - 1) << 8 | (cmd_off - 1) | iordy; return (cmd_on - 1) << 8 | (cmd_off - 1) | iordy;
...@@ -79,14 +79,13 @@ static u8 sl82c105_tune_pio(ide_drive_t *drive, u8 pio) ...@@ -79,14 +79,13 @@ static u8 sl82c105_tune_pio(ide_drive_t *drive, u8 pio)
{ {
struct pci_dev *dev = HWIF(drive)->pci_dev; struct pci_dev *dev = HWIF(drive)->pci_dev;
int reg = 0x44 + drive->dn * 4; int reg = 0x44 + drive->dn * 4;
ide_pio_data_t p;
u16 drv_ctrl; u16 drv_ctrl;
DBG(("sl82c105_tune_pio(drive:%s, pio:%u)\n", drive->name, pio)); DBG(("sl82c105_tune_pio(drive:%s, pio:%u)\n", drive->name, pio));
pio = ide_get_best_pio_mode(drive, pio, 5, &p); pio = ide_get_best_pio_mode(drive, pio, 5, NULL);
drv_ctrl = get_pio_timings(drive, &p); drv_ctrl = get_pio_timings(drive, pio);
/* /*
* Store the PIO timings so that we can restore them * Store the PIO timings so that we can restore them
...@@ -105,7 +104,8 @@ static u8 sl82c105_tune_pio(ide_drive_t *drive, u8 pio) ...@@ -105,7 +104,8 @@ static u8 sl82c105_tune_pio(ide_drive_t *drive, u8 pio)
} }
printk(KERN_DEBUG "%s: selected %s (%dns) (%04X)\n", drive->name, printk(KERN_DEBUG "%s: selected %s (%dns) (%04X)\n", drive->name,
ide_xfer_verbose(pio + XFER_PIO_0), p.cycle_time, drv_ctrl); ide_xfer_verbose(pio + XFER_PIO_0),
ide_pio_cycle_time(drive, pio), drv_ctrl);
return pio; return pio;
} }
......
...@@ -615,24 +615,25 @@ pmac_ide_do_setfeature(ide_drive_t *drive, u8 command) ...@@ -615,24 +615,25 @@ pmac_ide_do_setfeature(ide_drive_t *drive, u8 command)
static void static void
pmac_ide_tuneproc(ide_drive_t *drive, u8 pio) pmac_ide_tuneproc(ide_drive_t *drive, u8 pio)
{ {
ide_pio_data_t d;
u32 *timings; u32 *timings;
unsigned accessTicks, recTicks; unsigned accessTicks, recTicks;
unsigned accessTime, recTime; unsigned accessTime, recTime;
pmac_ide_hwif_t* pmif = (pmac_ide_hwif_t *)HWIF(drive)->hwif_data; pmac_ide_hwif_t* pmif = (pmac_ide_hwif_t *)HWIF(drive)->hwif_data;
unsigned int cycle_time;
if (pmif == NULL) if (pmif == NULL)
return; return;
/* which drive is it ? */ /* which drive is it ? */
timings = &pmif->timings[drive->select.b.unit & 0x01]; timings = &pmif->timings[drive->select.b.unit & 0x01];
pio = ide_get_best_pio_mode(drive, pio, 4, &d); pio = ide_get_best_pio_mode(drive, pio, 4, NULL);
cycle_time = ide_pio_cycle_time(drive, pio);
switch (pmif->kind) { switch (pmif->kind) {
case controller_sh_ata6: { case controller_sh_ata6: {
/* 133Mhz cell */ /* 133Mhz cell */
u32 tr = kauai_lookup_timing(shasta_pio_timings, d.cycle_time); u32 tr = kauai_lookup_timing(shasta_pio_timings, cycle_time);
if (tr == 0) if (tr == 0)
return; return;
*timings = ((*timings) & ~TR_133_PIOREG_PIO_MASK) | tr; *timings = ((*timings) & ~TR_133_PIOREG_PIO_MASK) | tr;
...@@ -641,7 +642,7 @@ pmac_ide_tuneproc(ide_drive_t *drive, u8 pio) ...@@ -641,7 +642,7 @@ pmac_ide_tuneproc(ide_drive_t *drive, u8 pio)
case controller_un_ata6: case controller_un_ata6:
case controller_k2_ata6: { case controller_k2_ata6: {
/* 100Mhz cell */ /* 100Mhz cell */
u32 tr = kauai_lookup_timing(kauai_pio_timings, d.cycle_time); u32 tr = kauai_lookup_timing(kauai_pio_timings, cycle_time);
if (tr == 0) if (tr == 0)
return; return;
*timings = ((*timings) & ~TR_100_PIOREG_PIO_MASK) | tr; *timings = ((*timings) & ~TR_100_PIOREG_PIO_MASK) | tr;
...@@ -649,7 +650,7 @@ pmac_ide_tuneproc(ide_drive_t *drive, u8 pio) ...@@ -649,7 +650,7 @@ pmac_ide_tuneproc(ide_drive_t *drive, u8 pio)
} }
case controller_kl_ata4: case controller_kl_ata4:
/* 66Mhz cell */ /* 66Mhz cell */
recTime = d.cycle_time - ide_pio_timings[pio].active_time recTime = cycle_time - ide_pio_timings[pio].active_time
- ide_pio_timings[pio].setup_time; - ide_pio_timings[pio].setup_time;
recTime = max(recTime, 150U); recTime = max(recTime, 150U);
accessTime = ide_pio_timings[pio].active_time; accessTime = ide_pio_timings[pio].active_time;
...@@ -665,7 +666,7 @@ pmac_ide_tuneproc(ide_drive_t *drive, u8 pio) ...@@ -665,7 +666,7 @@ pmac_ide_tuneproc(ide_drive_t *drive, u8 pio)
default: { default: {
/* 33Mhz cell */ /* 33Mhz cell */
int ebit = 0; int ebit = 0;
recTime = d.cycle_time - ide_pio_timings[pio].active_time recTime = cycle_time - ide_pio_timings[pio].active_time
- ide_pio_timings[pio].setup_time; - ide_pio_timings[pio].setup_time;
recTime = max(recTime, 150U); recTime = max(recTime, 150U);
accessTime = ide_pio_timings[pio].active_time; accessTime = ide_pio_timings[pio].active_time;
......
...@@ -1379,9 +1379,9 @@ typedef struct ide_pio_timings_s { ...@@ -1379,9 +1379,9 @@ typedef struct ide_pio_timings_s {
typedef struct ide_pio_data_s { typedef struct ide_pio_data_s {
u8 pio_mode; u8 pio_mode;
unsigned int cycle_time;
} ide_pio_data_t; } ide_pio_data_t;
unsigned int ide_pio_cycle_time(ide_drive_t *, u8);
extern u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_pio_data_t *d); extern u8 ide_get_best_pio_mode (ide_drive_t *drive, u8 mode_wanted, u8 max_mode, ide_pio_data_t *d);
extern const ide_pio_timings_t ide_pio_timings[6]; extern const ide_pio_timings_t ide_pio_timings[6];
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment