projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[PATCH] libata: pass qc around intead of ap during PIO
[GitHub/mt8127/android_kernel_alcatel_ttab.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 1190
27197367 1191 qc->flags |= ATA_QCFLAG_IO;
1da177e4 1192 tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1da177e4 1193
8cbd6df1
AL		 1194 if (scsicmd[0] == WRITE_10 || scsicmd[0] == WRITE_6 ||
1195 scsicmd[0] == WRITE_16)
1da177e4 1196 tf->flags |= ATA_TFLAG_WRITE;
1da177e4 1197
9a3dccc4 1198 /* Calculate the SCSI LBA, transfer length and FUA. */
3aef5231
AL		 1199 switch (scsicmd[0]) {
1200 case READ_10:
1201 case WRITE_10:
1202 scsi_10_lba_len(scsicmd, &block, &n_block);
9a3dccc4
TH		 1203 if (unlikely(scsicmd[1] & (1 << 3)))
1204 tf->flags |= ATA_TFLAG_FUA;
3aef5231
AL		 1205 break;
1206 case READ_6:
1207 case WRITE_6:
1208 scsi_6_lba_len(scsicmd, &block, &n_block);
c187c4b5
AL		 1209
1210 /* for 6-byte r/w commands, transfer length 0
1211 * means 256 blocks of data, not 0 block.
1212 */
76b2bf9b
JG		 1213 if (!n_block)
1214 n_block = 256;
3aef5231
AL		 1215 break;
1216 case READ_16:
1217 case WRITE_16:
1218 scsi_16_lba_len(scsicmd, &block, &n_block);
9a3dccc4
TH		 1219 if (unlikely(scsicmd[1] & (1 << 3)))
1220 tf->flags |= ATA_TFLAG_FUA;
3aef5231
AL		 1221 break;
1222 default:
8bf62ece 1223 DPRINTK("no-byte command\n");
ae006510 1224 goto invalid_fld;
1da177e4
LT		 1225 }
1226
8bf62ece
AL		 1227 /* Check and compose ATA command */
1228 if (!n_block)
c187c4b5
AL		 1229 /* For 10-byte and 16-byte SCSI R/W commands, transfer
1230 * length 0 means transfer 0 block of data.
1231 * However, for ATA R/W commands, sector count 0 means
1232 * 256 or 65536 sectors, not 0 sectors as in SCSI.
f51750d5
AC		 1233 *
1234 * WARNING: one or two older ATA drives treat 0 as 0...
c187c4b5 1235 */
ae006510 1236 goto nothing_to_do;
1da177e4 1237
07506697
AL		 1238 if (dev->flags & ATA_DFLAG_LBA) {
1239 tf->flags |= ATA_TFLAG_LBA;
1240
c6a33e24
AL		 1241 if (lba_28_ok(block, n_block)) {
1242 /* use LBA28 */
1243 tf->device |= (block >> 24) & 0xf;
1244 } else if (lba_48_ok(block, n_block)) {
1245 if (!(dev->flags & ATA_DFLAG_LBA48))
ae006510 1246 goto out_of_range;
1da177e4 1247
07506697
AL		 1248 /* use LBA48 */
1249 tf->flags |= ATA_TFLAG_LBA48;
1250
8bf62ece
AL		 1251 tf->hob_nsect = (n_block >> 8) & 0xff;
1252
1253 tf->hob_lbah = (block >> 40) & 0xff;
1254 tf->hob_lbam = (block >> 32) & 0xff;
1255 tf->hob_lbal = (block >> 24) & 0xff;
c6a33e24
AL		 1256 } else
1257 /* request too large even for LBA48 */
1258 goto out_of_range;
c187c4b5 1259
9a3dccc4
TH		 1260 if (unlikely(ata_rwcmd_protocol(qc) < 0))
1261 goto invalid_fld;
8cbd6df1 1262
8bf62ece
AL		 1263 qc->nsect = n_block;
1264 tf->nsect = n_block & 0xff;
1da177e4 1265
8bf62ece
AL		 1266 tf->lbah = (block >> 16) & 0xff;
1267 tf->lbam = (block >> 8) & 0xff;
1268 tf->lbal = block & 0xff;
1da177e4 1269
8bf62ece 1270 tf->device |= ATA_LBA;
2e9edbf8 1271 } else {
8bf62ece
AL		 1272 /* CHS */
1273 u32 sect, head, cyl, track;
1274
1275 /* The request -may- be too large for CHS addressing. */
c6a33e24 1276 if (!lba_28_ok(block, n_block))
ae006510 1277 goto out_of_range;
c187c4b5 1278
9a3dccc4
TH		 1279 if (unlikely(ata_rwcmd_protocol(qc) < 0))
1280 goto invalid_fld;
8cbd6df1 1281
8bf62ece
AL		 1282 /* Convert LBA to CHS */
1283 track = (u32)block / dev->sectors;
1284 cyl = track / dev->heads;
1285 head = track % dev->heads;
1286 sect = (u32)block % dev->sectors + 1;
1287
c187c4b5 1288 DPRINTK("block %u track %u cyl %u head %u sect %u\n",
8bf62ece 1289 (u32)block, track, cyl, head, sect);
c187c4b5 1290
2e9edbf8
JG		 1291 /* Check whether the converted CHS can fit.
1292 Cylinder: 0-65535
8bf62ece
AL		 1293 Head: 0-15
1294 Sector: 1-255*/
c187c4b5 1295 if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect))
ae006510 1296 goto out_of_range;
c187c4b5 1297
8bf62ece
AL		 1298 qc->nsect = n_block;
1299 tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */
1300 tf->lbal = sect;
1301 tf->lbam = cyl;
1302 tf->lbah = cyl >> 8;
1303 tf->device |= head;
1da177e4
LT		 1304 }
1305
8bf62ece 1306 return 0;
ae006510
DG		 1307
1308invalid_fld:
1309 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x0);
1310 /* "Invalid field in cbd" */
1311 return 1;
1312
1313out_of_range:
1314 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x21, 0x0);
1315 /* "Logical Block Address out of range" */
1316 return 1;
1317
1318nothing_to_do:
1319 qc->scsicmd->result = SAM_STAT_GOOD;
1320 return 1;
1da177e4
LT		 1321}
1322
77853bf2 1323static void ata_scsi_qc_complete(struct ata_queued_cmd *qc)
1da177e4
LT		 1324{
1325 struct scsi_cmnd *cmd = qc->scsicmd;
a7dac447 1326 u8 *cdb = cmd->cmnd;
a22e2eb0 1327 int need_sense = (qc->err_mask != 0);
b095518e
JG		 1328
1329 /* For ATA pass thru (SAT) commands, generate a sense block if
1330 * user mandated it or if there's an error. Note that if we
1331 * generate because the user forced us to, a check condition
1332 * is generated and the ATA register values are returned
1333 * whether the command completed successfully or not. If there
1334 * was no error, SK, ASC and ASCQ will all be zero.
1335 */
a7dac447
JG		 1336 if (((cdb[0] == ATA_16) || (cdb[0] == ATA_12)) &&
1337 ((cdb[2] & 0x20) || need_sense)) {
b095518e
JG		 1338 ata_gen_ata_desc_sense(qc);
1339 } else {
1340 if (!need_sense) {
1341 cmd->result = SAM_STAT_GOOD;
1342 } else {
1343 /* TODO: decide which descriptor format to use
1344 * for 48b LBA devices and call that here
1345 * instead of the fixed desc, which is only
1346 * good for smaller LBA (and maybe CHS?)
1347 * devices.
1348 */
1349 ata_gen_fixed_sense(qc);
1350 }
1351 }
1da177e4 1352
b095518e
JG		 1353 if (need_sense) {
1354 /* The ata_gen_..._sense routines fill in tf */
1355 ata_dump_status(qc->ap->id, &qc->tf);
1356 }
1da177e4
LT		 1357
1358 qc->scsidone(cmd);
1359
77853bf2 1360 ata_qc_free(qc);
1da177e4
LT		 1361}
1362
1363/**
1364 * ata_scsi_translate - Translate then issue SCSI command to ATA device
1365 * @ap: ATA port to which the command is addressed
1366 * @dev: ATA device to which the command is addressed
1367 * @cmd: SCSI command to execute
1368 * @done: SCSI command completion function
1369 * @xlat_func: Actor which translates @cmd to an ATA taskfile
1370 *
1371 * Our ->queuecommand() function has decided that the SCSI
1372 * command issued can be directly translated into an ATA
1373 * command, rather than handled internally.
1374 *
1375 * This function sets up an ata_queued_cmd structure for the
1376 * SCSI command, and sends that ata_queued_cmd to the hardware.
1377 *
ae006510
DG		 1378 * The xlat_func argument (actor) returns 0 if ready to execute
1379 * ATA command, else 1 to finish translation. If 1 is returned
1380 * then cmd->result (and possibly cmd->sense_buffer) are assumed
1381 * to be set reflecting an error condition or clean (early)
1382 * termination.
1383 *
1da177e4
LT		 1384 * LOCKING:
1385 * spin_lock_irqsave(host_set lock)
1386 */
1387
1388static void ata_scsi_translate(struct ata_port *ap, struct ata_device *dev,
1389 struct scsi_cmnd *cmd,
1390 void (*done)(struct scsi_cmnd *),
1391 ata_xlat_func_t xlat_func)
1392{
1393 struct ata_queued_cmd *qc;
1394 u8 *scsicmd = cmd->cmnd;
1395
1396 VPRINTK("ENTER\n");
1397
1398 qc = ata_scsi_qc_new(ap, dev, cmd, done);
1399 if (!qc)
ae006510 1400 goto err_mem;
1da177e4
LT		 1401
1402 /* data is present; dma-map it */
be7db055
CH		 1403 if (cmd->sc_data_direction == DMA_FROM_DEVICE ||
1404 cmd->sc_data_direction == DMA_TO_DEVICE) {
1da177e4
LT		 1405 if (unlikely(cmd->request_bufflen < 1)) {
1406 printk(KERN_WARNING "ata%u(%u): WARNING: zero len r/w req\n",
1407 ap->id, dev->devno);
ae006510 1408 goto err_did;
1da177e4
LT		 1409 }
1410
1411 if (cmd->use_sg)
1412 ata_sg_init(qc, cmd->request_buffer, cmd->use_sg);
1413 else
1414 ata_sg_init_one(qc, cmd->request_buffer,
1415 cmd->request_bufflen);
1416
1417 qc->dma_dir = cmd->sc_data_direction;
1418 }
1419
1420 qc->complete_fn = ata_scsi_qc_complete;
1421
1422 if (xlat_func(qc, scsicmd))
ae006510 1423 goto early_finish;
1da177e4
LT		 1424
1425 /* select device, send command to hardware */
8e0e694a 1426 ata_qc_issue(qc);
1da177e4
LT		 1427
1428 VPRINTK("EXIT\n");
1429 return;
1430
ae006510
DG		 1431early_finish:
1432 ata_qc_free(qc);
1433 done(cmd);
1434 DPRINTK("EXIT - early finish (good or error)\n");
1435 return;
1436
1437err_did:
1da177e4 1438 ata_qc_free(qc);
ae006510
DG		 1439err_mem:
1440 cmd->result = (DID_ERROR << 16);
1441 done(cmd);
1442 DPRINTK("EXIT - internal\n");
1443 return;
1da177e4
LT		 1444}
1445
1446/**
1447 * ata_scsi_rbuf_get - Map response buffer.
1448 * @cmd: SCSI command containing buffer to be mapped.
1449 * @buf_out: Pointer to mapped area.
1450 *
1451 * Maps buffer contained within SCSI command @cmd.
1452 *
1453 * LOCKING:
1454 * spin_lock_irqsave(host_set lock)
1455 *
1456 * RETURNS:
1457 * Length of response buffer.
1458 */
1459
1460static unsigned int ata_scsi_rbuf_get(struct scsi_cmnd *cmd, u8 **buf_out)
1461{
1462 u8 *buf;
1463 unsigned int buflen;
1464
1465 if (cmd->use_sg) {
1466 struct scatterlist *sg;
1467
1468 sg = (struct scatterlist *) cmd->request_buffer;
1469 buf = kmap_atomic(sg->page, KM_USER0) + sg->offset;
1470 buflen = sg->length;
1471 } else {
1472 buf = cmd->request_buffer;
1473 buflen = cmd->request_bufflen;
1474 }
1475
1476 *buf_out = buf;
1477 return buflen;
1478}
1479
1480/**
1481 * ata_scsi_rbuf_put - Unmap response buffer.
1482 * @cmd: SCSI command containing buffer to be unmapped.
1483 * @buf: buffer to unmap
1484 *
1485 * Unmaps response buffer contained within @cmd.
1486 *
1487 * LOCKING:
1488 * spin_lock_irqsave(host_set lock)
1489 */
1490
1491static inline void ata_scsi_rbuf_put(struct scsi_cmnd *cmd, u8 *buf)
1492{
1493 if (cmd->use_sg) {
1494 struct scatterlist *sg;
1495
1496 sg = (struct scatterlist *) cmd->request_buffer;
1497 kunmap_atomic(buf - sg->offset, KM_USER0);
1498 }
1499}
1500
1501/**
1502 * ata_scsi_rbuf_fill - wrapper for SCSI command simulators
1503 * @args: device IDENTIFY data / SCSI command of interest.
1504 * @actor: Callback hook for desired SCSI command simulator
1505 *
1506 * Takes care of the hard work of simulating a SCSI command...
1507 * Mapping the response buffer, calling the command's handler,
1508 * and handling the handler's return value. This return value
1509 * indicates whether the handler wishes the SCSI command to be
ae006510
DG		 1510 * completed successfully (0), or not (in which case cmd->result
1511 * and sense buffer are assumed to be set).
1da177e4
LT		 1512 *
1513 * LOCKING:
1514 * spin_lock_irqsave(host_set lock)
1515 */
1516
1517void ata_scsi_rbuf_fill(struct ata_scsi_args *args,
1518 unsigned int (*actor) (struct ata_scsi_args *args,
1519 u8 *rbuf, unsigned int buflen))
1520{
1521 u8 *rbuf;
1522 unsigned int buflen, rc;
1523 struct scsi_cmnd *cmd = args->cmd;
1524
1525 buflen = ata_scsi_rbuf_get(cmd, &rbuf);
1526 memset(rbuf, 0, buflen);
1527 rc = actor(args, rbuf, buflen);
1528 ata_scsi_rbuf_put(cmd, rbuf);
1529
ae006510 1530 if (rc == 0)
1da177e4 1531 cmd->result = SAM_STAT_GOOD;
ae006510 1532 args->done(cmd);
1da177e4
LT		 1533}
1534
1535/**
1536 * ata_scsiop_inq_std - Simulate INQUIRY command
1537 * @args: device IDENTIFY data / SCSI command of interest.
1538 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1539 * @buflen: Response buffer length.
1540 *
1541 * Returns standard device identification data associated
b142eb65 1542 * with non-VPD INQUIRY command output.
1da177e4
LT		 1543 *
1544 * LOCKING:
1545 * spin_lock_irqsave(host_set lock)
1546 */
1547
1548unsigned int ata_scsiop_inq_std(struct ata_scsi_args *args, u8 *rbuf,
1549 unsigned int buflen)
1550{
1551 u8 hdr[] = {
1552 TYPE_DISK,
1553 0,
1554 0x5, /* claim SPC-3 version compatibility */
1555 2,
1556 95 - 4
1557 };
1558
1559 /* set scsi removeable (RMB) bit per ata bit */
1560 if (ata_id_removeable(args->id))
1561 hdr[1] |= (1 << 7);
1562
1563 VPRINTK("ENTER\n");
1564
1565 memcpy(rbuf, hdr, sizeof(hdr));
1566
1567 if (buflen > 35) {
1568 memcpy(&rbuf[8], "ATA ", 8);
6a62a04d
TH		 1569 ata_id_string(args->id, &rbuf[16], ATA_ID_PROD_OFS, 16);
1570 ata_id_string(args->id, &rbuf[32], ATA_ID_FW_REV_OFS, 4);
1da177e4
LT		 1571 if (rbuf[32] == 0 || rbuf[32] == ' ')
1572 memcpy(&rbuf[32], "n/a ", 4);
1573 }
1574
1575 if (buflen > 63) {
1576 const u8 versions[] = {
1577 0x60, /* SAM-3 (no version claimed) */
1578
1579 0x03,
1580 0x20, /* SBC-2 (no version claimed) */
1581
1582 0x02,
1583 0x60 /* SPC-3 (no version claimed) */
1584 };
1585
1586 memcpy(rbuf + 59, versions, sizeof(versions));
1587 }
1588
1589 return 0;
1590}
1591
1592/**
b142eb65 1593 * ata_scsiop_inq_00 - Simulate INQUIRY VPD page 0, list of pages
1da177e4
LT		 1594 * @args: device IDENTIFY data / SCSI command of interest.
1595 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1596 * @buflen: Response buffer length.
1597 *
b142eb65 1598 * Returns list of inquiry VPD pages available.
1da177e4
LT		 1599 *
1600 * LOCKING:
1601 * spin_lock_irqsave(host_set lock)
1602 */
1603
1604unsigned int ata_scsiop_inq_00(struct ata_scsi_args *args, u8 *rbuf,
1605 unsigned int buflen)
1606{
1607 const u8 pages[] = {
1608 0x00, /* page 0x00, this page */
1609 0x80, /* page 0x80, unit serial no page */
1610 0x83 /* page 0x83, device ident page */
1611 };
b142eb65 1612 rbuf[3] = sizeof(pages); /* number of supported VPD pages */
1da177e4
LT		 1613
1614 if (buflen > 6)
1615 memcpy(rbuf + 4, pages, sizeof(pages));
1616
1617 return 0;
1618}
1619
1620/**
b142eb65 1621 * ata_scsiop_inq_80 - Simulate INQUIRY VPD page 80, device serial number
1da177e4
LT		 1622 * @args: device IDENTIFY data / SCSI command of interest.
1623 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1624 * @buflen: Response buffer length.
1625 *
1626 * Returns ATA device serial number.
1627 *
1628 * LOCKING:
1629 * spin_lock_irqsave(host_set lock)
1630 */
1631
1632unsigned int ata_scsiop_inq_80(struct ata_scsi_args *args, u8 *rbuf,
1633 unsigned int buflen)
1634{
1635 const u8 hdr[] = {
1636 0,
1637 0x80, /* this page code */
1638 0,
1639 ATA_SERNO_LEN, /* page len */
1640 };
1641 memcpy(rbuf, hdr, sizeof(hdr));
1642
1643 if (buflen > (ATA_SERNO_LEN + 4 - 1))
6a62a04d
TH		 1644 ata_id_string(args->id, (unsigned char *) &rbuf[4],
1645 ATA_ID_SERNO_OFS, ATA_SERNO_LEN);
1da177e4
LT		 1646
1647 return 0;
1648}
1649
1da177e4 1650/**
b142eb65 1651 * ata_scsiop_inq_83 - Simulate INQUIRY VPD page 83, device identity
1da177e4
LT		 1652 * @args: device IDENTIFY data / SCSI command of interest.
1653 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1654 * @buflen: Response buffer length.
1655 *
b142eb65
JG		 1656 * Yields two logical unit device identification designators:
1657 * - vendor specific ASCII containing the ATA serial number
1658 * - SAT defined "t10 vendor id based" containing ASCII vendor
1659 * name ("ATA "), model and serial numbers.
1da177e4
LT		 1660 *
1661 * LOCKING:
1662 * spin_lock_irqsave(host_set lock)
1663 */
1664
1665unsigned int ata_scsiop_inq_83(struct ata_scsi_args *args, u8 *rbuf,
1666 unsigned int buflen)
1667{
b142eb65
JG		 1668 int num;
1669 const int sat_model_serial_desc_len = 68;
1670 const int ata_model_byte_len = 40;
1da177e4 1671
b142eb65
JG		 1672 rbuf[1] = 0x83; /* this page code */
1673 num = 4;
1674
1675 if (buflen > (ATA_SERNO_LEN + num + 3)) {
1676 /* piv=0, assoc=lu, code_set=ACSII, designator=vendor */
2e9edbf8 1677 rbuf[num + 0] = 2;
b142eb65
JG		 1678 rbuf[num + 3] = ATA_SERNO_LEN;
1679 num += 4;
1680 ata_id_string(args->id, (unsigned char *) rbuf + num,
1681 ATA_ID_SERNO_OFS, ATA_SERNO_LEN);
1682 num += ATA_SERNO_LEN;
1da177e4 1683 }
b142eb65
JG		 1684 if (buflen > (sat_model_serial_desc_len + num + 3)) {
1685 /* SAT defined lu model and serial numbers descriptor */
1686 /* piv=0, assoc=lu, code_set=ACSII, designator=t10 vendor id */
2e9edbf8
JG		 1687 rbuf[num + 0] = 2;
1688 rbuf[num + 1] = 1;
b142eb65
JG		 1689 rbuf[num + 3] = sat_model_serial_desc_len;
1690 num += 4;
1691 memcpy(rbuf + num, "ATA ", 8);
1692 num += 8;
1693 ata_id_string(args->id, (unsigned char *) rbuf + num,
1694 ATA_ID_PROD_OFS, ata_model_byte_len);
1695 num += ata_model_byte_len;
1696 ata_id_string(args->id, (unsigned char *) rbuf + num,
1697 ATA_ID_SERNO_OFS, ATA_SERNO_LEN);
1698 num += ATA_SERNO_LEN;
1699 }
1700 rbuf[3] = num - 4; /* page len (assume less than 256 bytes) */
1da177e4
LT		 1701 return 0;
1702}
1703
1704/**
0cba632b 1705 * ata_scsiop_noop - Command handler that simply returns success.
1da177e4
LT		 1706 * @args: device IDENTIFY data / SCSI command of interest.
1707 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1708 * @buflen: Response buffer length.
1709 *
1710 * No operation. Simply returns success to caller, to indicate
1711 * that the caller should successfully complete this SCSI command.
1712 *
1713 * LOCKING:
1714 * spin_lock_irqsave(host_set lock)
1715 */
1716
1717unsigned int ata_scsiop_noop(struct ata_scsi_args *args, u8 *rbuf,
1718 unsigned int buflen)
1719{
1720 VPRINTK("ENTER\n");
1721 return 0;
1722}
1723
1724/**
1725 * ata_msense_push - Push data onto MODE SENSE data output buffer
1726 * @ptr_io: (input/output) Location to store more output data
1727 * @last: End of output data buffer
1728 * @buf: Pointer to BLOB being added to output buffer
1729 * @buflen: Length of BLOB
1730 *
1731 * Store MODE SENSE data on an output buffer.
1732 *
1733 * LOCKING:
1734 * None.
1735 */
1736
1737static void ata_msense_push(u8 **ptr_io, const u8 *last,
1738 const u8 *buf, unsigned int buflen)
1739{
1740 u8 *ptr = *ptr_io;
1741
1742 if ((ptr + buflen - 1) > last)
1743 return;
1744
1745 memcpy(ptr, buf, buflen);
1746
1747 ptr += buflen;
1748
1749 *ptr_io = ptr;
1750}
1751
1752/**
1753 * ata_msense_caching - Simulate MODE SENSE caching info page
1754 * @id: device IDENTIFY data
1755 * @ptr_io: (input/output) Location to store more output data
1756 * @last: End of output data buffer
1757 *
1758 * Generate a caching info page, which conditionally indicates
1759 * write caching to the SCSI layer, depending on device
1760 * capabilities.
1761 *
1762 * LOCKING:
1763 * None.
1764 */
1765
1766static unsigned int ata_msense_caching(u16 *id, u8 **ptr_io,
1767 const u8 *last)
1768{
00ac37f5 1769 u8 page[CACHE_MPAGE_LEN];
1da177e4 1770
00ac37f5 1771 memcpy(page, def_cache_mpage, sizeof(page));
1da177e4
LT		 1772 if (ata_id_wcache_enabled(id))
1773 page[2] |= (1 << 2); /* write cache enable */
1774 if (!ata_id_rahead_enabled(id))
1775 page[12] |= (1 << 5); /* disable read ahead */
1776
1777 ata_msense_push(ptr_io, last, page, sizeof(page));
1778 return sizeof(page);
1779}
1780
1781/**
1782 * ata_msense_ctl_mode - Simulate MODE SENSE control mode page
1783 * @dev: Device associated with this MODE SENSE command
1784 * @ptr_io: (input/output) Location to store more output data
1785 * @last: End of output data buffer
1786 *
1787 * Generate a generic MODE SENSE control mode page.
1788 *
1789 * LOCKING:
1790 * None.
1791 */
1792
1793static unsigned int ata_msense_ctl_mode(u8 **ptr_io, const u8 *last)
1794{
00ac37f5
DG		 1795 ata_msense_push(ptr_io, last, def_control_mpage,
1796 sizeof(def_control_mpage));
1797 return sizeof(def_control_mpage);
1da177e4
LT		 1798}
1799
1800/**
1801 * ata_msense_rw_recovery - Simulate MODE SENSE r/w error recovery page
1802 * @dev: Device associated with this MODE SENSE command
1803 * @ptr_io: (input/output) Location to store more output data
1804 * @last: End of output data buffer
1805 *
1806 * Generate a generic MODE SENSE r/w error recovery page.
1807 *
1808 * LOCKING:
1809 * None.
1810 */
1811
1812static unsigned int ata_msense_rw_recovery(u8 **ptr_io, const u8 *last)
1813{
1da177e4 1814
00ac37f5
DG		 1815 ata_msense_push(ptr_io, last, def_rw_recovery_mpage,
1816 sizeof(def_rw_recovery_mpage));
1817 return sizeof(def_rw_recovery_mpage);
1da177e4
LT		 1818}
1819
48bdc8ec
JA		 1820/*
1821 * We can turn this into a real blacklist if it's needed, for now just
1822 * blacklist any Maxtor BANC1G10 revision firmware
1823 */
1824static int ata_dev_supports_fua(u16 *id)
1825{
1826 unsigned char model[41], fw[9];
1827
c3c013a2
JG		 1828 if (!libata_fua)
1829 return 0;
48bdc8ec
JA		 1830 if (!ata_id_has_fua(id))
1831 return 0;
1832
6a62a04d
TH		 1833 ata_id_c_string(id, model, ATA_ID_PROD_OFS, sizeof(model));
1834 ata_id_c_string(id, fw, ATA_ID_FW_REV_OFS, sizeof(fw));
48bdc8ec 1835
2e02671d 1836 if (strcmp(model, "Maxtor"))
48bdc8ec 1837 return 1;
2e02671d 1838 if (strcmp(fw, "BANC1G10"))
48bdc8ec
JA		 1839 return 1;
1840
1841 return 0; /* blacklisted */
1842}
1843
1da177e4
LT		 1844/**
1845 * ata_scsiop_mode_sense - Simulate MODE SENSE 6, 10 commands
1846 * @args: device IDENTIFY data / SCSI command of interest.
1847 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1848 * @buflen: Response buffer length.
1849 *
00ac37f5
DG		 1850 * Simulate MODE SENSE commands. Assume this is invoked for direct
1851 * access devices (e.g. disks) only. There should be no block
1852 * descriptor for other device types.
1da177e4
LT		 1853 *
1854 * LOCKING:
1855 * spin_lock_irqsave(host_set lock)
1856 */
1857
1858unsigned int ata_scsiop_mode_sense(struct ata_scsi_args *args, u8 *rbuf,
1859 unsigned int buflen)
1860{
9a3dccc4 1861 struct ata_device *dev = args->dev;
1da177e4 1862 u8 *scsicmd = args->cmd->cmnd, *p, *last;
00ac37f5
DG		 1863 const u8 sat_blk_desc[] = {
1864 0, 0, 0, 0, /* number of blocks: sat unspecified */
1865 0,
1866 0, 0x2, 0x0 /* block length: 512 bytes */
1867 };
1868 u8 pg, spg;
1869 unsigned int ebd, page_control, six_byte, output_len, alloc_len, minlen;
9a3dccc4 1870 u8 dpofua;
1da177e4
LT		 1871
1872 VPRINTK("ENTER\n");
1873
1874 six_byte = (scsicmd[0] == MODE_SENSE);
00ac37f5
DG		 1875 ebd = !(scsicmd[1] & 0x8); /* dbd bit inverted == edb */
1876 /*
1877 * LLBA bit in msense(10) ignored (compliant)
1da177e4 1878 */
00ac37f5 1879
1da177e4 1880 page_control = scsicmd[2] >> 6;
ae006510
DG		 1881 switch (page_control) {
1882 case 0: /* current */
1883 break; /* supported */
1884 case 3: /* saved */
1885 goto saving_not_supp;
1886 case 1: /* changeable */
1887 case 2: /* defaults */
1888 default:
1889 goto invalid_fld;
1890 }
1da177e4 1891
00ac37f5
DG		 1892 if (six_byte) {
1893 output_len = 4 + (ebd ? 8 : 0);
1894 alloc_len = scsicmd[4];
1895 } else {
1896 output_len = 8 + (ebd ? 8 : 0);
1897 alloc_len = (scsicmd[7] << 8) + scsicmd[8];
1898 }
1899 minlen = (alloc_len < buflen) ? alloc_len : buflen;
1da177e4
LT		 1900
1901 p = rbuf + output_len;
00ac37f5 1902 last = rbuf + minlen - 1;
1da177e4 1903
00ac37f5
DG		 1904 pg = scsicmd[2] & 0x3f;
1905 spg = scsicmd[3];
1906 /*
1907 * No mode subpages supported (yet) but asking for _all_
1908 * subpages may be valid
1909 */
1910 if (spg && (spg != ALL_SUB_MPAGES))
1911 goto invalid_fld;
1912
1913 switch(pg) {
1914 case RW_RECOVERY_MPAGE:
1da177e4
LT		 1915 output_len += ata_msense_rw_recovery(&p, last);
1916 break;
1917
00ac37f5 1918 case CACHE_MPAGE:
1da177e4
LT		 1919 output_len += ata_msense_caching(args->id, &p, last);
1920 break;
1921
00ac37f5 1922 case CONTROL_MPAGE: {
1da177e4
LT		 1923 output_len += ata_msense_ctl_mode(&p, last);
1924 break;
1925 }
1926
00ac37f5 1927 case ALL_MPAGES:
1da177e4
LT		 1928 output_len += ata_msense_rw_recovery(&p, last);
1929 output_len += ata_msense_caching(args->id, &p, last);
1930 output_len += ata_msense_ctl_mode(&p, last);
1931 break;
1932
1933 default: /* invalid page code */
ae006510 1934 goto invalid_fld;
1da177e4
LT		 1935 }
1936
00ac37f5
DG		 1937 if (minlen < 1)
1938 return 0;
9a3dccc4
TH		 1939
1940 dpofua = 0;
48bdc8ec 1941 if (ata_dev_supports_fua(args->id) && dev->flags & ATA_DFLAG_LBA48 &&
9a3dccc4
TH		 1942 (!(dev->flags & ATA_DFLAG_PIO) || dev->multi_count))
1943 dpofua = 1 << 4;
1944
1da177e4
LT		 1945 if (six_byte) {
1946 output_len--;
1947 rbuf[0] = output_len;
9a3dccc4
TH		 1948 if (minlen > 2)
1949 rbuf[2] |= dpofua;
00ac37f5
DG		 1950 if (ebd) {
1951 if (minlen > 3)
1952 rbuf[3] = sizeof(sat_blk_desc);
1953 if (minlen > 11)
1954 memcpy(rbuf + 4, sat_blk_desc,
1955 sizeof(sat_blk_desc));
1956 }
1da177e4
LT		 1957 } else {
1958 output_len -= 2;
1959 rbuf[0] = output_len >> 8;
00ac37f5
DG		 1960 if (minlen > 1)
1961 rbuf[1] = output_len;
9a3dccc4
TH		 1962 if (minlen > 3)
1963 rbuf[3] |= dpofua;
00ac37f5
DG		 1964 if (ebd) {
1965 if (minlen > 7)
1966 rbuf[7] = sizeof(sat_blk_desc);
1967 if (minlen > 15)
1968 memcpy(rbuf + 8, sat_blk_desc,
1969 sizeof(sat_blk_desc));
1970 }
1da177e4 1971 }
1da177e4 1972 return 0;
ae006510
DG		 1973
1974invalid_fld:
1975 ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x24, 0x0);
1976 /* "Invalid field in cbd" */
1977 return 1;
1978
1979saving_not_supp:
1980 ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x39, 0x0);
1981 /* "Saving parameters not supported" */
1982 return 1;
1da177e4
LT		 1983}
1984
1985/**
1986 * ata_scsiop_read_cap - Simulate READ CAPACITY[ 16] commands
1987 * @args: device IDENTIFY data / SCSI command of interest.
1988 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1989 * @buflen: Response buffer length.
1990 *
1991 * Simulate READ CAPACITY commands.
1992 *
1993 * LOCKING:
1994 * spin_lock_irqsave(host_set lock)
1995 */
1996
1997unsigned int ata_scsiop_read_cap(struct ata_scsi_args *args, u8 *rbuf,
1998 unsigned int buflen)
1999{
2000 u64 n_sectors;
2001 u32 tmp;
2002
2003 VPRINTK("ENTER\n");
2004
8bf62ece
AL		 2005 if (ata_id_has_lba(args->id)) {
2006 if (ata_id_has_lba48(args->id))
2007 n_sectors = ata_id_u64(args->id, 100);
2008 else
2009 n_sectors = ata_id_u32(args->id, 60);
2010 } else {
2011 /* CHS default translation */
2012 n_sectors = args->id[1] * args->id[3] * args->id[6];
2013
2014 if (ata_id_current_chs_valid(args->id))
2015 /* CHS current translation */
2016 n_sectors = ata_id_u32(args->id, 57);
2017 }
2018
1da177e4
LT		 2019 n_sectors--; /* ATA TotalUserSectors - 1 */
2020
1da177e4 2021 if (args->cmd->cmnd[0] == READ_CAPACITY) {
0c144d0d
PP		 2022 if( n_sectors >= 0xffffffffULL )
2023 tmp = 0xffffffff ; /* Return max count on overflow */
2024 else
2025 tmp = n_sectors ;
2026
1da177e4
LT		 2027 /* sector count, 32-bit */
2028 rbuf[0] = tmp >> (8 * 3);
2029 rbuf[1] = tmp >> (8 * 2);
2030 rbuf[2] = tmp >> (8 * 1);
2031 rbuf[3] = tmp;
2032
2033 /* sector size */
2034 tmp = ATA_SECT_SIZE;
2035 rbuf[6] = tmp >> 8;
2036 rbuf[7] = tmp;
2037
2038 } else {
2039 /* sector count, 64-bit */
0c144d0d
PP		 2040 tmp = n_sectors >> (8 * 4);
2041 rbuf[2] = tmp >> (8 * 3);
2042 rbuf[3] = tmp >> (8 * 2);
2043 rbuf[4] = tmp >> (8 * 1);
2044 rbuf[5] = tmp;
2045 tmp = n_sectors;
1da177e4
LT		 2046 rbuf[6] = tmp >> (8 * 3);
2047 rbuf[7] = tmp >> (8 * 2);
2048 rbuf[8] = tmp >> (8 * 1);
2049 rbuf[9] = tmp;
2050
2051 /* sector size */
2052 tmp = ATA_SECT_SIZE;
2053 rbuf[12] = tmp >> 8;
2054 rbuf[13] = tmp;
2055 }
2056
2057 return 0;
2058}
2059
2060/**
2061 * ata_scsiop_report_luns - Simulate REPORT LUNS command
2062 * @args: device IDENTIFY data / SCSI command of interest.
2063 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
2064 * @buflen: Response buffer length.
2065 *
2066 * Simulate REPORT LUNS command.
2067 *
2068 * LOCKING:
2069 * spin_lock_irqsave(host_set lock)
2070 */
2071
2072unsigned int ata_scsiop_report_luns(struct ata_scsi_args *args, u8 *rbuf,
2073 unsigned int buflen)
2074{
2075 VPRINTK("ENTER\n");
2076 rbuf[3] = 8; /* just one lun, LUN 0, size 8 bytes */
2077
2078 return 0;
2079}
2080
845c5834
DG		 2081/**
2082 * ata_scsi_set_sense - Set SCSI sense data and status
2083 * @cmd: SCSI request to be handled
2084 * @sk: SCSI-defined sense key
2085 * @asc: SCSI-defined additional sense code
2086 * @ascq: SCSI-defined additional sense code qualifier
2087 *
2088 * Helper function that builds a valid fixed format, current
2089 * response code and the given sense key (sk), additional sense
2090 * code (asc) and additional sense code qualifier (ascq) with
2091 * a SCSI command status of %SAM_STAT_CHECK_CONDITION and
2092 * DRIVER_SENSE set in the upper bits of scsi_cmnd::result .
2093 *
2094 * LOCKING:
2095 * Not required
2096 */
2097
2098void ata_scsi_set_sense(struct scsi_cmnd *cmd, u8 sk, u8 asc, u8 ascq)
2099{
2100 cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
2101
2102 cmd->sense_buffer[0] = 0x70; /* fixed format, current */
2103 cmd->sense_buffer[2] = sk;
2104 cmd->sense_buffer[7] = 18 - 8; /* additional sense length */
2105 cmd->sense_buffer[12] = asc;
2106 cmd->sense_buffer[13] = ascq;
2107}
2108
1da177e4
LT		 2109/**
2110 * ata_scsi_badcmd - End a SCSI request with an error
2111 * @cmd: SCSI request to be handled
2112 * @done: SCSI command completion function
2113 * @asc: SCSI-defined additional sense code
2114 * @ascq: SCSI-defined additional sense code qualifier
2115 *
2116 * Helper function that completes a SCSI command with
2117 * %SAM_STAT_CHECK_CONDITION, with a sense key %ILLEGAL_REQUEST
2118 * and the specified additional sense codes.
2119 *
2120 * LOCKING:
2121 * spin_lock_irqsave(host_set lock)
2122 */
2123
2124void ata_scsi_badcmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *), u8 asc, u8 ascq)
2125{
2126 DPRINTK("ENTER\n");
ae006510 2127 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, asc, ascq);
1da177e4
LT		 2128
2129 done(cmd);
2130}
2131
77853bf2 2132static void atapi_sense_complete(struct ata_queued_cmd *qc)
a939c963 2133{
a22e2eb0 2134 if (qc->err_mask && ((qc->err_mask & AC_ERR_DEV) == 0))
c6e6e666
JG		 2135 /* FIXME: not quite right; we don't want the
2136 * translation of taskfile registers into
2137 * a sense descriptors, since that's only
2138 * correct for ATA, not ATAPI
2139 */
2140 ata_gen_ata_desc_sense(qc);
a939c963 2141
c6e6e666 2142 qc->scsidone(qc->scsicmd);
77853bf2 2143 ata_qc_free(qc);
c6e6e666 2144}
a939c963 2145
c6e6e666
JG		 2146/* is it pointless to prefer PIO for "safety reasons"? */
2147static inline int ata_pio_use_silly(struct ata_port *ap)
2148{
2149 return (ap->flags & ATA_FLAG_PIO_DMA);
2150}
2151
2152static void atapi_request_sense(struct ata_queued_cmd *qc)
2153{
2154 struct ata_port *ap = qc->ap;
2155 struct scsi_cmnd *cmd = qc->scsicmd;
2156
2157 DPRINTK("ATAPI request sense\n");
a939c963
JG		 2158
2159 /* FIXME: is this needed? */
2160 memset(cmd->sense_buffer, 0, sizeof(cmd->sense_buffer));
2161
c6e6e666
JG		 2162 ap->ops->tf_read(ap, &qc->tf);
2163
2164 /* fill these in, for the case where they are -not- overwritten */
2165 cmd->sense_buffer[0] = 0x70;
2166 cmd->sense_buffer[2] = qc->tf.feature >> 4;
2167
2168 ata_qc_reinit(qc);
2169
a939c963
JG		 2170 ata_sg_init_one(qc, cmd->sense_buffer, sizeof(cmd->sense_buffer));
2171 qc->dma_dir = DMA_FROM_DEVICE;
2172
6e7846e9 2173 memset(&qc->cdb, 0, qc->dev->cdb_len);
a939c963
JG		 2174 qc->cdb[0] = REQUEST_SENSE;
2175 qc->cdb[4] = SCSI_SENSE_BUFFERSIZE;
2176
2177 qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
2178 qc->tf.command = ATA_CMD_PACKET;
2179
c6e6e666
JG		 2180 if (ata_pio_use_silly(ap)) {
2181 qc->tf.protocol = ATA_PROT_ATAPI_DMA;
2182 qc->tf.feature |= ATAPI_PKT_DMA;
2183 } else {
2184 qc->tf.protocol = ATA_PROT_ATAPI;
2185 qc->tf.lbam = (8 * 1024) & 0xff;
2186 qc->tf.lbah = (8 * 1024) >> 8;
2187 }
a939c963
JG		 2188 qc->nbytes = SCSI_SENSE_BUFFERSIZE;
2189
c6e6e666 2190 qc->complete_fn = atapi_sense_complete;
a939c963 2191
8e0e694a 2192 ata_qc_issue(qc);
a939c963
JG		 2193
2194 DPRINTK("EXIT\n");
2195}
2196
77853bf2 2197static void atapi_qc_complete(struct ata_queued_cmd *qc)
1da177e4
LT		 2198{
2199 struct scsi_cmnd *cmd = qc->scsicmd;
a22e2eb0 2200 unsigned int err_mask = qc->err_mask;
1da177e4 2201
a7dac447 2202 VPRINTK("ENTER, err_mask 0x%X\n", err_mask);
e12669e7 2203
a7dac447 2204 if (unlikely(err_mask & AC_ERR_DEV)) {
1da177e4 2205 cmd->result = SAM_STAT_CHECK_CONDITION;
c6e6e666 2206 atapi_request_sense(qc);
77853bf2 2207 return;
e12669e7
JG		 2208 }
2209
a7dac447
JG		 2210 else if (unlikely(err_mask))
2211 /* FIXME: not quite right; we don't want the
2212 * translation of taskfile registers into
2213 * a sense descriptors, since that's only
2214 * correct for ATA, not ATAPI
2215 */
2216 ata_gen_ata_desc_sense(qc);
2217
e12669e7 2218 else {
1da177e4
LT		 2219 u8 *scsicmd = cmd->cmnd;
2220
fd71da46 2221 if ((scsicmd[0] == INQUIRY) && ((scsicmd[1] & 0x03) == 0)) {
1da177e4
LT		 2222 u8 *buf = NULL;
2223 unsigned int buflen;
2224
2225 buflen = ata_scsi_rbuf_get(cmd, &buf);
a15dbeb4
JG		 2226
2227 /* ATAPI devices typically report zero for their SCSI version,
2228 * and sometimes deviate from the spec WRT response data
2229 * format. If SCSI version is reported as zero like normal,
2230 * then we make the following fixups: 1) Fake MMC-5 version,
2231 * to indicate to the Linux scsi midlayer this is a modern
2232 * device. 2) Ensure response data format / ATAPI information
2233 * are always correct.
a15dbeb4
JG		 2234 */
2235 if (buf[2] == 0) {
2236 buf[2] = 0x5;
2237 buf[3] = 0x32;
2238 }
2239
1da177e4
LT		 2240 ata_scsi_rbuf_put(cmd, buf);
2241 }
a15dbeb4 2242
1da177e4
LT		 2243 cmd->result = SAM_STAT_GOOD;
2244 }
2245
2246 qc->scsidone(cmd);
77853bf2 2247 ata_qc_free(qc);
1da177e4
LT		 2248}
2249/**
2250 * atapi_xlat - Initialize PACKET taskfile
2251 * @qc: command structure to be initialized
2252 * @scsicmd: SCSI CDB associated with this PACKET command
2253 *
2254 * LOCKING:
2255 * spin_lock_irqsave(host_set lock)
2256 *
2257 * RETURNS:
2258 * Zero on success, non-zero on failure.
2259 */
2260
057ace5e 2261static unsigned int atapi_xlat(struct ata_queued_cmd *qc, const u8 *scsicmd)
1da177e4
LT		 2262{
2263 struct scsi_cmnd *cmd = qc->scsicmd;
2264 struct ata_device *dev = qc->dev;
2265 int using_pio = (dev->flags & ATA_DFLAG_PIO);
be7db055 2266 int nodata = (cmd->sc_data_direction == DMA_NONE);
1da177e4
LT		 2267
2268 if (!using_pio)
2269 /* Check whether ATAPI DMA is safe */
2270 if (ata_check_atapi_dma(qc))
2271 using_pio = 1;
2272
6e7846e9 2273 memcpy(&qc->cdb, scsicmd, dev->cdb_len);
1da177e4
LT		 2274
2275 qc->complete_fn = atapi_qc_complete;
2276
2277 qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
be7db055 2278 if (cmd->sc_data_direction == DMA_TO_DEVICE) {
1da177e4
LT		 2279 qc->tf.flags |= ATA_TFLAG_WRITE;
2280 DPRINTK("direction: write\n");
2281 }
2282
2283 qc->tf.command = ATA_CMD_PACKET;
2284
2285 /* no data, or PIO data xfer */
2286 if (using_pio || nodata) {
2287 if (nodata)
2288 qc->tf.protocol = ATA_PROT_ATAPI_NODATA;
2289 else
2290 qc->tf.protocol = ATA_PROT_ATAPI;
2291 qc->tf.lbam = (8 * 1024) & 0xff;
2292 qc->tf.lbah = (8 * 1024) >> 8;
2293 }
2294
2295 /* DMA data xfer */
2296 else {
2297 qc->tf.protocol = ATA_PROT_ATAPI_DMA;
2298 qc->tf.feature |= ATAPI_PKT_DMA;
2299
2300#ifdef ATAPI_ENABLE_DMADIR
2301 /* some SATA bridges need us to indicate data xfer direction */
be7db055 2302 if (cmd->sc_data_direction != DMA_TO_DEVICE)
1da177e4
LT		 2303 qc->tf.feature |= ATAPI_DMADIR;
2304#endif
2305 }
2306
2307 qc->nbytes = cmd->bufflen;
2308
2309 return 0;
2310}
2311
2312/**
2313 * ata_scsi_find_dev - lookup ata_device from scsi_cmnd
2314 * @ap: ATA port to which the device is attached
2315 * @scsidev: SCSI device from which we derive the ATA device
2316 *
2317 * Given various information provided in struct scsi_cmnd,
2318 * map that onto an ATA bus, and using that mapping
2319 * determine which ata_device is associated with the
2320 * SCSI command to be sent.
2321 *
2322 * LOCKING:
2323 * spin_lock_irqsave(host_set lock)
2324 *
2325 * RETURNS:
2326 * Associated ATA device, or %NULL if not found.
2327 */
2328
2329static struct ata_device *
057ace5e 2330ata_scsi_find_dev(struct ata_port *ap, const struct scsi_device *scsidev)
1da177e4
LT		 2331{
2332 struct ata_device *dev;
2333
2334 /* skip commands not addressed to targets we simulate */
2335 if (likely(scsidev->id < ATA_MAX_DEVICES))
2336 dev = &ap->device[scsidev->id];
2337 else
2338 return NULL;
2339
2340 if (unlikely((scsidev->channel != 0) ||
2341 (scsidev->lun != 0)))
2342 return NULL;
2343
e1211e3f 2344 if (unlikely(!ata_dev_enabled(dev)))
1da177e4
LT		 2345 return NULL;
2346
50630195
JG		 2347 if (!atapi_enabled || (ap->flags & ATA_FLAG_NO_ATAPI)) {
2348 if (unlikely(dev->class == ATA_DEV_ATAPI)) {
2349 printk(KERN_WARNING "ata%u(%u): WARNING: ATAPI is %s, device ignored.\n",
2350 ap->id, dev->devno, atapi_enabled ? "not supported with this driver" : "disabled");
1623c81e 2351 return NULL;
50630195 2352 }
1623c81e 2353 }
1da177e4
LT		 2354
2355 return dev;
2356}
2357
b095518e
JG		 2358/*
2359 * ata_scsi_map_proto - Map pass-thru protocol value to taskfile value.
2360 * @byte1: Byte 1 from pass-thru CDB.
2361 *
2362 * RETURNS:
2363 * ATA_PROT_UNKNOWN if mapping failed/unimplemented, protocol otherwise.
2364 */
2365static u8
2366ata_scsi_map_proto(u8 byte1)
2367{
2368 switch((byte1 & 0x1e) >> 1) {
2369 case 3: /* Non-data */
2370 return ATA_PROT_NODATA;
2371
2372 case 6: /* DMA */
2373 return ATA_PROT_DMA;
2374
2375 case 4: /* PIO Data-in */
2376 case 5: /* PIO Data-out */
b095518e
JG		 2377 return ATA_PROT_PIO;
2378
2379 case 10: /* Device Reset */
2380 case 0: /* Hard Reset */
2381 case 1: /* SRST */
2382 case 2: /* Bus Idle */
2383 case 7: /* Packet */
2384 case 8: /* DMA Queued */
2385 case 9: /* Device Diagnostic */
2386 case 11: /* UDMA Data-in */
2387 case 12: /* UDMA Data-Out */
2388 case 13: /* FPDMA */
2389 default: /* Reserved */
2390 break;
2391 }
2392
2393 return ATA_PROT_UNKNOWN;
2394}
2395
2396/**
2397 * ata_scsi_pass_thru - convert ATA pass-thru CDB to taskfile
2398 * @qc: command structure to be initialized
8e8b77dd 2399 * @scsicmd: SCSI command to convert
b095518e
JG		 2400 *
2401 * Handles either 12 or 16-byte versions of the CDB.
2402 *
2403 * RETURNS:
2404 * Zero on success, non-zero on failure.
2405 */
2406static unsigned int
00ac37f5 2407ata_scsi_pass_thru(struct ata_queued_cmd *qc, const u8 *scsicmd)
b095518e
JG		 2408{
2409 struct ata_taskfile *tf = &(qc->tf);
2410 struct scsi_cmnd *cmd = qc->scsicmd;
2411
2412 if ((tf->protocol = ata_scsi_map_proto(scsicmd[1])) == ATA_PROT_UNKNOWN)
9a405257 2413 goto invalid_fld;
b095518e 2414
f59b0cf8
AL		 2415 if (scsicmd[1] & 0xe0)
2416 /* PIO multi not supported yet */
2417 goto invalid_fld;
2418
b095518e
JG		 2419 /*
2420 * 12 and 16 byte CDBs use different offsets to
2421 * provide the various register values.
2422 */
2423 if (scsicmd[0] == ATA_16) {
2424 /*
2425 * 16-byte CDB - may contain extended commands.
2426 *
2427 * If that is the case, copy the upper byte register values.
2428 */
2429 if (scsicmd[1] & 0x01) {
2430 tf->hob_feature = scsicmd[3];
2431 tf->hob_nsect = scsicmd[5];
2432 tf->hob_lbal = scsicmd[7];
2433 tf->hob_lbam = scsicmd[9];
2434 tf->hob_lbah = scsicmd[11];
2435 tf->flags |= ATA_TFLAG_LBA48;
2436 } else
2437 tf->flags &= ~ATA_TFLAG_LBA48;
2438
2439 /*
2440 * Always copy low byte, device and command registers.
2441 */
2442 tf->feature = scsicmd[4];
2443 tf->nsect = scsicmd[6];
2444 tf->lbal = scsicmd[8];
2445 tf->lbam = scsicmd[10];
2446 tf->lbah = scsicmd[12];
2447 tf->device = scsicmd[13];
2448 tf->command = scsicmd[14];
2449 } else {
2450 /*
2451 * 12-byte CDB - incapable of extended commands.
2452 */
2453 tf->flags &= ~ATA_TFLAG_LBA48;
2454
2455 tf->feature = scsicmd[3];
2456 tf->nsect = scsicmd[4];
2457 tf->lbal = scsicmd[5];
2458 tf->lbam = scsicmd[6];
2459 tf->lbah = scsicmd[7];
2460 tf->device = scsicmd[8];
2461 tf->command = scsicmd[9];
2462 }
dcc2d1e7
ML		 2463 /*
2464 * If slave is possible, enforce correct master/slave bit
2465 */
2466 if (qc->ap->flags & ATA_FLAG_SLAVE_POSS)
2467 tf->device = qc->dev->devno ?
2468 tf->device | ATA_DEV1 : tf->device & ~ATA_DEV1;
b095518e
JG		 2469
2470 /*
2471 * Filter SET_FEATURES - XFER MODE command -- otherwise,
2472 * SET_FEATURES - XFER MODE must be preceded/succeeded
2473 * by an update to hardware-specific registers for each
2474 * controller (i.e. the reason for ->set_piomode(),
2475 * ->set_dmamode(), and ->post_set_mode() hooks).
2476 */
2477 if ((tf->command == ATA_CMD_SET_FEATURES)
2478 && (tf->feature == SETFEATURES_XFER))
9a405257 2479 goto invalid_fld;
b095518e
JG		 2480
2481 /*
2482 * Set flags so that all registers will be written,
2483 * and pass on write indication (used for PIO/DMA
2484 * setup.)
2485 */
2486 tf->flags |= (ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE);
2487
0274aa25 2488 if (cmd->sc_data_direction == DMA_TO_DEVICE)
b095518e
JG		 2489 tf->flags |= ATA_TFLAG_WRITE;
2490
2491 /*
2492 * Set transfer length.
2493 *
2494 * TODO: find out if we need to do more here to
2495 * cover scatter/gather case.
2496 */
2497 qc->nsect = cmd->bufflen / ATA_SECT_SIZE;
2498
2499 return 0;
9a405257
TH		 2500
2501 invalid_fld:
2502 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x00);
2503 /* "Invalid field in cdb" */
2504 return 1;
b095518e
JG		 2505}
2506
1da177e4
LT		 2507/**
2508 * ata_get_xlat_func - check if SCSI to ATA translation is possible
2509 * @dev: ATA device
2510 * @cmd: SCSI command opcode to consider
2511 *
2512 * Look up the SCSI command given, and determine whether the
2513 * SCSI command is to be translated or simulated.
2514 *
2515 * RETURNS:
2516 * Pointer to translation function if possible, %NULL if not.
2517 */
2518
2519static inline ata_xlat_func_t ata_get_xlat_func(struct ata_device *dev, u8 cmd)
2520{
2521 switch (cmd) {
2522 case READ_6:
2523 case READ_10:
2524 case READ_16:
2525
2526 case WRITE_6:
2527 case WRITE_10:
2528 case WRITE_16:
2529 return ata_scsi_rw_xlat;
2530
2531 case SYNCHRONIZE_CACHE:
2532 if (ata_try_flush_cache(dev))
2533 return ata_scsi_flush_xlat;
2534 break;
2535
2536 case VERIFY:
2537 case VERIFY_16:
2538 return ata_scsi_verify_xlat;
b095518e
JG		 2539
2540 case ATA_12:
2541 case ATA_16:
2542 return ata_scsi_pass_thru;
da61396d 2543
972dcafb
DG		 2544 case START_STOP:
2545 return ata_scsi_start_stop_xlat;
1da177e4
LT		 2546 }
2547
2548 return NULL;
2549}
2550
2551/**
2552 * ata_scsi_dump_cdb - dump SCSI command contents to dmesg
2553 * @ap: ATA port to which the command was being sent
2554 * @cmd: SCSI command to dump
2555 *
2556 * Prints the contents of a SCSI command via printk().
2557 */
2558
2559static inline void ata_scsi_dump_cdb(struct ata_port *ap,
2560 struct scsi_cmnd *cmd)
2561{
2562#ifdef ATA_DEBUG
2563 struct scsi_device *scsidev = cmd->device;
2564 u8 *scsicmd = cmd->cmnd;
2565
2566 DPRINTK("CDB (%u:%d,%d,%d) %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
2567 ap->id,
2568 scsidev->channel, scsidev->id, scsidev->lun,
2569 scsicmd[0], scsicmd[1], scsicmd[2], scsicmd[3],
2570 scsicmd[4], scsicmd[5], scsicmd[6], scsicmd[7],
2571 scsicmd[8]);
2572#endif
2573}
2574
eb3f0f9c
BK		 2575static inline void __ata_scsi_queuecmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *),
2576 struct ata_port *ap, struct ata_device *dev)
2577{
2578 if (dev->class == ATA_DEV_ATA) {
2579 ata_xlat_func_t xlat_func = ata_get_xlat_func(dev,
2580 cmd->cmnd[0]);
2581
2582 if (xlat_func)
2583 ata_scsi_translate(ap, dev, cmd, done, xlat_func);
2584 else
2585 ata_scsi_simulate(ap, dev, cmd, done);
2586 } else
2587 ata_scsi_translate(ap, dev, cmd, done, atapi_xlat);
2588}
2589
1da177e4
LT		 2590/**
2591 * ata_scsi_queuecmd - Issue SCSI cdb to libata-managed device
2592 * @cmd: SCSI command to be sent
2593 * @done: Completion function, called when command is complete
2594 *
2595 * In some cases, this function translates SCSI commands into
2596 * ATA taskfiles, and queues the taskfiles to be sent to
2597 * hardware. In other cases, this function simulates a
2598 * SCSI device by evaluating and responding to certain
2599 * SCSI commands. This creates the overall effect of
2600 * ATA and ATAPI devices appearing as SCSI devices.
2601 *
2602 * LOCKING:
2603 * Releases scsi-layer-held lock, and obtains host_set lock.
2604 *
2605 * RETURNS:
2606 * Zero.
2607 */
2608
2609int ata_scsi_queuecmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *))
2610{
2611 struct ata_port *ap;
2612 struct ata_device *dev;
2613 struct scsi_device *scsidev = cmd->device;
005a5a06 2614 struct Scsi_Host *shost = scsidev->host;
1da177e4 2615
005a5a06
JG		 2616 ap = (struct ata_port *) &shost->hostdata[0];
2617
2618 spin_unlock(shost->host_lock);
2619 spin_lock(&ap->host_set->lock);
1da177e4
LT		 2620
2621 ata_scsi_dump_cdb(ap, cmd);
2622
2623 dev = ata_scsi_find_dev(ap, scsidev);
eb3f0f9c
BK		 2624 if (likely(dev))
2625 __ata_scsi_queuecmd(cmd, done, ap, dev);
2626 else {
1da177e4
LT		 2627 cmd->result = (DID_BAD_TARGET << 16);
2628 done(cmd);
1da177e4
LT		 2629 }
2630
005a5a06
JG		 2631 spin_unlock(&ap->host_set->lock);
2632 spin_lock(shost->host_lock);
1da177e4
LT		 2633 return 0;
2634}
2635
2636/**
2637 * ata_scsi_simulate - simulate SCSI command on ATA device
c893a3ae
RD		 2638 * @ap: port the device is connected to
2639 * @dev: the target device
1da177e4
LT		 2640 * @cmd: SCSI command being sent to device.
2641 * @done: SCSI command completion function.
2642 *
2643 * Interprets and directly executes a select list of SCSI commands
2644 * that can be handled internally.
2645 *
2646 * LOCKING:
2647 * spin_lock_irqsave(host_set lock)
2648 */
2649
9a3dccc4 2650void ata_scsi_simulate(struct ata_port *ap, struct ata_device *dev,
1da177e4
LT		 2651 struct scsi_cmnd *cmd,
2652 void (*done)(struct scsi_cmnd *))
2653{
2654 struct ata_scsi_args args;
057ace5e 2655 const u8 *scsicmd = cmd->cmnd;
1da177e4 2656
9a3dccc4
TH		 2657 args.ap = ap;
2658 args.dev = dev;
2659 args.id = dev->id;
1da177e4
LT		 2660 args.cmd = cmd;
2661 args.done = done;
2662
2663 switch(scsicmd[0]) {
2664 /* no-op's, complete with success */
2665 case SYNCHRONIZE_CACHE:
2666 case REZERO_UNIT:
2667 case SEEK_6:
2668 case SEEK_10:
2669 case TEST_UNIT_READY:
2670 case FORMAT_UNIT: /* FIXME: correct? */
2671 case SEND_DIAGNOSTIC: /* FIXME: correct? */
2672 ata_scsi_rbuf_fill(&args, ata_scsiop_noop);
2673 break;
2674
2675 case INQUIRY:
2676 if (scsicmd[1] & 2) /* is CmdDt set? */
ae006510 2677 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2678 else if ((scsicmd[1] & 1) == 0) /* is EVPD clear? */
2679 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_std);
2680 else if (scsicmd[2] == 0x00)
2681 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_00);
2682 else if (scsicmd[2] == 0x80)
2683 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_80);
2684 else if (scsicmd[2] == 0x83)
2685 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_83);
2686 else
ae006510 2687 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2688 break;
2689
2690 case MODE_SENSE:
2691 case MODE_SENSE_10:
2692 ata_scsi_rbuf_fill(&args, ata_scsiop_mode_sense);
2693 break;
2694
2695 case MODE_SELECT: /* unconditionally return */
2696 case MODE_SELECT_10: /* bad-field-in-cdb */
ae006510 2697 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2698 break;
2699
2700 case READ_CAPACITY:
2701 ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
2702 break;
2703
2704 case SERVICE_ACTION_IN:
2705 if ((scsicmd[1] & 0x1f) == SAI_READ_CAPACITY_16)
2706 ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
2707 else
ae006510 2708 ata_scsi_invalid_field(cmd, done);
1da177e4
LT		 2709 break;
2710
2711 case REPORT_LUNS:
2712 ata_scsi_rbuf_fill(&args, ata_scsiop_report_luns);
2713 break;
2714
b095518e 2715 /* mandatory commands we haven't implemented yet */
1da177e4
LT		 2716 case REQUEST_SENSE:
2717
2718 /* all other commands */
2719 default:
ae006510
DG		 2720 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x20, 0x0);
2721 /* "Invalid command operation code" */
2722 done(cmd);
1da177e4
LT		 2723 break;
2724 }
2725}
2726
644dd0cc
JG		 2727void ata_scsi_scan_host(struct ata_port *ap)
2728{
3f19ee8c 2729 struct ata_device *dev;
644dd0cc
JG		 2730 unsigned int i;
2731
198e0fed 2732 if (ap->flags & ATA_FLAG_DISABLED)
644dd0cc
JG		 2733 return;
2734
3f19ee8c
JG		 2735 for (i = 0; i < ATA_MAX_DEVICES; i++) {
2736 dev = &ap->device[i];
2737
e1211e3f 2738 if (ata_dev_enabled(dev))
3f19ee8c
JG		 2739 scsi_scan_target(&ap->host->shost_gendev, 0, i, 0, 0);
2740 }
644dd0cc
JG		 2741}
2742
kernel source for telekom puls (alcatel/mediatek)