linux-imx

#include <linux/types.h>

#include <linux/string.h>

#include <linux/kernel.h>

#include <linux/export.h>

#include <linux/interrupt.h>

#include <linux/ide.h>

#include <linux/bitops.h>

​

u64 ide_get_lba_addr(struct ide_cmd *cmd, int lba48)

{

    struct ide_taskfile *tf = &cmd->tf;

    u32 high, low;

​

    low  = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal;

    if (lba48) {

        tf = &cmd->hob;

        high = (tf->lbah << 16) | (tf->lbam << 8) | tf->lbal;

    } else

        high = tf->device & 0xf;

​

    return ((u64)high << 24) | low;

}

EXPORT_SYMBOL_GPL(ide_get_lba_addr);

​

static void ide_dump_sector(ide_drive_t *drive)

{

    struct ide_cmd cmd;

    struct ide_taskfile *tf = &cmd.tf;

    u8 lba48 = !!(drive->dev_flags & IDE_DFLAG_LBA48);

​

    memset(&cmd, 0, sizeof(cmd));

    if (lba48) {

        cmd.valid.in.tf  = IDE_VALID_LBA;

        cmd.valid.in.hob = IDE_VALID_LBA;

        cmd.tf_flags = IDE_TFLAG_LBA48;

    } else

        cmd.valid.in.tf  = IDE_VALID_LBA | IDE_VALID_DEVICE;

​

    ide_tf_readback(drive, &cmd);

​

    if (lba48 || (tf->device & ATA_LBA))

        printk(KERN_CONT ", LBAsect=%llu",

            (unsigned long long)ide_get_lba_addr(&cmd, lba48));

    else

        printk(KERN_CONT ", CHS=%d/%d/%d", (tf->lbah << 8) + tf->lbam,

            tf->device & 0xf, tf->lbal);

}

​

static void ide_dump_ata_error(ide_drive_t *drive, u8 err)

{

    printk(KERN_CONT "{ ");

    if (err & ATA_ABORTED)

        printk(KERN_CONT "DriveStatusError ");

    if (err & ATA_ICRC)

        printk(KERN_CONT "%s",

            (err & ATA_ABORTED) ? "BadCRC " : "BadSector ");

    if (err & ATA_UNC)

        printk(KERN_CONT "UncorrectableError ");

    if (err & ATA_IDNF)

        printk(KERN_CONT "SectorIdNotFound ");

    if (err & ATA_TRK0NF)

        printk(KERN_CONT "TrackZeroNotFound ");

    if (err & ATA_AMNF)