mirror of
https://github.com/rd-stuffs/msm-4.14.git
synced 2025-02-20 11:45:48 +08:00
ide: fix registers loading order for IDE_NSECTOR_REG in execute_drive_cmd()
Move loading of IDE_NSECTOR_REG from ide_cmd() to execute_drive_cmd() (load the IDE_NSECTOR_REG just after IDE_FEATURE_REG). This also allows us to drop 'nsect' argument from ide_cmd() and simplify execute_drive_cmd() code for REQ_TYPE_ATA_CMD case a bit. It shouldn't affect anything (just a usual paranoia to separate changes which change the way in which hardware is accessed from code cleanups). Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>
This commit is contained in:
parent
46f26c362d
commit
6dd87233bc
@ -624,21 +624,18 @@ ide_startstop_t ide_abort(ide_drive_t *drive, const char *msg)
|
|||||||
* ide_cmd - issue a simple drive command
|
* ide_cmd - issue a simple drive command
|
||||||
* @drive: drive the command is for
|
* @drive: drive the command is for
|
||||||
* @cmd: command byte
|
* @cmd: command byte
|
||||||
* @nsect: sector byte
|
|
||||||
* @handler: handler for the command completion
|
* @handler: handler for the command completion
|
||||||
*
|
*
|
||||||
* Issue a simple drive command with interrupts.
|
* Issue a simple drive command with interrupts.
|
||||||
* The drive must be selected beforehand.
|
* The drive must be selected beforehand.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static void ide_cmd (ide_drive_t *drive, u8 cmd, u8 nsect,
|
static void ide_cmd(ide_drive_t *drive, u8 cmd, ide_handler_t *handler)
|
||||||
ide_handler_t *handler)
|
|
||||||
{
|
{
|
||||||
ide_hwif_t *hwif = HWIF(drive);
|
ide_hwif_t *hwif = HWIF(drive);
|
||||||
if (IDE_CONTROL_REG)
|
if (IDE_CONTROL_REG)
|
||||||
hwif->OUTB(drive->ctl,IDE_CONTROL_REG); /* clear nIEN */
|
hwif->OUTB(drive->ctl,IDE_CONTROL_REG); /* clear nIEN */
|
||||||
SELECT_MASK(drive,0);
|
SELECT_MASK(drive,0);
|
||||||
hwif->OUTB(nsect,IDE_NSECTOR_REG);
|
|
||||||
ide_execute_command(drive, cmd, handler, WAIT_CMD, NULL);
|
ide_execute_command(drive, cmd, handler, WAIT_CMD, NULL);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -913,11 +910,12 @@ static ide_startstop_t execute_drive_cmd (ide_drive_t *drive,
|
|||||||
printk("sel=0x%02x\n", args[6]);
|
printk("sel=0x%02x\n", args[6]);
|
||||||
#endif
|
#endif
|
||||||
hwif->OUTB(args[1], IDE_FEATURE_REG);
|
hwif->OUTB(args[1], IDE_FEATURE_REG);
|
||||||
|
hwif->OUTB(args[2], IDE_NSECTOR_REG);
|
||||||
hwif->OUTB(args[3], IDE_SECTOR_REG);
|
hwif->OUTB(args[3], IDE_SECTOR_REG);
|
||||||
hwif->OUTB(args[4], IDE_LCYL_REG);
|
hwif->OUTB(args[4], IDE_LCYL_REG);
|
||||||
hwif->OUTB(args[5], IDE_HCYL_REG);
|
hwif->OUTB(args[5], IDE_HCYL_REG);
|
||||||
hwif->OUTB((args[6] & 0xEF)|drive->select.all, IDE_SELECT_REG);
|
hwif->OUTB((args[6] & 0xEF)|drive->select.all, IDE_SELECT_REG);
|
||||||
ide_cmd(drive, args[0], args[2], &drive_cmd_intr);
|
ide_cmd(drive, args[0], &drive_cmd_intr);
|
||||||
return ide_started;
|
return ide_started;
|
||||||
} else if (rq->cmd_type == REQ_TYPE_ATA_CMD) {
|
} else if (rq->cmd_type == REQ_TYPE_ATA_CMD) {
|
||||||
u8 *args = rq->buffer;
|
u8 *args = rq->buffer;
|
||||||
@ -931,16 +929,15 @@ static ide_startstop_t execute_drive_cmd (ide_drive_t *drive,
|
|||||||
printk("fr=0x%02x ", args[2]);
|
printk("fr=0x%02x ", args[2]);
|
||||||
printk("xx=0x%02x\n", args[3]);
|
printk("xx=0x%02x\n", args[3]);
|
||||||
#endif
|
#endif
|
||||||
|
hwif->OUTB(args[2], IDE_FEATURE_REG);
|
||||||
if (args[0] == WIN_SMART) {
|
if (args[0] == WIN_SMART) {
|
||||||
hwif->OUTB(args[2],IDE_FEATURE_REG);
|
hwif->OUTB(args[3],IDE_NSECTOR_REG);
|
||||||
hwif->OUTB(args[1],IDE_SECTOR_REG);
|
hwif->OUTB(args[1],IDE_SECTOR_REG);
|
||||||
hwif->OUTB(0x4f, IDE_LCYL_REG);
|
hwif->OUTB(0x4f, IDE_LCYL_REG);
|
||||||
hwif->OUTB(0xc2, IDE_HCYL_REG);
|
hwif->OUTB(0xc2, IDE_HCYL_REG);
|
||||||
ide_cmd(drive, args[0], args[3], &drive_cmd_intr);
|
} else
|
||||||
return ide_started;
|
hwif->OUTB(args[1], IDE_NSECTOR_REG);
|
||||||
}
|
ide_cmd(drive, args[0], &drive_cmd_intr);
|
||||||
hwif->OUTB(args[2],IDE_FEATURE_REG);
|
|
||||||
ide_cmd(drive, args[0], args[1], &drive_cmd_intr);
|
|
||||||
return ide_started;
|
return ide_started;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
x
Reference in New Issue
Block a user