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