]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/scsi/libata-scsi.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[PATCH] libata: clean up constants
[net-next-2.6.git] / drivers / scsi / libata-scsi.c
CommitLineData
1da177e4 1/*
af36d7f0
JG		 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 *
1da177e4
LT		 34 */
35
36#include <linux/kernel.h>
37#include <linux/blkdev.h>
38#include <linux/spinlock.h>
39#include <scsi/scsi.h>
1da177e4 40#include <scsi/scsi_host.h>
85837ebd 41#include <scsi/scsi_eh.h>
005a5a06 42#include <scsi/scsi_device.h>
193515d5 43#include <scsi/scsi_request.h>
30afc84c 44#include <scsi/scsi_transport.h>
1da177e4 45#include <linux/libata.h>
b095518e 46#include <linux/hdreg.h>
1da177e4
LT		 47#include <asm/uaccess.h>
48
49#include "libata.h"
50
b095518e
JG		 51#define SECTOR_SIZE 512
52
057ace5e 53typedef unsigned int (*ata_xlat_func_t)(struct ata_queued_cmd *qc, const u8 *scsicmd);
1da177e4 54static struct ata_device *
057ace5e 55ata_scsi_find_dev(struct ata_port *ap, const struct scsi_device *scsidev);
30afc84c 56enum scsi_eh_timer_return ata_scsi_timed_out(struct scsi_cmnd *cmd);
1da177e4 57
00ac37f5
DG		 58#define RW_RECOVERY_MPAGE 0x1
59#define RW_RECOVERY_MPAGE_LEN 12
60#define CACHE_MPAGE 0x8
61#define CACHE_MPAGE_LEN 20
62#define CONTROL_MPAGE 0xa
63#define CONTROL_MPAGE_LEN 12
64#define ALL_MPAGES 0x3f
65#define ALL_SUB_MPAGES 0xff
66
67
68static const u8 def_rw_recovery_mpage[] = {
69 RW_RECOVERY_MPAGE,
70 RW_RECOVERY_MPAGE_LEN - 2,
71 (1 << 7) | /* AWRE, sat-r06 say it shall be 0 */
72 (1 << 6), /* ARRE (auto read reallocation) */
73 0, /* read retry count */
74 0, 0, 0, 0,
75 0, /* write retry count */
76 0, 0, 0
77};
78
79static const u8 def_cache_mpage[CACHE_MPAGE_LEN] = {
80 CACHE_MPAGE,
81 CACHE_MPAGE_LEN - 2,
82 0, /* contains WCE, needs to be 0 for logic */
83 0, 0, 0, 0, 0, 0, 0, 0, 0,
84 0, /* contains DRA, needs to be 0 for logic */
85 0, 0, 0, 0, 0, 0, 0
86};
87
88static const u8 def_control_mpage[CONTROL_MPAGE_LEN] = {
89 CONTROL_MPAGE,
90 CONTROL_MPAGE_LEN - 2,
91 2, /* DSENSE=0, GLTSD=1 */
92 0, /* [QAM+QERR may be 1, see 05-359r1] */
93 0, 0, 0, 0, 0xff, 0xff,
94 0, 30 /* extended self test time, see 05-359r1 */
95};
96
30afc84c
TH		 97/*
98 * libata transport template. libata doesn't do real transport stuff.
99 * It just needs the eh_timed_out hook.
100 */
101struct scsi_transport_template ata_scsi_transport_template = {
102 .eh_timed_out = ata_scsi_timed_out,
103};
104
1da177e4 105
ae006510
DG		 106static void ata_scsi_invalid_field(struct scsi_cmnd *cmd,
107 void (*done)(struct scsi_cmnd *))
108{
109 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x24, 0x0);
110 /* "Invalid field in cbd" */
111 done(cmd);
112}
113
1da177e4
LT		 114/**
115 * ata_std_bios_param - generic bios head/sector/cylinder calculator used by sd.
116 * @sdev: SCSI device for which BIOS geometry is to be determined
117 * @bdev: block device associated with @sdev
118 * @capacity: capacity of SCSI device
119 * @geom: location to which geometry will be output
120 *
121 * Generic bios head/sector/cylinder calculator
122 * used by sd. Most BIOSes nowadays expect a XXX/255/16 (CHS)
123 * mapping. Some situations may arise where the disk is not
124 * bootable if this is not used.
125 *
126 * LOCKING:
127 * Defined by the SCSI layer. We don't really care.
128 *
129 * RETURNS:
130 * Zero.
131 */
132int ata_std_bios_param(struct scsi_device *sdev, struct block_device *bdev,
133 sector_t capacity, int geom[])
134{
135 geom[0] = 255;
136 geom[1] = 63;
137 sector_div(capacity, 255*63);
138 geom[2] = capacity;
139
140 return 0;
141}
142
b095518e
JG		 143/**
144 * ata_cmd_ioctl - Handler for HDIO_DRIVE_CMD ioctl
8e8b77dd 145 * @scsidev: Device to which we are issuing command
b095518e
JG		 146 * @arg: User provided data for issuing command
147 *
148 * LOCKING:
149 * Defined by the SCSI layer. We don't really care.
150 *
151 * RETURNS:
152 * Zero on success, negative errno on error.
153 */
154
155int ata_cmd_ioctl(struct scsi_device *scsidev, void __user *arg)
156{
157 int rc = 0;
158 u8 scsi_cmd[MAX_COMMAND_SIZE];
159 u8 args[4], *argbuf = NULL;
160 int argsize = 0;
85837ebd
MC		 161 struct scsi_sense_hdr sshdr;
162 enum dma_data_direction data_dir;
b095518e 163
c893a3ae 164 if (arg == NULL)
b095518e
JG		 165 return -EINVAL;
166
167 if (copy_from_user(args, arg, sizeof(args)))
168 return -EFAULT;
169
b095518e
JG		 170 memset(scsi_cmd, 0, sizeof(scsi_cmd));
171
172 if (args[3]) {
173 argsize = SECTOR_SIZE * args[3];
174 argbuf = kmalloc(argsize, GFP_KERNEL);
54dac83c
JR		 175 if (argbuf == NULL) {
176 rc = -ENOMEM;
177 goto error;
178 }
b095518e
JG		 179
180 scsi_cmd[1] = (4 << 1); /* PIO Data-in */
181 scsi_cmd[2] = 0x0e; /* no off.line or cc, read from dev,
182 block count in sector count field */
85837ebd 183 data_dir = DMA_FROM_DEVICE;
b095518e
JG		 184 } else {
185 scsi_cmd[1] = (3 << 1); /* Non-data */
186 /* scsi_cmd[2] is already 0 -- no off.line, cc, or data xfer */
85837ebd 187 data_dir = DMA_NONE;
b095518e
JG		 188 }
189
190 scsi_cmd[0] = ATA_16;
191
192 scsi_cmd[4] = args[2];
193 if (args[0] == WIN_SMART) { /* hack -- ide driver does this too... */
194 scsi_cmd[6] = args[3];
195 scsi_cmd[8] = args[1];
196 scsi_cmd[10] = 0x4f;
197 scsi_cmd[12] = 0xc2;
198 } else {
199 scsi_cmd[6] = args[1];
200 }
201 scsi_cmd[14] = args[0];
202
203 /* Good values for timeout and retries? Values below
204 from scsi_ioctl_send_command() for default case... */
85837ebd
MC		 205 if (scsi_execute_req(scsidev, scsi_cmd, data_dir, argbuf, argsize,
206 &sshdr, (10*HZ), 5)) {
b095518e
JG		 207 rc = -EIO;
208 goto error;
209 }
210
211 /* Need code to retrieve data from check condition? */
212
213 if ((argbuf)
c893a3ae 214 && copy_to_user(arg + sizeof(args), argbuf, argsize))
b095518e
JG		 215 rc = -EFAULT;
216error:
b095518e
JG		 217 if (argbuf)
218 kfree(argbuf);
219
220 return rc;
221}
222
223/**
224 * ata_task_ioctl - Handler for HDIO_DRIVE_TASK ioctl
8e8b77dd 225 * @scsidev: Device to which we are issuing command
b095518e
JG		 226 * @arg: User provided data for issuing command
227 *
228 * LOCKING:
229 * Defined by the SCSI layer. We don't really care.
230 *
231 * RETURNS:
232 * Zero on success, negative errno on error.
233 */
234int ata_task_ioctl(struct scsi_device *scsidev, void __user *arg)
235{
236 int rc = 0;
237 u8 scsi_cmd[MAX_COMMAND_SIZE];
238 u8 args[7];
85837ebd 239 struct scsi_sense_hdr sshdr;
b095518e 240
c893a3ae 241 if (arg == NULL)
b095518e
JG		 242 return -EINVAL;
243
244 if (copy_from_user(args, arg, sizeof(args)))
245 return -EFAULT;
246
247 memset(scsi_cmd, 0, sizeof(scsi_cmd));
248 scsi_cmd[0] = ATA_16;
249 scsi_cmd[1] = (3 << 1); /* Non-data */
250 /* scsi_cmd[2] is already 0 -- no off.line, cc, or data xfer */
251 scsi_cmd[4] = args[1];
252 scsi_cmd[6] = args[2];
253 scsi_cmd[8] = args[3];
254 scsi_cmd[10] = args[4];
255 scsi_cmd[12] = args[5];
256 scsi_cmd[14] = args[0];
257
b095518e 258 /* Good values for timeout and retries? Values below
2e9edbf8 259 from scsi_ioctl_send_command() for default case... */
85837ebd
MC		 260 if (scsi_execute_req(scsidev, scsi_cmd, DMA_NONE, NULL, 0, &sshdr,
261 (10*HZ), 5))
b095518e 262 rc = -EIO;
b095518e
JG		 263
264 /* Need code to retrieve data from check condition? */
b095518e
JG		 265 return rc;
266}
267
1da177e4
LT		 268int ata_scsi_ioctl(struct scsi_device *scsidev, int cmd, void __user *arg)
269{
1da177e4
LT		 270 int val = -EINVAL, rc = -EINVAL;
271
1da177e4
LT		 272 switch (cmd) {
273 case ATA_IOC_GET_IO32:
274 val = 0;
275 if (copy_to_user(arg, &val, 1))
276 return -EFAULT;
277 return 0;
278
279 case ATA_IOC_SET_IO32:
280 val = (unsigned long) arg;
281 if (val != 0)
282 return -EINVAL;
283 return 0;
284
b095518e
JG		 285 case HDIO_DRIVE_CMD:
286 if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
287 return -EACCES;
288 return ata_cmd_ioctl(scsidev, arg);
289
290 case HDIO_DRIVE_TASK:
291 if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
292 return -EACCES;
293 return ata_task_ioctl(scsidev, arg);
294
1da177e4
LT		 295 default:
296 rc = -ENOTTY;
297 break;
298 }
299
1da177e4
LT		 300 return rc;
301}
302
303/**
304 * ata_scsi_qc_new - acquire new ata_queued_cmd reference
305 * @ap: ATA port to which the new command is attached
306 * @dev: ATA device to which the new command is attached
307 * @cmd: SCSI command that originated this ATA command
308 * @done: SCSI command completion function
309 *
310 * Obtain a reference to an unused ata_queued_cmd structure,
311 * which is the basic libata structure representing a single
312 * ATA command sent to the hardware.
313 *
314 * If a command was available, fill in the SCSI-specific
315 * portions of the structure with information on the
316 * current command.
317 *
318 * LOCKING:
319 * spin_lock_irqsave(host_set lock)
320 *
321 * RETURNS:
322 * Command allocated, or %NULL if none available.
323 */
324struct ata_queued_cmd *ata_scsi_qc_new(struct ata_port *ap,
325 struct ata_device *dev,
326 struct scsi_cmnd *cmd,
327 void (*done)(struct scsi_cmnd *))
328{
329 struct ata_queued_cmd *qc;
330
331 qc = ata_qc_new_init(ap, dev);
332 if (qc) {
333 qc->scsicmd = cmd;
334 qc->scsidone = done;
335
336 if (cmd->use_sg) {
cedc9a47 337 qc->__sg = (struct scatterlist *) cmd->request_buffer;
1da177e4
LT		 338 qc->n_elem = cmd->use_sg;
339 } else {
cedc9a47 340 qc->__sg = &qc->sgent;
1da177e4
LT		 341 qc->n_elem = 1;
342 }
343 } else {
344 cmd->result = (DID_OK << 16) | (QUEUE_FULL << 1);
345 done(cmd);
346 }
347
348 return qc;
349}
350
b095518e
JG		 351/**
352 * ata_dump_status - user friendly display of error info
353 * @id: id of the port in question
354 * @tf: ptr to filled out taskfile
355 *
356 * Decode and dump the ATA error/status registers for the user so
357 * that they have some idea what really happened at the non
358 * make-believe layer.
359 *
360 * LOCKING:
361 * inherited from caller
362 */
363void ata_dump_status(unsigned id, struct ata_taskfile *tf)
364{
365 u8 stat = tf->command, err = tf->feature;
366
367 printk(KERN_WARNING "ata%u: status=0x%02x { ", id, stat);
368 if (stat & ATA_BUSY) {
369 printk("Busy }\n"); /* Data is not valid in this case */
370 } else {
371 if (stat & 0x40) printk("DriveReady ");
372 if (stat & 0x20) printk("DeviceFault ");
373 if (stat & 0x10) printk("SeekComplete ");
374 if (stat & 0x08) printk("DataRequest ");
375 if (stat & 0x04) printk("CorrectedError ");
376 if (stat & 0x02) printk("Index ");
377 if (stat & 0x01) printk("Error ");
378 printk("}\n");
379
380 if (err) {
381 printk(KERN_WARNING "ata%u: error=0x%02x { ", id, err);
382 if (err & 0x04) printk("DriveStatusError ");
383 if (err & 0x80) {
384 if (err & 0x04) printk("BadCRC ");
385 else printk("Sector ");
386 }
387 if (err & 0x40) printk("UncorrectableError ");
388 if (err & 0x10) printk("SectorIdNotFound ");
389 if (err & 0x02) printk("TrackZeroNotFound ");
390 if (err & 0x01) printk("AddrMarkNotFound ");
391 printk("}\n");
392 }
393 }
394}
395
9b847548
JA		 396int ata_scsi_device_resume(struct scsi_device *sdev)
397{
398 struct ata_port *ap = (struct ata_port *) &sdev->host->hostdata[0];
399 struct ata_device *dev = &ap->device[sdev->id];
400
401 return ata_device_resume(ap, dev);
402}
403
082776e4 404int ata_scsi_device_suspend(struct scsi_device *sdev, pm_message_t state)
9b847548
JA		 405{
406 struct ata_port *ap = (struct ata_port *) &sdev->host->hostdata[0];
407 struct ata_device *dev = &ap->device[sdev->id];
408
082776e4 409 return ata_device_suspend(ap, dev, state);
9b847548
JA		 410}
411
1da177e4
LT		 412/**
413 * ata_to_sense_error - convert ATA error to SCSI error
8e8b77dd 414 * @id: ATA device number
1da177e4 415 * @drv_stat: value contained in ATA status register
b095518e
JG		 416 * @drv_err: value contained in ATA error register
417 * @sk: the sense key we'll fill out
418 * @asc: the additional sense code we'll fill out
419 * @ascq: the additional sense code qualifier we'll fill out
1da177e4 420 *
b095518e
JG		 421 * Converts an ATA error into a SCSI error. Fill out pointers to
422 * SK, ASC, and ASCQ bytes for later use in fixed or descriptor
423 * format sense blocks.
1da177e4
LT		 424 *
425 * LOCKING:
426 * spin_lock_irqsave(host_set lock)
427 */
2e9edbf8 428void ata_to_sense_error(unsigned id, u8 drv_stat, u8 drv_err, u8 *sk, u8 *asc,
b095518e 429 u8 *ascq)
1da177e4 430{
b095518e 431 int i;
ffe75ef6 432
1da177e4 433 /* Based on the 3ware driver translation table */
98ac62de 434 static const unsigned char sense_table[][4] = {
1da177e4
LT		 435 /* BBD|ECC|ID|MAR */
436 {0xd1, ABORTED_COMMAND, 0x00, 0x00}, // Device busy Aborted command
437 /* BBD|ECC|ID */
438 {0xd0, ABORTED_COMMAND, 0x00, 0x00}, // Device busy Aborted command
439 /* ECC|MC|MARK */
440 {0x61, HARDWARE_ERROR, 0x00, 0x00}, // Device fault Hardware error
441 /* ICRC|ABRT */ /* NB: ICRC & !ABRT is BBD */
442 {0x84, ABORTED_COMMAND, 0x47, 0x00}, // Data CRC error SCSI parity error
443 /* MC|ID|ABRT|TRK0|MARK */
444 {0x37, NOT_READY, 0x04, 0x00}, // Unit offline Not ready
445 /* MCR|MARK */
446 {0x09, NOT_READY, 0x04, 0x00}, // Unrecovered disk error Not ready
447 /* Bad address mark */
448 {0x01, MEDIUM_ERROR, 0x13, 0x00}, // Address mark not found Address mark not found for data field
449 /* TRK0 */
450 {0x02, HARDWARE_ERROR, 0x00, 0x00}, // Track 0 not found Hardware error
451 /* Abort & !ICRC */
452 {0x04, ABORTED_COMMAND, 0x00, 0x00}, // Aborted command Aborted command
453 /* Media change request */
454 {0x08, NOT_READY, 0x04, 0x00}, // Media change request FIXME: faking offline
455 /* SRV */
456 {0x10, ABORTED_COMMAND, 0x14, 0x00}, // ID not found Recorded entity not found
457 /* Media change */
458 {0x08, NOT_READY, 0x04, 0x00}, // Media change FIXME: faking offline
459 /* ECC */
460 {0x40, MEDIUM_ERROR, 0x11, 0x04}, // Uncorrectable ECC error Unrecovered read error
461 /* BBD - block marked bad */
462 {0x80, MEDIUM_ERROR, 0x11, 0x04}, // Block marked bad Medium error, unrecovered read error
463 {0xFF, 0xFF, 0xFF, 0xFF}, // END mark
464 };
98ac62de 465 static const unsigned char stat_table[][4] = {
1da177e4
LT		 466 /* Must be first because BUSY means no other bits valid */
467 {0x80, ABORTED_COMMAND, 0x47, 0x00}, // Busy, fake parity for now
468 {0x20, HARDWARE_ERROR, 0x00, 0x00}, // Device fault
469 {0x08, ABORTED_COMMAND, 0x47, 0x00}, // Timed out in xfer, fake parity for now
470 {0x04, RECOVERED_ERROR, 0x11, 0x00}, // Recovered ECC error Medium error, recovered
471 {0xFF, 0xFF, 0xFF, 0xFF}, // END mark
472 };
1da177e4 473
1da177e4
LT		 474 /*
475 * Is this an error we can process/parse
476 */
b095518e
JG		 477 if (drv_stat & ATA_BUSY) {
478 drv_err = 0; /* Ignore the err bits, they're invalid */
1da177e4 479 }
b095518e
JG		 480
481 if (drv_err) {
482 /* Look for drv_err */
483 for (i = 0; sense_table[i][0] != 0xFF; i++) {
484 /* Look for best matches first */
2e9edbf8 485 if ((sense_table[i][0] & drv_err) ==
b095518e
JG		 486 sense_table[i][0]) {
487 *sk = sense_table[i][1];
488 *asc = sense_table[i][2];
489 *ascq = sense_table[i][3];
490 goto translate_done;
491 }
492 }
493 /* No immediate match */
494 printk(KERN_WARNING "ata%u: no sense translation for "
495 "error 0x%02x\n", id, drv_err);
1da177e4 496 }
b095518e
JG		 497
498 /* Fall back to interpreting status bits */
499 for (i = 0; stat_table[i][0] != 0xFF; i++) {
500 if (stat_table[i][0] & drv_stat) {
501 *sk = stat_table[i][1];
502 *asc = stat_table[i][2];
503 *ascq = stat_table[i][3];
504 goto translate_done;
1da177e4 505 }
b095518e
JG		 506 }
507 /* No error? Undecoded? */
2e9edbf8 508 printk(KERN_WARNING "ata%u: no sense translation for status: 0x%02x\n",
b095518e
JG		 509 id, drv_stat);
510
2d202024
AC		 511 /* We need a sensible error return here, which is tricky, and one
512 that won't cause people to do things like return a disk wrongly */
513 *sk = ABORTED_COMMAND;
514 *asc = 0x00;
515 *ascq = 0x00;
b095518e
JG		 516
517 translate_done:
518 printk(KERN_ERR "ata%u: translated ATA stat/err 0x%02x/%02x to "
519 "SCSI SK/ASC/ASCQ 0x%x/%02x/%02x\n", id, drv_stat, drv_err,
520 *sk, *asc, *ascq);
521 return;
522}
523
524/*
525 * ata_gen_ata_desc_sense - Generate check condition sense block.
526 * @qc: Command that completed.
527 *
528 * This function is specific to the ATA descriptor format sense
529 * block specified for the ATA pass through commands. Regardless
530 * of whether the command errored or not, return a sense
531 * block. Copy all controller registers into the sense
532 * block. Clear sense key, ASC & ASCQ if there is no error.
533 *
534 * LOCKING:
535 * spin_lock_irqsave(host_set lock)
536 */
537void ata_gen_ata_desc_sense(struct ata_queued_cmd *qc)
538{
539 struct scsi_cmnd *cmd = qc->scsicmd;
540 struct ata_taskfile *tf = &qc->tf;
541 unsigned char *sb = cmd->sense_buffer;
542 unsigned char *desc = sb + 8;
543
544 memset(sb, 0, SCSI_SENSE_BUFFERSIZE);
545
0e5dec47 546 cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
b095518e
JG		 547
548 /*
549 * Read the controller registers.
550 */
a4631474 551 WARN_ON(qc->ap->ops->tf_read == NULL);
b095518e 552 qc->ap->ops->tf_read(qc->ap, tf);
1da177e4 553
b095518e
JG		 554 /*
555 * Use ata_to_sense_error() to map status register bits
556 * onto sense key, asc & ascq.
557 */
a7dac447 558 if (tf->command & (ATA_BUSY | ATA_DF | ATA_ERR | ATA_DRQ)) {
b095518e
JG		 559 ata_to_sense_error(qc->ap->id, tf->command, tf->feature,
560 &sb[1], &sb[2], &sb[3]);
561 sb[1] &= 0x0f;
1da177e4
LT		 562 }
563
b095518e
JG		 564 /*
565 * Sense data is current and format is descriptor.
566 */
567 sb[0] = 0x72;
1da177e4 568
b095518e
JG		 569 desc[0] = 0x09;
570
571 /*
572 * Set length of additional sense data.
573 * Since we only populate descriptor 0, the total
574 * length is the same (fixed) length as descriptor 0.
575 */
576 desc[1] = sb[7] = 14;
577
578 /*
579 * Copy registers into sense buffer.
580 */
581 desc[2] = 0x00;
582 desc[3] = tf->feature; /* == error reg */
583 desc[5] = tf->nsect;
584 desc[7] = tf->lbal;
585 desc[9] = tf->lbam;
586 desc[11] = tf->lbah;
587 desc[12] = tf->device;
588 desc[13] = tf->command; /* == status reg */
589
590 /*
591 * Fill in Extend bit, and the high order bytes
592 * if applicable.
593 */
594 if (tf->flags & ATA_TFLAG_LBA48) {
595 desc[2] |= 0x01;
596 desc[4] = tf->hob_nsect;
597 desc[6] = tf->hob_lbal;
598 desc[8] = tf->hob_lbam;
599 desc[10] = tf->hob_lbah;
1da177e4 600 }
b095518e 601}
1da177e4 602
b095518e
JG		 603/**
604 * ata_gen_fixed_sense - generate a SCSI fixed sense block
605 * @qc: Command that we are erroring out
606 *
607 * Leverage ata_to_sense_error() to give us the codes. Fit our
608 * LBA in here if there's room.
609 *
610 * LOCKING:
611 * inherited from caller
612 */
613void ata_gen_fixed_sense(struct ata_queued_cmd *qc)
614{
615 struct scsi_cmnd *cmd = qc->scsicmd;
616 struct ata_taskfile *tf = &qc->tf;
617 unsigned char *sb = cmd->sense_buffer;
618
619 memset(sb, 0, SCSI_SENSE_BUFFERSIZE);
620
0e5dec47 621 cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
b095518e
JG		 622
623 /*
624 * Read the controller registers.
625 */
a4631474 626 WARN_ON(qc->ap->ops->tf_read == NULL);
b095518e
JG		 627 qc->ap->ops->tf_read(qc->ap, tf);
628
629 /*
630 * Use ata_to_sense_error() to map status register bits
631 * onto sense key, asc & ascq.
632 */
a7dac447 633 if (tf->command & (ATA_BUSY | ATA_DF | ATA_ERR | ATA_DRQ)) {
b095518e
JG		 634 ata_to_sense_error(qc->ap->id, tf->command, tf->feature,
635 &sb[2], &sb[12], &sb[13]);
636 sb[2] &= 0x0f;
1da177e4 637 }
1da177e4
LT		 638
639 sb[0] = 0x70;
b095518e 640 sb[7] = 0x0a;
0274aa25 641
a7dac447
JG		 642 if (tf->flags & ATA_TFLAG_LBA48) {
643 /* TODO: find solution for LBA48 descriptors */
644 }
645
646 else if (tf->flags & ATA_TFLAG_LBA) {
b095518e
JG		 647 /* A small (28b) LBA will fit in the 32b info field */
648 sb[0] |= 0x80; /* set valid bit */
649 sb[3] = tf->device & 0x0f;
650 sb[4] = tf->lbah;
651 sb[5] = tf->lbam;
652 sb[6] = tf->lbal;
1da177e4 653 }
a7dac447
JG		 654
655 else {
656 /* TODO: C/H/S */
657 }
1da177e4
LT		 658}
659
a6cce2a7
BK		 660static void ata_scsi_sdev_config(struct scsi_device *sdev)
661{
662 sdev->use_10_for_rw = 1;
663 sdev->use_10_for_ms = 1;
664}
665
666static void ata_scsi_dev_config(struct scsi_device *sdev,
667 struct ata_device *dev)
668{
669 unsigned int max_sectors;
670
671 /* TODO: 2048 is an arbitrary number, not the
672 * hardware maximum. This should be increased to
673 * 65534 when Jens Axboe's patch for dynamically
674 * determining max_sectors is merged.
675 */
676 max_sectors = ATA_MAX_SECTORS;
677 if (dev->flags & ATA_DFLAG_LBA48)
678 max_sectors = 2048;
679 if (dev->max_sectors)
680 max_sectors = dev->max_sectors;
681
682 blk_queue_max_sectors(sdev->request_queue, max_sectors);
683
684 /*
685 * SATA DMA transfers must be multiples of 4 byte, so
686 * we need to pad ATAPI transfers using an extra sg.
687 * Decrement max hw segments accordingly.
688 */
689 if (dev->class == ATA_DEV_ATAPI) {
690 request_queue_t *q = sdev->request_queue;
691 blk_queue_max_hw_segments(q, q->max_hw_segments - 1);
692 }
693}
694
1da177e4
LT		 695/**
696 * ata_scsi_slave_config - Set SCSI device attributes
697 * @sdev: SCSI device to examine
698 *
699 * This is called before we actually start reading
700 * and writing to the device, to configure certain
701 * SCSI mid-layer behaviors.
702 *
703 * LOCKING:
704 * Defined by SCSI layer. We don't really care.
705 */
706
707int ata_scsi_slave_config(struct scsi_device *sdev)
708{
a6cce2a7 709 ata_scsi_sdev_config(sdev);
1da177e4
LT		 710
711 blk_queue_max_phys_segments(sdev->request_queue, LIBATA_MAX_PRD);
712
713 if (sdev->id < ATA_MAX_DEVICES) {
714 struct ata_port *ap;
715 struct ata_device *dev;
716
717 ap = (struct ata_port *) &sdev->host->hostdata[0];
718 dev = &ap->device[sdev->id];
719
a6cce2a7 720 ata_scsi_dev_config(sdev, dev);
1da177e4
LT		 721 }
722
723 return 0; /* scsi layer doesn't check return value, sigh */
724}
725
f29841e0
TH		 726/**
727 * ata_scsi_timed_out - SCSI layer time out callback
728 * @cmd: timed out SCSI command
729 *
730 * Handles SCSI layer timeout. We race with normal completion of
731 * the qc for @cmd. If the qc is already gone, we lose and let
732 * the scsi command finish (EH_HANDLED). Otherwise, the qc has
733 * timed out and EH should be invoked. Prevent ata_qc_complete()
734 * from finishing it by setting EH_SCHEDULED and return
735 * EH_NOT_HANDLED.
736 *
737 * LOCKING:
738 * Called from timer context
739 *
740 * RETURNS:
741 * EH_HANDLED or EH_NOT_HANDLED
742 */
743enum scsi_eh_timer_return ata_scsi_timed_out(struct scsi_cmnd *cmd)
744{
745 struct Scsi_Host *host = cmd->device->host;
746 struct ata_port *ap = (struct ata_port *) &host->hostdata[0];
747 unsigned long flags;
748 struct ata_queued_cmd *qc;
749 enum scsi_eh_timer_return ret = EH_HANDLED;
750
751 DPRINTK("ENTER\n");
752
753 spin_lock_irqsave(&ap->host_set->lock, flags);
754 qc = ata_qc_from_tag(ap, ap->active_tag);
755 if (qc) {
a4631474 756 WARN_ON(qc->scsicmd != cmd);
f29841e0
TH		 757 qc->flags |= ATA_QCFLAG_EH_SCHEDULED;
758 qc->err_mask |= AC_ERR_TIMEOUT;
759 ret = EH_NOT_HANDLED;
760 }
761 spin_unlock_irqrestore(&ap->host_set->lock, flags);
762
763 DPRINTK("EXIT, ret=%d\n", ret);
764 return ret;
765}
766
1da177e4
LT		 767/**
768 * ata_scsi_error - SCSI layer error handler callback
769 * @host: SCSI host on which error occurred
770 *
771 * Handles SCSI-layer-thrown error events.
772 *
773 * LOCKING:
774 * Inherited from SCSI layer (none, can sleep)
775 *
776 * RETURNS:
777 * Zero.
778 */
779
780int ata_scsi_error(struct Scsi_Host *host)
781{
c43c555c 782 struct ata_port *ap = (struct ata_port *)&host->hostdata[0];
1da177e4
LT		 783
784 DPRINTK("ENTER\n");
785
c43c555c
TH		 786 /* synchronize with IRQ handler and port task */
787 spin_unlock_wait(&ap->host_set->lock);
788 ata_port_flush_task(ap);
5140788f 789
a4631474 790 WARN_ON(ata_qc_from_tag(ap, ap->active_tag) == NULL);
86e45b6b 791
1da177e4
LT		 792 ap->ops->eng_timeout(ap);
793
a4631474 794 WARN_ON(host->host_failed || !list_empty(&host->eh_cmd_q));
a72ec4ce
TH		 795
796 scsi_eh_flush_done_q(&ap->eh_done_q);
1da177e4
LT		 797
798 DPRINTK("EXIT\n");
799 return 0;
800}
801
a72ec4ce
TH		 802static void ata_eh_scsidone(struct scsi_cmnd *scmd)
803{
804 /* nada */
805}
806
807static void __ata_eh_qc_complete(struct ata_queued_cmd *qc)
808{
809 struct ata_port *ap = qc->ap;
810 struct scsi_cmnd *scmd = qc->scsicmd;
811 unsigned long flags;
812
813 spin_lock_irqsave(&ap->host_set->lock, flags);
814 qc->scsidone = ata_eh_scsidone;
341963b9 815 __ata_qc_complete(qc);
a4631474 816 WARN_ON(ata_tag_valid(qc->tag));
a72ec4ce
TH		 817 spin_unlock_irqrestore(&ap->host_set->lock, flags);
818
819 scsi_eh_finish_cmd(scmd, &ap->eh_done_q);
820}
821
822/**
823 * ata_eh_qc_complete - Complete an active ATA command from EH
824 * @qc: Command to complete
825 *
826 * Indicate to the mid and upper layers that an ATA command has
827 * completed. To be used from EH.
828 */
829void ata_eh_qc_complete(struct ata_queued_cmd *qc)
830{
831 struct scsi_cmnd *scmd = qc->scsicmd;
832 scmd->retries = scmd->allowed;
833 __ata_eh_qc_complete(qc);
834}
835
836/**
837 * ata_eh_qc_retry - Tell midlayer to retry an ATA command after EH
838 * @qc: Command to retry
839 *
840 * Indicate to the mid and upper layers that an ATA command
841 * should be retried. To be used from EH.
842 *
843 * SCSI midlayer limits the number of retries to scmd->allowed.
844 * This function might need to adjust scmd->retries for commands
845 * which get retried due to unrelated NCQ failures.
846 */
847void ata_eh_qc_retry(struct ata_queued_cmd *qc)
848{
849 __ata_eh_qc_complete(qc);
850}
851
972dcafb
DG		 852/**
853 * ata_scsi_start_stop_xlat - Translate SCSI START STOP UNIT command
854 * @qc: Storage for translated ATA taskfile
855 * @scsicmd: SCSI command to translate
856 *
857 * Sets up an ATA taskfile to issue STANDBY (to stop) or READ VERIFY
858 * (to start). Perhaps these commands should be preceded by
859 * CHECK POWER MODE to see what power mode the device is already in.
860 * [See SAT revision 5 at www.t10.org]
861 *
862 * LOCKING:
863 * spin_lock_irqsave(host_set lock)
864 *
865 * RETURNS:
866 * Zero on success, non-zero on error.
867 */
868
869static unsigned int ata_scsi_start_stop_xlat(struct ata_queued_cmd *qc,
057ace5e 870 const u8 *scsicmd)
972dcafb
DG		 871{
872 struct ata_taskfile *tf = &qc->tf;
873
874 tf->flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
875 tf->protocol = ATA_PROT_NODATA;
876 if (scsicmd[1] & 0x1) {
877 ; /* ignore IMMED bit, violates sat-r05 */
878 }
879 if (scsicmd[4] & 0x2)
ae006510 880 goto invalid_fld; /* LOEJ bit set not supported */
972dcafb 881 if (((scsicmd[4] >> 4) & 0xf) != 0)
ae006510 882 goto invalid_fld; /* power conditions not supported */
972dcafb
DG		 883 if (scsicmd[4] & 0x1) {
884 tf->nsect = 1; /* 1 sector, lba=0 */
9d5b1302
AL		 885
886 if (qc->dev->flags & ATA_DFLAG_LBA) {
887 qc->tf.flags |= ATA_TFLAG_LBA;
888
889 tf->lbah = 0x0;
890 tf->lbam = 0x0;
891 tf->lbal = 0x0;
892 tf->device |= ATA_LBA;
893 } else {
894 /* CHS */
895 tf->lbal = 0x1; /* sect */
896 tf->lbam = 0x0; /* cyl low */
897 tf->lbah = 0x0; /* cyl high */
898 }
899
972dcafb
DG		 900 tf->command = ATA_CMD_VERIFY; /* READ VERIFY */
901 } else {
902 tf->nsect = 0; /* time period value (0 implies now) */
903 tf->command = ATA_CMD_STANDBY;
904 /* Consider: ATA STANDBY IMMEDIATE command */
905 }
906 /*
907 * Standby and Idle condition timers could be implemented but that
908 * would require libata to implement the Power condition mode page
909 * and allow the user to change it. Changing mode pages requires
910 * MODE SELECT to be implemented.
911 */
912
913 return 0;
ae006510
DG		 914
915invalid_fld:
916 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x0);
917 /* "Invalid field in cbd" */
918 return 1;
972dcafb
DG		 919}
920
921
1da177e4
LT		 922/**
923 * ata_scsi_flush_xlat - Translate SCSI SYNCHRONIZE CACHE command
924 * @qc: Storage for translated ATA taskfile
925 * @scsicmd: SCSI command to translate (ignored)
926 *
927 * Sets up an ATA taskfile to issue FLUSH CACHE or
928 * FLUSH CACHE EXT.
929 *
930 * LOCKING:
931 * spin_lock_irqsave(host_set lock)
932 *
933 * RETURNS:
934 * Zero on success, non-zero on error.
935 */
936
057ace5e 937static unsigned int ata_scsi_flush_xlat(struct ata_queued_cmd *qc, const u8 *scsicmd)
1da177e4
LT		 938{
939 struct ata_taskfile *tf = &qc->tf;
940
941 tf->flags |= ATA_TFLAG_DEVICE;
942 tf->protocol = ATA_PROT_NODATA;
943
07506697 944 if ((qc->dev->flags & ATA_DFLAG_LBA48) &&
1da177e4
LT		 945 (ata_id_has_flush_ext(qc->dev->id)))
946 tf->command = ATA_CMD_FLUSH_EXT;
947 else
948 tf->command = ATA_CMD_FLUSH;
949
950 return 0;
951}
952
3aef5231
AL		 953/**
954 * scsi_6_lba_len - Get LBA and transfer length
955 * @scsicmd: SCSI command to translate
956 *
957 * Calculate LBA and transfer length for 6-byte commands.
958 *
959 * RETURNS:
960 * @plba: the LBA
961 * @plen: the transfer length
962 */
963
057ace5e 964static void scsi_6_lba_len(const u8 *scsicmd, u64 *plba, u32 *plen)
3aef5231
AL		 965{
966 u64 lba = 0;
967 u32 len = 0;
968
969 VPRINTK("six-byte command\n");
970
971 lba |= ((u64)scsicmd[2]) << 8;
972 lba |= ((u64)scsicmd[3]);
973
974 len |= ((u32)scsicmd[4]);
975
976 *plba = lba;
977 *plen = len;
978}
979
980/**
981 * scsi_10_lba_len - Get LBA and transfer length
982 * @scsicmd: SCSI command to translate
983 *
984 * Calculate LBA and transfer length for 10-byte commands.
985 *
986 * RETURNS:
987 * @plba: the LBA
988 * @plen: the transfer length
989 */
990
057ace5e 991static void scsi_10_lba_len(const u8 *scsicmd, u64 *plba, u32 *plen)
3aef5231
AL		 992{
993 u64 lba = 0;
994 u32 len = 0;
995
996 VPRINTK("ten-byte command\n");
997
998 lba |= ((u64)scsicmd[2]) << 24;
999 lba |= ((u64)scsicmd[3]) << 16;
1000 lba |= ((u64)scsicmd[4]) << 8;
1001 lba |= ((u64)scsicmd[5]);
1002
1003 len |= ((u32)scsicmd[7]) << 8;
1004 len |= ((u32)scsicmd[8]);
1005
1006 *plba = lba;
1007 *plen = len;
1008}
1009
1010/**
1011 * scsi_16_lba_len - Get LBA and transfer length
1012 * @scsicmd: SCSI command to translate
1013 *
1014 * Calculate LBA and transfer length for 16-byte commands.
1015 *
1016 * RETURNS:
1017 * @plba: the LBA
1018 * @plen: the transfer length
1019 */
1020
057ace5e 1021static void scsi_16_lba_len(const u8 *scsicmd, u64 *plba, u32 *plen)
3aef5231
AL		 1022{
1023 u64 lba = 0;
1024 u32 len = 0;
1025
1026 VPRINTK("sixteen-byte command\n");
1027
1028 lba |= ((u64)scsicmd[2]) << 56;
1029 lba |= ((u64)scsicmd[3]) << 48;
1030 lba |= ((u64)scsicmd[4]) << 40;
1031 lba |= ((u64)scsicmd[5]) << 32;
1032 lba |= ((u64)scsicmd[6]) << 24;
1033 lba |= ((u64)scsicmd[7]) << 16;
1034 lba |= ((u64)scsicmd[8]) << 8;
1035 lba |= ((u64)scsicmd[9]);
1036
1037 len |= ((u32)scsicmd[10]) << 24;
1038 len |= ((u32)scsicmd[11]) << 16;
1039 len |= ((u32)scsicmd[12]) << 8;
1040 len |= ((u32)scsicmd[13]);
1041
1042 *plba = lba;
1043 *plen = len;
1044}
1045
1da177e4
LT		 1046/**
1047 * ata_scsi_verify_xlat - Translate SCSI VERIFY command into an ATA one
1048 * @qc: Storage for translated ATA taskfile
1049 * @scsicmd: SCSI command to translate
1050 *
1051 * Converts SCSI VERIFY command to an ATA READ VERIFY command.
1052 *
1053 * LOCKING:
1054 * spin_lock_irqsave(host_set lock)
1055 *
1056 * RETURNS:
1057 * Zero on success, non-zero on error.
1058 */
1059
057ace5e 1060static unsigned int ata_scsi_verify_xlat(struct ata_queued_cmd *qc, const u8 *scsicmd)
1da177e4
LT		 1061{
1062 struct ata_taskfile *tf = &qc->tf;
8bf62ece 1063 struct ata_device *dev = qc->dev;
1da177e4 1064 u64 dev_sectors = qc->dev->n_sectors;
3aef5231
AL		 1065 u64 block;
1066 u32 n_block;
1da177e4
LT		 1067
1068 tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1069 tf->protocol = ATA_PROT_NODATA;
1da177e4 1070
3aef5231
AL		 1071 if (scsicmd[0] == VERIFY)
1072 scsi_10_lba_len(scsicmd, &block, &n_block);
1073 else if (scsicmd[0] == VERIFY_16)
1074 scsi_16_lba_len(scsicmd, &block, &n_block);
1da177e4 1075 else
ae006510 1076 goto invalid_fld;
1da177e4 1077
8bf62ece 1078 if (!n_block)
ae006510 1079 goto nothing_to_do;
8bf62ece 1080 if (block >= dev_sectors)
ae006510 1081 goto out_of_range;
8bf62ece 1082 if ((block + n_block) > dev_sectors)
ae006510 1083 goto out_of_range;
1da177e4 1084
07506697
AL		 1085 if (dev->flags & ATA_DFLAG_LBA) {
1086 tf->flags |= ATA_TFLAG_LBA;
1087
c6a33e24
AL		 1088 if (lba_28_ok(block, n_block)) {
1089 /* use LBA28 */
1090 tf->command = ATA_CMD_VERIFY;
1091 tf->device |= (block >> 24) & 0xf;
1092 } else if (lba_48_ok(block, n_block)) {
1093 if (!(dev->flags & ATA_DFLAG_LBA48))
1094 goto out_of_range;
07506697
AL		 1095
1096 /* use LBA48 */
1097 tf->flags |= ATA_TFLAG_LBA48;
8bf62ece 1098 tf->command = ATA_CMD_VERIFY_EXT;
1da177e4 1099
8bf62ece 1100 tf->hob_nsect = (n_block >> 8) & 0xff;
1da177e4 1101
8bf62ece
AL		 1102 tf->hob_lbah = (block >> 40) & 0xff;
1103 tf->hob_lbam = (block >> 32) & 0xff;
1104 tf->hob_lbal = (block >> 24) & 0xff;
c6a33e24
AL		 1105 } else
1106 /* request too large even for LBA48 */
1107 goto out_of_range;
8bf62ece
AL		 1108
1109 tf->nsect = n_block & 0xff;
1da177e4 1110
8bf62ece
AL		 1111 tf->lbah = (block >> 16) & 0xff;
1112 tf->lbam = (block >> 8) & 0xff;
1113 tf->lbal = block & 0xff;
1da177e4 1114
8bf62ece
AL		 1115 tf->device |= ATA_LBA;
1116 } else {
1117 /* CHS */
1118 u32 sect, head, cyl, track;
1119
c6a33e24
AL		 1120 if (!lba_28_ok(block, n_block))
1121 goto out_of_range;
07506697 1122
8bf62ece
AL		 1123 /* Convert LBA to CHS */
1124 track = (u32)block / dev->sectors;
1125 cyl = track / dev->heads;
1126 head = track % dev->heads;
1127 sect = (u32)block % dev->sectors + 1;
1128
c187c4b5
AL		 1129 DPRINTK("block %u track %u cyl %u head %u sect %u\n",
1130 (u32)block, track, cyl, head, sect);
2e9edbf8
JG		 1131
1132 /* Check whether the converted CHS can fit.
1133 Cylinder: 0-65535
8bf62ece
AL		 1134 Head: 0-15
1135 Sector: 1-255*/
2e9edbf8 1136 if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect))
ae006510 1137 goto out_of_range;
2e9edbf8 1138
8bf62ece
AL		 1139 tf->command = ATA_CMD_VERIFY;
1140 tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */
1141 tf->lbal = sect;
1142 tf->lbam = cyl;
1143 tf->lbah = cyl >> 8;
1144 tf->device |= head;
1145 }
1da177e4
LT		 1146
1147 return 0;
ae006510
DG		 1148
1149invalid_fld:
1150 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x0);
1151 /* "Invalid field in cbd" */
1152 return 1;
1153
1154out_of_range:
1155 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x21, 0x0);
1156 /* "Logical Block Address out of range" */
1157 return 1;
1158
1159nothing_to_do:
1160 qc->scsicmd->result = SAM_STAT_GOOD;
1161 return 1;
1da177e4
LT		 1162}
1163
1164/**
1165 * ata_scsi_rw_xlat - Translate SCSI r/w command into an ATA one
1166 * @qc: Storage for translated ATA taskfile
1167 * @scsicmd: SCSI command to translate
1168 *
1169 * Converts any of six SCSI read/write commands into the
1170 * ATA counterpart, including starting sector (LBA),
1171 * sector count, and taking into account the device's LBA48
1172 * support.
1173 *
1174 * Commands %READ_6, %READ_10, %READ_16, %WRITE_6, %WRITE_10, and
1175 * %WRITE_16 are currently supported.
1176 *
1177 * LOCKING:
1178 * spin_lock_irqsave(host_set lock)
1179 *
1180 * RETURNS:
1181 * Zero on success, non-zero on error.
1182 */
1183
057ace5e 1184static unsigned int ata_scsi_rw_xlat(struct ata_queued_cmd *qc, const u8 *scsicmd)
1da177e4
LT		 1185{
1186 struct ata_taskfile *tf = &qc->tf;
8bf62ece 1187 struct ata_device *dev = qc->dev;
3aef5231
AL		 1188 u64 block;
1189 u32 n_block;
1da177e4
LT		 1190
1191 tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1da177e4 1192
8cbd6df1
AL		 1193 if (scsicmd[0] == WRITE_10 || scsicmd[0] == WRITE_6 ||
1194 scsicmd[0] == WRITE_16)
1da177e4 1195 tf->flags |= ATA_TFLAG_WRITE;
1da177e4 1196
9a3dccc4 1197 /* Calculate the SCSI LBA, transfer length and FUA. */
3aef5231
AL		 1198 switch (scsicmd[0]) {
1199 case READ_10:
1200 case WRITE_10:
1201 scsi_10_lba_len(scsicmd, &block, &n_block);
9a3dccc4
TH		 1202 if (unlikely(scsicmd[1] & (1 << 3)))
1203 tf->flags |= ATA_TFLAG_FUA;
3aef5231
AL		 1204 break;
1205 case READ_6:
1206 case WRITE_6:
1207 scsi_6_lba_len(scsicmd, &block, &n_block);
c187c4b5
AL		 1208
1209 /* for 6-byte r/w commands, transfer length 0
1210 * means 256 blocks of data, not 0 block.
1211 */
76b2bf9b
JG		 1212 if (!n_block)
1213 n_block = 256;
3aef5231
AL		 1214 break;
1215 case READ_16:
1216 case WRITE_16:
1217 scsi_16_lba_len(scsicmd, &block, &n_block);
9a3dccc4
TH		 1218 if (unlikely(scsicmd[1] & (1 << 3)))
1219 tf->flags |= ATA_TFLAG_FUA;
3aef5231
AL		 1220 break;
1221 default:
8bf62ece 1222 DPRINTK("no-byte command\n");
ae006510 1223 goto invalid_fld;
1da177e4
LT		 1224 }
1225
8bf62ece
AL		 1226 /* Check and compose ATA command */
1227 if (!n_block)
c187c4b5
AL		 1228 /* For 10-byte and 16-byte SCSI R/W commands, transfer
1229 * length 0 means transfer 0 block of data.
1230 * However, for ATA R/W commands, sector count 0 means
1231 * 256 or 65536 sectors, not 0 sectors as in SCSI.
f51750d5
AC		 1232 *
1233 * WARNING: one or two older ATA drives treat 0 as 0...
c187c4b5 1234 */
ae006510 1235 goto nothing_to_do;
1da177e4 1236
07506697
AL		 1237 if (dev->flags & ATA_DFLAG_LBA) {
1238 tf->flags |= ATA_TFLAG_LBA;
1239
c6a33e24
AL		 1240 if (lba_28_ok(block, n_block)) {
1241 /* use LBA28 */
1242 tf->device |= (block >> 24) & 0xf;
1243 } else if (lba_48_ok(block, n_block)) {
1244 if (!(dev->flags & ATA_DFLAG_LBA48))
ae006510 1245 goto out_of_range;
1da177e4 1246
07506697
AL		 1247 /* use LBA48 */
1248 tf->flags |= ATA_TFLAG_LBA48;
1249
8bf62ece
AL		 1250 tf->hob_nsect = (n_block >> 8) & 0xff;
1251
1252 tf->hob_lbah = (block >> 40) & 0xff;
1253 tf->hob_lbam = (block >> 32) & 0xff;
1254 tf->hob_lbal = (block >> 24) & 0xff;
c6a33e24
AL		 1255 } else
1256 /* request too large even for LBA48 */
1257 goto out_of_range;
c187c4b5 1258
9a3dccc4
TH		 1259 if (unlikely(ata_rwcmd_protocol(qc) < 0))
1260 goto invalid_fld;
8cbd6df1 1261
8bf62ece
AL		 1262 qc->nsect = n_block;
1263 tf->nsect = n_block & 0xff;
1da177e4 1264
8bf62ece
AL		 1265 tf->lbah = (block >> 16) & 0xff;
1266 tf->lbam = (block >> 8) & 0xff;
1267 tf->lbal = block & 0xff;
1da177e4 1268
8bf62ece 1269 tf->device |= ATA_LBA;
2e9edbf8 1270 } else {
8bf62ece
AL		 1271 /* CHS */
1272 u32 sect, head, cyl, track;
1273
1274 /* The request -may- be too large for CHS addressing. */
c6a33e24 1275 if (!lba_28_ok(block, n_block))
ae006510 1276 goto out_of_range;
c187c4b5 1277
9a3dccc4
TH		 1278 if (unlikely(ata_rwcmd_protocol(qc) < 0))
1279 goto invalid_fld;
8cbd6df1 1280
8bf62ece
AL		 1281 /* Convert LBA to CHS */
1282 track = (u32)block / dev->sectors;
1283 cyl = track / dev->heads;
1284 head = track % dev->heads;
1285 sect = (u32)block % dev->sectors + 1;
1286
c187c4b5 1287 DPRINTK("block %u track %u cyl %u head %u sect %u\n",
8bf62ece 1288 (u32)block, track, cyl, head, sect);
c187c4b5 1289
2e9edbf8
JG		 1290 /* Check whether the converted CHS can fit.
1291 Cylinder: 0-65535
8bf62ece
AL		 1292 Head: 0-15
1293 Sector: 1-255*/
c187c4b5 1294 if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect))
ae006510 1295 goto out_of_range;
c187c4b5 1296
8bf62ece
AL		 1297 qc->nsect = n_block;
1298 tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */
1299 tf->lbal = sect;
1300 tf->lbam = cyl;
1301 tf->lbah = cyl >> 8;
1302 tf->device |= head;
1da177e4
LT		 1303 }
1304
8bf62ece 1305 return 0;
ae006510
DG		 1306
1307invalid_fld:
1308 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x0);
1309 /* "Invalid field in cbd" */
1310 return 1;
1311
1312out_of_range:
1313 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x21, 0x0);
1314 /* "Logical Block Address out of range" */
1315 return 1;
1316
1317nothing_to_do:
1318 qc->scsicmd->result = SAM_STAT_GOOD;
1319 return 1;
1da177e4
LT		 1320}
1321
77853bf2 1322static void ata_scsi_qc_complete(struct ata_queued_cmd *qc)
1da177e4
LT		 1323{
1324 struct scsi_cmnd *cmd = qc->scsicmd;
a7dac447 1325 u8 *cdb = cmd->cmnd;
a22e2eb0 1326 int need_sense = (qc->err_mask != 0);
b095518e
JG		 1327
1328 /* For ATA pass thru (SAT) commands, generate a sense block if
1329 * user mandated it or if there's an error. Note that if we
1330 * generate because the user forced us to, a check condition
1331 * is generated and the ATA register values are returned
1332 * whether the command completed successfully or not. If there
1333 * was no error, SK, ASC and ASCQ will all be zero.
1334 */
a7dac447
JG		 1335 if (((cdb[0] == ATA_16) || (cdb[0] == ATA_12)) &&
1336 ((cdb[2] & 0x20) || need_sense)) {
b095518e
JG		 1337 ata_gen_ata_desc_sense(qc);
1338 } else {
1339 if (!need_sense) {
1340 cmd->result = SAM_STAT_GOOD;
1341 } else {
1342 /* TODO: decide which descriptor format to use
1343 * for 48b LBA devices and call that here
1344 * instead of the fixed desc, which is only
1345 * good for smaller LBA (and maybe CHS?)
1346 * devices.
1347 */
1348 ata_gen_fixed_sense(qc);
1349 }
1350 }
1da177e4 1351
b095518e
JG		 1352 if (need_sense) {
1353 /* The ata_gen_..._sense routines fill in tf */
1354 ata_dump_status(qc->ap->id, &qc->tf);
1355 }
1da177e4
LT		 1356
1357 qc->scsidone(cmd);
1358
77853bf2 1359 ata_qc_free(qc);
1da177e4
LT		 1360}
1361
1362/**
1363 * ata_scsi_translate - Translate then issue SCSI command to ATA device
1364 * @ap: ATA port to which the command is addressed
1365 * @dev: ATA device to which the command is addressed
1366 * @cmd: SCSI command to execute
1367 * @done: SCSI command completion function
1368 * @xlat_func: Actor which translates @cmd to an ATA taskfile
1369 *
1370 * Our ->queuecommand() function has decided that the SCSI
1371 * command issued can be directly translated into an ATA
1372 * command, rather than handled internally.
1373 *
1374 * This function sets up an ata_queued_cmd structure for the
1375 * SCSI command, and sends that ata_queued_cmd to the hardware.
1376 *
ae006510
DG		 1377 * The xlat_func argument (actor) returns 0 if ready to execute
1378 * ATA command, else 1 to finish translation. If 1 is returned
1379 * then cmd->result (and possibly cmd->sense_buffer) are assumed
1380 * to be set reflecting an error condition or clean (early)
1381 * termination.
1382 *
1da177e4
LT		 1383 * LOCKING:
1384 * spin_lock_irqsave(host_set lock)
1385 */
1386
1387static void ata_scsi_translate(struct ata_port *ap, struct ata_device *dev,
1388 struct scsi_cmnd *cmd,
1389 void (*done)(struct scsi_cmnd *),
1390 ata_xlat_func_t xlat_func)
1391{
1392 struct ata_queued_cmd *qc;
1393 u8 *scsicmd = cmd->cmnd;
1394
1395 VPRINTK("ENTER\n");
1396
1397 qc = ata_scsi_qc_new(ap, dev, cmd, done);
1398 if (!qc)
ae006510 1399 goto err_mem;
1da177e4
LT		 1400
1401 /* data is present; dma-map it */
be7db055
CH		 1402 if (cmd->sc_data_direction == DMA_FROM_DEVICE ||
1403 cmd->sc_data_direction == DMA_TO_DEVICE) {
1da177e4
LT		 1404 if (unlikely(cmd->request_bufflen < 1)) {
1405 printk(KERN_WARNING "ata%u(%u): WARNING: zero len r/w req\n",
1406 ap->id, dev->devno);
ae006510 1407 goto err_did;
1da177e4
LT		 1408 }
1409
1410 if (cmd->use_sg)
1411 ata_sg_init(qc, cmd->request_buffer, cmd->use_sg);
1412 else
1413 ata_sg_init_one(qc, cmd->request_buffer,
1414 cmd->request_bufflen);
1415
1416 qc->dma_dir = cmd->sc_data_direction;
1417 }
1418
1419 qc->complete_fn = ata_scsi_qc_complete;
1420
1421 if (xlat_func(qc, scsicmd))
ae006510 1422 goto early_finish;
1da177e4
LT		 1423
1424 /* select device, send command to hardware */
8e0e694a 1425 ata_qc_issue(qc);
1da177e4
LT		 1426
1427 VPRINTK("EXIT\n");
1428 return;
1429
ae006510
DG		 1430early_finish:
1431 ata_qc_free(qc);
1432 done(cmd);
1433 DPRINTK("EXIT - early finish (good or error)\n");
1434 return;
1435
1436err_did:
1da177e4 1437 ata_qc_free(qc);
ae006510
DG		 1438err_mem:
1439 cmd->result = (DID_ERROR << 16);
1440 done(cmd);
1441 DPRINTK("EXIT - internal\n");
1442 return;
1da177e4
LT		 1443}
1444
1445/**
1446 * ata_scsi_rbuf_get - Map response buffer.
1447 * @cmd: SCSI command containing buffer to be mapped.
1448 * @buf_out: Pointer to mapped area.
1449 *
1450 * Maps buffer contained within SCSI command @cmd.
1451 *
1452 * LOCKING:
1453 * spin_lock_irqsave(host_set lock)
1454 *
1455 * RETURNS:
1456 * Length of response buffer.
1457 */
1458
1459static unsigned int ata_scsi_rbuf_get(struct scsi_cmnd *cmd, u8 **buf_out)
1460{
1461 u8 *buf;
1462 unsigned int buflen;
1463
1464 if (cmd->use_sg) {
1465 struct scatterlist *sg;
1466
1467 sg = (struct scatterlist *) cmd->request_buffer;
1468 buf = kmap_atomic(sg->page, KM_USER0) + sg->offset;
1469 buflen = sg->length;
1470 } else {
1471 buf = cmd->request_buffer;
1472 buflen = cmd->request_bufflen;
1473 }
1474
1475 *buf_out = buf;
1476 return buflen;
1477}
1478
1479/**
1480 * ata_scsi_rbuf_put - Unmap response buffer.
1481 * @cmd: SCSI command containing buffer to be unmapped.
1482 * @buf: buffer to unmap
1483 *
1484 * Unmaps response buffer contained within @cmd.
1485 *
1486 * LOCKING:
1487 * spin_lock_irqsave(host_set lock)
1488 */
1489
1490static inline void ata_scsi_rbuf_put(struct scsi_cmnd *cmd, u8 *buf)
1491{
1492 if (cmd->use_sg) {
1493 struct scatterlist *sg;
1494
1495 sg = (struct scatterlist *) cmd->request_buffer;
1496 kunmap_atomic(buf - sg->offset, KM_USER0);
1497 }
1498}
1499
1500/**
1501 * ata_scsi_rbuf_fill - wrapper for SCSI command simulators
1502 * @args: device IDENTIFY data / SCSI command of interest.
1503 * @actor: Callback hook for desired SCSI command simulator
1504 *
1505 * Takes care of the hard work of simulating a SCSI command...
1506 * Mapping the response buffer, calling the command's handler,
1507 * and handling the handler's return value. This return value
1508 * indicates whether the handler wishes the SCSI command to be
ae006510
DG		 1509 * completed successfully (0), or not (in which case cmd->result
1510 * and sense buffer are assumed to be set).
1da177e4
LT		 1511 *
1512 * LOCKING:
1513 * spin_lock_irqsave(host_set lock)
1514 */
1515
1516void ata_scsi_rbuf_fill(struct ata_scsi_args *args,
1517 unsigned int (*actor) (struct ata_scsi_args *args,
1518 u8 *rbuf, unsigned int buflen))
1519{
1520 u8 *rbuf;
1521 unsigned int buflen, rc;
1522 struct scsi_cmnd *cmd = args->cmd;
1523
1524 buflen = ata_scsi_rbuf_get(cmd, &rbuf);
1525 memset(rbuf, 0, buflen);
1526 rc = actor(args, rbuf, buflen);
1527 ata_scsi_rbuf_put(cmd, rbuf);
1528
ae006510 1529 if (rc == 0)
1da177e4 1530 cmd->result = SAM_STAT_GOOD;
ae006510 1531 args->done(cmd);
1da177e4
LT		 1532}
1533
1534/**
1535 * ata_scsiop_inq_std - Simulate INQUIRY command
1536 * @args: device IDENTIFY data / SCSI command of interest.
1537 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1538 * @buflen: Response buffer length.
1539 *
1540 * Returns standard device identification data associated
b142eb65 1541 * with non-VPD INQUIRY command output.
1da177e4
LT		 1542 *
1543 * LOCKING:
1544 * spin_lock_irqsave(host_set lock)
1545 */
1546
1547unsigned int ata_scsiop_inq_std(struct ata_scsi_args *args, u8 *rbuf,
1548 unsigned int buflen)
1549{
1550 u8 hdr[] = {
1551 TYPE_DISK,
1552 0,
1553 0x5, /* claim SPC-3 version compatibility */
1554 2,
1555 95 - 4
1556 };
1557
1558 /* set scsi removeable (RMB) bit per ata bit */
1559 if (ata_id_removeable(args->id))
1560 hdr[1] |= (1 << 7);
1561
1562 VPRINTK("ENTER\n");
1563
1564 memcpy(rbuf, hdr, sizeof(hdr));
1565
1566 if (buflen > 35) {
1567 memcpy(&rbuf[8], "ATA ", 8);
6a62a04d
TH		 1568 ata_id_string(args->id, &rbuf[16], ATA_ID_PROD_OFS, 16);
1569 ata_id_string(args->id, &rbuf[32], ATA_ID_FW_REV_OFS, 4);
1da177e4
LT		 1570 if (rbuf[32] == 0 || rbuf[32] == ' ')
1571 memcpy(&rbuf[32], "n/a ", 4);
1572 }
1573
1574 if (buflen > 63) {
1575 const u8 versions[] = {
1576 0x60, /* SAM-3 (no version claimed) */
1577
1578 0x03,
1579 0x20, /* SBC-2 (no version claimed) */
1580
1581 0x02,
1582 0x60 /* SPC-3 (no version claimed) */
1583 };
1584
1585 memcpy(rbuf + 59, versions, sizeof(versions));
1586 }
1587
1588 return 0;
1589}
1590
1591/**
b142eb65 1592 * ata_scsiop_inq_00 - Simulate INQUIRY VPD page 0, list of pages
1da177e4
LT		 1593 * @args: device IDENTIFY data / SCSI command of interest.
1594 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1595 * @buflen: Response buffer length.
1596 *
b142eb65 1597 * Returns list of inquiry VPD pages available.
1da177e4
LT		 1598 *
1599 * LOCKING:
1600 * spin_lock_irqsave(host_set lock)
1601 */
1602
1603unsigned int ata_scsiop_inq_00(struct ata_scsi_args *args, u8 *rbuf,
1604 unsigned int buflen)
1605{
1606 const u8 pages[] = {
1607 0x00, /* page 0x00, this page */
1608 0x80, /* page 0x80, unit serial no page */
1609 0x83 /* page 0x83, device ident page */
1610 };
b142eb65 1611 rbuf[3] = sizeof(pages); /* number of supported VPD pages */
1da177e4
LT		 1612
1613 if (buflen > 6)
1614 memcpy(rbuf + 4, pages, sizeof(pages));
1615
1616 return 0;
1617}
1618
1619/**
b142eb65 1620 * ata_scsiop_inq_80 - Simulate INQUIRY VPD page 80, device serial number
1da177e4
LT		 1621 * @args: device IDENTIFY data / SCSI command of interest.
1622 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1623 * @buflen: Response buffer length.
1624 *
1625 * Returns ATA device serial number.
1626 *
1627 * LOCKING:
1628 * spin_lock_irqsave(host_set lock)
1629 */
1630
1631unsigned int ata_scsiop_inq_80(struct ata_scsi_args *args, u8 *rbuf,
1632 unsigned int buflen)
1633{
1634 const u8 hdr[] = {
1635 0,
1636 0x80, /* this page code */
1637 0,
1638 ATA_SERNO_LEN, /* page len */
1639 };
1640 memcpy(rbuf, hdr, sizeof(hdr));
1641
1642 if (buflen > (ATA_SERNO_LEN + 4 - 1))
6a62a04d
TH		 1643 ata_id_string(args->id, (unsigned char *) &rbuf[4],
1644 ATA_ID_SERNO_OFS, ATA_SERNO_LEN);
1da177e4
LT		 1645
1646 return 0;
1647}
1648
1da177e4 1649/**
b142eb65 1650 * ata_scsiop_inq_83 - Simulate INQUIRY VPD page 83, device identity
1da177e4
LT		 1651 * @args: device IDENTIFY data / SCSI command of interest.
1652 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1653 * @buflen: Response buffer length.
1654 *
b142eb65
JG		 1655 * Yields two logical unit device identification designators:
1656 * - vendor specific ASCII containing the ATA serial number
1657 * - SAT defined "t10 vendor id based" containing ASCII vendor
1658 * name ("ATA "), model and serial numbers.
1da177e4
LT		 1659 *
1660 * LOCKING:
1661 * spin_lock_irqsave(host_set lock)
1662 */
1663
1664unsigned int ata_scsiop_inq_83(struct ata_scsi_args *args, u8 *rbuf,
1665 unsigned int buflen)
1666{
b142eb65
JG		 1667 int num;
1668 const int sat_model_serial_desc_len = 68;
1669 const int ata_model_byte_len = 40;
1da177e4 1670
b142eb65
JG		 1671 rbuf[1] = 0x83; /* this page code */
1672 num = 4;
1673
1674 if (buflen > (ATA_SERNO_LEN + num + 3)) {
1675 /* piv=0, assoc=lu, code_set=ACSII, designator=vendor */
2e9edbf8 1676 rbuf[num + 0] = 2;
b142eb65
JG		 1677 rbuf[num + 3] = ATA_SERNO_LEN;
1678 num += 4;
1679 ata_id_string(args->id, (unsigned char *) rbuf + num,
1680 ATA_ID_SERNO_OFS, ATA_SERNO_LEN);
1681 num += ATA_SERNO_LEN;
1da177e4 1682 }
b142eb65
JG		 1683 if (buflen > (sat_model_serial_desc_len + num + 3)) {
1684 /* SAT defined lu model and serial numbers descriptor */
1685 /* piv=0, assoc=lu, code_set=ACSII, designator=t10 vendor id */
2e9edbf8
JG		 1686 rbuf[num + 0] = 2;
1687 rbuf[num + 1] = 1;
b142eb65
JG		 1688 rbuf[num + 3] = sat_model_serial_desc_len;
1689 num += 4;
1690 memcpy(rbuf + num, "ATA ", 8);
1691 num += 8;
1692 ata_id_string(args->id, (unsigned char *) rbuf + num,
1693 ATA_ID_PROD_OFS, ata_model_byte_len);
1694 num += ata_model_byte_len;
1695 ata_id_string(args->id, (unsigned char *) rbuf + num,
1696 ATA_ID_SERNO_OFS, ATA_SERNO_LEN);
1697 num += ATA_SERNO_LEN;
1698 }
1699 rbuf[3] = num - 4; /* page len (assume less than 256 bytes) */
1da177e4
LT		 1700 return 0;
1701}
1702
1703/**
0cba632b 1704 * ata_scsiop_noop - Command handler that simply returns success.
1da177e4
LT		 1705 * @args: device IDENTIFY data / SCSI command of interest.
1706 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1707 * @buflen: Response buffer length.
1708 *
1709 * No operation. Simply returns success to caller, to indicate
1710 * that the caller should successfully complete this SCSI command.
1711 *
1712 * LOCKING:
1713 * spin_lock_irqsave(host_set lock)
1714 */
1715
1716unsigned int ata_scsiop_noop(struct ata_scsi_args *args, u8 *rbuf,
1717 unsigned int buflen)
1718{
1719 VPRINTK("ENTER\n");
1720 return 0;
1721}
1722
1723/**
1724 * ata_msense_push - Push data onto MODE SENSE data output buffer
1725 * @ptr_io: (input/output) Location to store more output data
1726 * @last: End of output data buffer
1727 * @buf: Pointer to BLOB being added to output buffer
1728 * @buflen: Length of BLOB
1729 *
1730 * Store MODE SENSE data on an output buffer.
1731 *
1732 * LOCKING:
1733 * None.
1734 */
1735
1736static void ata_msense_push(u8 **ptr_io, const u8 *last,
1737 const u8 *buf, unsigned int buflen)
1738{
1739 u8 *ptr = *ptr_io;
1740
1741 if ((ptr + buflen - 1) > last)
1742 return;
1743
1744 memcpy(ptr, buf, buflen);
1745
1746 ptr += buflen;
1747
1748 *ptr_io = ptr;
1749}
1750
1751/**
1752 * ata_msense_caching - Simulate MODE SENSE caching info page
1753 * @id: device IDENTIFY data
1754 * @ptr_io: (input/output) Location to store more output data
1755 * @last: End of output data buffer
1756 *
1757 * Generate a caching info page, which conditionally indicates
1758 * write caching to the SCSI layer, depending on device
1759 * capabilities.
1760 *
1761 * LOCKING:
1762 * None.
1763 */
1764
1765static unsigned int ata_msense_caching(u16 *id, u8 **ptr_io,
1766 const u8 *last)
1767{
00ac37f5 1768 u8 page[CACHE_MPAGE_LEN];
1da177e4 1769
00ac37f5 1770 memcpy(page, def_cache_mpage, sizeof(page));
1da177e4
LT		 1771 if (ata_id_wcache_enabled(id))
1772 page[2] |= (1 << 2); /* write cache enable */
1773 if (!ata_id_rahead_enabled(id))
1774 page[12] |= (1 << 5); /* disable read ahead */
1775
1776 ata_msense_push(ptr_io, last, page, sizeof(page));
1777 return sizeof(page);
1778}
1779
1780/**
1781 * ata_msense_ctl_mode - Simulate MODE SENSE control mode page
1782 * @dev: Device associated with this MODE SENSE command
1783 * @ptr_io: (input/output) Location to store more output data
1784 * @last: End of output data buffer
1785 *
1786 * Generate a generic MODE SENSE control mode page.
1787 *
1788 * LOCKING:
1789 * None.
1790 */
1791
1792static unsigned int ata_msense_ctl_mode(u8 **ptr_io, const u8 *last)
1793{
00ac37f5
DG		 1794 ata_msense_push(ptr_io, last, def_control_mpage,
1795 sizeof(def_control_mpage));
1796 return sizeof(def_control_mpage);
1da177e4
LT		 1797}
1798
1799/**
1800 * ata_msense_rw_recovery - Simulate MODE SENSE r/w error recovery page
1801 * @dev: Device associated with this MODE SENSE command
1802 * @ptr_io: (input/output) Location to store more output data
1803 * @last: End of output data buffer
1804 *
1805 * Generate a generic MODE SENSE r/w error recovery page.
1806 *
1807 * LOCKING:
1808 * None.
1809 */
1810
1811static unsigned int ata_msense_rw_recovery(u8 **ptr_io, const u8 *last)
1812{
1da177e4 1813
00ac37f5
DG		 1814 ata_msense_push(ptr_io, last, def_rw_recovery_mpage,
1815 sizeof(def_rw_recovery_mpage));
1816 return sizeof(def_rw_recovery_mpage);
1da177e4
LT		 1817}
1818
48bdc8ec
JA		 1819/*
1820 * We can turn this into a real blacklist if it's needed, for now just
1821 * blacklist any Maxtor BANC1G10 revision firmware
1822 */
1823static int ata_dev_supports_fua(u16 *id)
1824{
1825 unsigned char model[41], fw[9];
1826
c3c013a2
JG		 1827 if (!libata_fua)
1828 return 0;
48bdc8ec
JA		 1829 if (!ata_id_has_fua(id))
1830 return 0;
1831
6a62a04d
TH		 1832 ata_id_c_string(id, model, ATA_ID_PROD_OFS, sizeof(model));
1833 ata_id_c_string(id, fw, ATA_ID_FW_REV_OFS, sizeof(fw));
48bdc8ec 1834
2e02671d 1835 if (strcmp(model, "Maxtor"))
48bdc8ec 1836 return 1;
2e02671d 1837 if (strcmp(fw, "BANC1G10"))
48bdc8ec
JA		 1838 return 1;
1839
1840 return 0; /* blacklisted */
1841}
1842
1da177e4
LT		 1843/**
1844 * ata_scsiop_mode_sense - Simulate MODE SENSE 6, 10 commands
1845 * @args: device IDENTIFY data / SCSI command of interest.
1846 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1847 * @buflen: Response buffer length.
1848 *
00ac37f5
DG		 1849 * Simulate MODE SENSE commands. Assume this is invoked for direct
1850 * access devices (e.g. disks) only. There should be no block
1851 * descriptor for other device types.
1da177e4
LT		 1852 *
1853 * LOCKING:
1854 * spin_lock_irqsave(host_set lock)
1855 */
1856
1857unsigned int ata_scsiop_mode_sense(struct ata_scsi_args *args, u8 *rbuf,
1858 unsigned int buflen)
1859{
9a3dccc4 1860 struct ata_device *dev = args->dev;
1da177e4 1861 u8 *scsicmd = args->cmd->cmnd, *p, *last;
00ac37f5
DG		 1862 const u8 sat_blk_desc[] = {
1863 0, 0, 0, 0, /* number of blocks: sat unspecified */
1864 0,
1865 0, 0x2, 0x0 /* block length: 512 bytes */
1866 };
1867 u8 pg, spg;
1868 unsigned int ebd, page_control, six_byte, output_len, alloc_len, minlen;
9a3dccc4 1869 u8 dpofua;
1da177e4
LT		 1870
1871 VPRINTK("ENTER\n");
1872
1873 six_byte = (scsicmd[0] == MODE_SENSE);
00ac37f5
DG		 1874 ebd = !(scsicmd[1] & 0x8); /* dbd bit inverted == edb */
1875 /*
1876 * LLBA bit in msense(10) ignored (compliant)
1da177e4 1877 */
00ac37f5 1878
1da177e4 1879 page_control = scsicmd[2] >> 6;
ae006510
DG		 1880 switch (page_control) {
1881 case 0: /* current */
1882 break; /* supported */
1883 case 3: /* saved */
1884 goto saving_not_supp;
1885 case 1: /* changeable */
1886 case 2: /* defaults */
1887 default:
1888 goto invalid_fld;
1889 }
1da177e4 1890
00ac37f5
DG		 1891 if (six_byte) {
1892 output_len = 4 + (ebd ? 8 : 0);
1893 alloc_len = scsicmd[4];
1894 } else {
1895 output_len = 8 + (ebd ? 8 : 0);
1896 alloc_len = (scsicmd[7] << 8) + scsicmd[8];
1897 }
1898 minlen = (alloc_len < buflen) ? alloc_len : buflen;
1da177e4
LT		 1899
1900 p = rbuf + output_len;
00ac37f5 1901 last = rbuf + minlen - 1;
1da177e4 1902
00ac37f5
DG		 1903 pg = scsicmd[2] & 0x3f;
1904 spg = scsicmd[3];
1905 /*
1906 * No mode subpages supported (yet) but asking for _all_
1907 * subpages may be valid
1908 */
1909 if (spg && (spg != ALL_SUB_MPAGES))
1910 goto invalid_fld;
1911
1912 switch(pg) {
1913 case RW_RECOVERY_MPAGE:
1da177e4
LT		 1914 output_len += ata_msense_rw_recovery(&p, last);
1915 break;
1916
00ac37f5 1917 case CACHE_MPAGE:
1da177e4
LT		 1918 output_len += ata_msense_caching(args->id, &p, last);
1919 break;
1920
00ac37f5 1921 case CONTROL_MPAGE: {
1da177e4
LT		 1922 output_len += ata_msense_ctl_mode(&p, last);
1923 break;
1924 }
1925
00ac37f5 1926 case ALL_MPAGES:
1da177e4
LT		 1927 output_len += ata_msense_rw_recovery(&p, last);
1928 output_len += ata_msense_caching(args->id, &p, last);
1929 output_len += ata_msense_ctl_mode(&p, last);
1930 break;
1931
1932 default: /* invalid page code */
ae006510 1933 goto invalid_fld;
1da177e4
LT		 1934 }
1935
00ac37f5
DG		 1936 if (minlen < 1)
1937 return 0;
9a3dccc4
TH		 1938
1939 dpofua = 0;
48bdc8ec 1940 if (ata_dev_supports_fua(args->id) && dev->flags & ATA_DFLAG_LBA48 &&
9a3dccc4
TH		 1941 (!(dev->flags & ATA_DFLAG_PIO) || dev->multi_count))
1942 dpofua = 1 << 4;
1943
1da177e4
LT		 1944 if (six_byte) {
1945 output_len--;
1946 rbuf[0] = output_len;
9a3dccc4
TH		 1947 if (minlen > 2)
1948 rbuf[2] |= dpofua;
00ac37f5
DG		 1949 if (ebd) {
1950 if (minlen > 3)
1951 rbuf[3] = sizeof(sat_blk_desc);
1952 if (minlen > 11)
1953 memcpy(rbuf + 4, sat_blk_desc,
1954 sizeof(sat_blk_desc));
1955 }
1da177e4
LT		 1956 } else {
1957 output_len -= 2;
1958 rbuf[0] = output_len >> 8;
00ac37f5
DG		 1959 if (minlen > 1)
1960 rbuf[1] = output_len;
9a3dccc4
TH		 1961 if (minlen > 3)
1962 rbuf[3] |= dpofua;
00ac37f5
DG		 1963 if (ebd) {
1964 if (minlen > 7)
1965 rbuf[7] = sizeof(sat_blk_desc);
1966 if (minlen > 15)
1967 memcpy(rbuf + 8, sat_blk_desc,
1968 sizeof(sat_blk_desc));
1969 }
1da177e4 1970 }
1da177e4 1971 return 0;
ae006510
DG		 1972
1973invalid_fld:
1974 ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x24, 0x0);
1975 /* "Invalid field in cbd" */
1976 return 1;
1977
1978saving_not_supp:
1979 ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x39, 0x0);
1980 /* "Saving parameters not supported" */
1981 return 1;
1da177e4
LT		 1982}
1983
1984/**
1985 * ata_scsiop_read_cap - Simulate READ CAPACITY[ 16] commands
1986 * @args: device IDENTIFY data / SCSI command of interest.
1987 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1988 * @buflen: Response buffer length.
1989 *
1990 * Simulate READ CAPACITY commands.
1991 *
1992 * LOCKING:
1993 * spin_lock_irqsave(host_set lock)
1994 */
1995
1996unsigned int ata_scsiop_read_cap(struct ata_scsi_args *args, u8 *rbuf,
1997 unsigned int buflen)
1998{
1999 u64 n_sectors;
2000 u32 tmp;
2001
2002 VPRINTK("ENTER\n");
2003
8bf62ece
AL		 2004 if (ata_id_has_lba(args->id)) {
2005 if (ata_id_has_lba48(args->id))
2006 n_sectors = ata_id_u64(args->id, 100);
2007 else
2008 n_sectors = ata_id_u32(args->id, 60);
2009 } else {
2010 /* CHS default translation */
2011 n_sectors = args->id[1] * args->id[3] * args->id[6];
2012
2013 if (ata_id_current_chs_valid(args->id))
2014 /* CHS current translation */
2015 n_sectors = ata_id_u32(args->id, 57);
2016 }
2017
1da177e4
LT		 2018 n_sectors--; /* ATA TotalUserSectors - 1 */
2019
1da177e4 2020 if (args->cmd->cmnd[0] == READ_CAPACITY) {
0c144d0d
PP		 2021 if( n_sectors >= 0xffffffffULL )
2022 tmp = 0xffffffff ; /* Return max count on overflow */
2023 else
2024 tmp = n_sectors ;
2025
1da177e4
LT		 2026 /* sector count, 32-bit */
2027 rbuf[0] = tmp >> (8 * 3);
2028 rbuf[1] = tmp >> (8 * 2);
2029 rbuf[2] = tmp >> (8 * 1);
2030 rbuf[3] = tmp;
2031
2032 /* sector size */
2033 tmp = ATA_SECT_SIZE;
2034 rbuf[6] = tmp >> 8;
2035 rbuf[7] = tmp;
2036
2037 } else {
2038 /* sector count, 64-bit */
0c144d0d
PP		 2039 tmp = n_sectors >> (8 * 4);
2040 rbuf[2] = tmp >> (8 * 3);
2041 rbuf[3] = tmp >> (8 * 2);
2042 rbuf[4] = tmp >> (8 * 1);
2043 rbuf[5] = tmp;
2044 tmp = n_sectors;
1da177e4
LT		 2045 rbuf[6] = tmp >> (8 * 3);
2046 rbuf[7] = tmp >> (8 * 2);
2047 rbuf[8] = tmp >> (8 * 1);
2048 rbuf[9] = tmp;
2049
2050 /* sector size */
2051 tmp = ATA_SECT_SIZE;
2052 rbuf[12] = tmp >> 8;
2053 rbuf[13] = tmp;
2054 }
2055
2056 return 0;
2057}
2058
2059/**
2060 * ata_scsiop_report_luns - Simulate REPORT LUNS command
2061 * @args: device IDENTIFY data / SCSI command of interest.
2062 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2063 * @buflen: Response buffer length.
2064 *
2065 * Simulate REPORT LUNS command.
2066 *
2067 * LOCKING:
2068 * spin_lock_irqsave(host_set lock)
2069 */
2070
2071unsigned int ata_scsiop_report_luns(struct ata_scsi_args *args, u8 *rbuf,
2072 unsigned int buflen)
2073{
2074 VPRINTK("ENTER\n");
2075 rbuf[3] = 8; /* just one lun, LUN 0, size 8 bytes */
2076
2077 return 0;
2078}
2079
845c5834
DG		 2080/**
2081 * ata_scsi_set_sense - Set SCSI sense data and status
2082 * @cmd: SCSI request to be handled
2083 * @sk: SCSI-defined sense key
2084 * @asc: SCSI-defined additional sense code
2085 * @ascq: SCSI-defined additional sense code qualifier
2086 *
2087 * Helper function that builds a valid fixed format, current
2088 * response code and the given sense key (sk), additional sense
2089 * code (asc) and additional sense code qualifier (ascq) with
2090 * a SCSI command status of %SAM_STAT_CHECK_CONDITION and
2091 * DRIVER_SENSE set in the upper bits of scsi_cmnd::result .
2092 *
2093 * LOCKING:
2094 * Not required
2095 */
2096
2097void ata_scsi_set_sense(struct scsi_cmnd *cmd, u8 sk, u8 asc, u8 ascq)
2098{
2099 cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
2100
2101 cmd->sense_buffer[0] = 0x70; /* fixed format, current */
2102 cmd->sense_buffer[2] = sk;
2103 cmd->sense_buffer[7] = 18 - 8; /* additional sense length */
2104 cmd->sense_buffer[12] = asc;
2105 cmd->sense_buffer[13] = ascq;
2106}
2107
1da177e4
LT		 2108/**
2109 * ata_scsi_badcmd - End a SCSI request with an error
2110 * @cmd: SCSI request to be handled
2111 * @done: SCSI command completion function
2112 * @asc: SCSI-defined additional sense code
2113 * @ascq: SCSI-defined additional sense code qualifier
2114 *
2115 * Helper function that completes a SCSI command with
2116 * %SAM_STAT_CHECK_CONDITION, with a sense key %ILLEGAL_REQUEST
2117 * and the specified additional sense codes.
2118 *
2119 * LOCKING:
2120 * spin_lock_irqsave(host_set lock)
2121 */
2122
2123void ata_scsi_badcmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *), u8 asc, u8 ascq)
2124{
2125 DPRINTK("ENTER\n");
ae006510 2126 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, asc, ascq);
1da177e4
LT		 2127
2128 done(cmd);
2129}
2130
77853bf2 2131static void atapi_sense_complete(struct ata_queued_cmd *qc)
a939c963 2132{
a22e2eb0 2133 if (qc->err_mask && ((qc->err_mask & AC_ERR_DEV) == 0))
c6e6e666
JG		 2134 /* FIXME: not quite right; we don't want the
2135 * translation of taskfile registers into
2136 * a sense descriptors, since that's only
2137 * correct for ATA, not ATAPI
2138 */
2139 ata_gen_ata_desc_sense(qc);
a939c963 2140
c6e6e666 2141 qc->scsidone(qc->scsicmd);
77853bf2 2142 ata_qc_free(qc);
c6e6e666 2143}
a939c963 2144
c6e6e666
JG		 2145/* is it pointless to prefer PIO for "safety reasons"? */
2146static inline int ata_pio_use_silly(struct ata_port *ap)
2147{
2148 return (ap->flags & ATA_FLAG_PIO_DMA);
2149}
2150
2151static void atapi_request_sense(struct ata_queued_cmd *qc)
2152{
2153 struct ata_port *ap = qc->ap;
2154 struct scsi_cmnd *cmd = qc->scsicmd;
2155
2156 DPRINTK("ATAPI request sense\n");
a939c963
JG		 2157
2158 /* FIXME: is this needed? */
2159 memset(cmd->sense_buffer, 0, sizeof(cmd->sense_buffer));
2160
c6e6e666
JG		 2161 ap->ops->tf_read(ap, &qc->tf);
2162
2163 /* fill these in, for the case where they are -not- overwritten */
2164 cmd->sense_buffer[0] = 0x70;
2165 cmd->sense_buffer[2] = qc->tf.feature >> 4;
2166
2167 ata_qc_reinit(qc);
2168
a939c963
JG		 2169 ata_sg_init_one(qc, cmd->sense_buffer, sizeof(cmd->sense_buffer));
2170 qc->dma_dir = DMA_FROM_DEVICE;
2171
6e7846e9 2172 memset(&qc->cdb, 0, qc->dev->cdb_len);
a939c963
JG		 2173 qc->cdb[0] = REQUEST_SENSE;
2174 qc->cdb[4] = SCSI_SENSE_BUFFERSIZE;
2175
2176 qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
2177 qc->tf.command = ATA_CMD_PACKET;
2178
c6e6e666
JG		 2179 if (ata_pio_use_silly(ap)) {
2180 qc->tf.protocol = ATA_PROT_ATAPI_DMA;
2181 qc->tf.feature |= ATAPI_PKT_DMA;
2182 } else {
2183 qc->tf.protocol = ATA_PROT_ATAPI;
2184 qc->tf.lbam = (8 * 1024) & 0xff;
2185 qc->tf.lbah = (8 * 1024) >> 8;
2186 }
a939c963
JG		 2187 qc->nbytes = SCSI_SENSE_BUFFERSIZE;
2188
c6e6e666 2189 qc->complete_fn = atapi_sense_complete;
a939c963 2190
8e0e694a 2191 ata_qc_issue(qc);
a939c963
JG		 2192
2193 DPRINTK("EXIT\n");
2194}
2195
77853bf2 2196static void atapi_qc_complete(struct ata_queued_cmd *qc)
1da177e4
LT		 2197{
2198 struct scsi_cmnd *cmd = qc->scsicmd;
a22e2eb0 2199 unsigned int err_mask = qc->err_mask;
1da177e4 2200
a7dac447 2201 VPRINTK("ENTER, err_mask 0x%X\n", err_mask);
e12669e7 2202
a7dac447 2203 if (unlikely(err_mask & AC_ERR_DEV)) {
1da177e4 2204 cmd->result = SAM_STAT_CHECK_CONDITION;
c6e6e666 2205 atapi_request_sense(qc);
77853bf2 2206 return;
e12669e7
JG		 2207 }
2208
a7dac447
JG		 2209 else if (unlikely(err_mask))
2210 /* FIXME: not quite right; we don't want the
2211 * translation of taskfile registers into
2212 * a sense descriptors, since that's only
2213 * correct for ATA, not ATAPI
2214 */
2215 ata_gen_ata_desc_sense(qc);
2216
e12669e7 2217 else {
1da177e4
LT		 2218 u8 *scsicmd = cmd->cmnd;
2219
fd71da46 2220 if ((scsicmd[0] == INQUIRY) && ((scsicmd[1] & 0x03) == 0)) {
1da177e4
LT		 2221 u8 *buf = NULL;
2222 unsigned int buflen;
2223
2224 buflen = ata_scsi_rbuf_get(cmd, &buf);
a15dbeb4
JG		 2225
2226 /* ATAPI devices typically report zero for their SCSI version,
2227 * and sometimes deviate from the spec WRT response data
2228 * format. If SCSI version is reported as zero like normal,
2229 * then we make the following fixups: 1) Fake MMC-5 version,
2230 * to indicate to the Linux scsi midlayer this is a modern
2231 * device. 2) Ensure response data format / ATAPI information
2232 * are always correct.
a15dbeb4
JG		 2233 */
2234 if (buf[2] == 0) {
2235 buf[2] = 0x5;
2236 buf[3] = 0x32;
2237 }
2238
1da177e4
LT		 2239 ata_scsi_rbuf_put(cmd, buf);
2240 }
a15dbeb4 2241
1da177e4
LT		 2242 cmd->result = SAM_STAT_GOOD;
2243 }
2244
2245 qc->scsidone(cmd);
77853bf2 2246 ata_qc_free(qc);
1da177e4
LT		 2247}
2248/**
2249 * atapi_xlat - Initialize PACKET taskfile
2250 * @qc: command structure to be initialized
2251 * @scsicmd: SCSI CDB associated with this PACKET command
2252 *
2253 * LOCKING:
2254 * spin_lock_irqsave(host_set lock)
2255 *
2256 * RETURNS:
2257 * Zero on success, non-zero on failure.
2258 */
2259
057ace5e 2260static unsigned int atapi_xlat(struct ata_queued_cmd *qc, const u8 *scsicmd)
1da177e4
LT		 2261{
2262 struct scsi_cmnd *cmd = qc->scsicmd;
2263 struct ata_device *dev = qc->dev;
2264 int using_pio = (dev->flags & ATA_DFLAG_PIO);
be7db055 2265 int nodata = (cmd->sc_data_direction == DMA_NONE);
1da177e4
LT		 2266
2267 if (!using_pio)
2268 /* Check whether ATAPI DMA is safe */
2269 if (ata_check_atapi_dma(qc))
2270 using_pio = 1;
2271
6e7846e9 2272 memcpy(&qc->cdb, scsicmd, dev->cdb_len);
1da177e4
LT		 2273
2274 qc->complete_fn = atapi_qc_complete;
2275
2276 qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
be7db055 2277 if (cmd->sc_data_direction == DMA_TO_DEVICE) {
1da177e4
LT		 2278 qc->tf.flags |= ATA_TFLAG_WRITE;
2279 DPRINTK("direction: write\n");
2280 }
2281
2282 qc->tf.command = ATA_CMD_PACKET;
2283
2284 /* no data, or PIO data xfer */
2285 if (using_pio || nodata) {
2286 if (nodata)
2287 qc->tf.protocol = ATA_PROT_ATAPI_NODATA;
2288 else
2289 qc->tf.protocol = ATA_PROT_ATAPI;
2290 qc->tf.lbam = (8 * 1024) & 0xff;
2291 qc->tf.lbah = (8 * 1024) >> 8;
2292 }
2293
2294 /* DMA data xfer */
2295 else {
2296 qc->tf.protocol = ATA_PROT_ATAPI_DMA;
2297 qc->tf.feature |= ATAPI_PKT_DMA;
2298
2299#ifdef ATAPI_ENABLE_DMADIR
2300 /* some SATA bridges need us to indicate data xfer direction */
be7db055 2301 if (cmd->sc_data_direction != DMA_TO_DEVICE)
1da177e4
LT		 2302 qc->tf.feature |= ATAPI_DMADIR;
2303#endif
2304 }
2305
2306 qc->nbytes = cmd->bufflen;
2307
2308 return 0;
2309}
2310
2311/**
2312 * ata_scsi_find_dev - lookup ata_device from scsi_cmnd
2313 * @ap: ATA port to which the device is attached
2314 * @scsidev: SCSI device from which we derive the ATA device
2315 *
2316 * Given various information provided in struct scsi_cmnd,
2317 * map that onto an ATA bus, and using that mapping
2318 * determine which ata_device is associated with the
2319 * SCSI command to be sent.
2320 *
2321 * LOCKING:
2322 * spin_lock_irqsave(host_set lock)
2323 *
2324 * RETURNS:
2325 * Associated ATA device, or %NULL if not found.
2326 */
2327
2328static struct ata_device *
057ace5e 2329ata_scsi_find_dev(struct ata_port *ap, const struct scsi_device *scsidev)
1da177e4
LT		 2330{
2331 struct ata_device *dev;
2332
2333 /* skip commands not addressed to targets we simulate */
2334 if (likely(scsidev->id < ATA_MAX_DEVICES))
2335 dev = &ap->device[scsidev->id];
2336 else
2337 return NULL;
2338
2339 if (unlikely((scsidev->channel != 0) ||
2340 (scsidev->lun != 0)))
2341 return NULL;
2342
e1211e3f 2343 if (unlikely(!ata_dev_enabled(dev)))
1da177e4
LT		 2344 return NULL;
2345
50630195
JG		 2346 if (!atapi_enabled || (ap->flags & ATA_FLAG_NO_ATAPI)) {
2347 if (unlikely(dev->class == ATA_DEV_ATAPI)) {
2348 printk(KERN_WARNING "ata%u(%u): WARNING: ATAPI is %s, device ignored.\n",
2349 ap->id, dev->devno, atapi_enabled ? "not supported with this driver" : "disabled");
1623c81e 2350 return NULL;
50630195 2351 }
1623c81e 2352 }
1da177e4
LT		 2353
2354 return dev;
2355}
2356
b095518e
JG		 2357/*
2358 * ata_scsi_map_proto - Map pass-thru protocol value to taskfile value.
2359 * @byte1: Byte 1 from pass-thru CDB.
2360 *
2361 * RETURNS:
2362 * ATA_PROT_UNKNOWN if mapping failed/unimplemented, protocol otherwise.
2363 */
2364static u8
2365ata_scsi_map_proto(u8 byte1)
2366{
2367 switch((byte1 & 0x1e) >> 1) {
2368 case 3: /* Non-data */
2369 return ATA_PROT_NODATA;
2370
2371 case 6: /* DMA */
2372 return ATA_PROT_DMA;
2373
2374 case 4: /* PIO Data-in */
2375 case 5: /* PIO Data-out */
b095518e
JG		 2376 return ATA_PROT_PIO;
2377
2378 case 10: /* Device Reset */
2379 case 0: /* Hard Reset */
2380 case 1: /* SRST */
2381 case 2: /* Bus Idle */
2382 case 7: /* Packet */
2383 case 8: /* DMA Queued */
2384 case 9: /* Device Diagnostic */
2385 case 11: /* UDMA Data-in */
2386 case 12: /* UDMA Data-Out */
2387 case 13: /* FPDMA */
2388 default: /* Reserved */
2389 break;
2390 }
2391
2392 return ATA_PROT_UNKNOWN;
2393}
2394
2395/**
2396 * ata_scsi_pass_thru - convert ATA pass-thru CDB to taskfile
2397 * @qc: command structure to be initialized
8e8b77dd 2398 * @scsicmd: SCSI command to convert
b095518e
JG		 2399 *
2400 * Handles either 12 or 16-byte versions of the CDB.
2401 *
2402 * RETURNS:
2403 * Zero on success, non-zero on failure.
2404 */
2405static unsigned int
00ac37f5 2406ata_scsi_pass_thru(struct ata_queued_cmd *qc, const u8 *scsicmd)
b095518e
JG		 2407{
2408 struct ata_taskfile *tf = &(qc->tf);
2409 struct scsi_cmnd *cmd = qc->scsicmd;
2410
2411 if ((tf->protocol = ata_scsi_map_proto(scsicmd[1])) == ATA_PROT_UNKNOWN)
9a405257 2412 goto invalid_fld;
b095518e 2413
f59b0cf8
AL		 2414 if (scsicmd[1] & 0xe0)
2415 /* PIO multi not supported yet */
2416 goto invalid_fld;
2417
b095518e
JG		 2418 /*
2419 * 12 and 16 byte CDBs use different offsets to
2420 * provide the various register values.
2421 */
2422 if (scsicmd[0] == ATA_16) {
2423 /*
2424 * 16-byte CDB - may contain extended commands.
2425 *
2426 * If that is the case, copy the upper byte register values.
2427 */
2428 if (scsicmd[1] & 0x01) {
2429 tf->hob_feature = scsicmd[3];
2430 tf->hob_nsect = scsicmd[5];
2431 tf->hob_lbal = scsicmd[7];
2432 tf->hob_lbam = scsicmd[9];
2433 tf->hob_lbah = scsicmd[11];
2434 tf->flags |= ATA_TFLAG_LBA48;
2435 } else
2436 tf->flags &= ~ATA_TFLAG_LBA48;
2437
2438 /*
2439 * Always copy low byte, device and command registers.
2440 */
2441 tf->feature = scsicmd[4];
2442 tf->nsect = scsicmd[6];
2443 tf->lbal = scsicmd[8];
2444 tf->lbam = scsicmd[10];
2445 tf->lbah = scsicmd[12];
2446 tf->device = scsicmd[13];
2447 tf->command = scsicmd[14];
2448 } else {
2449 /*
2450 * 12-byte CDB - incapable of extended commands.
2451 */
2452 tf->flags &= ~ATA_TFLAG_LBA48;
2453
2454 tf->feature = scsicmd[3];
2455 tf->nsect = scsicmd[4];
2456 tf->lbal = scsicmd[5];
2457 tf->lbam = scsicmd[6];
2458 tf->lbah = scsicmd[7];
2459 tf->device = scsicmd[8];
2460 tf->command = scsicmd[9];
2461 }
dcc2d1e7
ML		 2462 /*
2463 * If slave is possible, enforce correct master/slave bit
2464 */
2465 if (qc->ap->flags & ATA_FLAG_SLAVE_POSS)
2466 tf->device = qc->dev->devno ?
2467 tf->device | ATA_DEV1 : tf->device & ~ATA_DEV1;
b095518e
JG		 2468
2469 /*
2470 * Filter SET_FEATURES - XFER MODE command -- otherwise,
2471 * SET_FEATURES - XFER MODE must be preceded/succeeded
2472 * by an update to hardware-specific registers for each
2473 * controller (i.e. the reason for ->set_piomode(),
2474 * ->set_dmamode(), and ->post_set_mode() hooks).
2475 */
2476 if ((tf->command == ATA_CMD_SET_FEATURES)
2477 && (tf->feature == SETFEATURES_XFER))
9a405257 2478 goto invalid_fld;
b095518e
JG		 2479
2480 /*
2481 * Set flags so that all registers will be written,
2482 * and pass on write indication (used for PIO/DMA
2483 * setup.)
2484 */
2485 tf->flags |= (ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE);
2486
0274aa25 2487 if (cmd->sc_data_direction == DMA_TO_DEVICE)
b095518e
JG		 2488 tf->flags |= ATA_TFLAG_WRITE;
2489
2490 /*
2491 * Set transfer length.
2492 *
2493 * TODO: find out if we need to do more here to
2494 * cover scatter/gather case.
2495 */
2496 qc->nsect = cmd->bufflen / ATA_SECT_SIZE;
2497
2498 return 0;
9a405257
TH		 2499
2500 invalid_fld:
2501 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x00);
2502 /* "Invalid field in cdb" */
2503 return 1;
b095518e
JG		 2504}
2505
1da177e4
LT		 2506/**
2507 * ata_get_xlat_func - check if SCSI to ATA translation is possible
2508 * @dev: ATA device
2509 * @cmd: SCSI command opcode to consider
2510 *
2511 * Look up the SCSI command given, and determine whether the
2512 * SCSI command is to be translated or simulated.
2513 *
2514 * RETURNS:
2515 * Pointer to translation function if possible, %NULL if not.
2516 */
2517
2518static inline ata_xlat_func_t ata_get_xlat_func(struct ata_device *dev, u8 cmd)
2519{
2520 switch (cmd) {
2521 case READ_6:
2522 case READ_10:
2523 case READ_16:
2524
2525 case WRITE_6:
2526 case WRITE_10:
2527 case WRITE_16:
2528 return ata_scsi_rw_xlat;
2529
2530 case SYNCHRONIZE_CACHE:
2531 if (ata_try_flush_cache(dev))
2532 return ata_scsi_flush_xlat;
2533 break;
2534
2535 case VERIFY:
2536 case VERIFY_16:
2537 return ata_scsi_verify_xlat;
b095518e
JG		 2538
2539 case ATA_12:
2540 case ATA_16:
2541 return ata_scsi_pass_thru;
da61396d 2542
972dcafb
DG		 2543 case START_STOP:
2544 return ata_scsi_start_stop_xlat;
1da177e4
LT		 2545 }
2546
2547 return NULL;
2548}
2549
2550/**
2551 * ata_scsi_dump_cdb - dump SCSI command contents to dmesg
2552 * @ap: ATA port to which the command was being sent
2553 * @cmd: SCSI command to dump
2554 *
2555 * Prints the contents of a SCSI command via printk().
2556 */
2557
2558static inline void ata_scsi_dump_cdb(struct ata_port *ap,
2559 struct scsi_cmnd *cmd)
2560{
2561#ifdef ATA_DEBUG
2562 struct scsi_device *scsidev = cmd->device;
2563 u8 *scsicmd = cmd->cmnd;
2564
2565 DPRINTK("CDB (%u:%d,%d,%d) %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
2566 ap->id,
2567 scsidev->channel, scsidev->id, scsidev->lun,
2568 scsicmd[0], scsicmd[1], scsicmd[2], scsicmd[3],
2569 scsicmd[4], scsicmd[5], scsicmd[6], scsicmd[7],
2570 scsicmd[8]);
2571#endif
2572}
2573
eb3f0f9c
BK		 2574static inline void __ata_scsi_queuecmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *),
2575 struct ata_port *ap, struct ata_device *dev)
2576{
2577 if (dev->class == ATA_DEV_ATA) {
2578 ata_xlat_func_t xlat_func = ata_get_xlat_func(dev,
2579 cmd->cmnd[0]);
2580
2581 if (xlat_func)
2582 ata_scsi_translate(ap, dev, cmd, done, xlat_func);
2583 else
2584 ata_scsi_simulate(ap, dev, cmd, done);
2585 } else
2586 ata_scsi_translate(ap, dev, cmd, done, atapi_xlat);
2587}
2588
1da177e4
LT		 2589/**
2590 * ata_scsi_queuecmd - Issue SCSI cdb to libata-managed device
2591 * @cmd: SCSI command to be sent
2592 * @done: Completion function, called when command is complete
2593 *
2594 * In some cases, this function translates SCSI commands into
2595 * ATA taskfiles, and queues the taskfiles to be sent to
2596 * hardware. In other cases, this function simulates a
2597 * SCSI device by evaluating and responding to certain
2598 * SCSI commands. This creates the overall effect of
2599 * ATA and ATAPI devices appearing as SCSI devices.
2600 *
2601 * LOCKING:
2602 * Releases scsi-layer-held lock, and obtains host_set lock.
2603 *
2604 * RETURNS:
2605 * Zero.
2606 */
2607
2608int ata_scsi_queuecmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *))
2609{
2610 struct ata_port *ap;
2611 struct ata_device *dev;
2612 struct scsi_device *scsidev = cmd->device;
005a5a06 2613 struct Scsi_Host *shost = scsidev->host;
1da177e4 2614
005a5a06
JG		 2615 ap = (struct ata_port *) &shost->hostdata[0];
2616
2617 spin_unlock(shost->host_lock);
2618 spin_lock(&ap->host_set->lock);
1da177e4
LT		 2619
2620 ata_scsi_dump_cdb(ap, cmd);
2621
2622 dev = ata_scsi_find_dev(ap, scsidev);
eb3f0f9c
BK		 2623 if (likely(dev))
2624 __ata_scsi_queuecmd(cmd, done, ap, dev);
2625 else {
1da177e4
LT		 2626 cmd->result = (DID_BAD_TARGET << 16);
2627 done(cmd);
1da177e4
LT		 2628 }
2629
005a5a06
JG		 2630 spin_unlock(&ap->host_set->lock);
2631 spin_lock(shost->host_lock);
1da177e4
LT		 2632 return 0;
2633}
2634
2635/**
2636 * ata_scsi_simulate - simulate SCSI command on ATA device
c893a3ae
RD		 2637 * @ap: port the device is connected to
2638 * @dev: the target device
1da177e4
LT		 2639 * @cmd: SCSI command being sent to device.
2640 * @done: SCSI command completion function.
2641 *
2642 * Interprets and directly executes a select list of SCSI commands
2643 * that can be handled internally.
2644 *
2645 * LOCKING:
2646 * spin_lock_irqsave(host_set lock)
2647 */
2648
9a3dccc4 2649void ata_scsi_simulate(struct ata_port *ap, struct ata_device *dev,
1da177e4
LT		 2650 struct scsi_cmnd *cmd,
2651 void (*done)(struct scsi_cmnd *))
2652{
2653 struct ata_scsi_args args;
057ace5e 2654 const u8 *scsicmd = cmd->cmnd;
1da177e4 2655
9a3dccc4
TH		 2656 args.ap = ap;
2657 args.dev = dev;
2658 args.id = dev->id;
1da177e4
LT		 2659 args.cmd = cmd;
2660 args.done = done;
2661
2662 switch(scsicmd[0]) {
2663 /* no-op's, complete with success */
2664 case SYNCHRONIZE_CACHE:
2665 case REZERO_UNIT:
2666 case SEEK_6:
2667 case SEEK_10:
2668 case TEST_UNIT_READY:
2669 case FORMAT_UNIT: /* FIXME: correct? */
2670 case SEND_DIAGNOSTIC: /* FIXME: correct? */
2671 ata_scsi_rbuf_fill(&args, ata_scsiop_noop);
2672 break;
2673
2674 case INQUIRY:
2675 if (scsicmd[1] & 2) /* is CmdDt set? */
ae006510 2676 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2677 else if ((scsicmd[1] & 1) == 0) /* is EVPD clear? */
2678 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_std);
2679 else if (scsicmd[2] == 0x00)
2680 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_00);
2681 else if (scsicmd[2] == 0x80)
2682 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_80);
2683 else if (scsicmd[2] == 0x83)
2684 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_83);
2685 else
ae006510 2686 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2687 break;
2688
2689 case MODE_SENSE:
2690 case MODE_SENSE_10:
2691 ata_scsi_rbuf_fill(&args, ata_scsiop_mode_sense);
2692 break;
2693
2694 case MODE_SELECT: /* unconditionally return */
2695 case MODE_SELECT_10: /* bad-field-in-cdb */
ae006510 2696 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2697 break;
2698
2699 case READ_CAPACITY:
2700 ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
2701 break;
2702
2703 case SERVICE_ACTION_IN:
2704 if ((scsicmd[1] & 0x1f) == SAI_READ_CAPACITY_16)
2705 ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
2706 else
ae006510 2707 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2708 break;
2709
2710 case REPORT_LUNS:
2711 ata_scsi_rbuf_fill(&args, ata_scsiop_report_luns);
2712 break;
2713
b095518e 2714 /* mandatory commands we haven't implemented yet */
1da177e4
LT		 2715 case REQUEST_SENSE:
2716
2717 /* all other commands */
2718 default:
ae006510
DG		 2719 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x20, 0x0);
2720 /* "Invalid command operation code" */
2721 done(cmd);
1da177e4
LT		 2722 break;
2723 }
2724}
2725
644dd0cc
JG		 2726void ata_scsi_scan_host(struct ata_port *ap)
2727{
3f19ee8c 2728 struct ata_device *dev;
644dd0cc
JG		 2729 unsigned int i;
2730
2731 if (ap->flags & ATA_FLAG_PORT_DISABLED)
2732 return;
2733
3f19ee8c
JG		 2734 for (i = 0; i < ATA_MAX_DEVICES; i++) {
2735 dev = &ap->device[i];
2736
e1211e3f 2737 if (ata_dev_enabled(dev))
3f19ee8c
JG		 2738 scsi_scan_target(&ap->host->shost_gendev, 0, i, 0, 0);
2739 }
644dd0cc
JG		 2740}
2741
Clone of davem's net-next-2.6 tree