linux/drivers/ata/libata-scsi.c
<<
>>
Prefs
   1/*
   2 *  libata-scsi.c - helper library for ATA
   3 *
   4 *  Maintained by:  Jeff Garzik <jgarzik@pobox.com>
   5 *                  Please ALWAYS copy linux-ide@vger.kernel.org
   6 *                  on emails.
   7 *
   8 *  Copyright 2003-2004 Red Hat, Inc.  All rights reserved.
   9 *  Copyright 2003-2004 Jeff Garzik
  10 *
  11 *
  12 *  This program is free software; you can redistribute it and/or modify
  13 *  it under the terms of the GNU General Public License as published by
  14 *  the Free Software Foundation; either version 2, or (at your option)
  15 *  any later version.
  16 *
  17 *  This program is distributed in the hope that it will be useful,
  18 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  19 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20 *  GNU General Public License for more details.
  21 *
  22 *  You should have received a copy of the GNU General Public License
  23 *  along with this program; see the file COPYING.  If not, write to
  24 *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
  25 *
  26 *
  27 *  libata documentation is available via 'make {ps|pdf}docs',
  28 *  as Documentation/DocBook/libata.*
  29 *
  30 *  Hardware documentation available from
  31 *  - http://www.t10.org/
  32 *  - http://www.t13.org/
  33 *
  34 */
  35
  36#include <linux/slab.h>
  37#include <linux/kernel.h>
  38#include <linux/blkdev.h>
  39#include <linux/spinlock.h>
  40#include <linux/export.h>
  41#include <scsi/scsi.h>
  42#include <scsi/scsi_host.h>
  43#include <scsi/scsi_cmnd.h>
  44#include <scsi/scsi_eh.h>
  45#include <scsi/scsi_device.h>
  46#include <scsi/scsi_tcq.h>
  47#include <scsi/scsi_transport.h>
  48#include <linux/libata.h>
  49#include <linux/hdreg.h>
  50#include <linux/uaccess.h>
  51#include <linux/suspend.h>
  52#include <asm/unaligned.h>
  53
  54#include "libata.h"
  55#include "libata-transport.h"
  56
  57#define ATA_SCSI_RBUF_SIZE      4096
  58
  59static DEFINE_SPINLOCK(ata_scsi_rbuf_lock);
  60static u8 ata_scsi_rbuf[ATA_SCSI_RBUF_SIZE];
  61
  62typedef unsigned int (*ata_xlat_func_t)(struct ata_queued_cmd *qc);
  63
  64static struct ata_device *__ata_scsi_find_dev(struct ata_port *ap,
  65                                        const struct scsi_device *scsidev);
  66static struct ata_device *ata_scsi_find_dev(struct ata_port *ap,
  67                                            const struct scsi_device *scsidev);
  68
  69#define RW_RECOVERY_MPAGE 0x1
  70#define RW_RECOVERY_MPAGE_LEN 12
  71#define CACHE_MPAGE 0x8
  72#define CACHE_MPAGE_LEN 20
  73#define CONTROL_MPAGE 0xa
  74#define CONTROL_MPAGE_LEN 12
  75#define ALL_MPAGES 0x3f
  76#define ALL_SUB_MPAGES 0xff
  77
  78
  79static const u8 def_rw_recovery_mpage[RW_RECOVERY_MPAGE_LEN] = {
  80        RW_RECOVERY_MPAGE,
  81        RW_RECOVERY_MPAGE_LEN - 2,
  82        (1 << 7),       /* AWRE */
  83        0,              /* read retry count */
  84        0, 0, 0, 0,
  85        0,              /* write retry count */
  86        0, 0, 0
  87};
  88
  89static const u8 def_cache_mpage[CACHE_MPAGE_LEN] = {
  90        CACHE_MPAGE,
  91        CACHE_MPAGE_LEN - 2,
  92        0,              /* contains WCE, needs to be 0 for logic */
  93        0, 0, 0, 0, 0, 0, 0, 0, 0,
  94        0,              /* contains DRA, needs to be 0 for logic */
  95        0, 0, 0, 0, 0, 0, 0
  96};
  97
  98static const u8 def_control_mpage[CONTROL_MPAGE_LEN] = {
  99        CONTROL_MPAGE,
 100        CONTROL_MPAGE_LEN - 2,
 101        2,      /* DSENSE=0, GLTSD=1 */
 102        0,      /* [QAM+QERR may be 1, see 05-359r1] */
 103        0, 0, 0, 0, 0xff, 0xff,
 104        0, 30   /* extended self test time, see 05-359r1 */
 105};
 106
 107static const char *ata_lpm_policy_names[] = {
 108        [ATA_LPM_UNKNOWN]       = "max_performance",
 109        [ATA_LPM_MAX_POWER]     = "max_performance",
 110        [ATA_LPM_MED_POWER]     = "medium_power",
 111        [ATA_LPM_MIN_POWER]     = "min_power",
 112};
 113
 114static ssize_t ata_scsi_lpm_store(struct device *dev,
 115                                  struct device_attribute *attr,
 116                                  const char *buf, size_t count)
 117{
 118        struct Scsi_Host *shost = class_to_shost(dev);
 119        struct ata_port *ap = ata_shost_to_port(shost);
 120        enum ata_lpm_policy policy;
 121        unsigned long flags;
 122
 123        /* UNKNOWN is internal state, iterate from MAX_POWER */
 124        for (policy = ATA_LPM_MAX_POWER;
 125             policy < ARRAY_SIZE(ata_lpm_policy_names); policy++) {
 126                const char *name = ata_lpm_policy_names[policy];
 127
 128                if (strncmp(name, buf, strlen(name)) == 0)
 129                        break;
 130        }
 131        if (policy == ARRAY_SIZE(ata_lpm_policy_names))
 132                return -EINVAL;
 133
 134        spin_lock_irqsave(ap->lock, flags);
 135        ap->target_lpm_policy = policy;
 136        ata_port_schedule_eh(ap);
 137        spin_unlock_irqrestore(ap->lock, flags);
 138
 139        return count;
 140}
 141
 142static ssize_t ata_scsi_lpm_show(struct device *dev,
 143                                 struct device_attribute *attr, char *buf)
 144{
 145        struct Scsi_Host *shost = class_to_shost(dev);
 146        struct ata_port *ap = ata_shost_to_port(shost);
 147
 148        if (ap->target_lpm_policy >= ARRAY_SIZE(ata_lpm_policy_names))
 149                return -EINVAL;
 150
 151        return snprintf(buf, PAGE_SIZE, "%s\n",
 152                        ata_lpm_policy_names[ap->target_lpm_policy]);
 153}
 154DEVICE_ATTR(link_power_management_policy, S_IRUGO | S_IWUSR,
 155            ata_scsi_lpm_show, ata_scsi_lpm_store);
 156EXPORT_SYMBOL_GPL(dev_attr_link_power_management_policy);
 157
 158static ssize_t ata_scsi_park_show(struct device *device,
 159                                  struct device_attribute *attr, char *buf)
 160{
 161        struct scsi_device *sdev = to_scsi_device(device);
 162        struct ata_port *ap;
 163        struct ata_link *link;
 164        struct ata_device *dev;
 165        unsigned long flags, now;
 166        unsigned int uninitialized_var(msecs);
 167        int rc = 0;
 168
 169        ap = ata_shost_to_port(sdev->host);
 170
 171        spin_lock_irqsave(ap->lock, flags);
 172        dev = ata_scsi_find_dev(ap, sdev);
 173        if (!dev) {
 174                rc = -ENODEV;
 175                goto unlock;
 176        }
 177        if (dev->flags & ATA_DFLAG_NO_UNLOAD) {
 178                rc = -EOPNOTSUPP;
 179                goto unlock;
 180        }
 181
 182        link = dev->link;
 183        now = jiffies;
 184        if (ap->pflags & ATA_PFLAG_EH_IN_PROGRESS &&
 185            link->eh_context.unloaded_mask & (1 << dev->devno) &&
 186            time_after(dev->unpark_deadline, now))
 187                msecs = jiffies_to_msecs(dev->unpark_deadline - now);
 188        else
 189                msecs = 0;
 190
 191unlock:
 192        spin_unlock_irq(ap->lock);
 193
 194        return rc ? rc : snprintf(buf, 20, "%u\n", msecs);
 195}
 196
 197static ssize_t ata_scsi_park_store(struct device *device,
 198                                   struct device_attribute *attr,
 199                                   const char *buf, size_t len)
 200{
 201        struct scsi_device *sdev = to_scsi_device(device);
 202        struct ata_port *ap;
 203        struct ata_device *dev;
 204        long int input;
 205        unsigned long flags;
 206        int rc;
 207
 208        rc = strict_strtol(buf, 10, &input);
 209        if (rc || input < -2)
 210                return -EINVAL;
 211        if (input > ATA_TMOUT_MAX_PARK) {
 212                rc = -EOVERFLOW;
 213                input = ATA_TMOUT_MAX_PARK;
 214        }
 215
 216        ap = ata_shost_to_port(sdev->host);
 217
 218        spin_lock_irqsave(ap->lock, flags);
 219        dev = ata_scsi_find_dev(ap, sdev);
 220        if (unlikely(!dev)) {
 221                rc = -ENODEV;
 222                goto unlock;
 223        }
 224        if (dev->class != ATA_DEV_ATA) {
 225                rc = -EOPNOTSUPP;
 226                goto unlock;
 227        }
 228
 229        if (input >= 0) {
 230                if (dev->flags & ATA_DFLAG_NO_UNLOAD) {
 231                        rc = -EOPNOTSUPP;
 232                        goto unlock;
 233                }
 234
 235                dev->unpark_deadline = ata_deadline(jiffies, input);
 236                dev->link->eh_info.dev_action[dev->devno] |= ATA_EH_PARK;
 237                ata_port_schedule_eh(ap);
 238                complete(&ap->park_req_pending);
 239        } else {
 240                switch (input) {
 241                case -1:
 242                        dev->flags &= ~ATA_DFLAG_NO_UNLOAD;
 243                        break;
 244                case -2:
 245                        dev->flags |= ATA_DFLAG_NO_UNLOAD;
 246                        break;
 247                }
 248        }
 249unlock:
 250        spin_unlock_irqrestore(ap->lock, flags);
 251
 252        return rc ? rc : len;
 253}
 254DEVICE_ATTR(unload_heads, S_IRUGO | S_IWUSR,
 255            ata_scsi_park_show, ata_scsi_park_store);
 256EXPORT_SYMBOL_GPL(dev_attr_unload_heads);
 257
 258static void ata_scsi_set_sense(struct scsi_cmnd *cmd, u8 sk, u8 asc, u8 ascq)
 259{
 260        cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
 261
 262        scsi_build_sense_buffer(0, cmd->sense_buffer, sk, asc, ascq);
 263}
 264
 265static ssize_t
 266ata_scsi_em_message_store(struct device *dev, struct device_attribute *attr,
 267                          const char *buf, size_t count)
 268{
 269        struct Scsi_Host *shost = class_to_shost(dev);
 270        struct ata_port *ap = ata_shost_to_port(shost);
 271        if (ap->ops->em_store && (ap->flags & ATA_FLAG_EM))
 272                return ap->ops->em_store(ap, buf, count);
 273        return -EINVAL;
 274}
 275
 276static ssize_t
 277ata_scsi_em_message_show(struct device *dev, struct device_attribute *attr,
 278                         char *buf)
 279{
 280        struct Scsi_Host *shost = class_to_shost(dev);
 281        struct ata_port *ap = ata_shost_to_port(shost);
 282
 283        if (ap->ops->em_show && (ap->flags & ATA_FLAG_EM))
 284                return ap->ops->em_show(ap, buf);
 285        return -EINVAL;
 286}
 287DEVICE_ATTR(em_message, S_IRUGO | S_IWUSR,
 288                ata_scsi_em_message_show, ata_scsi_em_message_store);
 289EXPORT_SYMBOL_GPL(dev_attr_em_message);
 290
 291static ssize_t
 292ata_scsi_em_message_type_show(struct device *dev, struct device_attribute *attr,
 293                              char *buf)
 294{
 295        struct Scsi_Host *shost = class_to_shost(dev);
 296        struct ata_port *ap = ata_shost_to_port(shost);
 297
 298        return snprintf(buf, 23, "%d\n", ap->em_message_type);
 299}
 300DEVICE_ATTR(em_message_type, S_IRUGO,
 301                  ata_scsi_em_message_type_show, NULL);
 302EXPORT_SYMBOL_GPL(dev_attr_em_message_type);
 303
 304static ssize_t
 305ata_scsi_activity_show(struct device *dev, struct device_attribute *attr,
 306                char *buf)
 307{
 308        struct scsi_device *sdev = to_scsi_device(dev);
 309        struct ata_port *ap = ata_shost_to_port(sdev->host);
 310        struct ata_device *atadev = ata_scsi_find_dev(ap, sdev);
 311
 312        if (ap->ops->sw_activity_show && (ap->flags & ATA_FLAG_SW_ACTIVITY))
 313                return ap->ops->sw_activity_show(atadev, buf);
 314        return -EINVAL;
 315}
 316
 317static ssize_t
 318ata_scsi_activity_store(struct device *dev, struct device_attribute *attr,
 319        const char *buf, size_t count)
 320{
 321        struct scsi_device *sdev = to_scsi_device(dev);
 322        struct ata_port *ap = ata_shost_to_port(sdev->host);
 323        struct ata_device *atadev = ata_scsi_find_dev(ap, sdev);
 324        enum sw_activity val;
 325        int rc;
 326
 327        if (ap->ops->sw_activity_store && (ap->flags & ATA_FLAG_SW_ACTIVITY)) {
 328                val = simple_strtoul(buf, NULL, 0);
 329                switch (val) {
 330                case OFF: case BLINK_ON: case BLINK_OFF:
 331                        rc = ap->ops->sw_activity_store(atadev, val);
 332                        if (!rc)
 333                                return count;
 334                        else
 335                                return rc;
 336                }
 337        }
 338        return -EINVAL;
 339}
 340DEVICE_ATTR(sw_activity, S_IWUSR | S_IRUGO, ata_scsi_activity_show,
 341                        ata_scsi_activity_store);
 342EXPORT_SYMBOL_GPL(dev_attr_sw_activity);
 343
 344struct device_attribute *ata_common_sdev_attrs[] = {
 345        &dev_attr_unload_heads,
 346        NULL
 347};
 348EXPORT_SYMBOL_GPL(ata_common_sdev_attrs);
 349
 350static void ata_scsi_invalid_field(struct scsi_cmnd *cmd)
 351{
 352        ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x24, 0x0);
 353        /* "Invalid field in cbd" */
 354        cmd->scsi_done(cmd);
 355}
 356
 357/**
 358 *      ata_std_bios_param - generic bios head/sector/cylinder calculator used by sd.
 359 *      @sdev: SCSI device for which BIOS geometry is to be determined
 360 *      @bdev: block device associated with @sdev
 361 *      @capacity: capacity of SCSI device
 362 *      @geom: location to which geometry will be output
 363 *
 364 *      Generic bios head/sector/cylinder calculator
 365 *      used by sd. Most BIOSes nowadays expect a XXX/255/16  (CHS)
 366 *      mapping. Some situations may arise where the disk is not
 367 *      bootable if this is not used.
 368 *
 369 *      LOCKING:
 370 *      Defined by the SCSI layer.  We don't really care.
 371 *
 372 *      RETURNS:
 373 *      Zero.
 374 */
 375int ata_std_bios_param(struct scsi_device *sdev, struct block_device *bdev,
 376                       sector_t capacity, int geom[])
 377{
 378        geom[0] = 255;
 379        geom[1] = 63;
 380        sector_div(capacity, 255*63);
 381        geom[2] = capacity;
 382
 383        return 0;
 384}
 385
 386/**
 387 *      ata_scsi_unlock_native_capacity - unlock native capacity
 388 *      @sdev: SCSI device to adjust device capacity for
 389 *
 390 *      This function is called if a partition on @sdev extends beyond
 391 *      the end of the device.  It requests EH to unlock HPA.
 392 *
 393 *      LOCKING:
 394 *      Defined by the SCSI layer.  Might sleep.
 395 */
 396void ata_scsi_unlock_native_capacity(struct scsi_device *sdev)
 397{
 398        struct ata_port *ap = ata_shost_to_port(sdev->host);
 399        struct ata_device *dev;
 400        unsigned long flags;
 401
 402        spin_lock_irqsave(ap->lock, flags);
 403
 404        dev = ata_scsi_find_dev(ap, sdev);
 405        if (dev && dev->n_sectors < dev->n_native_sectors) {
 406                dev->flags |= ATA_DFLAG_UNLOCK_HPA;
 407                dev->link->eh_info.action |= ATA_EH_RESET;
 408                ata_port_schedule_eh(ap);
 409        }
 410
 411        spin_unlock_irqrestore(ap->lock, flags);
 412        ata_port_wait_eh(ap);
 413}
 414
 415/**
 416 *      ata_get_identity - Handler for HDIO_GET_IDENTITY ioctl
 417 *      @ap: target port
 418 *      @sdev: SCSI device to get identify data for
 419 *      @arg: User buffer area for identify data
 420 *
 421 *      LOCKING:
 422 *      Defined by the SCSI layer.  We don't really care.
 423 *
 424 *      RETURNS:
 425 *      Zero on success, negative errno on error.
 426 */
 427static int ata_get_identity(struct ata_port *ap, struct scsi_device *sdev,
 428                            void __user *arg)
 429{
 430        struct ata_device *dev = ata_scsi_find_dev(ap, sdev);
 431        u16 __user *dst = arg;
 432        char buf[40];
 433
 434        if (!dev)
 435                return -ENOMSG;
 436
 437        if (copy_to_user(dst, dev->id, ATA_ID_WORDS * sizeof(u16)))
 438                return -EFAULT;
 439
 440        ata_id_string(dev->id, buf, ATA_ID_PROD, ATA_ID_PROD_LEN);
 441        if (copy_to_user(dst + ATA_ID_PROD, buf, ATA_ID_PROD_LEN))
 442                return -EFAULT;
 443
 444        ata_id_string(dev->id, buf, ATA_ID_FW_REV, ATA_ID_FW_REV_LEN);
 445        if (copy_to_user(dst + ATA_ID_FW_REV, buf, ATA_ID_FW_REV_LEN))
 446                return -EFAULT;
 447
 448        ata_id_string(dev->id, buf, ATA_ID_SERNO, ATA_ID_SERNO_LEN);
 449        if (copy_to_user(dst + ATA_ID_SERNO, buf, ATA_ID_SERNO_LEN))
 450                return -EFAULT;
 451
 452        return 0;
 453}
 454
 455/**
 456 *      ata_cmd_ioctl - Handler for HDIO_DRIVE_CMD ioctl
 457 *      @scsidev: Device to which we are issuing command
 458 *      @arg: User provided data for issuing command
 459 *
 460 *      LOCKING:
 461 *      Defined by the SCSI layer.  We don't really care.
 462 *
 463 *      RETURNS:
 464 *      Zero on success, negative errno on error.
 465 */
 466int ata_cmd_ioctl(struct scsi_device *scsidev, void __user *arg)
 467{
 468        int rc = 0;
 469        u8 scsi_cmd[MAX_COMMAND_SIZE];
 470        u8 args[4], *argbuf = NULL, *sensebuf = NULL;
 471        int argsize = 0;
 472        enum dma_data_direction data_dir;
 473        int cmd_result;
 474
 475        if (arg == NULL)
 476                return -EINVAL;
 477
 478        if (copy_from_user(args, arg, sizeof(args)))
 479                return -EFAULT;
 480
 481        sensebuf = kzalloc(SCSI_SENSE_BUFFERSIZE, GFP_NOIO);
 482        if (!sensebuf)
 483                return -ENOMEM;
 484
 485        memset(scsi_cmd, 0, sizeof(scsi_cmd));
 486
 487        if (args[3]) {
 488                argsize = ATA_SECT_SIZE * args[3];
 489                argbuf = kmalloc(argsize, GFP_KERNEL);
 490                if (argbuf == NULL) {
 491                        rc = -ENOMEM;
 492                        goto error;
 493                }
 494
 495                scsi_cmd[1]  = (4 << 1); /* PIO Data-in */
 496                scsi_cmd[2]  = 0x0e;     /* no off.line or cc, read from dev,
 497                                            block count in sector count field */
 498                data_dir = DMA_FROM_DEVICE;
 499        } else {
 500                scsi_cmd[1]  = (3 << 1); /* Non-data */
 501                scsi_cmd[2]  = 0x20;     /* cc but no off.line or data xfer */
 502                data_dir = DMA_NONE;
 503        }
 504
 505        scsi_cmd[0] = ATA_16;
 506
 507        scsi_cmd[4] = args[2];
 508        if (args[0] == ATA_CMD_SMART) { /* hack -- ide driver does this too */
 509                scsi_cmd[6]  = args[3];
 510                scsi_cmd[8]  = args[1];
 511                scsi_cmd[10] = 0x4f;
 512                scsi_cmd[12] = 0xc2;
 513        } else {
 514                scsi_cmd[6]  = args[1];
 515        }
 516        scsi_cmd[14] = args[0];
 517
 518        /* Good values for timeout and retries?  Values below
 519           from scsi_ioctl_send_command() for default case... */
 520        cmd_result = scsi_execute(scsidev, scsi_cmd, data_dir, argbuf, argsize,
 521                                  sensebuf, (10*HZ), 5, 0, NULL);
 522
 523        if (driver_byte(cmd_result) == DRIVER_SENSE) {/* sense data available */
 524                u8 *desc = sensebuf + 8;
 525                cmd_result &= ~(0xFF<<24); /* DRIVER_SENSE is not an error */
 526
 527                /* If we set cc then ATA pass-through will cause a
 528                 * check condition even if no error. Filter that. */
 529                if (cmd_result & SAM_STAT_CHECK_CONDITION) {
 530                        struct scsi_sense_hdr sshdr;
 531                        scsi_normalize_sense(sensebuf, SCSI_SENSE_BUFFERSIZE,
 532                                             &sshdr);
 533                        if (sshdr.sense_key == 0 &&
 534                            sshdr.asc == 0 && sshdr.ascq == 0)
 535                                cmd_result &= ~SAM_STAT_CHECK_CONDITION;
 536                }
 537
 538                /* Send userspace a few ATA registers (same as drivers/ide) */
 539                if (sensebuf[0] == 0x72 &&      /* format is "descriptor" */
 540                    desc[0] == 0x09) {          /* code is "ATA Descriptor" */
 541                        args[0] = desc[13];     /* status */
 542                        args[1] = desc[3];      /* error */
 543                        args[2] = desc[5];      /* sector count (0:7) */
 544                        if (copy_to_user(arg, args, sizeof(args)))
 545                                rc = -EFAULT;
 546                }
 547        }
 548
 549
 550        if (cmd_result) {
 551                rc = -EIO;
 552                goto error;
 553        }
 554
 555        if ((argbuf)
 556         && copy_to_user(arg + sizeof(args), argbuf, argsize))
 557                rc = -EFAULT;
 558error:
 559        kfree(sensebuf);
 560        kfree(argbuf);
 561        return rc;
 562}
 563
 564/**
 565 *      ata_task_ioctl - Handler for HDIO_DRIVE_TASK ioctl
 566 *      @scsidev: Device to which we are issuing command
 567 *      @arg: User provided data for issuing command
 568 *
 569 *      LOCKING:
 570 *      Defined by the SCSI layer.  We don't really care.
 571 *
 572 *      RETURNS:
 573 *      Zero on success, negative errno on error.
 574 */
 575int ata_task_ioctl(struct scsi_device *scsidev, void __user *arg)
 576{
 577        int rc = 0;
 578        u8 scsi_cmd[MAX_COMMAND_SIZE];
 579        u8 args[7], *sensebuf = NULL;
 580        int cmd_result;
 581
 582        if (arg == NULL)
 583                return -EINVAL;
 584
 585        if (copy_from_user(args, arg, sizeof(args)))
 586                return -EFAULT;
 587
 588        sensebuf = kzalloc(SCSI_SENSE_BUFFERSIZE, GFP_NOIO);
 589        if (!sensebuf)
 590                return -ENOMEM;
 591
 592        memset(scsi_cmd, 0, sizeof(scsi_cmd));
 593        scsi_cmd[0]  = ATA_16;
 594        scsi_cmd[1]  = (3 << 1); /* Non-data */
 595        scsi_cmd[2]  = 0x20;     /* cc but no off.line or data xfer */
 596        scsi_cmd[4]  = args[1];
 597        scsi_cmd[6]  = args[2];
 598        scsi_cmd[8]  = args[3];
 599        scsi_cmd[10] = args[4];
 600        scsi_cmd[12] = args[5];
 601        scsi_cmd[13] = args[6] & 0x4f;
 602        scsi_cmd[14] = args[0];
 603
 604        /* Good values for timeout and retries?  Values below
 605           from scsi_ioctl_send_command() for default case... */
 606        cmd_result = scsi_execute(scsidev, scsi_cmd, DMA_NONE, NULL, 0,
 607                                sensebuf, (10*HZ), 5, 0, NULL);
 608
 609        if (driver_byte(cmd_result) == DRIVER_SENSE) {/* sense data available */
 610                u8 *desc = sensebuf + 8;
 611                cmd_result &= ~(0xFF<<24); /* DRIVER_SENSE is not an error */
 612
 613                /* If we set cc then ATA pass-through will cause a
 614                 * check condition even if no error. Filter that. */
 615                if (cmd_result & SAM_STAT_CHECK_CONDITION) {
 616                        struct scsi_sense_hdr sshdr;
 617                        scsi_normalize_sense(sensebuf, SCSI_SENSE_BUFFERSIZE,
 618                                                &sshdr);
 619                        if (sshdr.sense_key == 0 &&
 620                                sshdr.asc == 0 && sshdr.ascq == 0)
 621                                cmd_result &= ~SAM_STAT_CHECK_CONDITION;
 622                }
 623
 624                /* Send userspace ATA registers */
 625                if (sensebuf[0] == 0x72 &&      /* format is "descriptor" */
 626                                desc[0] == 0x09) {/* code is "ATA Descriptor" */
 627                        args[0] = desc[13];     /* status */
 628                        args[1] = desc[3];      /* error */
 629                        args[2] = desc[5];      /* sector count (0:7) */
 630                        args[3] = desc[7];      /* lbal */
 631                        args[4] = desc[9];      /* lbam */
 632                        args[5] = desc[11];     /* lbah */
 633                        args[6] = desc[12];     /* select */
 634                        if (copy_to_user(arg, args, sizeof(args)))
 635                                rc = -EFAULT;
 636                }
 637        }
 638
 639        if (cmd_result) {
 640                rc = -EIO;
 641                goto error;
 642        }
 643
 644 error:
 645        kfree(sensebuf);
 646        return rc;
 647}
 648
 649static int ata_ioc32(struct ata_port *ap)
 650{
 651        if (ap->flags & ATA_FLAG_PIO_DMA)
 652                return 1;
 653        if (ap->pflags & ATA_PFLAG_PIO32)
 654                return 1;
 655        return 0;
 656}
 657
 658int ata_sas_scsi_ioctl(struct ata_port *ap, struct scsi_device *scsidev,
 659                     int cmd, void __user *arg)
 660{
 661        int val = -EINVAL, rc = -EINVAL;
 662        unsigned long flags;
 663
 664        switch (cmd) {
 665        case ATA_IOC_GET_IO32:
 666                spin_lock_irqsave(ap->lock, flags);
 667                val = ata_ioc32(ap);
 668                spin_unlock_irqrestore(ap->lock, flags);
 669                if (copy_to_user(arg, &val, 1))
 670                        return -EFAULT;
 671                return 0;
 672
 673        case ATA_IOC_SET_IO32:
 674                val = (unsigned long) arg;
 675                rc = 0;
 676                spin_lock_irqsave(ap->lock, flags);
 677                if (ap->pflags & ATA_PFLAG_PIO32CHANGE) {
 678                        if (val)
 679                                ap->pflags |= ATA_PFLAG_PIO32;
 680                        else
 681                                ap->pflags &= ~ATA_PFLAG_PIO32;
 682                } else {
 683                        if (val != ata_ioc32(ap))
 684                                rc = -EINVAL;
 685                }
 686                spin_unlock_irqrestore(ap->lock, flags);
 687                return rc;
 688
 689        case HDIO_GET_IDENTITY:
 690                return ata_get_identity(ap, scsidev, arg);
 691
 692        case HDIO_DRIVE_CMD:
 693                if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
 694                        return -EACCES;
 695                return ata_cmd_ioctl(scsidev, arg);
 696
 697        case HDIO_DRIVE_TASK:
 698                if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
 699                        return -EACCES;
 700                return ata_task_ioctl(scsidev, arg);
 701
 702        default:
 703                rc = -ENOTTY;
 704                break;
 705        }
 706
 707        return rc;
 708}
 709EXPORT_SYMBOL_GPL(ata_sas_scsi_ioctl);
 710
 711int ata_scsi_ioctl(struct scsi_device *scsidev, int cmd, void __user *arg)
 712{
 713        return ata_sas_scsi_ioctl(ata_shost_to_port(scsidev->host),
 714                                scsidev, cmd, arg);
 715}
 716EXPORT_SYMBOL_GPL(ata_scsi_ioctl);
 717
 718/**
 719 *      ata_scsi_qc_new - acquire new ata_queued_cmd reference
 720 *      @dev: ATA device to which the new command is attached
 721 *      @cmd: SCSI command that originated this ATA command
 722 *
 723 *      Obtain a reference to an unused ata_queued_cmd structure,
 724 *      which is the basic libata structure representing a single
 725 *      ATA command sent to the hardware.
 726 *
 727 *      If a command was available, fill in the SCSI-specific
 728 *      portions of the structure with information on the
 729 *      current command.
 730 *
 731 *      LOCKING:
 732 *      spin_lock_irqsave(host lock)
 733 *
 734 *      RETURNS:
 735 *      Command allocated, or %NULL if none available.
 736 */
 737static struct ata_queued_cmd *ata_scsi_qc_new(struct ata_device *dev,
 738                                              struct scsi_cmnd *cmd)
 739{
 740        struct ata_queued_cmd *qc;
 741
 742        qc = ata_qc_new_init(dev);
 743        if (qc) {
 744                qc->scsicmd = cmd;
 745                qc->scsidone = cmd->scsi_done;
 746
 747                qc->sg = scsi_sglist(cmd);
 748                qc->n_elem = scsi_sg_count(cmd);
 749        } else {
 750                cmd->result = (DID_OK << 16) | (QUEUE_FULL << 1);
 751                cmd->scsi_done(cmd);
 752        }
 753
 754        return qc;
 755}
 756
 757static void ata_qc_set_pc_nbytes(struct ata_queued_cmd *qc)
 758{
 759        struct scsi_cmnd *scmd = qc->scsicmd;
 760
 761        qc->extrabytes = scmd->request->extra_len;
 762        qc->nbytes = scsi_bufflen(scmd) + qc->extrabytes;
 763}
 764
 765/**
 766 *      ata_dump_status - user friendly display of error info
 767 *      @id: id of the port in question
 768 *      @tf: ptr to filled out taskfile
 769 *
 770 *      Decode and dump the ATA error/status registers for the user so
 771 *      that they have some idea what really happened at the non
 772 *      make-believe layer.
 773 *
 774 *      LOCKING:
 775 *      inherited from caller
 776 */
 777static void ata_dump_status(unsigned id, struct ata_taskfile *tf)
 778{
 779        u8 stat = tf->command, err = tf->feature;
 780
 781        printk(KERN_WARNING "ata%u: status=0x%02x { ", id, stat);
 782        if (stat & ATA_BUSY) {
 783                printk("Busy }\n");     /* Data is not valid in this case */
 784        } else {
 785                if (stat & 0x40)        printk("DriveReady ");
 786                if (stat & 0x20)        printk("DeviceFault ");
 787                if (stat & 0x10)        printk("SeekComplete ");
 788                if (stat & 0x08)        printk("DataRequest ");
 789                if (stat & 0x04)        printk("CorrectedError ");
 790                if (stat & 0x02)        printk("Index ");
 791                if (stat & 0x01)        printk("Error ");
 792                printk("}\n");
 793
 794                if (err) {
 795                        printk(KERN_WARNING "ata%u: error=0x%02x { ", id, err);
 796                        if (err & 0x04)         printk("DriveStatusError ");
 797                        if (err & 0x80) {
 798                                if (err & 0x04) printk("BadCRC ");
 799                                else            printk("Sector ");
 800                        }
 801                        if (err & 0x40)         printk("UncorrectableError ");
 802                        if (err & 0x10)         printk("SectorIdNotFound ");
 803                        if (err & 0x02)         printk("TrackZeroNotFound ");
 804                        if (err & 0x01)         printk("AddrMarkNotFound ");
 805                        printk("}\n");
 806                }
 807        }
 808}
 809
 810/**
 811 *      ata_to_sense_error - convert ATA error to SCSI error
 812 *      @id: ATA device number
 813 *      @drv_stat: value contained in ATA status register
 814 *      @drv_err: value contained in ATA error register
 815 *      @sk: the sense key we'll fill out
 816 *      @asc: the additional sense code we'll fill out
 817 *      @ascq: the additional sense code qualifier we'll fill out
 818 *      @verbose: be verbose
 819 *
 820 *      Converts an ATA error into a SCSI error.  Fill out pointers to
 821 *      SK, ASC, and ASCQ bytes for later use in fixed or descriptor
 822 *      format sense blocks.
 823 *
 824 *      LOCKING:
 825 *      spin_lock_irqsave(host lock)
 826 */
 827static void ata_to_sense_error(unsigned id, u8 drv_stat, u8 drv_err, u8 *sk,
 828                               u8 *asc, u8 *ascq, int verbose)
 829{
 830        int i;
 831
 832        /* Based on the 3ware driver translation table */
 833        static const unsigned char sense_table[][4] = {
 834                /* BBD|ECC|ID|MAR */
 835                {0xd1,          ABORTED_COMMAND, 0x00, 0x00},   // Device busy                  Aborted command
 836                /* BBD|ECC|ID */
 837                {0xd0,          ABORTED_COMMAND, 0x00, 0x00},   // Device busy                  Aborted command
 838                /* ECC|MC|MARK */
 839                {0x61,          HARDWARE_ERROR, 0x00, 0x00},    // Device fault                 Hardware error
 840                /* ICRC|ABRT */         /* NB: ICRC & !ABRT is BBD */
 841                {0x84,          ABORTED_COMMAND, 0x47, 0x00},   // Data CRC error               SCSI parity error
 842                /* MC|ID|ABRT|TRK0|MARK */
 843                {0x37,          NOT_READY, 0x04, 0x00},         // Unit offline                 Not ready
 844                /* MCR|MARK */
 845                {0x09,          NOT_READY, 0x04, 0x00},         // Unrecovered disk error       Not ready
 846                /*  Bad address mark */
 847                {0x01,          MEDIUM_ERROR, 0x13, 0x00},      // Address mark not found       Address mark not found for data field
 848                /* TRK0 */
 849                {0x02,          HARDWARE_ERROR, 0x00, 0x00},    // Track 0 not found              Hardware error
 850                /* Abort & !ICRC */
 851                {0x04,          ABORTED_COMMAND, 0x00, 0x00},   // Aborted command              Aborted command
 852                /* Media change request */
 853                {0x08,          NOT_READY, 0x04, 0x00},         // Media change request   FIXME: faking offline
 854                /* SRV */
 855                {0x10,          ABORTED_COMMAND, 0x14, 0x00},   // ID not found                 Recorded entity not found
 856                /* Media change */
 857                {0x08,          NOT_READY, 0x04, 0x00},         // Media change           FIXME: faking offline
 858                /* ECC */
 859                {0x40,          MEDIUM_ERROR, 0x11, 0x04},      // Uncorrectable ECC error      Unrecovered read error
 860                /* BBD - block marked bad */
 861                {0x80,          MEDIUM_ERROR, 0x11, 0x04},      // Block marked bad               Medium error, unrecovered read error
 862                {0xFF, 0xFF, 0xFF, 0xFF}, // END mark
 863        };
 864        static const unsigned char stat_table[][4] = {
 865                /* Must be first because BUSY means no other bits valid */
 866                {0x80,          ABORTED_COMMAND, 0x47, 0x00},   // Busy, fake parity for now
 867                {0x20,          HARDWARE_ERROR,  0x00, 0x00},   // Device fault
 868                {0x08,          ABORTED_COMMAND, 0x47, 0x00},   // Timed out in xfer, fake parity for now
 869                {0x04,          RECOVERED_ERROR, 0x11, 0x00},   // Recovered ECC error    Medium error, recovered
 870                {0xFF, 0xFF, 0xFF, 0xFF}, // END mark
 871        };
 872
 873        /*
 874         *      Is this an error we can process/parse
 875         */
 876        if (drv_stat & ATA_BUSY) {
 877                drv_err = 0;    /* Ignore the err bits, they're invalid */
 878        }
 879
 880        if (drv_err) {
 881                /* Look for drv_err */
 882                for (i = 0; sense_table[i][0] != 0xFF; i++) {
 883                        /* Look for best matches first */
 884                        if ((sense_table[i][0] & drv_err) ==
 885                            sense_table[i][0]) {
 886                                *sk = sense_table[i][1];
 887                                *asc = sense_table[i][2];
 888                                *ascq = sense_table[i][3];
 889                                goto translate_done;
 890                        }
 891                }
 892                /* No immediate match */
 893                if (verbose)
 894                        printk(KERN_WARNING "ata%u: no sense translation for "
 895                               "error 0x%02x\n", id, drv_err);
 896        }
 897
 898        /* Fall back to interpreting status bits */
 899        for (i = 0; stat_table[i][0] != 0xFF; i++) {
 900                if (stat_table[i][0] & drv_stat) {
 901                        *sk = stat_table[i][1];
 902                        *asc = stat_table[i][2];
 903                        *ascq = stat_table[i][3];
 904                        goto translate_done;
 905                }
 906        }
 907        /* No error?  Undecoded? */
 908        if (verbose)
 909                printk(KERN_WARNING "ata%u: no sense translation for "
 910                       "status: 0x%02x\n", id, drv_stat);
 911
 912        /* We need a sensible error return here, which is tricky, and one
 913           that won't cause people to do things like return a disk wrongly */
 914        *sk = ABORTED_COMMAND;
 915        *asc = 0x00;
 916        *ascq = 0x00;
 917
 918 translate_done:
 919        if (verbose)
 920                printk(KERN_ERR "ata%u: translated ATA stat/err 0x%02x/%02x "
 921                       "to SCSI SK/ASC/ASCQ 0x%x/%02x/%02x\n",
 922                       id, drv_stat, drv_err, *sk, *asc, *ascq);
 923        return;
 924}
 925
 926/*
 927 *      ata_gen_passthru_sense - Generate check condition sense block.
 928 *      @qc: Command that completed.
 929 *
 930 *      This function is specific to the ATA descriptor format sense
 931 *      block specified for the ATA pass through commands.  Regardless
 932 *      of whether the command errored or not, return a sense
 933 *      block. Copy all controller registers into the sense
 934 *      block. Clear sense key, ASC & ASCQ if there is no error.
 935 *
 936 *      LOCKING:
 937 *      None.
 938 */
 939static void ata_gen_passthru_sense(struct ata_queued_cmd *qc)
 940{
 941        struct scsi_cmnd *cmd = qc->scsicmd;
 942        struct ata_taskfile *tf = &qc->result_tf;
 943        unsigned char *sb = cmd->sense_buffer;
 944        unsigned char *desc = sb + 8;
 945        int verbose = qc->ap->ops->error_handler == NULL;
 946
 947        memset(sb, 0, SCSI_SENSE_BUFFERSIZE);
 948
 949        cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
 950
 951        /*
 952         * Use ata_to_sense_error() to map status register bits
 953         * onto sense key, asc & ascq.
 954         */
 955        if (qc->err_mask ||
 956            tf->command & (ATA_BUSY | ATA_DF | ATA_ERR | ATA_DRQ)) {
 957                ata_to_sense_error(qc->ap->print_id, tf->command, tf->feature,
 958                                   &sb[1], &sb[2], &sb[3], verbose);
 959                sb[1] &= 0x0f;
 960        }
 961
 962        /*
 963         * Sense data is current and format is descriptor.
 964         */
 965        sb[0] = 0x72;
 966
 967        desc[0] = 0x09;
 968
 969        /* set length of additional sense data */
 970        sb[7] = 14;
 971        desc[1] = 12;
 972
 973        /*
 974         * Copy registers into sense buffer.
 975         */
 976        desc[2] = 0x00;
 977        desc[3] = tf->feature;  /* == error reg */
 978        desc[5] = tf->nsect;
 979        desc[7] = tf->lbal;
 980        desc[9] = tf->lbam;
 981        desc[11] = tf->lbah;
 982        desc[12] = tf->device;
 983        desc[13] = tf->command; /* == status reg */
 984
 985        /*
 986         * Fill in Extend bit, and the high order bytes
 987         * if applicable.
 988         */
 989        if (tf->flags & ATA_TFLAG_LBA48) {
 990                desc[2] |= 0x01;
 991                desc[4] = tf->hob_nsect;
 992                desc[6] = tf->hob_lbal;
 993                desc[8] = tf->hob_lbam;
 994                desc[10] = tf->hob_lbah;
 995        }
 996}
 997
 998/**
 999 *      ata_gen_ata_sense - generate a SCSI fixed sense block
1000 *      @qc: Command that we are erroring out
1001 *
1002 *      Generate sense block for a failed ATA command @qc.  Descriptor
1003 *      format is used to accommodate LBA48 block address.
1004 *
1005 *      LOCKING:
1006 *      None.
1007 */
1008static void ata_gen_ata_sense(struct ata_queued_cmd *qc)
1009{
1010        struct ata_device *dev = qc->dev;
1011        struct scsi_cmnd *cmd = qc->scsicmd;
1012        struct ata_taskfile *tf = &qc->result_tf;
1013        unsigned char *sb = cmd->sense_buffer;
1014        unsigned char *desc = sb + 8;
1015        int verbose = qc->ap->ops->error_handler == NULL;
1016        u64 block;
1017
1018        memset(sb, 0, SCSI_SENSE_BUFFERSIZE);
1019
1020        cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
1021
1022        /* sense data is current and format is descriptor */
1023        sb[0] = 0x72;
1024
1025        /* Use ata_to_sense_error() to map status register bits
1026         * onto sense key, asc & ascq.
1027         */
1028        if (qc->err_mask ||
1029            tf->command & (ATA_BUSY | ATA_DF | ATA_ERR | ATA_DRQ)) {
1030                ata_to_sense_error(qc->ap->print_id, tf->command, tf->feature,
1031                                   &sb[1], &sb[2], &sb[3], verbose);
1032                sb[1] &= 0x0f;
1033        }
1034
1035        block = ata_tf_read_block(&qc->result_tf, dev);
1036
1037        /* information sense data descriptor */
1038        sb[7] = 12;
1039        desc[0] = 0x00;
1040        desc[1] = 10;
1041
1042        desc[2] |= 0x80;        /* valid */
1043        desc[6] = block >> 40;
1044        desc[7] = block >> 32;
1045        desc[8] = block >> 24;
1046        desc[9] = block >> 16;
1047        desc[10] = block >> 8;
1048        desc[11] = block;
1049}
1050
1051static void ata_scsi_sdev_config(struct scsi_device *sdev)
1052{
1053        sdev->use_10_for_rw = 1;
1054        sdev->use_10_for_ms = 1;
1055        sdev->no_report_opcodes = 1;
1056        sdev->no_write_same = 1;
1057
1058        /* Schedule policy is determined by ->qc_defer() callback and
1059         * it needs to see every deferred qc.  Set dev_blocked to 1 to
1060         * prevent SCSI midlayer from automatically deferring
1061         * requests.
1062         */
1063        sdev->max_device_blocked = 1;
1064}
1065
1066/**
1067 *      atapi_drain_needed - Check whether data transfer may overflow
1068 *      @rq: request to be checked
1069 *
1070 *      ATAPI commands which transfer variable length data to host
1071 *      might overflow due to application error or hardare bug.  This
1072 *      function checks whether overflow should be drained and ignored
1073 *      for @request.
1074 *
1075 *      LOCKING:
1076 *      None.
1077 *
1078 *      RETURNS:
1079 *      1 if ; otherwise, 0.
1080 */
1081static int atapi_drain_needed(struct request *rq)
1082{
1083        if (likely(rq->cmd_type != REQ_TYPE_BLOCK_PC))
1084                return 0;
1085
1086        if (!blk_rq_bytes(rq) || (rq->cmd_flags & REQ_WRITE))
1087                return 0;
1088
1089        return atapi_cmd_type(rq->cmd[0]) == ATAPI_MISC;
1090}
1091
1092static int ata_scsi_dev_config(struct scsi_device *sdev,
1093                               struct ata_device *dev)
1094{
1095        struct request_queue *q = sdev->request_queue;
1096
1097        if (!ata_id_has_unload(dev->id))
1098                dev->flags |= ATA_DFLAG_NO_UNLOAD;
1099
1100        /* configure max sectors */
1101        blk_queue_max_hw_sectors(q, dev->max_sectors);
1102
1103        if (dev->class == ATA_DEV_ATAPI) {
1104                void *buf;
1105
1106                sdev->sector_size = ATA_SECT_SIZE;
1107
1108                /* set DMA padding */
1109                blk_queue_update_dma_pad(q, ATA_DMA_PAD_SZ - 1);
1110
1111                /* configure draining */
1112                buf = kmalloc(ATAPI_MAX_DRAIN, q->bounce_gfp | GFP_KERNEL);
1113                if (!buf) {
1114                        ata_dev_err(dev, "drain buffer allocation failed\n");
1115                        return -ENOMEM;
1116                }
1117
1118                blk_queue_dma_drain(q, atapi_drain_needed, buf, ATAPI_MAX_DRAIN);
1119        } else {
1120                sdev->sector_size = ata_id_logical_sector_size(dev->id);
1121                sdev->manage_start_stop = 1;
1122        }
1123
1124        /*
1125         * ata_pio_sectors() expects buffer for each sector to not cross
1126         * page boundary.  Enforce it by requiring buffers to be sector
1127         * aligned, which works iff sector_size is not larger than
1128         * PAGE_SIZE.  ATAPI devices also need the alignment as
1129         * IDENTIFY_PACKET is executed as ATA_PROT_PIO.
1130         */
1131        if (sdev->sector_size > PAGE_SIZE)
1132                ata_dev_warn(dev,
1133                        "sector_size=%u > PAGE_SIZE, PIO may malfunction\n",
1134                        sdev->sector_size);
1135
1136        blk_queue_update_dma_alignment(q, sdev->sector_size - 1);
1137
1138        if (dev->flags & ATA_DFLAG_AN)
1139                set_bit(SDEV_EVT_MEDIA_CHANGE, sdev->supported_events);
1140
1141        if (dev->flags & ATA_DFLAG_NCQ) {
1142                int depth;
1143
1144                depth = min(sdev->host->can_queue, ata_id_queue_depth(dev->id));
1145                depth = min(ATA_MAX_QUEUE - 1, depth);
1146                scsi_adjust_queue_depth(sdev, MSG_SIMPLE_TAG, depth);
1147        }
1148
1149        blk_queue_flush_queueable(q, false);
1150
1151        dev->sdev = sdev;
1152        return 0;
1153}
1154
1155/**
1156 *      ata_scsi_slave_config - Set SCSI device attributes
1157 *      @sdev: SCSI device to examine
1158 *
1159 *      This is called before we actually start reading
1160 *      and writing to the device, to configure certain
1161 *      SCSI mid-layer behaviors.
1162 *
1163 *      LOCKING:
1164 *      Defined by SCSI layer.  We don't really care.
1165 */
1166
1167int ata_scsi_slave_config(struct scsi_device *sdev)
1168{
1169        struct ata_port *ap = ata_shost_to_port(sdev->host);
1170        struct ata_device *dev = __ata_scsi_find_dev(ap, sdev);
1171        int rc = 0;
1172
1173        ata_scsi_sdev_config(sdev);
1174
1175        if (dev)
1176                rc = ata_scsi_dev_config(sdev, dev);
1177
1178        return rc;
1179}
1180
1181/**
1182 *      ata_scsi_slave_destroy - SCSI device is about to be destroyed
1183 *      @sdev: SCSI device to be destroyed
1184 *
1185 *      @sdev is about to be destroyed for hot/warm unplugging.  If
1186 *      this unplugging was initiated by libata as indicated by NULL
1187 *      dev->sdev, this function doesn't have to do anything.
1188 *      Otherwise, SCSI layer initiated warm-unplug is in progress.
1189 *      Clear dev->sdev, schedule the device for ATA detach and invoke
1190 *      EH.
1191 *
1192 *      LOCKING:
1193 *      Defined by SCSI layer.  We don't really care.
1194 */
1195void ata_scsi_slave_destroy(struct scsi_device *sdev)
1196{
1197        struct ata_port *ap = ata_shost_to_port(sdev->host);
1198        struct request_queue *q = sdev->request_queue;
1199        unsigned long flags;
1200        struct ata_device *dev;
1201
1202        if (!ap->ops->error_handler)
1203                return;
1204
1205        spin_lock_irqsave(ap->lock, flags);
1206        dev = __ata_scsi_find_dev(ap, sdev);
1207        if (dev && dev->sdev) {
1208                /* SCSI device already in CANCEL state, no need to offline it */
1209                dev->sdev = NULL;
1210                dev->flags |= ATA_DFLAG_DETACH;
1211                ata_port_schedule_eh(ap);
1212        }
1213        spin_unlock_irqrestore(ap->lock, flags);
1214
1215        kfree(q->dma_drain_buffer);
1216        q->dma_drain_buffer = NULL;
1217        q->dma_drain_size = 0;
1218}
1219
1220/**
1221 *      __ata_change_queue_depth - helper for ata_scsi_change_queue_depth
1222 *      @ap: ATA port to which the device change the queue depth
1223 *      @sdev: SCSI device to configure queue depth for
1224 *      @queue_depth: new queue depth
1225 *      @reason: calling context
1226 *
1227 *      libsas and libata have different approaches for associating a sdev to
1228 *      its ata_port.
1229 *
1230 */
1231int __ata_change_queue_depth(struct ata_port *ap, struct scsi_device *sdev,
1232                             int queue_depth, int reason)
1233{
1234        struct ata_device *dev;
1235        unsigned long flags;
1236
1237        if (reason != SCSI_QDEPTH_DEFAULT)
1238                return -EOPNOTSUPP;
1239
1240        if (queue_depth < 1 || queue_depth == sdev->queue_depth)
1241                return sdev->queue_depth;
1242
1243        dev = ata_scsi_find_dev(ap, sdev);
1244        if (!dev || !ata_dev_enabled(dev))
1245                return sdev->queue_depth;
1246
1247        /* NCQ enabled? */
1248        spin_lock_irqsave(ap->lock, flags);
1249        dev->flags &= ~ATA_DFLAG_NCQ_OFF;
1250        if (queue_depth == 1 || !ata_ncq_enabled(dev)) {
1251                dev->flags |= ATA_DFLAG_NCQ_OFF;
1252                queue_depth = 1;
1253        }
1254        spin_unlock_irqrestore(ap->lock, flags);
1255
1256        /* limit and apply queue depth */
1257        queue_depth = min(queue_depth, sdev->host->can_queue);
1258        queue_depth = min(queue_depth, ata_id_queue_depth(dev->id));
1259        queue_depth = min(queue_depth, ATA_MAX_QUEUE - 1);
1260
1261        if (sdev->queue_depth == queue_depth)
1262                return -EINVAL;
1263
1264        scsi_adjust_queue_depth(sdev, MSG_SIMPLE_TAG, queue_depth);
1265        return queue_depth;
1266}
1267
1268/**
1269 *      ata_scsi_change_queue_depth - SCSI callback for queue depth config
1270 *      @sdev: SCSI device to configure queue depth for
1271 *      @queue_depth: new queue depth
1272 *      @reason: calling context
1273 *
1274 *      This is libata standard hostt->change_queue_depth callback.
1275 *      SCSI will call into this callback when user tries to set queue
1276 *      depth via sysfs.
1277 *
1278 *      LOCKING:
1279 *      SCSI layer (we don't care)
1280 *
1281 *      RETURNS:
1282 *      Newly configured queue depth.
1283 */
1284int ata_scsi_change_queue_depth(struct scsi_device *sdev, int queue_depth,
1285                                int reason)
1286{
1287        struct ata_port *ap = ata_shost_to_port(sdev->host);
1288
1289        return __ata_change_queue_depth(ap, sdev, queue_depth, reason);
1290}
1291
1292/**
1293 *      ata_scsi_start_stop_xlat - Translate SCSI START STOP UNIT command
1294 *      @qc: Storage for translated ATA taskfile
1295 *
1296 *      Sets up an ATA taskfile to issue STANDBY (to stop) or READ VERIFY
1297 *      (to start). Perhaps these commands should be preceded by
1298 *      CHECK POWER MODE to see what power mode the device is already in.
1299 *      [See SAT revision 5 at www.t10.org]
1300 *
1301 *      LOCKING:
1302 *      spin_lock_irqsave(host lock)
1303 *
1304 *      RETURNS:
1305 *      Zero on success, non-zero on error.
1306 */
1307static unsigned int ata_scsi_start_stop_xlat(struct ata_queued_cmd *qc)
1308{
1309        struct scsi_cmnd *scmd = qc->scsicmd;
1310        struct ata_taskfile *tf = &qc->tf;
1311        const u8 *cdb = scmd->cmnd;
1312
1313        if (scmd->cmd_len < 5)
1314                goto invalid_fld;
1315
1316        tf->flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
1317        tf->protocol = ATA_PROT_NODATA;
1318        if (cdb[1] & 0x1) {
1319                ;       /* ignore IMMED bit, violates sat-r05 */
1320        }
1321        if (cdb[4] & 0x2)
1322                goto invalid_fld;       /* LOEJ bit set not supported */
1323        if (((cdb[4] >> 4) & 0xf) != 0)
1324                goto invalid_fld;       /* power conditions not supported */
1325
1326        if (cdb[4] & 0x1) {
1327                tf->nsect = 1;  /* 1 sector, lba=0 */
1328
1329                if (qc->dev->flags & ATA_DFLAG_LBA) {
1330                        tf->flags |= ATA_TFLAG_LBA;
1331
1332                        tf->lbah = 0x0;
1333                        tf->lbam = 0x0;
1334                        tf->lbal = 0x0;
1335                        tf->device |= ATA_LBA;
1336                } else {
1337                        /* CHS */
1338                        tf->lbal = 0x1; /* sect */
1339                        tf->lbam = 0x0; /* cyl low */
1340                        tf->lbah = 0x0; /* cyl high */
1341                }
1342
1343                tf->command = ATA_CMD_VERIFY;   /* READ VERIFY */
1344        } else {
1345                /* Some odd clown BIOSen issue spindown on power off (ACPI S4
1346                 * or S5) causing some drives to spin up and down again.
1347                 */
1348                if ((qc->ap->flags & ATA_FLAG_NO_POWEROFF_SPINDOWN) &&
1349                    system_state == SYSTEM_POWER_OFF)
1350                        goto skip;
1351
1352                if ((qc->ap->flags & ATA_FLAG_NO_HIBERNATE_SPINDOWN) &&
1353                     system_entering_hibernation())
1354                        goto skip;
1355
1356                /* Issue ATA STANDBY IMMEDIATE command */
1357                tf->command = ATA_CMD_STANDBYNOW1;
1358        }
1359
1360        /*
1361         * Standby and Idle condition timers could be implemented but that
1362         * would require libata to implement the Power condition mode page
1363         * and allow the user to change it. Changing mode pages requires
1364         * MODE SELECT to be implemented.
1365         */
1366
1367        return 0;
1368
1369 invalid_fld:
1370        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x0);
1371        /* "Invalid field in cbd" */
1372        return 1;
1373 skip:
1374        scmd->result = SAM_STAT_GOOD;
1375        return 1;
1376}
1377
1378
1379/**
1380 *      ata_scsi_flush_xlat - Translate SCSI SYNCHRONIZE CACHE command
1381 *      @qc: Storage for translated ATA taskfile
1382 *
1383 *      Sets up an ATA taskfile to issue FLUSH CACHE or
1384 *      FLUSH CACHE EXT.
1385 *
1386 *      LOCKING:
1387 *      spin_lock_irqsave(host lock)
1388 *
1389 *      RETURNS:
1390 *      Zero on success, non-zero on error.
1391 */
1392static unsigned int ata_scsi_flush_xlat(struct ata_queued_cmd *qc)
1393{
1394        struct ata_taskfile *tf = &qc->tf;
1395
1396        tf->flags |= ATA_TFLAG_DEVICE;
1397        tf->protocol = ATA_PROT_NODATA;
1398
1399        if (qc->dev->flags & ATA_DFLAG_FLUSH_EXT)
1400                tf->command = ATA_CMD_FLUSH_EXT;
1401        else
1402                tf->command = ATA_CMD_FLUSH;
1403
1404        /* flush is critical for IO integrity, consider it an IO command */
1405        qc->flags |= ATA_QCFLAG_IO;
1406
1407        return 0;
1408}
1409
1410/**
1411 *      scsi_6_lba_len - Get LBA and transfer length
1412 *      @cdb: SCSI command to translate
1413 *
1414 *      Calculate LBA and transfer length for 6-byte commands.
1415 *
1416 *      RETURNS:
1417 *      @plba: the LBA
1418 *      @plen: the transfer length
1419 */
1420static void scsi_6_lba_len(const u8 *cdb, u64 *plba, u32 *plen)
1421{
1422        u64 lba = 0;
1423        u32 len;
1424
1425        VPRINTK("six-byte command\n");
1426
1427        lba |= ((u64)(cdb[1] & 0x1f)) << 16;
1428        lba |= ((u64)cdb[2]) << 8;
1429        lba |= ((u64)cdb[3]);
1430
1431        len = cdb[4];
1432
1433        *plba = lba;
1434        *plen = len;
1435}
1436
1437/**
1438 *      scsi_10_lba_len - Get LBA and transfer length
1439 *      @cdb: SCSI command to translate
1440 *
1441 *      Calculate LBA and transfer length for 10-byte commands.
1442 *
1443 *      RETURNS:
1444 *      @plba: the LBA
1445 *      @plen: the transfer length
1446 */
1447static void scsi_10_lba_len(const u8 *cdb, u64 *plba, u32 *plen)
1448{
1449        u64 lba = 0;
1450        u32 len = 0;
1451
1452        VPRINTK("ten-byte command\n");
1453
1454        lba |= ((u64)cdb[2]) << 24;
1455        lba |= ((u64)cdb[3]) << 16;
1456        lba |= ((u64)cdb[4]) << 8;
1457        lba |= ((u64)cdb[5]);
1458
1459        len |= ((u32)cdb[7]) << 8;
1460        len |= ((u32)cdb[8]);
1461
1462        *plba = lba;
1463        *plen = len;
1464}
1465
1466/**
1467 *      scsi_16_lba_len - Get LBA and transfer length
1468 *      @cdb: SCSI command to translate
1469 *
1470 *      Calculate LBA and transfer length for 16-byte commands.
1471 *
1472 *      RETURNS:
1473 *      @plba: the LBA
1474 *      @plen: the transfer length
1475 */
1476static void scsi_16_lba_len(const u8 *cdb, u64 *plba, u32 *plen)
1477{
1478        u64 lba = 0;
1479        u32 len = 0;
1480
1481        VPRINTK("sixteen-byte command\n");
1482
1483        lba |= ((u64)cdb[2]) << 56;
1484        lba |= ((u64)cdb[3]) << 48;
1485        lba |= ((u64)cdb[4]) << 40;
1486        lba |= ((u64)cdb[5]) << 32;
1487        lba |= ((u64)cdb[6]) << 24;
1488        lba |= ((u64)cdb[7]) << 16;
1489        lba |= ((u64)cdb[8]) << 8;
1490        lba |= ((u64)cdb[9]);
1491
1492        len |= ((u32)cdb[10]) << 24;
1493        len |= ((u32)cdb[11]) << 16;
1494        len |= ((u32)cdb[12]) << 8;
1495        len |= ((u32)cdb[13]);
1496
1497        *plba = lba;
1498        *plen = len;
1499}
1500
1501/**
1502 *      ata_scsi_verify_xlat - Translate SCSI VERIFY command into an ATA one
1503 *      @qc: Storage for translated ATA taskfile
1504 *
1505 *      Converts SCSI VERIFY command to an ATA READ VERIFY command.
1506 *
1507 *      LOCKING:
1508 *      spin_lock_irqsave(host lock)
1509 *
1510 *      RETURNS:
1511 *      Zero on success, non-zero on error.
1512 */
1513static unsigned int ata_scsi_verify_xlat(struct ata_queued_cmd *qc)
1514{
1515        struct scsi_cmnd *scmd = qc->scsicmd;
1516        struct ata_taskfile *tf = &qc->tf;
1517        struct ata_device *dev = qc->dev;
1518        u64 dev_sectors = qc->dev->n_sectors;
1519        const u8 *cdb = scmd->cmnd;
1520        u64 block;
1521        u32 n_block;
1522
1523        tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1524        tf->protocol = ATA_PROT_NODATA;
1525
1526        if (cdb[0] == VERIFY) {
1527                if (scmd->cmd_len < 10)
1528                        goto invalid_fld;
1529                scsi_10_lba_len(cdb, &block, &n_block);
1530        } else if (cdb[0] == VERIFY_16) {
1531                if (scmd->cmd_len < 16)
1532                        goto invalid_fld;
1533                scsi_16_lba_len(cdb, &block, &n_block);
1534        } else
1535                goto invalid_fld;
1536
1537        if (!n_block)
1538                goto nothing_to_do;
1539        if (block >= dev_sectors)
1540                goto out_of_range;
1541        if ((block + n_block) > dev_sectors)
1542                goto out_of_range;
1543
1544        if (dev->flags & ATA_DFLAG_LBA) {
1545                tf->flags |= ATA_TFLAG_LBA;
1546
1547                if (lba_28_ok(block, n_block)) {
1548                        /* use LBA28 */
1549                        tf->command = ATA_CMD_VERIFY;
1550                        tf->device |= (block >> 24) & 0xf;
1551                } else if (lba_48_ok(block, n_block)) {
1552                        if (!(dev->flags & ATA_DFLAG_LBA48))
1553                                goto out_of_range;
1554
1555                        /* use LBA48 */
1556                        tf->flags |= ATA_TFLAG_LBA48;
1557                        tf->command = ATA_CMD_VERIFY_EXT;
1558
1559                        tf->hob_nsect = (n_block >> 8) & 0xff;
1560
1561                        tf->hob_lbah = (block >> 40) & 0xff;
1562                        tf->hob_lbam = (block >> 32) & 0xff;
1563                        tf->hob_lbal = (block >> 24) & 0xff;
1564                } else
1565                        /* request too large even for LBA48 */
1566                        goto out_of_range;
1567
1568                tf->nsect = n_block & 0xff;
1569
1570                tf->lbah = (block >> 16) & 0xff;
1571                tf->lbam = (block >> 8) & 0xff;
1572                tf->lbal = block & 0xff;
1573
1574                tf->device |= ATA_LBA;
1575        } else {
1576                /* CHS */
1577                u32 sect, head, cyl, track;
1578
1579                if (!lba_28_ok(block, n_block))
1580                        goto out_of_range;
1581
1582                /* Convert LBA to CHS */
1583                track = (u32)block / dev->sectors;
1584                cyl   = track / dev->heads;
1585                head  = track % dev->heads;
1586                sect  = (u32)block % dev->sectors + 1;
1587
1588                DPRINTK("block %u track %u cyl %u head %u sect %u\n",
1589                        (u32)block, track, cyl, head, sect);
1590
1591                /* Check whether the converted CHS can fit.
1592                   Cylinder: 0-65535
1593                   Head: 0-15
1594                   Sector: 1-255*/
1595                if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect))
1596                        goto out_of_range;
1597
1598                tf->command = ATA_CMD_VERIFY;
1599                tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */
1600                tf->lbal = sect;
1601                tf->lbam = cyl;
1602                tf->lbah = cyl >> 8;
1603                tf->device |= head;
1604        }
1605
1606        return 0;
1607
1608invalid_fld:
1609        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x0);
1610        /* "Invalid field in cbd" */
1611        return 1;
1612
1613out_of_range:
1614        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x21, 0x0);
1615        /* "Logical Block Address out of range" */
1616        return 1;
1617
1618nothing_to_do:
1619        scmd->result = SAM_STAT_GOOD;
1620        return 1;
1621}
1622
1623/**
1624 *      ata_scsi_rw_xlat - Translate SCSI r/w command into an ATA one
1625 *      @qc: Storage for translated ATA taskfile
1626 *
1627 *      Converts any of six SCSI read/write commands into the
1628 *      ATA counterpart, including starting sector (LBA),
1629 *      sector count, and taking into account the device's LBA48
1630 *      support.
1631 *
1632 *      Commands %READ_6, %READ_10, %READ_16, %WRITE_6, %WRITE_10, and
1633 *      %WRITE_16 are currently supported.
1634 *
1635 *      LOCKING:
1636 *      spin_lock_irqsave(host lock)
1637 *
1638 *      RETURNS:
1639 *      Zero on success, non-zero on error.
1640 */
1641static unsigned int ata_scsi_rw_xlat(struct ata_queued_cmd *qc)
1642{
1643        struct scsi_cmnd *scmd = qc->scsicmd;
1644        const u8 *cdb = scmd->cmnd;
1645        unsigned int tf_flags = 0;
1646        u64 block;
1647        u32 n_block;
1648        int rc;
1649
1650        if (cdb[0] == WRITE_10 || cdb[0] == WRITE_6 || cdb[0] == WRITE_16)
1651                tf_flags |= ATA_TFLAG_WRITE;
1652
1653        /* Calculate the SCSI LBA, transfer length and FUA. */
1654        switch (cdb[0]) {
1655        case READ_10:
1656        case WRITE_10:
1657                if (unlikely(scmd->cmd_len < 10))
1658                        goto invalid_fld;
1659                scsi_10_lba_len(cdb, &block, &n_block);
1660                if (cdb[1] & (1 << 3))
1661                        tf_flags |= ATA_TFLAG_FUA;
1662                break;
1663        case READ_6:
1664        case WRITE_6:
1665                if (unlikely(scmd->cmd_len < 6))
1666                        goto invalid_fld;
1667                scsi_6_lba_len(cdb, &block, &n_block);
1668
1669                /* for 6-byte r/w commands, transfer length 0
1670                 * means 256 blocks of data, not 0 block.
1671                 */
1672                if (!n_block)
1673                        n_block = 256;
1674                break;
1675        case READ_16:
1676        case WRITE_16:
1677                if (unlikely(scmd->cmd_len < 16))
1678                        goto invalid_fld;
1679                scsi_16_lba_len(cdb, &block, &n_block);
1680                if (cdb[1] & (1 << 3))
1681                        tf_flags |= ATA_TFLAG_FUA;
1682                break;
1683        default:
1684                DPRINTK("no-byte command\n");
1685                goto invalid_fld;
1686        }
1687
1688        /* Check and compose ATA command */
1689        if (!n_block)
1690                /* For 10-byte and 16-byte SCSI R/W commands, transfer
1691                 * length 0 means transfer 0 block of data.
1692                 * However, for ATA R/W commands, sector count 0 means
1693                 * 256 or 65536 sectors, not 0 sectors as in SCSI.
1694                 *
1695                 * WARNING: one or two older ATA drives treat 0 as 0...
1696                 */
1697                goto nothing_to_do;
1698
1699        qc->flags |= ATA_QCFLAG_IO;
1700        qc->nbytes = n_block * scmd->device->sector_size;
1701
1702        rc = ata_build_rw_tf(&qc->tf, qc->dev, block, n_block, tf_flags,
1703                             qc->tag);
1704        if (likely(rc == 0))
1705                return 0;
1706
1707        if (rc == -ERANGE)
1708                goto out_of_range;
1709        /* treat all other errors as -EINVAL, fall through */
1710invalid_fld:
1711        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x0);
1712        /* "Invalid field in cbd" */
1713        return 1;
1714
1715out_of_range:
1716        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x21, 0x0);
1717        /* "Logical Block Address out of range" */
1718        return 1;
1719
1720nothing_to_do:
1721        scmd->result = SAM_STAT_GOOD;
1722        return 1;
1723}
1724
1725static void ata_scsi_qc_complete(struct ata_queued_cmd *qc)
1726{
1727        struct ata_port *ap = qc->ap;
1728        struct scsi_cmnd *cmd = qc->scsicmd;
1729        u8 *cdb = cmd->cmnd;
1730        int need_sense = (qc->err_mask != 0);
1731
1732        /* For ATA pass thru (SAT) commands, generate a sense block if
1733         * user mandated it or if there's an error.  Note that if we
1734         * generate because the user forced us to, a check condition
1735         * is generated and the ATA register values are returned
1736         * whether the command completed successfully or not. If there
1737         * was no error, SK, ASC and ASCQ will all be zero.
1738         */
1739        if (((cdb[0] == ATA_16) || (cdb[0] == ATA_12)) &&
1740            ((cdb[2] & 0x20) || need_sense)) {
1741                ata_gen_passthru_sense(qc);
1742        } else {
1743                if (!need_sense) {
1744                        cmd->result = SAM_STAT_GOOD;
1745                } else {
1746                        /* TODO: decide which descriptor format to use
1747                         * for 48b LBA devices and call that here
1748                         * instead of the fixed desc, which is only
1749                         * good for smaller LBA (and maybe CHS?)
1750                         * devices.
1751                         */
1752                        ata_gen_ata_sense(qc);
1753                }
1754        }
1755
1756        if (need_sense && !ap->ops->error_handler)
1757                ata_dump_status(ap->print_id, &qc->result_tf);
1758
1759        qc->scsidone(cmd);
1760
1761        ata_qc_free(qc);
1762}
1763
1764/**
1765 *      ata_scsi_translate - Translate then issue SCSI command to ATA device
1766 *      @dev: ATA device to which the command is addressed
1767 *      @cmd: SCSI command to execute
1768 *      @xlat_func: Actor which translates @cmd to an ATA taskfile
1769 *
1770 *      Our ->queuecommand() function has decided that the SCSI
1771 *      command issued can be directly translated into an ATA
1772 *      command, rather than handled internally.
1773 *
1774 *      This function sets up an ata_queued_cmd structure for the
1775 *      SCSI command, and sends that ata_queued_cmd to the hardware.
1776 *
1777 *      The xlat_func argument (actor) returns 0 if ready to execute
1778 *      ATA command, else 1 to finish translation. If 1 is returned
1779 *      then cmd->result (and possibly cmd->sense_buffer) are assumed
1780 *      to be set reflecting an error condition or clean (early)
1781 *      termination.
1782 *
1783 *      LOCKING:
1784 *      spin_lock_irqsave(host lock)
1785 *
1786 *      RETURNS:
1787 *      0 on success, SCSI_ML_QUEUE_DEVICE_BUSY if the command
1788 *      needs to be deferred.
1789 */
1790static int ata_scsi_translate(struct ata_device *dev, struct scsi_cmnd *cmd,
1791                              ata_xlat_func_t xlat_func)
1792{
1793        struct ata_port *ap = dev->link->ap;
1794        struct ata_queued_cmd *qc;
1795        int rc;
1796
1797        VPRINTK("ENTER\n");
1798
1799        qc = ata_scsi_qc_new(dev, cmd);
1800        if (!qc)
1801                goto err_mem;
1802
1803        /* data is present; dma-map it */
1804        if (cmd->sc_data_direction == DMA_FROM_DEVICE ||
1805            cmd->sc_data_direction == DMA_TO_DEVICE) {
1806                if (unlikely(scsi_bufflen(cmd) < 1)) {
1807                        ata_dev_warn(dev, "WARNING: zero len r/w req\n");
1808                        goto err_did;
1809                }
1810
1811                ata_sg_init(qc, scsi_sglist(cmd), scsi_sg_count(cmd));
1812
1813                qc->dma_dir = cmd->sc_data_direction;
1814        }
1815
1816        qc->complete_fn = ata_scsi_qc_complete;
1817
1818        if (xlat_func(qc))
1819                goto early_finish;
1820
1821        if (ap->ops->qc_defer) {
1822                if ((rc = ap->ops->qc_defer(qc)))
1823                        goto defer;
1824        }
1825
1826        /* select device, send command to hardware */
1827        ata_qc_issue(qc);
1828
1829        VPRINTK("EXIT\n");
1830        return 0;
1831
1832early_finish:
1833        ata_qc_free(qc);
1834        cmd->scsi_done(cmd);
1835        DPRINTK("EXIT - early finish (good or error)\n");
1836        return 0;
1837
1838err_did:
1839        ata_qc_free(qc);
1840        cmd->result = (DID_ERROR << 16);
1841        cmd->scsi_done(cmd);
1842err_mem:
1843        DPRINTK("EXIT - internal\n");
1844        return 0;
1845
1846defer:
1847        ata_qc_free(qc);
1848        DPRINTK("EXIT - defer\n");
1849        if (rc == ATA_DEFER_LINK)
1850                return SCSI_MLQUEUE_DEVICE_BUSY;
1851        else
1852                return SCSI_MLQUEUE_HOST_BUSY;
1853}
1854
1855/**
1856 *      ata_scsi_rbuf_get - Map response buffer.
1857 *      @cmd: SCSI command containing buffer to be mapped.
1858 *      @flags: unsigned long variable to store irq enable status
1859 *      @copy_in: copy in from user buffer
1860 *
1861 *      Prepare buffer for simulated SCSI commands.
1862 *
1863 *      LOCKING:
1864 *      spin_lock_irqsave(ata_scsi_rbuf_lock) on success
1865 *
1866 *      RETURNS:
1867 *      Pointer to response buffer.
1868 */
1869static void *ata_scsi_rbuf_get(struct scsi_cmnd *cmd, bool copy_in,
1870                               unsigned long *flags)
1871{
1872        spin_lock_irqsave(&ata_scsi_rbuf_lock, *flags);
1873
1874        memset(ata_scsi_rbuf, 0, ATA_SCSI_RBUF_SIZE);
1875        if (copy_in)
1876                sg_copy_to_buffer(scsi_sglist(cmd), scsi_sg_count(cmd),
1877                                  ata_scsi_rbuf, ATA_SCSI_RBUF_SIZE);
1878        return ata_scsi_rbuf;
1879}
1880
1881/**
1882 *      ata_scsi_rbuf_put - Unmap response buffer.
1883 *      @cmd: SCSI command containing buffer to be unmapped.
1884 *      @copy_out: copy out result
1885 *      @flags: @flags passed to ata_scsi_rbuf_get()
1886 *
1887 *      Returns rbuf buffer.  The result is copied to @cmd's buffer if
1888 *      @copy_back is true.
1889 *
1890 *      LOCKING:
1891 *      Unlocks ata_scsi_rbuf_lock.
1892 */
1893static inline void ata_scsi_rbuf_put(struct scsi_cmnd *cmd, bool copy_out,
1894                                     unsigned long *flags)
1895{
1896        if (copy_out)
1897                sg_copy_from_buffer(scsi_sglist(cmd), scsi_sg_count(cmd),
1898                                    ata_scsi_rbuf, ATA_SCSI_RBUF_SIZE);
1899        spin_unlock_irqrestore(&ata_scsi_rbuf_lock, *flags);
1900}
1901
1902/**
1903 *      ata_scsi_rbuf_fill - wrapper for SCSI command simulators
1904 *      @args: device IDENTIFY data / SCSI command of interest.
1905 *      @actor: Callback hook for desired SCSI command simulator
1906 *
1907 *      Takes care of the hard work of simulating a SCSI command...
1908 *      Mapping the response buffer, calling the command's handler,
1909 *      and handling the handler's return value.  This return value
1910 *      indicates whether the handler wishes the SCSI command to be
1911 *      completed successfully (0), or not (in which case cmd->result
1912 *      and sense buffer are assumed to be set).
1913 *
1914 *      LOCKING:
1915 *      spin_lock_irqsave(host lock)
1916 */
1917static void ata_scsi_rbuf_fill(struct ata_scsi_args *args,
1918                unsigned int (*actor)(struct ata_scsi_args *args, u8 *rbuf))
1919{
1920        u8 *rbuf;
1921        unsigned int rc;
1922        struct scsi_cmnd *cmd = args->cmd;
1923        unsigned long flags;
1924
1925        rbuf = ata_scsi_rbuf_get(cmd, false, &flags);
1926        rc = actor(args, rbuf);
1927        ata_scsi_rbuf_put(cmd, rc == 0, &flags);
1928
1929        if (rc == 0)
1930                cmd->result = SAM_STAT_GOOD;
1931        args->done(cmd);
1932}
1933
1934/**
1935 *      ata_scsiop_inq_std - Simulate INQUIRY command
1936 *      @args: device IDENTIFY data / SCSI command of interest.
1937 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1938 *
1939 *      Returns standard device identification data associated
1940 *      with non-VPD INQUIRY command output.
1941 *
1942 *      LOCKING:
1943 *      spin_lock_irqsave(host lock)
1944 */
1945static unsigned int ata_scsiop_inq_std(struct ata_scsi_args *args, u8 *rbuf)
1946{
1947        const u8 versions[] = {
1948                0x60,   /* SAM-3 (no version claimed) */
1949
1950                0x03,
1951                0x20,   /* SBC-2 (no version claimed) */
1952
1953                0x02,
1954                0x60    /* SPC-3 (no version claimed) */
1955        };
1956        u8 hdr[] = {
1957                TYPE_DISK,
1958                0,
1959                0x5,    /* claim SPC-3 version compatibility */
1960                2,
1961                95 - 4
1962        };
1963
1964        VPRINTK("ENTER\n");
1965
1966        /* set scsi removeable (RMB) bit per ata bit */
1967        if (ata_id_removeable(args->id))
1968                hdr[1] |= (1 << 7);
1969
1970        memcpy(rbuf, hdr, sizeof(hdr));
1971        memcpy(&rbuf[8], "ATA     ", 8);
1972        ata_id_string(args->id, &rbuf[16], ATA_ID_PROD, 16);
1973        ata_id_string(args->id, &rbuf[32], ATA_ID_FW_REV, 4);
1974
1975        if (rbuf[32] == 0 || rbuf[32] == ' ')
1976                memcpy(&rbuf[32], "n/a ", 4);
1977
1978        memcpy(rbuf + 59, versions, sizeof(versions));
1979
1980        return 0;
1981}
1982
1983/**
1984 *      ata_scsiop_inq_00 - Simulate INQUIRY VPD page 0, list of pages
1985 *      @args: device IDENTIFY data / SCSI command of interest.
1986 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1987 *
1988 *      Returns list of inquiry VPD pages available.
1989 *
1990 *      LOCKING:
1991 *      spin_lock_irqsave(host lock)
1992 */
1993static unsigned int ata_scsiop_inq_00(struct ata_scsi_args *args, u8 *rbuf)
1994{
1995        const u8 pages[] = {
1996                0x00,   /* page 0x00, this page */
1997                0x80,   /* page 0x80, unit serial no page */
1998                0x83,   /* page 0x83, device ident page */
1999                0x89,   /* page 0x89, ata info page */
2000                0xb0,   /* page 0xb0, block limits page */
2001                0xb1,   /* page 0xb1, block device characteristics page */
2002                0xb2,   /* page 0xb2, thin provisioning page */
2003        };
2004
2005        rbuf[3] = sizeof(pages);        /* number of supported VPD pages */
2006        memcpy(rbuf + 4, pages, sizeof(pages));
2007        return 0;
2008}
2009
2010/**
2011 *      ata_scsiop_inq_80 - Simulate INQUIRY VPD page 80, device serial number
2012 *      @args: device IDENTIFY data / SCSI command of interest.
2013 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2014 *
2015 *      Returns ATA device serial number.
2016 *
2017 *      LOCKING:
2018 *      spin_lock_irqsave(host lock)
2019 */
2020static unsigned int ata_scsiop_inq_80(struct ata_scsi_args *args, u8 *rbuf)
2021{
2022        const u8 hdr[] = {
2023                0,
2024                0x80,                   /* this page code */
2025                0,
2026                ATA_ID_SERNO_LEN,       /* page len */
2027        };
2028
2029        memcpy(rbuf, hdr, sizeof(hdr));
2030        ata_id_string(args->id, (unsigned char *) &rbuf[4],
2031                      ATA_ID_SERNO, ATA_ID_SERNO_LEN);
2032        return 0;
2033}
2034
2035/**
2036 *      ata_scsiop_inq_83 - Simulate INQUIRY VPD page 83, device identity
2037 *      @args: device IDENTIFY data / SCSI command of interest.
2038 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2039 *
2040 *      Yields two logical unit device identification designators:
2041 *       - vendor specific ASCII containing the ATA serial number
2042 *       - SAT defined "t10 vendor id based" containing ASCII vendor
2043 *         name ("ATA     "), model and serial numbers.
2044 *
2045 *      LOCKING:
2046 *      spin_lock_irqsave(host lock)
2047 */
2048static unsigned int ata_scsiop_inq_83(struct ata_scsi_args *args, u8 *rbuf)
2049{
2050        const int sat_model_serial_desc_len = 68;
2051        int num;
2052
2053        rbuf[1] = 0x83;                 /* this page code */
2054        num = 4;
2055
2056        /* piv=0, assoc=lu, code_set=ACSII, designator=vendor */
2057        rbuf[num + 0] = 2;
2058        rbuf[num + 3] = ATA_ID_SERNO_LEN;
2059        num += 4;
2060        ata_id_string(args->id, (unsigned char *) rbuf + num,
2061                      ATA_ID_SERNO, ATA_ID_SERNO_LEN);
2062        num += ATA_ID_SERNO_LEN;
2063
2064        /* SAT defined lu model and serial numbers descriptor */
2065        /* piv=0, assoc=lu, code_set=ACSII, designator=t10 vendor id */
2066        rbuf[num + 0] = 2;
2067        rbuf[num + 1] = 1;
2068        rbuf[num + 3] = sat_model_serial_desc_len;
2069        num += 4;
2070        memcpy(rbuf + num, "ATA     ", 8);
2071        num += 8;
2072        ata_id_string(args->id, (unsigned char *) rbuf + num, ATA_ID_PROD,
2073                      ATA_ID_PROD_LEN);
2074        num += ATA_ID_PROD_LEN;
2075        ata_id_string(args->id, (unsigned char *) rbuf + num, ATA_ID_SERNO,
2076                      ATA_ID_SERNO_LEN);
2077        num += ATA_ID_SERNO_LEN;
2078
2079        if (ata_id_has_wwn(args->id)) {
2080                /* SAT defined lu world wide name */
2081                /* piv=0, assoc=lu, code_set=binary, designator=NAA */
2082                rbuf[num + 0] = 1;
2083                rbuf[num + 1] = 3;
2084                rbuf[num + 3] = ATA_ID_WWN_LEN;
2085                num += 4;
2086                ata_id_string(args->id, (unsigned char *) rbuf + num,
2087                              ATA_ID_WWN, ATA_ID_WWN_LEN);
2088                num += ATA_ID_WWN_LEN;
2089        }
2090        rbuf[3] = num - 4;    /* page len (assume less than 256 bytes) */
2091        return 0;
2092}
2093
2094/**
2095 *      ata_scsiop_inq_89 - Simulate INQUIRY VPD page 89, ATA info
2096 *      @args: device IDENTIFY data / SCSI command of interest.
2097 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2098 *
2099 *      Yields SAT-specified ATA VPD page.
2100 *
2101 *      LOCKING:
2102 *      spin_lock_irqsave(host lock)
2103 */
2104static unsigned int ata_scsiop_inq_89(struct ata_scsi_args *args, u8 *rbuf)
2105{
2106        struct ata_taskfile tf;
2107
2108        memset(&tf, 0, sizeof(tf));
2109
2110        rbuf[1] = 0x89;                 /* our page code */
2111        rbuf[2] = (0x238 >> 8);         /* page size fixed at 238h */
2112        rbuf[3] = (0x238 & 0xff);
2113
2114        memcpy(&rbuf[8], "linux   ", 8);
2115        memcpy(&rbuf[16], "libata          ", 16);
2116        memcpy(&rbuf[32], DRV_VERSION, 4);
2117        ata_id_string(args->id, &rbuf[32], ATA_ID_FW_REV, 4);
2118
2119        /* we don't store the ATA device signature, so we fake it */
2120
2121        tf.command = ATA_DRDY;          /* really, this is Status reg */
2122        tf.lbal = 0x1;
2123        tf.nsect = 0x1;
2124
2125        ata_tf_to_fis(&tf, 0, 1, &rbuf[36]);    /* TODO: PMP? */
2126        rbuf[36] = 0x34;                /* force D2H Reg FIS (34h) */
2127
2128        rbuf[56] = ATA_CMD_ID_ATA;
2129
2130        memcpy(&rbuf[60], &args->id[0], 512);
2131        return 0;
2132}
2133
2134static unsigned int ata_scsiop_inq_b0(struct ata_scsi_args *args, u8 *rbuf)
2135{
2136        u16 min_io_sectors;
2137
2138        rbuf[1] = 0xb0;
2139        rbuf[3] = 0x3c;         /* required VPD size with unmap support */
2140
2141        /*
2142         * Optimal transfer length granularity.
2143         *
2144         * This is always one physical block, but for disks with a smaller
2145         * logical than physical sector size we need to figure out what the
2146         * latter is.
2147         */
2148        min_io_sectors = 1 << ata_id_log2_per_physical_sector(args->id);
2149        put_unaligned_be16(min_io_sectors, &rbuf[6]);
2150
2151        /*
2152         * Optimal unmap granularity.
2153         *
2154         * The ATA spec doesn't even know about a granularity or alignment
2155         * for the TRIM command.  We can leave away most of the unmap related
2156         * VPD page entries, but we have specifify a granularity to signal
2157         * that we support some form of unmap - in thise case via WRITE SAME
2158         * with the unmap bit set.
2159         */
2160        if (ata_id_has_trim(args->id)) {
2161                put_unaligned_be64(65535 * 512 / 8, &rbuf[36]);
2162                put_unaligned_be32(1, &rbuf[28]);
2163        }
2164
2165        return 0;
2166}
2167
2168static unsigned int ata_scsiop_inq_b1(struct ata_scsi_args *args, u8 *rbuf)
2169{
2170        int form_factor = ata_id_form_factor(args->id);
2171        int media_rotation_rate = ata_id_rotation_rate(args->id);
2172
2173        rbuf[1] = 0xb1;
2174        rbuf[3] = 0x3c;
2175        rbuf[4] = media_rotation_rate >> 8;
2176        rbuf[5] = media_rotation_rate;
2177        rbuf[7] = form_factor;
2178
2179        return 0;
2180}
2181
2182static unsigned int ata_scsiop_inq_b2(struct ata_scsi_args *args, u8 *rbuf)
2183{
2184        /* SCSI Thin Provisioning VPD page: SBC-3 rev 22 or later */
2185        rbuf[1] = 0xb2;
2186        rbuf[3] = 0x4;
2187        rbuf[5] = 1 << 6;       /* TPWS */
2188
2189        return 0;
2190}
2191
2192/**
2193 *      ata_scsiop_noop - Command handler that simply returns success.
2194 *      @args: device IDENTIFY data / SCSI command of interest.
2195 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2196 *
2197 *      No operation.  Simply returns success to caller, to indicate
2198 *      that the caller should successfully complete this SCSI command.
2199 *
2200 *      LOCKING:
2201 *      spin_lock_irqsave(host lock)
2202 */
2203static unsigned int ata_scsiop_noop(struct ata_scsi_args *args, u8 *rbuf)
2204{
2205        VPRINTK("ENTER\n");
2206        return 0;
2207}
2208
2209/**
2210 *      modecpy - Prepare response for MODE SENSE
2211 *      @dest: output buffer
2212 *      @src: data being copied
2213 *      @n: length of mode page
2214 *      @changeable: whether changeable parameters are requested
2215 *
2216 *      Generate a generic MODE SENSE page for either current or changeable
2217 *      parameters.
2218 *
2219 *      LOCKING:
2220 *      None.
2221 */
2222static void modecpy(u8 *dest, const u8 *src, int n, bool changeable)
2223{
2224        if (changeable) {
2225                memcpy(dest, src, 2);
2226                memset(dest + 2, 0, n - 2);
2227        } else {
2228                memcpy(dest, src, n);
2229        }
2230}
2231
2232/**
2233 *      ata_msense_caching - Simulate MODE SENSE caching info page
2234 *      @id: device IDENTIFY data
2235 *      @buf: output buffer
2236 *      @changeable: whether changeable parameters are requested
2237 *
2238 *      Generate a caching info page, which conditionally indicates
2239 *      write caching to the SCSI layer, depending on device
2240 *      capabilities.
2241 *
2242 *      LOCKING:
2243 *      None.
2244 */
2245static unsigned int ata_msense_caching(u16 *id, u8 *buf, bool changeable)
2246{
2247        modecpy(buf, def_cache_mpage, sizeof(def_cache_mpage), changeable);
2248        if (changeable || ata_id_wcache_enabled(id))
2249                buf[2] |= (1 << 2);     /* write cache enable */
2250        if (!changeable && !ata_id_rahead_enabled(id))
2251                buf[12] |= (1 << 5);    /* disable read ahead */
2252        return sizeof(def_cache_mpage);
2253}
2254
2255/**
2256 *      ata_msense_ctl_mode - Simulate MODE SENSE control mode page
2257 *      @buf: output buffer
2258 *      @changeable: whether changeable parameters are requested
2259 *
2260 *      Generate a generic MODE SENSE control mode page.
2261 *
2262 *      LOCKING:
2263 *      None.
2264 */
2265static unsigned int ata_msense_ctl_mode(u8 *buf, bool changeable)
2266{
2267        modecpy(buf, def_control_mpage, sizeof(def_control_mpage), changeable);
2268        return sizeof(def_control_mpage);
2269}
2270
2271/**
2272 *      ata_msense_rw_recovery - Simulate MODE SENSE r/w error recovery page
2273 *      @buf: output buffer
2274 *      @changeable: whether changeable parameters are requested
2275 *
2276 *      Generate a generic MODE SENSE r/w error recovery page.
2277 *
2278 *      LOCKING:
2279 *      None.
2280 */
2281static unsigned int ata_msense_rw_recovery(u8 *buf, bool changeable)
2282{
2283        modecpy(buf, def_rw_recovery_mpage, sizeof(def_rw_recovery_mpage),
2284                changeable);
2285        return sizeof(def_rw_recovery_mpage);
2286}
2287
2288/*
2289 * We can turn this into a real blacklist if it's needed, for now just
2290 * blacklist any Maxtor BANC1G10 revision firmware
2291 */
2292static int ata_dev_supports_fua(u16 *id)
2293{
2294        unsigned char model[ATA_ID_PROD_LEN + 1], fw[ATA_ID_FW_REV_LEN + 1];
2295
2296        if (!libata_fua)
2297                return 0;
2298        if (!ata_id_has_fua(id))
2299                return 0;
2300
2301        ata_id_c_string(id, model, ATA_ID_PROD, sizeof(model));
2302        ata_id_c_string(id, fw, ATA_ID_FW_REV, sizeof(fw));
2303
2304        if (strcmp(model, "Maxtor"))
2305                return 1;
2306        if (strcmp(fw, "BANC1G10"))
2307                return 1;
2308
2309        return 0; /* blacklisted */
2310}
2311
2312/**
2313 *      ata_scsiop_mode_sense - Simulate MODE SENSE 6, 10 commands
2314 *      @args: device IDENTIFY data / SCSI command of interest.
2315 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2316 *
2317 *      Simulate MODE SENSE commands. Assume this is invoked for direct
2318 *      access devices (e.g. disks) only. There should be no block
2319 *      descriptor for other device types.
2320 *
2321 *      LOCKING:
2322 *      spin_lock_irqsave(host lock)
2323 */
2324static unsigned int ata_scsiop_mode_sense(struct ata_scsi_args *args, u8 *rbuf)
2325{
2326        struct ata_device *dev = args->dev;
2327        u8 *scsicmd = args->cmd->cmnd, *p = rbuf;
2328        const u8 sat_blk_desc[] = {
2329                0, 0, 0, 0,     /* number of blocks: sat unspecified */
2330                0,
2331                0, 0x2, 0x0     /* block length: 512 bytes */
2332        };
2333        u8 pg, spg;
2334        unsigned int ebd, page_control, six_byte;
2335        u8 dpofua;
2336
2337        VPRINTK("ENTER\n");
2338
2339        six_byte = (scsicmd[0] == MODE_SENSE);
2340        ebd = !(scsicmd[1] & 0x8);      /* dbd bit inverted == edb */
2341        /*
2342         * LLBA bit in msense(10) ignored (compliant)
2343         */
2344
2345        page_control = scsicmd[2] >> 6;
2346        switch (page_control) {
2347        case 0: /* current */
2348        case 1: /* changeable */
2349        case 2: /* defaults */
2350                break;  /* supported */
2351        case 3: /* saved */
2352                goto saving_not_supp;
2353        default:
2354                goto invalid_fld;
2355        }
2356
2357        if (six_byte)
2358                p += 4 + (ebd ? 8 : 0);
2359        else
2360                p += 8 + (ebd ? 8 : 0);
2361
2362        pg = scsicmd[2] & 0x3f;
2363        spg = scsicmd[3];
2364        /*
2365         * No mode subpages supported (yet) but asking for _all_
2366         * subpages may be valid
2367         */
2368        if (spg && (spg != ALL_SUB_MPAGES))
2369                goto invalid_fld;
2370
2371        switch(pg) {
2372        case RW_RECOVERY_MPAGE:
2373                p += ata_msense_rw_recovery(p, page_control == 1);
2374                break;
2375
2376        case CACHE_MPAGE:
2377                p += ata_msense_caching(args->id, p, page_control == 1);
2378                break;
2379
2380        case CONTROL_MPAGE:
2381                p += ata_msense_ctl_mode(p, page_control == 1);
2382                break;
2383
2384        case ALL_MPAGES:
2385                p += ata_msense_rw_recovery(p, page_control == 1);
2386                p += ata_msense_caching(args->id, p, page_control == 1);
2387                p += ata_msense_ctl_mode(p, page_control == 1);
2388                break;
2389
2390        default:                /* invalid page code */
2391                goto invalid_fld;
2392        }
2393
2394        dpofua = 0;
2395        if (ata_dev_supports_fua(args->id) && (dev->flags & ATA_DFLAG_LBA48) &&
2396            (!(dev->flags & ATA_DFLAG_PIO) || dev->multi_count))
2397                dpofua = 1 << 4;
2398
2399        if (six_byte) {
2400                rbuf[0] = p - rbuf - 1;
2401                rbuf[2] |= dpofua;
2402                if (ebd) {
2403                        rbuf[3] = sizeof(sat_blk_desc);
2404                        memcpy(rbuf + 4, sat_blk_desc, sizeof(sat_blk_desc));
2405                }
2406        } else {
2407                unsigned int output_len = p - rbuf - 2;
2408
2409                rbuf[0] = output_len >> 8;
2410                rbuf[1] = output_len;
2411                rbuf[3] |= dpofua;
2412                if (ebd) {
2413                        rbuf[7] = sizeof(sat_blk_desc);
2414                        memcpy(rbuf + 8, sat_blk_desc, sizeof(sat_blk_desc));
2415                }
2416        }
2417        return 0;
2418
2419invalid_fld:
2420        ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x24, 0x0);
2421        /* "Invalid field in cbd" */
2422        return 1;
2423
2424saving_not_supp:
2425        ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x39, 0x0);
2426         /* "Saving parameters not supported" */
2427        return 1;
2428}
2429
2430/**
2431 *      ata_scsiop_read_cap - Simulate READ CAPACITY[ 16] commands
2432 *      @args: device IDENTIFY data / SCSI command of interest.
2433 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2434 *
2435 *      Simulate READ CAPACITY commands.
2436 *
2437 *      LOCKING:
2438 *      None.
2439 */
2440static unsigned int ata_scsiop_read_cap(struct ata_scsi_args *args, u8 *rbuf)
2441{
2442        struct ata_device *dev = args->dev;
2443        u64 last_lba = dev->n_sectors - 1; /* LBA of the last block */
2444        u32 sector_size; /* physical sector size in bytes */
2445        u8 log2_per_phys;
2446        u16 lowest_aligned;
2447
2448        sector_size = ata_id_logical_sector_size(dev->id);
2449        log2_per_phys = ata_id_log2_per_physical_sector(dev->id);
2450        lowest_aligned = ata_id_logical_sector_offset(dev->id, log2_per_phys);
2451
2452        VPRINTK("ENTER\n");
2453
2454        if (args->cmd->cmnd[0] == READ_CAPACITY) {
2455                if (last_lba >= 0xffffffffULL)
2456                        last_lba = 0xffffffff;
2457
2458                /* sector count, 32-bit */
2459                rbuf[0] = last_lba >> (8 * 3);
2460                rbuf[1] = last_lba >> (8 * 2);
2461                rbuf[2] = last_lba >> (8 * 1);
2462                rbuf[3] = last_lba;
2463
2464                /* sector size */
2465                rbuf[4] = sector_size >> (8 * 3);
2466                rbuf[5] = sector_size >> (8 * 2);
2467                rbuf[6] = sector_size >> (8 * 1);
2468                rbuf[7] = sector_size;
2469        } else {
2470                /* sector count, 64-bit */
2471                rbuf[0] = last_lba >> (8 * 7);
2472                rbuf[1] = last_lba >> (8 * 6);
2473                rbuf[2] = last_lba >> (8 * 5);
2474                rbuf[3] = last_lba >> (8 * 4);
2475                rbuf[4] = last_lba >> (8 * 3);
2476                rbuf[5] = last_lba >> (8 * 2);
2477                rbuf[6] = last_lba >> (8 * 1);
2478                rbuf[7] = last_lba;
2479
2480                /* sector size */
2481                rbuf[ 8] = sector_size >> (8 * 3);
2482                rbuf[ 9] = sector_size >> (8 * 2);
2483                rbuf[10] = sector_size >> (8 * 1);
2484                rbuf[11] = sector_size;
2485
2486                rbuf[12] = 0;
2487                rbuf[13] = log2_per_phys;
2488                rbuf[14] = (lowest_aligned >> 8) & 0x3f;
2489                rbuf[15] = lowest_aligned;
2490
2491                if (ata_id_has_trim(args->id)) {
2492                        rbuf[14] |= 0x80; /* TPE */
2493
2494                        if (ata_id_has_zero_after_trim(args->id))
2495                                rbuf[14] |= 0x40; /* TPRZ */
2496                }
2497        }
2498
2499        return 0;
2500}
2501
2502/**
2503 *      ata_scsiop_report_luns - Simulate REPORT LUNS command
2504 *      @args: device IDENTIFY data / SCSI command of interest.
2505 *      @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2506 *
2507 *      Simulate REPORT LUNS command.
2508 *
2509 *      LOCKING:
2510 *      spin_lock_irqsave(host lock)
2511 */
2512static unsigned int ata_scsiop_report_luns(struct ata_scsi_args *args, u8 *rbuf)
2513{
2514        VPRINTK("ENTER\n");
2515        rbuf[3] = 8;    /* just one lun, LUN 0, size 8 bytes */
2516
2517        return 0;
2518}
2519
2520static void atapi_sense_complete(struct ata_queued_cmd *qc)
2521{
2522        if (qc->err_mask && ((qc->err_mask & AC_ERR_DEV) == 0)) {
2523                /* FIXME: not quite right; we don't want the
2524                 * translation of taskfile registers into
2525                 * a sense descriptors, since that's only
2526                 * correct for ATA, not ATAPI
2527                 */
2528                ata_gen_passthru_sense(qc);
2529        }
2530
2531        qc->scsidone(qc->scsicmd);
2532        ata_qc_free(qc);
2533}
2534
2535/* is it pointless to prefer PIO for "safety reasons"? */
2536static inline int ata_pio_use_silly(struct ata_port *ap)
2537{
2538        return (ap->flags & ATA_FLAG_PIO_DMA);
2539}
2540
2541static void atapi_request_sense(struct ata_queued_cmd *qc)
2542{
2543        struct ata_port *ap = qc->ap;
2544        struct scsi_cmnd *cmd = qc->scsicmd;
2545
2546        DPRINTK("ATAPI request sense\n");
2547
2548        /* FIXME: is this needed? */
2549        memset(cmd->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
2550
2551#ifdef CONFIG_ATA_SFF
2552        if (ap->ops->sff_tf_read)
2553                ap->ops->sff_tf_read(ap, &qc->tf);
2554#endif
2555
2556        /* fill these in, for the case where they are -not- overwritten */
2557        cmd->sense_buffer[0] = 0x70;
2558        cmd->sense_buffer[2] = qc->tf.feature >> 4;
2559
2560        ata_qc_reinit(qc);
2561
2562        /* setup sg table and init transfer direction */
2563        sg_init_one(&qc->sgent, cmd->sense_buffer, SCSI_SENSE_BUFFERSIZE);
2564        ata_sg_init(qc, &qc->sgent, 1);
2565        qc->dma_dir = DMA_FROM_DEVICE;
2566
2567        memset(&qc->cdb, 0, qc->dev->cdb_len);
2568        qc->cdb[0] = REQUEST_SENSE;
2569        qc->cdb[4] = SCSI_SENSE_BUFFERSIZE;
2570
2571        qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
2572        qc->tf.command = ATA_CMD_PACKET;
2573
2574        if (ata_pio_use_silly(ap)) {
2575                qc->tf.protocol = ATAPI_PROT_DMA;
2576                qc->tf.feature |= ATAPI_PKT_DMA;
2577        } else {
2578                qc->tf.protocol = ATAPI_PROT_PIO;
2579                qc->tf.lbam = SCSI_SENSE_BUFFERSIZE;
2580                qc->tf.lbah = 0;
2581        }
2582        qc->nbytes = SCSI_SENSE_BUFFERSIZE;
2583
2584        qc->complete_fn = atapi_sense_complete;
2585
2586        ata_qc_issue(qc);
2587
2588        DPRINTK("EXIT\n");
2589}
2590
2591static void atapi_qc_complete(struct ata_queued_cmd *qc)
2592{
2593        struct scsi_cmnd *cmd = qc->scsicmd;
2594        unsigned int err_mask = qc->err_mask;
2595
2596        VPRINTK("ENTER, err_mask 0x%X\n", err_mask);
2597
2598        /* handle completion from new EH */
2599        if (unlikely(qc->ap->ops->error_handler &&
2600                     (err_mask || qc->flags & ATA_QCFLAG_SENSE_VALID))) {
2601
2602                if (!(qc->flags & ATA_QCFLAG_SENSE_VALID)) {
2603                        /* FIXME: not quite right; we don't want the
2604                         * translation of taskfile registers into a
2605                         * sense descriptors, since that's only
2606                         * correct for ATA, not ATAPI
2607                         */
2608                        ata_gen_passthru_sense(qc);
2609                }
2610
2611                /* SCSI EH automatically locks door if sdev->locked is
2612                 * set.  Sometimes door lock request continues to
2613                 * fail, for example, when no media is present.  This
2614                 * creates a loop - SCSI EH issues door lock which
2615                 * fails and gets invoked again to acquire sense data
2616                 * for the failed command.
2617                 *
2618                 * If door lock fails, always clear sdev->locked to
2619                 * avoid this infinite loop.
2620                 *
2621                 * This may happen before SCSI scan is complete.  Make
2622                 * sure qc->dev->sdev isn't NULL before dereferencing.
2623                 */
2624                if (qc->cdb[0] == ALLOW_MEDIUM_REMOVAL && qc->dev->sdev)
2625                        qc->dev->sdev->locked = 0;
2626
2627                qc->scsicmd->result = SAM_STAT_CHECK_CONDITION;
2628                qc->scsidone(cmd);
2629                ata_qc_free(qc);
2630                return;
2631        }
2632
2633        /* successful completion or old EH failure path */
2634        if (unlikely(err_mask & AC_ERR_DEV)) {
2635                cmd->result = SAM_STAT_CHECK_CONDITION;
2636                atapi_request_sense(qc);
2637                return;
2638        } else if (unlikely(err_mask)) {
2639                /* FIXME: not quite right; we don't want the
2640                 * translation of taskfile registers into
2641                 * a sense descriptors, since that's only
2642                 * correct for ATA, not ATAPI
2643                 */
2644                ata_gen_passthru_sense(qc);
2645        } else {
2646                u8 *scsicmd = cmd->cmnd;
2647
2648                if ((scsicmd[0] == INQUIRY) && ((scsicmd[1] & 0x03) == 0)) {
2649                        unsigned long flags;
2650                        u8 *buf;
2651
2652                        buf = ata_scsi_rbuf_get(cmd, true, &flags);
2653
2654        /* ATAPI devices typically report zero for their SCSI version,
2655         * and sometimes deviate from the spec WRT response data
2656         * format.  If SCSI version is reported as zero like normal,
2657         * then we make the following fixups:  1) Fake MMC-5 version,
2658         * to indicate to the Linux scsi midlayer this is a modern
2659         * device.  2) Ensure response data format / ATAPI information
2660         * are always correct.
2661         */
2662                        if (buf[2] == 0) {
2663                                buf[2] = 0x5;
2664                                buf[3] = 0x32;
2665                        }
2666
2667                        ata_scsi_rbuf_put(cmd, true, &flags);
2668                }
2669
2670                cmd->result = SAM_STAT_GOOD;
2671        }
2672
2673        qc->scsidone(cmd);
2674        ata_qc_free(qc);
2675}
2676/**
2677 *      atapi_xlat - Initialize PACKET taskfile
2678 *      @qc: command structure to be initialized
2679 *
2680 *      LOCKING:
2681 *      spin_lock_irqsave(host lock)
2682 *
2683 *      RETURNS:
2684 *      Zero on success, non-zero on failure.
2685 */
2686static unsigned int atapi_xlat(struct ata_queued_cmd *qc)
2687{
2688        struct scsi_cmnd *scmd = qc->scsicmd;
2689        struct ata_device *dev = qc->dev;
2690        int nodata = (scmd->sc_data_direction == DMA_NONE);
2691        int using_pio = !nodata && (dev->flags & ATA_DFLAG_PIO);
2692        unsigned int nbytes;
2693
2694        memset(qc->cdb, 0, dev->cdb_len);
2695        memcpy(qc->cdb, scmd->cmnd, scmd->cmd_len);
2696
2697        qc->complete_fn = atapi_qc_complete;
2698
2699        qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
2700        if (scmd->sc_data_direction == DMA_TO_DEVICE) {
2701                qc->tf.flags |= ATA_TFLAG_WRITE;
2702                DPRINTK("direction: write\n");
2703        }
2704
2705        qc->tf.command = ATA_CMD_PACKET;
2706        ata_qc_set_pc_nbytes(qc);
2707
2708        /* check whether ATAPI DMA is safe */
2709        if (!nodata && !using_pio && atapi_check_dma(qc))
2710                using_pio = 1;
2711
2712        /* Some controller variants snoop this value for Packet
2713         * transfers to do state machine and FIFO management.  Thus we
2714         * want to set it properly, and for DMA where it is
2715         * effectively meaningless.
2716         */
2717        nbytes = min(ata_qc_raw_nbytes(qc), (unsigned int)63 * 1024);
2718
2719        /* Most ATAPI devices which honor transfer chunk size don't
2720         * behave according to the spec when odd chunk size which
2721         * matches the transfer length is specified.  If the number of
2722         * bytes to transfer is 2n+1.  According to the spec, what
2723         * should happen is to indicate that 2n+1 is going to be
2724         * transferred and transfer 2n+2 bytes where the last byte is
2725         * padding.
2726         *
2727         * In practice, this doesn't happen.  ATAPI devices first
2728         * indicate and transfer 2n bytes and then indicate and
2729         * transfer 2 bytes where the last byte is padding.
2730         *
2731         * This inconsistency confuses several controllers which
2732         * perform PIO using DMA such as Intel AHCIs and sil3124/32.
2733         * These controllers use actual number of transferred bytes to
2734         * update DMA poitner and transfer of 4n+2 bytes make those
2735         * controller push DMA pointer by 4n+4 bytes because SATA data
2736         * FISes are aligned to 4 bytes.  This causes data corruption
2737         * and buffer overrun.
2738         *
2739         * Always setting nbytes to even number solves this problem
2740         * because then ATAPI devices don't have to split data at 2n
2741         * boundaries.
2742         */
2743        if (nbytes & 0x1)
2744                nbytes++;
2745
2746        qc->tf.lbam = (nbytes & 0xFF);
2747        qc->tf.lbah = (nbytes >> 8);
2748
2749        if (nodata)
2750                qc->tf.protocol = ATAPI_PROT_NODATA;
2751        else if (using_pio)
2752                qc->tf.protocol = ATAPI_PROT_PIO;
2753        else {
2754                /* DMA data xfer */
2755                qc->tf.protocol = ATAPI_PROT_DMA;
2756                qc->tf.feature |= ATAPI_PKT_DMA;
2757
2758                if ((dev->flags & ATA_DFLAG_DMADIR) &&
2759                    (scmd->sc_data_direction != DMA_TO_DEVICE))
2760                        /* some SATA bridges need us to indicate data xfer direction */
2761                        qc->tf.feature |= ATAPI_DMADIR;
2762        }
2763
2764
2765        /* FIXME: We need to translate 0x05 READ_BLOCK_LIMITS to a MODE_SENSE
2766           as ATAPI tape drives don't get this right otherwise */
2767        return 0;
2768}
2769
2770static struct ata_device *ata_find_dev(struct ata_port *ap, int devno)
2771{
2772        if (!sata_pmp_attached(ap)) {
2773                if (likely(devno < ata_link_max_devices(&ap->link)))
2774                        return &ap->link.device[devno];
2775        } else {
2776                if (likely(devno < ap->nr_pmp_links))
2777                        return &ap->pmp_link[devno].device[0];
2778        }
2779
2780        return NULL;
2781}
2782
2783static struct ata_device *__ata_scsi_find_dev(struct ata_port *ap,
2784                                              const struct scsi_device *scsidev)
2785{
2786        int devno;
2787
2788        /* skip commands not addressed to targets we simulate */
2789        if (!sata_pmp_attached(ap)) {
2790                if (unlikely(scsidev->channel || scsidev->lun))
2791                        return NULL;
2792                devno = scsidev->id;
2793        } else {
2794                if (unlikely(scsidev->id || scsidev->lun))
2795                        return NULL;
2796                devno = scsidev->channel;
2797        }
2798
2799        return ata_find_dev(ap, devno);
2800}
2801
2802/**
2803 *      ata_scsi_find_dev - lookup ata_device from scsi_cmnd
2804 *      @ap: ATA port to which the device is attached
2805 *      @scsidev: SCSI device from which we derive the ATA device
2806 *
2807 *      Given various information provided in struct scsi_cmnd,
2808 *      map that onto an ATA bus, and using that mapping
2809 *      determine which ata_device is associated with the
2810 *      SCSI command to be sent.
2811 *
2812 *      LOCKING:
2813 *      spin_lock_irqsave(host lock)
2814 *
2815 *      RETURNS:
2816 *      Associated ATA device, or %NULL if not found.
2817 */
2818static struct ata_device *
2819ata_scsi_find_dev(struct ata_port *ap, const struct scsi_device *scsidev)
2820{
2821        struct ata_device *dev = __ata_scsi_find_dev(ap, scsidev);
2822
2823        if (unlikely(!dev || !ata_dev_enabled(dev)))
2824                return NULL;
2825
2826        return dev;
2827}
2828
2829/*
2830 *      ata_scsi_map_proto - Map pass-thru protocol value to taskfile value.
2831 *      @byte1: Byte 1 from pass-thru CDB.
2832 *
2833 *      RETURNS:
2834 *      ATA_PROT_UNKNOWN if mapping failed/unimplemented, protocol otherwise.
2835 */
2836static u8
2837ata_scsi_map_proto(u8 byte1)
2838{
2839        switch((byte1 & 0x1e) >> 1) {
2840        case 3:         /* Non-data */
2841                return ATA_PROT_NODATA;
2842
2843        case 6:         /* DMA */
2844        case 10:        /* UDMA Data-in */
2845        case 11:        /* UDMA Data-Out */
2846                return ATA_PROT_DMA;
2847
2848        case 4:         /* PIO Data-in */
2849        case 5:         /* PIO Data-out */
2850                return ATA_PROT_PIO;
2851
2852        case 0:         /* Hard Reset */
2853        case 1:         /* SRST */
2854        case 8:         /* Device Diagnostic */
2855        case 9:         /* Device Reset */
2856        case 7:         /* DMA Queued */
2857        case 12:        /* FPDMA */
2858        case 15:        /* Return Response Info */
2859        default:        /* Reserved */
2860                break;
2861        }
2862
2863        return ATA_PROT_UNKNOWN;
2864}
2865
2866/**
2867 *      ata_scsi_pass_thru - convert ATA pass-thru CDB to taskfile
2868 *      @qc: command structure to be initialized
2869 *
2870 *      Handles either 12 or 16-byte versions of the CDB.
2871 *
2872 *      RETURNS:
2873 *      Zero on success, non-zero on failure.
2874 */
2875static unsigned int ata_scsi_pass_thru(struct ata_queued_cmd *qc)
2876{
2877        struct ata_taskfile *tf = &(qc->tf);
2878        struct scsi_cmnd *scmd = qc->scsicmd;
2879        struct ata_device *dev = qc->dev;
2880        const u8 *cdb = scmd->cmnd;
2881
2882        if ((tf->protocol = ata_scsi_map_proto(cdb[1])) == ATA_PROT_UNKNOWN)
2883                goto invalid_fld;
2884
2885        /*
2886         * 12 and 16 byte CDBs use different offsets to
2887         * provide the various register values.
2888         */
2889        if (cdb[0] == ATA_16) {
2890                /*
2891                 * 16-byte CDB - may contain extended commands.
2892                 *
2893                 * If that is the case, copy the upper byte register values.
2894                 */
2895                if (cdb[1] & 0x01) {
2896                        tf->hob_feature = cdb[3];
2897                        tf->hob_nsect = cdb[5];
2898                        tf->hob_lbal = cdb[7];
2899                        tf->hob_lbam = cdb[9];
2900                        tf->hob_lbah = cdb[11];
2901                        tf->flags |= ATA_TFLAG_LBA48;
2902                } else
2903                        tf->flags &= ~ATA_TFLAG_LBA48;
2904
2905                /*
2906                 * Always copy low byte, device and command registers.
2907                 */
2908                tf->feature = cdb[4];
2909                tf->nsect = cdb[6];
2910                tf->lbal = cdb[8];
2911                tf->lbam = cdb[10];
2912                tf->lbah = cdb[12];
2913                tf->device = cdb[13];
2914                tf->command = cdb[14];
2915        } else {
2916                /*
2917                 * 12-byte CDB - incapable of extended commands.
2918                 */
2919                tf->flags &= ~ATA_TFLAG_LBA48;
2920
2921                tf->feature = cdb[3];
2922                tf->nsect = cdb[4];
2923                tf->lbal = cdb[5];
2924                tf->lbam = cdb[6];
2925                tf->lbah = cdb[7];
2926                tf->device = cdb[8];
2927                tf->command = cdb[9];
2928        }
2929
2930        /* enforce correct master/slave bit */
2931        tf->device = dev->devno ?
2932                tf->device | ATA_DEV1 : tf->device & ~ATA_DEV1;
2933
2934        switch (tf->command) {
2935        /* READ/WRITE LONG use a non-standard sect_size */
2936        case ATA_CMD_READ_LONG:
2937        case ATA_CMD_READ_LONG_ONCE:
2938        case ATA_CMD_WRITE_LONG:
2939        case ATA_CMD_WRITE_LONG_ONCE:
2940                if (tf->protocol != ATA_PROT_PIO || tf->nsect != 1)
2941                        goto invalid_fld;
2942                qc->sect_size = scsi_bufflen(scmd);
2943                break;
2944
2945        /* commands using reported Logical Block size (e.g. 512 or 4K) */
2946        case ATA_CMD_CFA_WRITE_NE:
2947        case ATA_CMD_CFA_TRANS_SECT:
2948        case ATA_CMD_CFA_WRITE_MULT_NE:
2949        /* XXX: case ATA_CMD_CFA_WRITE_SECTORS_WITHOUT_ERASE: */
2950        case ATA_CMD_READ:
2951        case ATA_CMD_READ_EXT:
2952        case ATA_CMD_READ_QUEUED:
2953        /* XXX: case ATA_CMD_READ_QUEUED_EXT: */
2954        case ATA_CMD_FPDMA_READ:
2955        case ATA_CMD_READ_MULTI:
2956        case ATA_CMD_READ_MULTI_EXT:
2957        case ATA_CMD_PIO_READ:
2958        case ATA_CMD_PIO_READ_EXT:
2959        case ATA_CMD_READ_STREAM_DMA_EXT:
2960        case ATA_CMD_READ_STREAM_EXT:
2961        case ATA_CMD_VERIFY:
2962        case ATA_CMD_VERIFY_EXT:
2963        case ATA_CMD_WRITE:
2964        case ATA_CMD_WRITE_EXT:
2965        case ATA_CMD_WRITE_FUA_EXT:
2966        case ATA_CMD_WRITE_QUEUED:
2967        case ATA_CMD_WRITE_QUEUED_FUA_EXT:
2968        case ATA_CMD_FPDMA_WRITE:
2969        case ATA_CMD_WRITE_MULTI:
2970        case ATA_CMD_WRITE_MULTI_EXT:
2971        case ATA_CMD_WRITE_MULTI_FUA_EXT:
2972        case ATA_CMD_PIO_WRITE:
2973        case ATA_CMD_PIO_WRITE_EXT:
2974        case ATA_CMD_WRITE_STREAM_DMA_EXT:
2975        case ATA_CMD_WRITE_STREAM_EXT:
2976                qc->sect_size = scmd->device->sector_size;
2977                break;
2978
2979        /* Everything else uses 512 byte "sectors" */
2980        default:
2981                qc->sect_size = ATA_SECT_SIZE;
2982        }
2983
2984        /*
2985         * Set flags so that all registers will be written, pass on
2986         * write indication (used for PIO/DMA setup), result TF is
2987         * copied back and we don't whine too much about its failure.
2988         */
2989        tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
2990        if (scmd->sc_data_direction == DMA_TO_DEVICE)
2991                tf->flags |= ATA_TFLAG_WRITE;
2992
2993        qc->flags |= ATA_QCFLAG_RESULT_TF | ATA_QCFLAG_QUIET;
2994
2995        /*
2996         * Set transfer length.
2997         *
2998         * TODO: find out if we need to do more here to
2999         *       cover scatter/gather case.
3000         */
3001        ata_qc_set_pc_nbytes(qc);
3002
3003        /* We may not issue DMA commands if no DMA mode is set */
3004        if (tf->protocol == ATA_PROT_DMA && dev->dma_mode == 0)
3005                goto invalid_fld;
3006
3007        /* sanity check for pio multi commands */
3008        if ((cdb[1] & 0xe0) && !is_multi_taskfile(tf))
3009                goto invalid_fld;
3010
3011        if (is_multi_taskfile(tf)) {
3012                unsigned int multi_count = 1 << (cdb[1] >> 5);
3013
3014                /* compare the passed through multi_count
3015                 * with the cached multi_count of libata
3016                 */
3017                if (multi_count != dev->multi_count)
3018                        ata_dev_warn(dev, "invalid multi_count %u ignored\n",
3019                                     multi_count);
3020        }
3021
3022        /*
3023         * Filter SET_FEATURES - XFER MODE command -- otherwise,
3024         * SET_FEATURES - XFER MODE must be preceded/succeeded
3025         * by an update to hardware-specific registers for each
3026         * controller (i.e. the reason for ->set_piomode(),
3027         * ->set_dmamode(), and ->post_set_mode() hooks).
3028         */
3029        if (tf->command == ATA_CMD_SET_FEATURES &&
3030            tf->feature == SETFEATURES_XFER)
3031                goto invalid_fld;
3032
3033        /*
3034         * Filter TPM commands by default. These provide an
3035         * essentially uncontrolled encrypted "back door" between
3036         * applications and the disk. Set libata.allow_tpm=1 if you
3037         * have a real reason for wanting to use them. This ensures
3038         * that installed software cannot easily mess stuff up without
3039         * user intent. DVR type users will probably ship with this enabled
3040         * for movie content management.
3041         *
3042         * Note that for ATA8 we can issue a DCS change and DCS freeze lock
3043         * for this and should do in future but that it is not sufficient as
3044         * DCS is an optional feature set. Thus we also do the software filter
3045         * so that we comply with the TC consortium stated goal that the user
3046         * can turn off TC features of their system.
3047         */
3048        if (tf->command >= 0x5C && tf->command <= 0x5F && !libata_allow_tpm)
3049                goto invalid_fld;
3050
3051        return 0;
3052
3053 invalid_fld:
3054        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x00);
3055        /* "Invalid field in cdb" */
3056        return 1;
3057}
3058
3059static unsigned int ata_scsi_write_same_xlat(struct ata_queued_cmd *qc)
3060{
3061        struct ata_taskfile *tf = &qc->tf;
3062        struct scsi_cmnd *scmd = qc->scsicmd;
3063        struct ata_device *dev = qc->dev;
3064        const u8 *cdb = scmd->cmnd;
3065        u64 block;
3066        u32 n_block;
3067        u32 size;
3068        void *buf;
3069
3070        /* we may not issue DMA commands if no DMA mode is set */
3071        if (unlikely(!dev->dma_mode))
3072                goto invalid_fld;
3073
3074        if (unlikely(scmd->cmd_len < 16))
3075                goto invalid_fld;
3076        scsi_16_lba_len(cdb, &block, &n_block);
3077
3078        /* for now we only support WRITE SAME with the unmap bit set */
3079        if (unlikely(!(cdb[1] & 0x8)))
3080                goto invalid_fld;
3081
3082        /*
3083         * WRITE SAME always has a sector sized buffer as payload, this
3084         * should never be a multiple entry S/G list.
3085         */
3086        if (!scsi_sg_count(scmd))
3087                goto invalid_fld;
3088
3089        buf = page_address(sg_page(scsi_sglist(scmd)));
3090        size = ata_set_lba_range_entries(buf, 512, block, n_block);
3091
3092        tf->protocol = ATA_PROT_DMA;
3093        tf->hob_feature = 0;
3094        tf->feature = ATA_DSM_TRIM;
3095        tf->hob_nsect = (size / 512) >> 8;
3096        tf->nsect = size / 512;
3097        tf->command = ATA_CMD_DSM;
3098        tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE | ATA_TFLAG_LBA48 |
3099                     ATA_TFLAG_WRITE;
3100
3101        ata_qc_set_pc_nbytes(qc);
3102
3103        return 0;
3104
3105 invalid_fld:
3106        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x00);
3107        /* "Invalid field in cdb" */
3108        return 1;
3109}
3110
3111/**
3112 *      ata_mselect_caching - Simulate MODE SELECT for caching info page
3113 *      @qc: Storage for translated ATA taskfile
3114 *      @buf: input buffer
3115 *      @len: number of valid bytes in the input buffer
3116 *
3117 *      Prepare a taskfile to modify caching information for the device.
3118 *
3119 *      LOCKING:
3120 *      None.
3121 */
3122static int ata_mselect_caching(struct ata_queued_cmd *qc,
3123                               const u8 *buf, int len)
3124{
3125        struct ata_taskfile *tf = &qc->tf;
3126        struct ata_device *dev = qc->dev;
3127        char mpage[CACHE_MPAGE_LEN];
3128        u8 wce;
3129
3130        /*
3131         * The first two bytes of def_cache_mpage are a header, so offsets
3132         * in mpage are off by 2 compared to buf.  Same for len.
3133         */
3134
3135        if (len != CACHE_MPAGE_LEN - 2)
3136                return -EINVAL;
3137
3138        wce = buf[0] & (1 << 2);
3139
3140        /*
3141         * Check that read-only bits are not modified.
3142         */
3143        ata_msense_caching(dev->id, mpage, false);
3144        mpage[2] &= ~(1 << 2);
3145        mpage[2] |= wce;
3146        if (memcmp(mpage + 2, buf, CACHE_MPAGE_LEN - 2) != 0)
3147                return -EINVAL;
3148
3149        tf->flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
3150        tf->protocol = ATA_PROT_NODATA;
3151        tf->nsect = 0;
3152        tf->command = ATA_CMD_SET_FEATURES;
3153        tf->feature = wce ? SETFEATURES_WC_ON : SETFEATURES_WC_OFF;
3154        return 0;
3155}
3156
3157/**
3158 *      ata_scsiop_mode_select - Simulate MODE SELECT 6, 10 commands
3159 *      @qc: Storage for translated ATA taskfile
3160 *
3161 *      Converts a MODE SELECT command to an ATA SET FEATURES taskfile.
3162 *      Assume this is invoked for direct access devices (e.g. disks) only.
3163 *      There should be no block descriptor for other device types.
3164 *
3165 *      LOCKING:
3166 *      spin_lock_irqsave(host lock)
3167 */
3168static unsigned int ata_scsi_mode_select_xlat(struct ata_queued_cmd *qc)
3169{
3170        struct scsi_cmnd *scmd = qc->scsicmd;
3171        const u8 *cdb = scmd->cmnd;
3172        const u8 *p;
3173        u8 pg, spg;
3174        unsigned six_byte, pg_len, hdr_len, bd_len;
3175        int len;
3176
3177        VPRINTK("ENTER\n");
3178
3179        six_byte = (cdb[0] == MODE_SELECT);
3180        if (six_byte) {
3181                if (scmd->cmd_len < 5)
3182                        goto invalid_fld;
3183
3184                len = cdb[4];
3185                hdr_len = 4;
3186        } else {
3187                if (scmd->cmd_len < 9)
3188                        goto invalid_fld;
3189
3190                len = (cdb[7] << 8) + cdb[8];
3191                hdr_len = 8;
3192        }
3193
3194        /* We only support PF=1, SP=0.  */
3195        if ((cdb[1] & 0x11) != 0x10)
3196                goto invalid_fld;
3197
3198        /* Test early for possible overrun.  */
3199        if (!scsi_sg_count(scmd) || scsi_sglist(scmd)->length < len)
3200                goto invalid_param_len;
3201
3202        p = page_address(sg_page(scsi_sglist(scmd)));
3203
3204        /* Move past header and block descriptors.  */
3205        if (len < hdr_len)
3206                goto invalid_param_len;
3207
3208        if (six_byte)
3209                bd_len = p[3];
3210        else
3211                bd_len = (p[6] << 8) + p[7];
3212
3213        len -= hdr_len;
3214        p += hdr_len;
3215        if (len < bd_len)
3216                goto invalid_param_len;
3217        if (bd_len != 0 && bd_len != 8)
3218                goto invalid_param;
3219
3220        len -= bd_len;
3221        p += bd_len;
3222        if (len == 0)
3223                goto skip;
3224
3225        /* Parse both possible formats for the mode page headers.  */
3226        pg = p[0] & 0x3f;
3227        if (p[0] & 0x40) {
3228                if (len < 4)
3229                        goto invalid_param_len;
3230
3231                spg = p[1];
3232                pg_len = (p[2] << 8) | p[3];
3233                p += 4;
3234                len -= 4;
3235        } else {
3236                if (len < 2)
3237                        goto invalid_param_len;
3238
3239                spg = 0;
3240                pg_len = p[1];
3241                p += 2;
3242                len -= 2;
3243        }
3244
3245        /*
3246         * No mode subpages supported (yet) but asking for _all_
3247         * subpages may be valid
3248         */
3249        if (spg && (spg != ALL_SUB_MPAGES))
3250                goto invalid_param;
3251        if (pg_len > len)
3252                goto invalid_param_len;
3253
3254        switch (pg) {
3255        case CACHE_MPAGE:
3256                if (ata_mselect_caching(qc, p, pg_len) < 0)
3257                        goto invalid_param;
3258                break;
3259
3260        default:                /* invalid page code */
3261                goto invalid_param;
3262        }
3263
3264        /*
3265         * Only one page has changeable data, so we only support setting one
3266         * page at a time.
3267         */
3268        if (len > pg_len)
3269                goto invalid_param;
3270
3271        return 0;
3272
3273 invalid_fld:
3274        /* "Invalid field in CDB" */
3275        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x0);
3276        return 1;
3277
3278 invalid_param:
3279        /* "Invalid field in parameter list" */
3280        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x26, 0x0);
3281        return 1;
3282
3283 invalid_param_len:
3284        /* "Parameter list length error" */
3285        ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x1a, 0x0);
3286        return 1;
3287
3288 skip:
3289        scmd->result = SAM_STAT_GOOD;
3290        return 1;
3291}
3292
3293/**
3294 *      ata_get_xlat_func - check if SCSI to ATA translation is possible
3295 *      @dev: ATA device
3296 *      @cmd: SCSI command opcode to consider
3297 *
3298 *      Look up the SCSI command given, and determine whether the
3299 *      SCSI command is to be translated or simulated.
3300 *
3301 *      RETURNS:
3302 *      Pointer to translation function if possible, %NULL if not.
3303 */
3304
3305static inline ata_xlat_func_t ata_get_xlat_func(struct ata_device *dev, u8 cmd)
3306{
3307        switch (cmd) {
3308        case READ_6:
3309        case READ_10:
3310        case READ_16:
3311
3312        case WRITE_6:
3313        case WRITE_10:
3314        case WRITE_16:
3315                return ata_scsi_rw_xlat;
3316
3317        case WRITE_SAME_16:
3318                return ata_scsi_write_same_xlat;
3319
3320        case SYNCHRONIZE_CACHE:
3321                if (ata_try_flush_cache(dev))
3322                        return ata_scsi_flush_xlat;
3323                break;
3324
3325        case VERIFY:
3326        case VERIFY_16:
3327                return ata_scsi_verify_xlat;
3328
3329        case ATA_12:
3330        case ATA_16:
3331                return ata_scsi_pass_thru;
3332
3333        case MODE_SELECT:
3334        case MODE_SELECT_10:
3335                return ata_scsi_mode_select_xlat;
3336                break;
3337
3338        case START_STOP:
3339                return ata_scsi_start_stop_xlat;
3340        }
3341
3342        return NULL;
3343}
3344
3345/**
3346 *      ata_scsi_dump_cdb - dump SCSI command contents to dmesg
3347 *      @ap: ATA port to which the command was being sent
3348 *      @cmd: SCSI command to dump
3349 *
3350 *      Prints the contents of a SCSI command via printk().
3351 */
3352
3353static inline void ata_scsi_dump_cdb(struct ata_port *ap,
3354                                     struct scsi_cmnd *cmd)
3355{
3356#ifdef ATA_DEBUG
3357        struct scsi_device *scsidev = cmd->device;
3358        u8 *scsicmd = cmd->cmnd;
3359
3360        DPRINTK("CDB (%u:%d,%d,%d) %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
3361                ap->print_id,
3362                scsidev->channel, scsidev->id, scsidev->lun,
3363                scsicmd[0], scsicmd[1], scsicmd[2], scsicmd[3],
3364                scsicmd[4], scsicmd[5], scsicmd[6], scsicmd[7],
3365                scsicmd[8]);
3366#endif
3367}
3368
3369static inline int __ata_scsi_queuecmd(struct scsi_cmnd *scmd,
3370                                      struct ata_device *dev)
3371{
3372        u8 scsi_op = scmd->cmnd[0];
3373        ata_xlat_func_t xlat_func;
3374        int rc = 0;
3375
3376        if (dev->class == ATA_DEV_ATA) {
3377                if (unlikely(!scmd->cmd_len || scmd->cmd_len > dev->cdb_len))
3378                        goto bad_cdb_len;
3379
3380                xlat_func = ata_get_xlat_func(dev, scsi_op);
3381        } else {
3382                if (unlikely(!scmd->cmd_len))
3383                        goto bad_cdb_len;
3384
3385                xlat_func = NULL;
3386                if (likely((scsi_op != ATA_16) || !atapi_passthru16)) {
3387                        /* relay SCSI command to ATAPI device */
3388                        int len = COMMAND_SIZE(scsi_op);
3389                        if (unlikely(len > scmd->cmd_len || len > dev->cdb_len))
3390                                goto bad_cdb_len;
3391
3392                        xlat_func = atapi_xlat;
3393                } else {
3394                        /* ATA_16 passthru, treat as an ATA command */
3395                        if (unlikely(scmd->cmd_len > 16))
3396                                goto bad_cdb_len;
3397
3398                        xlat_func = ata_get_xlat_func(dev, scsi_op);
3399                }
3400        }
3401
3402        if (xlat_func)
3403                rc = ata_scsi_translate(dev, scmd, xlat_func);
3404        else
3405                ata_scsi_simulate(dev, scmd);
3406
3407        return rc;
3408
3409 bad_cdb_len:
3410        DPRINTK("bad CDB len=%u, scsi_op=0x%02x, max=%u\n",
3411                scmd->cmd_len, scsi_op, dev->cdb_len);
3412        scmd->result = DID_ERROR << 16;
3413        scmd->scsi_done(scmd);
3414        return 0;
3415}
3416
3417/**
3418 *      ata_scsi_queuecmd - Issue SCSI cdb to libata-managed device
3419 *      @shost: SCSI host of command to be sent
3420 *      @cmd: SCSI command to be sent
3421 *
3422 *      In some cases, this function translates SCSI commands into
3423 *      ATA taskfiles, and queues the taskfiles to be sent to
3424 *      hardware.  In other cases, this function simulates a
3425 *      SCSI device by evaluating and responding to certain
3426 *      SCSI commands.  This creates the overall effect of
3427 *      ATA and ATAPI devices appearing as SCSI devices.
3428 *
3429 *      LOCKING:
3430 *      ATA host lock
3431 *
3432 *      RETURNS:
3433 *      Return value from __ata_scsi_queuecmd() if @cmd can be queued,
3434 *      0 otherwise.
3435 */
3436int ata_scsi_queuecmd(struct Scsi_Host *shost, struct scsi_cmnd *cmd)
3437{
3438        struct ata_port *ap;
3439        struct ata_device *dev;
3440        struct scsi_device *scsidev = cmd->device;
3441        int rc = 0;
3442        unsigned long irq_flags;
3443
3444        ap = ata_shost_to_port(shost);
3445
3446        spin_lock_irqsave(ap->lock, irq_flags);
3447
3448        ata_scsi_dump_cdb(ap, cmd);
3449
3450        dev = ata_scsi_find_dev(ap, scsidev);
3451        if (likely(dev))
3452                rc = __ata_scsi_queuecmd(cmd, dev);
3453        else {
3454                cmd->result = (DID_BAD_TARGET << 16);
3455                cmd->scsi_done(cmd);
3456        }
3457
3458        spin_unlock_irqrestore(ap->lock, irq_flags);
3459
3460        return rc;
3461}
3462
3463/**
3464 *      ata_scsi_simulate - simulate SCSI command on ATA device
3465 *      @dev: the target device
3466 *      @cmd: SCSI command being sent to device.
3467 *
3468 *      Interprets and directly executes a select list of SCSI commands
3469 *      that can be handled internally.
3470 *
3471 *      LOCKING:
3472 *      spin_lock_irqsave(host lock)
3473 */
3474
3475void ata_scsi_simulate(struct ata_device *dev, struct scsi_cmnd *cmd)
3476{
3477        struct ata_scsi_args args;
3478        const u8 *scsicmd = cmd->cmnd;
3479        u8 tmp8;
3480
3481        args.dev = dev;
3482        args.id = dev->id;
3483        args.cmd = cmd;
3484        args.done = cmd->scsi_done;
3485
3486        switch(scsicmd[0]) {
3487        /* TODO: worth improving? */
3488        case FORMAT_UNIT:
3489                ata_scsi_invalid_field(cmd);
3490                break;
3491
3492        case INQUIRY:
3493                if (scsicmd[1] & 2)                /* is CmdDt set?  */
3494                        ata_scsi_invalid_field(cmd);
3495                else if ((scsicmd[1] & 1) == 0)    /* is EVPD clear? */
3496                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_std);
3497                else switch (scsicmd[2]) {
3498                case 0x00:
3499                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_00);
3500                        break;
3501                case 0x80:
3502                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_80);
3503                        break;
3504                case 0x83:
3505                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_83);
3506                        break;
3507                case 0x89:
3508                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_89);
3509                        break;
3510                case 0xb0:
3511                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_b0);
3512                        break;
3513                case 0xb1:
3514                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_b1);
3515                        break;
3516                case 0xb2:
3517                        ata_scsi_rbuf_fill(&args, ata_scsiop_inq_b2);
3518                        break;
3519                default:
3520                        ata_scsi_invalid_field(cmd);
3521                        break;
3522                }
3523                break;
3524
3525        case MODE_SENSE:
3526        case MODE_SENSE_10:
3527                ata_scsi_rbuf_fill(&args, ata_scsiop_mode_sense);
3528                break;
3529
3530        case READ_CAPACITY:
3531                ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
3532                break;
3533
3534        case SERVICE_ACTION_IN:
3535                if ((scsicmd[1] & 0x1f) == SAI_READ_CAPACITY_16)
3536                        ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
3537                else
3538                        ata_scsi_invalid_field(cmd);
3539                break;
3540
3541        case REPORT_LUNS:
3542                ata_scsi_rbuf_fill(&args, ata_scsiop_report_luns);
3543                break;
3544
3545        case REQUEST_SENSE:
3546                ata_scsi_set_sense(cmd, 0, 0, 0);
3547                cmd->result = (DRIVER_SENSE << 24);
3548                cmd->scsi_done(cmd);
3549                break;
3550
3551        /* if we reach this, then writeback caching is disabled,
3552         * turning this into a no-op.
3553         */
3554        case SYNCHRONIZE_CACHE:
3555                /* fall through */
3556
3557        /* no-op's, complete with success */
3558        case REZERO_UNIT:
3559        case SEEK_6:
3560        case SEEK_10:
3561        case TEST_UNIT_READY:
3562                ata_scsi_rbuf_fill(&args, ata_scsiop_noop);
3563                break;
3564
3565        case SEND_DIAGNOSTIC:
3566                tmp8 = scsicmd[1] & ~(1 << 3);
3567                if ((tmp8 == 0x4) && (!scsicmd[3]) && (!scsicmd[4]))
3568                        ata_scsi_rbuf_fill(&args, ata_scsiop_noop);
3569                else
3570                        ata_scsi_invalid_field(cmd);
3571                break;
3572
3573        /* all other commands */
3574        default:
3575                ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x20, 0x0);
3576                /* "Invalid command operation code" */
3577                cmd->scsi_done(cmd);
3578                break;
3579        }
3580}
3581
3582int ata_scsi_add_hosts(struct ata_host *host, struct scsi_host_template *sht)
3583{
3584        int i, rc;
3585
3586        for (i = 0; i < host->n_ports; i++) {
3587                struct ata_port *ap = host->ports[i];
3588                struct Scsi_Host *shost;
3589
3590                rc = -ENOMEM;
3591                shost = scsi_host_alloc(sht, sizeof(struct ata_port *));
3592                if (!shost)
3593                        goto err_alloc;
3594
3595                shost->eh_noresume = 1;
3596                *(struct ata_port **)&shost->hostdata[0] = ap;
3597                ap->scsi_host = shost;
3598
3599                shost->transportt = ata_scsi_transport_template;
3600                shost->unique_id = ap->print_id;
3601                shost->max_id = 16;
3602                shost->max_lun = 1;
3603                shost->max_channel = 1;
3604                shost->max_cmd_len = 16;
3605
3606                /* Schedule policy is determined by ->qc_defer()
3607                 * callback and it needs to see every deferred qc.
3608                 * Set host_blocked to 1 to prevent SCSI midlayer from
3609                 * automatically deferring requests.
3610                 */
3611                shost->max_host_blocked = 1;
3612
3613                rc = scsi_add_host_with_dma(ap->scsi_host,
3614                                                &ap->tdev, ap->host->dev);
3615                if (rc)
3616                        goto err_add;
3617        }
3618
3619        return 0;
3620
3621 err_add:
3622        scsi_host_put(host->ports[i]->scsi_host);
3623 err_alloc:
3624        while (--i >= 0) {
3625                struct Scsi_Host *shost = host->ports[i]->scsi_host;
3626
3627                scsi_remove_host(shost);
3628                scsi_host_put(shost);
3629        }
3630        return rc;
3631}
3632
3633void ata_scsi_scan_host(struct ata_port *ap, int sync)
3634{
3635        int tries = 5;
3636        struct ata_device *last_failed_dev = NULL;
3637        struct ata_link *link;
3638        struct ata_device *dev;
3639
3640 repeat:
3641        ata_for_each_link(link, ap, EDGE) {
3642                ata_for_each_dev(dev, link, ENABLED) {
3643                        struct scsi_device *sdev;
3644                        int channel = 0, id = 0;
3645
3646                        if (dev->sdev)
3647                                continue;
3648
3649                        if (ata_is_host_link(link))
3650                                id = dev->devno;
3651                        else
3652                                channel = link->pmp;
3653
3654                        sdev = __scsi_add_device(ap->scsi_host, channel, id, 0,
3655                                                 NULL);
3656                        if (!IS_ERR(sdev)) {
3657                                dev->sdev = sdev;
3658                                scsi_device_put(sdev);
3659                                ata_acpi_bind(dev);
3660                        } else {
3661                                dev->sdev = NULL;
3662                        }
3663                }
3664        }
3665
3666        /* If we scanned while EH was in progress or allocation
3667         * failure occurred, scan would have failed silently.  Check
3668         * whether all devices are attached.
3669         */
3670        ata_for_each_link(link, ap, EDGE) {
3671                ata_for_each_dev(dev, link, ENABLED) {
3672                        if (!dev->sdev)
3673                                goto exit_loop;
3674                }
3675        }
3676 exit_loop:
3677        if (!link)
3678                return;
3679
3680        /* we're missing some SCSI devices */
3681        if (sync) {
3682                /* If caller requested synchrnous scan && we've made
3683                 * any progress, sleep briefly and repeat.
3684                 */
3685                if (dev != last_failed_dev) {
3686                        msleep(100);
3687                        last_failed_dev = dev;
3688                        goto repeat;
3689                }
3690
3691                /* We might be failing to detect boot device, give it
3692                 * a few more chances.
3693                 */
3694                if (--tries) {
3695                        msleep(100);
3696                        goto repeat;
3697                }
3698
3699                ata_port_err(ap,
3700                             "WARNING: synchronous SCSI scan failed without making any progress, switching to async\n");
3701        }
3702
3703        queue_delayed_work(system_long_wq, &ap->hotplug_task,
3704                           round_jiffies_relative(HZ));
3705}
3706
3707/**
3708 *      ata_scsi_offline_dev - offline attached SCSI device
3709 *      @dev: ATA device to offline attached SCSI device for
3710 *
3711 *      This function is called from ata_eh_hotplug() and responsible
3712 *      for taking the SCSI device attached to @dev offline.  This
3713 *      function is called with host lock which protects dev->sdev
3714 *      against clearing.
3715 *
3716 *      LOCKING:
3717 *      spin_lock_irqsave(host lock)
3718 *
3719 *      RETURNS:
3720 *      1 if attached SCSI device exists, 0 otherwise.
3721 */
3722int ata_scsi_offline_dev(struct ata_device *dev)
3723{
3724        if (dev->sdev) {
3725                scsi_device_set_state(dev->sdev, SDEV_OFFLINE);
3726                return 1;
3727        }
3728        return 0;
3729}
3730
3731/**
3732 *      ata_scsi_remove_dev - remove attached SCSI device
3733 *      @dev: ATA device to remove attached SCSI device for
3734 *
3735 *      This function is called from ata_eh_scsi_hotplug() and
3736 *      responsible for removing the SCSI device attached to @dev.
3737 *
3738 *      LOCKING:
3739 *      Kernel thread context (may sleep).
3740 */
3741static void ata_scsi_remove_dev(struct ata_device *dev)
3742{
3743        struct ata_port *ap = dev->link->ap;
3744        struct scsi_device *sdev;
3745        unsigned long flags;
3746
3747        /* Alas, we need to grab scan_mutex to ensure SCSI device
3748         * state doesn't change underneath us and thus
3749         * scsi_device_get() always succeeds.  The mutex locking can
3750         * be removed if there is __scsi_device_get() interface which
3751         * increments reference counts regardless of device state.
3752         */
3753        mutex_lock(&ap->scsi_host->scan_mutex);
3754        spin_lock_irqsave(ap->lock, flags);
3755
3756        ata_acpi_unbind(dev);
3757
3758        /* clearing dev->sdev is protected by host lock */
3759        sdev = dev->sdev;
3760        dev->sdev = NULL;
3761
3762        if (sdev) {
3763                /* If user initiated unplug races with us, sdev can go
3764                 * away underneath us after the host lock and
3765                 * scan_mutex are released.  Hold onto it.
3766                 */
3767                if (scsi_device_get(sdev) == 0) {
3768                        /* The following ensures the attached sdev is
3769                         * offline on return from ata_scsi_offline_dev()
3770                         * regardless it wins or loses the race
3771                         * against this function.
3772                         */
3773                        scsi_device_set_state(sdev, SDEV_OFFLINE);
3774                } else {
3775                        WARN_ON(1);
3776                        sdev = NULL;
3777                }
3778        }
3779
3780        spin_unlock_irqrestore(ap->lock, flags);
3781        mutex_unlock(&ap->scsi_host->scan_mutex);
3782
3783        if (sdev) {
3784                ata_dev_info(dev, "detaching (SCSI %s)\n",
3785                             dev_name(&sdev->sdev_gendev));
3786
3787                scsi_remove_device(sdev);
3788                scsi_device_put(sdev);
3789        }
3790}
3791
3792static void ata_scsi_handle_link_detach(struct ata_link *link)
3793{
3794        struct ata_port *ap = link->ap;
3795        struct ata_device *dev;
3796
3797        ata_for_each_dev(dev, link, ALL) {
3798                unsigned long flags;
3799
3800                if (!(dev->flags & ATA_DFLAG_DETACHED))
3801                        continue;
3802
3803                spin_lock_irqsave(ap->lock, flags);
3804                dev->flags &= ~ATA_DFLAG_DETACHED;
3805                spin_unlock_irqrestore(ap->lock, flags);
3806
3807                ata_scsi_remove_dev(dev);
3808        }
3809}
3810
3811/**
3812 *      ata_scsi_media_change_notify - send media change event
3813 *      @dev: Pointer to the disk device with media change event
3814 *
3815 *      Tell the block layer to send a media change notification
3816 *      event.
3817 *
3818 *      LOCKING:
3819 *      spin_lock_irqsave(host lock)
3820 */
3821void ata_scsi_media_change_notify(struct ata_device *dev)
3822{
3823        if (dev->sdev)
3824                sdev_evt_send_simple(dev->sdev, SDEV_EVT_MEDIA_CHANGE,
3825                                     GFP_ATOMIC);
3826}
3827
3828/**
3829 *      ata_scsi_hotplug - SCSI part of hotplug
3830 *      @work: Pointer to ATA port to perform SCSI hotplug on
3831 *
3832 *      Perform SCSI part of hotplug.  It's executed from a separate
3833 *      workqueue after EH completes.  This is necessary because SCSI
3834 *      hot plugging requires working EH and hot unplugging is
3835 *      synchronized with hot plugging with a mutex.
3836 *
3837 *      LOCKING:
3838 *      Kernel thread context (may sleep).
3839 */
3840void ata_scsi_hotplug(struct work_struct *work)
3841{
3842        struct ata_port *ap =
3843                container_of(work, struct ata_port, hotplug_task.work);
3844        int i;
3845
3846        if (ap->pflags & ATA_PFLAG_UNLOADING) {
3847                DPRINTK("ENTER/EXIT - unloading\n");
3848                return;
3849        }
3850
3851        DPRINTK("ENTER\n");
3852        mutex_lock(&ap->scsi_scan_mutex);
3853
3854        /* Unplug detached devices.  We cannot use link iterator here
3855         * because PMP links have to be scanned even if PMP is
3856         * currently not attached.  Iterate manually.
3857         */
3858        ata_scsi_handle_link_detach(&ap->link);
3859        if (ap->pmp_link)
3860                for (i = 0; i < SATA_PMP_MAX_PORTS; i++)
3861                        ata_scsi_handle_link_detach(&ap->pmp_link[i]);
3862
3863        /* scan for new ones */
3864        ata_scsi_scan_host(ap, 0);
3865
3866        mutex_unlock(&ap->scsi_scan_mutex);
3867        DPRINTK("EXIT\n");
3868}
3869
3870/**
3871 *      ata_scsi_user_scan - indication for user-initiated bus scan
3872 *      @shost: SCSI host to scan
3873 *      @channel: Channel to scan
3874 *      @id: ID to scan
3875 *      @lun: LUN to scan
3876 *
3877 *      This function is called when user explicitly requests bus
3878 *      scan.  Set probe pending flag and invoke EH.
3879 *
3880 *      LOCKING:
3881 *      SCSI layer (we don't care)
3882 *
3883 *      RETURNS:
3884 *      Zero.
3885 */
3886int ata_scsi_user_scan(struct Scsi_Host *shost, unsigned int channel,
3887                       unsigned int id, unsigned int lun)
3888{
3889        struct ata_port *ap = ata_shost_to_port(shost);
3890        unsigned long flags;
3891        int devno, rc = 0;
3892
3893        if (!ap->ops->error_handler)
3894                return -EOPNOTSUPP;
3895
3896        if (lun != SCAN_WILD_CARD && lun)
3897                return -EINVAL;
3898
3899        if (!sata_pmp_attached(ap)) {
3900                if (channel != SCAN_WILD_CARD && channel)
3901                        return -EINVAL;
3902                devno = id;
3903        } else {
3904                if (id != SCAN_WILD_CARD && id)
3905                        return -EINVAL;
3906                devno = channel;
3907        }
3908
3909        spin_lock_irqsave(ap->lock, flags);
3910
3911        if (devno == SCAN_WILD_CARD) {
3912                struct ata_link *link;
3913
3914                ata_for_each_link(link, ap, EDGE) {
3915                        struct ata_eh_info *ehi = &link->eh_info;
3916                        ehi->probe_mask |= ATA_ALL_DEVICES;
3917                        ehi->action |= ATA_EH_RESET;
3918                }
3919        } else {
3920                struct ata_device *dev = ata_find_dev(ap, devno);
3921
3922                if (dev) {
3923                        struct ata_eh_info *ehi = &dev->link->eh_info;
3924                        ehi->probe_mask |= 1 << dev->devno;
3925                        ehi->action |= ATA_EH_RESET;
3926                } else
3927                        rc = -EINVAL;
3928        }
3929
3930        if (rc == 0) {
3931                ata_port_schedule_eh(ap);
3932                spin_unlock_irqrestore(ap->lock, flags);
3933                ata_port_wait_eh(ap);
3934        } else
3935                spin_unlock_irqrestore(ap->lock, flags);
3936
3937        return rc;
3938}
3939
3940/**
3941 *      ata_scsi_dev_rescan - initiate scsi_rescan_device()
3942 *      @work: Pointer to ATA port to perform scsi_rescan_device()
3943 *
3944 *      After ATA pass thru (SAT) commands are executed successfully,
3945 *      libata need to propagate the changes to SCSI layer.
3946 *
3947 *      LOCKING:
3948 *      Kernel thread context (may sleep).
3949 */
3950void ata_scsi_dev_rescan(struct work_struct *work)
3951{
3952        struct ata_port *ap =
3953                container_of(work, struct ata_port, scsi_rescan_task);
3954        struct ata_link *link;
3955        struct ata_device *dev;
3956        unsigned long flags;
3957
3958        mutex_lock(&ap->scsi_scan_mutex);
3959        spin_lock_irqsave(ap->lock, flags);
3960
3961        ata_for_each_link(link, ap, EDGE) {
3962                ata_for_each_dev(dev, link, ENABLED) {
3963                        struct scsi_device *sdev = dev->sdev;
3964
3965                        if (!sdev)
3966                                continue;
3967                        if (scsi_device_get(sdev))
3968                                continue;
3969
3970                        spin_unlock_irqrestore(ap->lock, flags);
3971                        scsi_rescan_device(&(sdev->sdev_gendev));
3972                        scsi_device_put(sdev);
3973                        spin_lock_irqsave(ap->lock, flags);
3974                }
3975        }
3976
3977        spin_unlock_irqrestore(ap->lock, flags);
3978        mutex_unlock(&ap->scsi_scan_mutex);
3979}
3980
3981/**
3982 *      ata_sas_port_alloc - Allocate port for a SAS attached SATA device
3983 *      @host: ATA host container for all SAS ports
3984 *      @port_info: Information from low-level host driver
3985 *      @shost: SCSI host that the scsi device is attached to
3986 *
3987 *      LOCKING:
3988 *      PCI/etc. bus probe sem.
3989 *
3990 *      RETURNS:
3991 *      ata_port pointer on success / NULL on failure.
3992 */
3993
3994struct ata_port *ata_sas_port_alloc(struct ata_host *host,
3995                                    struct ata_port_info *port_info,
3996                                    struct Scsi_Host *shost)
3997{
3998        struct ata_port *ap;
3999
4000        ap = ata_port_alloc(host);
4001        if (!ap)
4002                return NULL;
4003
4004        ap->port_no = 0;
4005        ap->lock = &host->lock;
4006        ap->pio_mask = port_info->pio_mask;
4007        ap->mwdma_mask = port_info->mwdma_mask;
4008        ap->udma_mask = port_info->udma_mask;
4009        ap->flags |= port_info->flags;
4010        ap->ops = port_info->port_ops;
4011        ap->cbl = ATA_CBL_SATA;
4012
4013        return ap;
4014}
4015EXPORT_SYMBOL_GPL(ata_sas_port_alloc);
4016
4017/**
4018 *      ata_sas_port_start - Set port up for dma.
4019 *      @ap: Port to initialize
4020 *
4021 *      Called just after data structures for each port are
4022 *      initialized.
4023 *
4024 *      May be used as the port_start() entry in ata_port_operations.
4025 *
4026 *      LOCKING:
4027 *      Inherited from caller.
4028 */
4029int ata_sas_port_start(struct ata_port *ap)
4030{
4031        /*
4032         * the port is marked as frozen at allocation time, but if we don't
4033         * have new eh, we won't thaw it
4034         */
4035        if (!ap->ops->error_handler)
4036                ap->pflags &= ~ATA_PFLAG_FROZEN;
4037        return 0;
4038}
4039EXPORT_SYMBOL_GPL(ata_sas_port_start);
4040
4041/**
4042 *      ata_port_stop - Undo ata_sas_port_start()
4043 *      @ap: Port to shut down
4044 *
4045 *      May be used as the port_stop() entry in ata_port_operations.
4046 *
4047 *      LOCKING:
4048 *      Inherited from caller.
4049 */
4050
4051void ata_sas_port_stop(struct ata_port *ap)
4052{
4053}
4054EXPORT_SYMBOL_GPL(ata_sas_port_stop);
4055
4056/**
4057 * ata_sas_async_probe - simply schedule probing and return
4058 * @ap: Port to probe
4059 *
4060 * For batch scheduling of probe for sas attached ata devices, assumes
4061 * the port has already been through ata_sas_port_init()
4062 */
4063void ata_sas_async_probe(struct ata_port *ap)
4064{
4065        __ata_port_probe(ap);
4066}
4067EXPORT_SYMBOL_GPL(ata_sas_async_probe);
4068
4069int ata_sas_sync_probe(struct ata_port *ap)
4070{
4071        return ata_port_probe(ap);
4072}
4073EXPORT_SYMBOL_GPL(ata_sas_sync_probe);
4074
4075
4076/**
4077 *      ata_sas_port_init - Initialize a SATA device
4078 *      @ap: SATA port to initialize
4079 *
4080 *      LOCKING:
4081 *      PCI/etc. bus probe sem.
4082 *
4083 *      RETURNS:
4084 *      Zero on success, non-zero on error.
4085 */
4086
4087int ata_sas_port_init(struct ata_port *ap)
4088{
4089        int rc = ap->ops->port_start(ap);
4090
4091        if (rc)
4092                return rc;
4093        ap->print_id = atomic_inc_return(&ata_print_id);
4094        return 0;
4095}
4096EXPORT_SYMBOL_GPL(ata_sas_port_init);
4097
4098/**
4099 *      ata_sas_port_destroy - Destroy a SATA port allocated by ata_sas_port_alloc
4100 *      @ap: SATA port to destroy
4101 *
4102 */
4103
4104void ata_sas_port_destroy(struct ata_port *ap)
4105{
4106        if (ap->ops->port_stop)
4107                ap->ops->port_stop(ap);
4108        kfree(ap);
4109}
4110EXPORT_SYMBOL_GPL(ata_sas_port_destroy);
4111
4112/**
4113 *      ata_sas_slave_configure - Default slave_config routine for libata devices
4114 *      @sdev: SCSI device to configure
4115 *      @ap: ATA port to which SCSI device is attached
4116 *
4117 *      RETURNS:
4118 *      Zero.
4119 */
4120
4121int ata_sas_slave_configure(struct scsi_device *sdev, struct ata_port *ap)
4122{
4123        ata_scsi_sdev_config(sdev);
4124        ata_scsi_dev_config(sdev, ap->link.device);
4125        return 0;
4126}
4127EXPORT_SYMBOL_GPL(ata_sas_slave_configure);
4128
4129/**
4130 *      ata_sas_queuecmd - Issue SCSI cdb to libata-managed device
4131 *      @cmd: SCSI command to be sent
4132 *      @ap:    ATA port to which the command is being sent
4133 *
4134 *      RETURNS:
4135 *      Return value from __ata_scsi_queuecmd() if @cmd can be queued,
4136 *      0 otherwise.
4137 */
4138
4139int ata_sas_queuecmd(struct scsi_cmnd *cmd, struct ata_port *ap)
4140{
4141        int rc = 0;
4142
4143        ata_scsi_dump_cdb(ap, cmd);
4144
4145        if (likely(ata_dev_enabled(ap->link.device)))
4146                rc = __ata_scsi_queuecmd(cmd, ap->link.device);
4147        else {
4148                cmd->result = (DID_BAD_TARGET << 16);
4149                cmd->scsi_done(cmd);
4150        }
4151        return rc;
4152}
4153EXPORT_SYMBOL_GPL(ata_sas_queuecmd);
4154
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.