blob: efbe6fe65442cace7f1fe7c86c6580ee5408614b [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Jeff Garzikaf36d7f2005-08-28 20:18:39 -04002 * 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 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070034 */
35
36#include <linux/kernel.h>
37#include <linux/blkdev.h>
38#include <linux/spinlock.h>
39#include <scsi/scsi.h>
40#include "scsi.h"
41#include <scsi/scsi_host.h>
42#include <linux/libata.h>
43#include <asm/uaccess.h>
44
45#include "libata.h"
46
47typedef unsigned int (*ata_xlat_func_t)(struct ata_queued_cmd *qc, u8 *scsicmd);
48static struct ata_device *
49ata_scsi_find_dev(struct ata_port *ap, struct scsi_device *scsidev);
50
51
Douglas Gilbertae006512005-10-09 09:09:35 -040052static void ata_scsi_invalid_field(struct scsi_cmnd *cmd,
53 void (*done)(struct scsi_cmnd *))
54{
55 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x24, 0x0);
56 /* "Invalid field in cbd" */
57 done(cmd);
58}
59
Linus Torvalds1da177e2005-04-16 15:20:36 -070060/**
61 * ata_std_bios_param - generic bios head/sector/cylinder calculator used by sd.
62 * @sdev: SCSI device for which BIOS geometry is to be determined
63 * @bdev: block device associated with @sdev
64 * @capacity: capacity of SCSI device
65 * @geom: location to which geometry will be output
66 *
67 * Generic bios head/sector/cylinder calculator
68 * used by sd. Most BIOSes nowadays expect a XXX/255/16 (CHS)
69 * mapping. Some situations may arise where the disk is not
70 * bootable if this is not used.
71 *
72 * LOCKING:
73 * Defined by the SCSI layer. We don't really care.
74 *
75 * RETURNS:
76 * Zero.
77 */
78int ata_std_bios_param(struct scsi_device *sdev, struct block_device *bdev,
79 sector_t capacity, int geom[])
80{
81 geom[0] = 255;
82 geom[1] = 63;
83 sector_div(capacity, 255*63);
84 geom[2] = capacity;
85
86 return 0;
87}
88
89int ata_scsi_ioctl(struct scsi_device *scsidev, int cmd, void __user *arg)
90{
91 struct ata_port *ap;
92 struct ata_device *dev;
93 int val = -EINVAL, rc = -EINVAL;
94
95 ap = (struct ata_port *) &scsidev->host->hostdata[0];
96 if (!ap)
97 goto out;
98
99 dev = ata_scsi_find_dev(ap, scsidev);
100 if (!dev) {
101 rc = -ENODEV;
102 goto out;
103 }
104
105 switch (cmd) {
106 case ATA_IOC_GET_IO32:
107 val = 0;
108 if (copy_to_user(arg, &val, 1))
109 return -EFAULT;
110 return 0;
111
112 case ATA_IOC_SET_IO32:
113 val = (unsigned long) arg;
114 if (val != 0)
115 return -EINVAL;
116 return 0;
117
118 default:
119 rc = -ENOTTY;
120 break;
121 }
122
123out:
124 return rc;
125}
126
127/**
128 * ata_scsi_qc_new - acquire new ata_queued_cmd reference
129 * @ap: ATA port to which the new command is attached
130 * @dev: ATA device to which the new command is attached
131 * @cmd: SCSI command that originated this ATA command
132 * @done: SCSI command completion function
133 *
134 * Obtain a reference to an unused ata_queued_cmd structure,
135 * which is the basic libata structure representing a single
136 * ATA command sent to the hardware.
137 *
138 * If a command was available, fill in the SCSI-specific
139 * portions of the structure with information on the
140 * current command.
141 *
142 * LOCKING:
143 * spin_lock_irqsave(host_set lock)
144 *
145 * RETURNS:
146 * Command allocated, or %NULL if none available.
147 */
148struct ata_queued_cmd *ata_scsi_qc_new(struct ata_port *ap,
149 struct ata_device *dev,
150 struct scsi_cmnd *cmd,
151 void (*done)(struct scsi_cmnd *))
152{
153 struct ata_queued_cmd *qc;
154
155 qc = ata_qc_new_init(ap, dev);
156 if (qc) {
157 qc->scsicmd = cmd;
158 qc->scsidone = done;
159
160 if (cmd->use_sg) {
161 qc->sg = (struct scatterlist *) cmd->request_buffer;
162 qc->n_elem = cmd->use_sg;
163 } else {
164 qc->sg = &qc->sgent;
165 qc->n_elem = 1;
166 }
167 } else {
168 cmd->result = (DID_OK << 16) | (QUEUE_FULL << 1);
169 done(cmd);
170 }
171
172 return qc;
173}
174
175/**
176 * ata_to_sense_error - convert ATA error to SCSI error
177 * @qc: Command that we are erroring out
178 * @drv_stat: value contained in ATA status register
179 *
180 * Converts an ATA error into a SCSI error. While we are at it
181 * we decode and dump the ATA error for the user so that they
182 * have some idea what really happened at the non make-believe
183 * layer.
184 *
185 * LOCKING:
186 * spin_lock_irqsave(host_set lock)
187 */
188
189void ata_to_sense_error(struct ata_queued_cmd *qc, u8 drv_stat)
190{
191 struct scsi_cmnd *cmd = qc->scsicmd;
192 u8 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193 /* Based on the 3ware driver translation table */
194 static unsigned char sense_table[][4] = {
195 /* BBD|ECC|ID|MAR */
196 {0xd1, ABORTED_COMMAND, 0x00, 0x00}, // Device busy Aborted command
197 /* BBD|ECC|ID */
198 {0xd0, ABORTED_COMMAND, 0x00, 0x00}, // Device busy Aborted command
199 /* ECC|MC|MARK */
200 {0x61, HARDWARE_ERROR, 0x00, 0x00}, // Device fault Hardware error
201 /* ICRC|ABRT */ /* NB: ICRC & !ABRT is BBD */
202 {0x84, ABORTED_COMMAND, 0x47, 0x00}, // Data CRC error SCSI parity error
203 /* MC|ID|ABRT|TRK0|MARK */
204 {0x37, NOT_READY, 0x04, 0x00}, // Unit offline Not ready
205 /* MCR|MARK */
206 {0x09, NOT_READY, 0x04, 0x00}, // Unrecovered disk error Not ready
207 /* Bad address mark */
208 {0x01, MEDIUM_ERROR, 0x13, 0x00}, // Address mark not found Address mark not found for data field
209 /* TRK0 */
210 {0x02, HARDWARE_ERROR, 0x00, 0x00}, // Track 0 not found Hardware error
211 /* Abort & !ICRC */
212 {0x04, ABORTED_COMMAND, 0x00, 0x00}, // Aborted command Aborted command
213 /* Media change request */
214 {0x08, NOT_READY, 0x04, 0x00}, // Media change request FIXME: faking offline
215 /* SRV */
216 {0x10, ABORTED_COMMAND, 0x14, 0x00}, // ID not found Recorded entity not found
217 /* Media change */
218 {0x08, NOT_READY, 0x04, 0x00}, // Media change FIXME: faking offline
219 /* ECC */
220 {0x40, MEDIUM_ERROR, 0x11, 0x04}, // Uncorrectable ECC error Unrecovered read error
221 /* BBD - block marked bad */
222 {0x80, MEDIUM_ERROR, 0x11, 0x04}, // Block marked bad Medium error, unrecovered read error
223 {0xFF, 0xFF, 0xFF, 0xFF}, // END mark
224 };
225 static unsigned char stat_table[][4] = {
226 /* Must be first because BUSY means no other bits valid */
227 {0x80, ABORTED_COMMAND, 0x47, 0x00}, // Busy, fake parity for now
228 {0x20, HARDWARE_ERROR, 0x00, 0x00}, // Device fault
229 {0x08, ABORTED_COMMAND, 0x47, 0x00}, // Timed out in xfer, fake parity for now
230 {0x04, RECOVERED_ERROR, 0x11, 0x00}, // Recovered ECC error Medium error, recovered
231 {0xFF, 0xFF, 0xFF, 0xFF}, // END mark
232 };
233 int i = 0;
234
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235 /*
236 * Is this an error we can process/parse
237 */
238
239 if(drv_stat & ATA_ERR)
240 /* Read the err bits */
241 err = ata_chk_err(qc->ap);
242
243 /* Display the ATA level error info */
244
245 printk(KERN_WARNING "ata%u: status=0x%02x { ", qc->ap->id, drv_stat);
246 if(drv_stat & 0x80)
247 {
248 printk("Busy ");
249 err = 0; /* Data is not valid in this case */
250 }
251 else {
252 if(drv_stat & 0x40) printk("DriveReady ");
253 if(drv_stat & 0x20) printk("DeviceFault ");
254 if(drv_stat & 0x10) printk("SeekComplete ");
255 if(drv_stat & 0x08) printk("DataRequest ");
256 if(drv_stat & 0x04) printk("CorrectedError ");
257 if(drv_stat & 0x02) printk("Index ");
258 if(drv_stat & 0x01) printk("Error ");
259 }
260 printk("}\n");
261
262 if(err)
263 {
264 printk(KERN_WARNING "ata%u: error=0x%02x { ", qc->ap->id, err);
265 if(err & 0x04) printk("DriveStatusError ");
266 if(err & 0x80)
267 {
268 if(err & 0x04)
269 printk("BadCRC ");
270 else
271 printk("Sector ");
272 }
273 if(err & 0x40) printk("UncorrectableError ");
274 if(err & 0x10) printk("SectorIdNotFound ");
275 if(err & 0x02) printk("TrackZeroNotFound ");
276 if(err & 0x01) printk("AddrMarkNotFound ");
277 printk("}\n");
278
279 /* Should we dump sector info here too ?? */
280 }
281
282
283 /* Look for err */
284 while(sense_table[i][0] != 0xFF)
285 {
286 /* Look for best matches first */
287 if((sense_table[i][0] & err) == sense_table[i][0])
288 {
Douglas Gilbertae006512005-10-09 09:09:35 -0400289 ata_scsi_set_sense(cmd, sense_table[i][1] /* sk */,
290 sense_table[i][2] /* asc */,
291 sense_table[i][3] /* ascq */ );
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 return;
293 }
294 i++;
295 }
296 /* No immediate match */
297 if(err)
298 printk(KERN_DEBUG "ata%u: no sense translation for 0x%02x\n", qc->ap->id, err);
299
300 i = 0;
301 /* Fall back to interpreting status bits */
302 while(stat_table[i][0] != 0xFF)
303 {
304 if(stat_table[i][0] & drv_stat)
305 {
Douglas Gilbertae006512005-10-09 09:09:35 -0400306 ata_scsi_set_sense(cmd, sense_table[i][1] /* sk */,
307 sense_table[i][2] /* asc */,
308 sense_table[i][3] /* ascq */ );
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309 return;
310 }
311 i++;
312 }
313 /* No error ?? */
314 printk(KERN_ERR "ata%u: called with no error (%02X)!\n", qc->ap->id, drv_stat);
315 /* additional-sense-code[-qualifier] */
316
be7db052005-04-17 15:26:13 -0500317 if (cmd->sc_data_direction == DMA_FROM_DEVICE) {
Douglas Gilbertae006512005-10-09 09:09:35 -0400318 ata_scsi_set_sense(cmd, MEDIUM_ERROR, 0x11, 0x4);
319 /* "unrecovered read error" */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 } else {
Douglas Gilbertae006512005-10-09 09:09:35 -0400321 ata_scsi_set_sense(cmd, MEDIUM_ERROR, 0xc, 0x2);
322 /* "write error - auto-reallocation failed" */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700323 }
324}
325
326/**
327 * ata_scsi_slave_config - Set SCSI device attributes
328 * @sdev: SCSI device to examine
329 *
330 * This is called before we actually start reading
331 * and writing to the device, to configure certain
332 * SCSI mid-layer behaviors.
333 *
334 * LOCKING:
335 * Defined by SCSI layer. We don't really care.
336 */
337
338int ata_scsi_slave_config(struct scsi_device *sdev)
339{
340 sdev->use_10_for_rw = 1;
341 sdev->use_10_for_ms = 1;
342
343 blk_queue_max_phys_segments(sdev->request_queue, LIBATA_MAX_PRD);
344
345 if (sdev->id < ATA_MAX_DEVICES) {
346 struct ata_port *ap;
347 struct ata_device *dev;
348
349 ap = (struct ata_port *) &sdev->host->hostdata[0];
350 dev = &ap->device[sdev->id];
351
352 /* TODO: 1024 is an arbitrary number, not the
353 * hardware maximum. This should be increased to
354 * 65534 when Jens Axboe's patch for dynamically
355 * determining max_sectors is merged.
356 */
357 if ((dev->flags & ATA_DFLAG_LBA48) &&
358 ((dev->flags & ATA_DFLAG_LOCK_SECTORS) == 0)) {
John W. Linvillef85bdb92005-05-12 15:49:54 -0400359 /*
360 * do not overwrite sdev->host->max_sectors, since
361 * other drives on this host may not support LBA48
362 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 blk_queue_max_sectors(sdev->request_queue, 2048);
364 }
365 }
366
367 return 0; /* scsi layer doesn't check return value, sigh */
368}
369
370/**
371 * ata_scsi_error - SCSI layer error handler callback
372 * @host: SCSI host on which error occurred
373 *
374 * Handles SCSI-layer-thrown error events.
375 *
376 * LOCKING:
377 * Inherited from SCSI layer (none, can sleep)
378 *
379 * RETURNS:
380 * Zero.
381 */
382
383int ata_scsi_error(struct Scsi_Host *host)
384{
385 struct ata_port *ap;
386
387 DPRINTK("ENTER\n");
388
389 ap = (struct ata_port *) &host->hostdata[0];
390 ap->ops->eng_timeout(ap);
391
392 /* TODO: this is per-command; when queueing is supported
393 * this code will either change or move to a more
394 * appropriate place
395 */
396 host->host_failed--;
Tejun Heo425174382005-08-10 13:38:27 -0400397 INIT_LIST_HEAD(&host->eh_cmd_q);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398
399 DPRINTK("EXIT\n");
400 return 0;
401}
402
403/**
Douglas Gilbert972dcaf2005-08-11 03:35:53 -0400404 * ata_scsi_start_stop_xlat - Translate SCSI START STOP UNIT command
405 * @qc: Storage for translated ATA taskfile
406 * @scsicmd: SCSI command to translate
407 *
408 * Sets up an ATA taskfile to issue STANDBY (to stop) or READ VERIFY
409 * (to start). Perhaps these commands should be preceded by
410 * CHECK POWER MODE to see what power mode the device is already in.
411 * [See SAT revision 5 at www.t10.org]
412 *
413 * LOCKING:
414 * spin_lock_irqsave(host_set lock)
415 *
416 * RETURNS:
417 * Zero on success, non-zero on error.
418 */
419
420static unsigned int ata_scsi_start_stop_xlat(struct ata_queued_cmd *qc,
421 u8 *scsicmd)
422{
423 struct ata_taskfile *tf = &qc->tf;
424
425 tf->flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
426 tf->protocol = ATA_PROT_NODATA;
427 if (scsicmd[1] & 0x1) {
428 ; /* ignore IMMED bit, violates sat-r05 */
429 }
430 if (scsicmd[4] & 0x2)
Douglas Gilbertae006512005-10-09 09:09:35 -0400431 goto invalid_fld; /* LOEJ bit set not supported */
Douglas Gilbert972dcaf2005-08-11 03:35:53 -0400432 if (((scsicmd[4] >> 4) & 0xf) != 0)
Douglas Gilbertae006512005-10-09 09:09:35 -0400433 goto invalid_fld; /* power conditions not supported */
Douglas Gilbert972dcaf2005-08-11 03:35:53 -0400434 if (scsicmd[4] & 0x1) {
435 tf->nsect = 1; /* 1 sector, lba=0 */
Albert Lee9d5b1302005-10-04 08:48:17 -0400436
437 if (qc->dev->flags & ATA_DFLAG_LBA) {
438 qc->tf.flags |= ATA_TFLAG_LBA;
439
440 tf->lbah = 0x0;
441 tf->lbam = 0x0;
442 tf->lbal = 0x0;
443 tf->device |= ATA_LBA;
444 } else {
445 /* CHS */
446 tf->lbal = 0x1; /* sect */
447 tf->lbam = 0x0; /* cyl low */
448 tf->lbah = 0x0; /* cyl high */
449 }
450
Douglas Gilbert972dcaf2005-08-11 03:35:53 -0400451 tf->command = ATA_CMD_VERIFY; /* READ VERIFY */
452 } else {
453 tf->nsect = 0; /* time period value (0 implies now) */
454 tf->command = ATA_CMD_STANDBY;
455 /* Consider: ATA STANDBY IMMEDIATE command */
456 }
457 /*
458 * Standby and Idle condition timers could be implemented but that
459 * would require libata to implement the Power condition mode page
460 * and allow the user to change it. Changing mode pages requires
461 * MODE SELECT to be implemented.
462 */
463
464 return 0;
Douglas Gilbertae006512005-10-09 09:09:35 -0400465
466invalid_fld:
467 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x0);
468 /* "Invalid field in cbd" */
469 return 1;
Douglas Gilbert972dcaf2005-08-11 03:35:53 -0400470}
471
472
473/**
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 * ata_scsi_flush_xlat - Translate SCSI SYNCHRONIZE CACHE command
475 * @qc: Storage for translated ATA taskfile
476 * @scsicmd: SCSI command to translate (ignored)
477 *
478 * Sets up an ATA taskfile to issue FLUSH CACHE or
479 * FLUSH CACHE EXT.
480 *
481 * LOCKING:
482 * spin_lock_irqsave(host_set lock)
483 *
484 * RETURNS:
485 * Zero on success, non-zero on error.
486 */
487
488static unsigned int ata_scsi_flush_xlat(struct ata_queued_cmd *qc, u8 *scsicmd)
489{
490 struct ata_taskfile *tf = &qc->tf;
491
492 tf->flags |= ATA_TFLAG_DEVICE;
493 tf->protocol = ATA_PROT_NODATA;
494
Albert Lee07506692005-10-12 15:04:18 +0800495 if ((qc->dev->flags & ATA_DFLAG_LBA48) &&
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 (ata_id_has_flush_ext(qc->dev->id)))
497 tf->command = ATA_CMD_FLUSH_EXT;
498 else
499 tf->command = ATA_CMD_FLUSH;
500
501 return 0;
502}
503
504/**
Albert Lee3aef5232005-10-04 08:47:43 -0400505 * scsi_6_lba_len - Get LBA and transfer length
506 * @scsicmd: SCSI command to translate
507 *
508 * Calculate LBA and transfer length for 6-byte commands.
509 *
510 * RETURNS:
511 * @plba: the LBA
512 * @plen: the transfer length
513 */
514
515static void scsi_6_lba_len(u8 *scsicmd, u64 *plba, u32 *plen)
516{
517 u64 lba = 0;
518 u32 len = 0;
519
520 VPRINTK("six-byte command\n");
521
522 lba |= ((u64)scsicmd[2]) << 8;
523 lba |= ((u64)scsicmd[3]);
524
525 len |= ((u32)scsicmd[4]);
526
527 *plba = lba;
528 *plen = len;
529}
530
531/**
532 * scsi_10_lba_len - Get LBA and transfer length
533 * @scsicmd: SCSI command to translate
534 *
535 * Calculate LBA and transfer length for 10-byte commands.
536 *
537 * RETURNS:
538 * @plba: the LBA
539 * @plen: the transfer length
540 */
541
542static void scsi_10_lba_len(u8 *scsicmd, u64 *plba, u32 *plen)
543{
544 u64 lba = 0;
545 u32 len = 0;
546
547 VPRINTK("ten-byte command\n");
548
549 lba |= ((u64)scsicmd[2]) << 24;
550 lba |= ((u64)scsicmd[3]) << 16;
551 lba |= ((u64)scsicmd[4]) << 8;
552 lba |= ((u64)scsicmd[5]);
553
554 len |= ((u32)scsicmd[7]) << 8;
555 len |= ((u32)scsicmd[8]);
556
557 *plba = lba;
558 *plen = len;
559}
560
561/**
562 * scsi_16_lba_len - Get LBA and transfer length
563 * @scsicmd: SCSI command to translate
564 *
565 * Calculate LBA and transfer length for 16-byte commands.
566 *
567 * RETURNS:
568 * @plba: the LBA
569 * @plen: the transfer length
570 */
571
572static void scsi_16_lba_len(u8 *scsicmd, u64 *plba, u32 *plen)
573{
574 u64 lba = 0;
575 u32 len = 0;
576
577 VPRINTK("sixteen-byte command\n");
578
579 lba |= ((u64)scsicmd[2]) << 56;
580 lba |= ((u64)scsicmd[3]) << 48;
581 lba |= ((u64)scsicmd[4]) << 40;
582 lba |= ((u64)scsicmd[5]) << 32;
583 lba |= ((u64)scsicmd[6]) << 24;
584 lba |= ((u64)scsicmd[7]) << 16;
585 lba |= ((u64)scsicmd[8]) << 8;
586 lba |= ((u64)scsicmd[9]);
587
588 len |= ((u32)scsicmd[10]) << 24;
589 len |= ((u32)scsicmd[11]) << 16;
590 len |= ((u32)scsicmd[12]) << 8;
591 len |= ((u32)scsicmd[13]);
592
593 *plba = lba;
594 *plen = len;
595}
596
597/**
Linus Torvalds1da177e2005-04-16 15:20:36 -0700598 * ata_scsi_verify_xlat - Translate SCSI VERIFY command into an ATA one
599 * @qc: Storage for translated ATA taskfile
600 * @scsicmd: SCSI command to translate
601 *
602 * Converts SCSI VERIFY command to an ATA READ VERIFY command.
603 *
604 * LOCKING:
605 * spin_lock_irqsave(host_set lock)
606 *
607 * RETURNS:
608 * Zero on success, non-zero on error.
609 */
610
611static unsigned int ata_scsi_verify_xlat(struct ata_queued_cmd *qc, u8 *scsicmd)
612{
613 struct ata_taskfile *tf = &qc->tf;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400614 struct ata_device *dev = qc->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615 u64 dev_sectors = qc->dev->n_sectors;
Albert Lee3aef5232005-10-04 08:47:43 -0400616 u64 block;
617 u32 n_block;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618
619 tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
620 tf->protocol = ATA_PROT_NODATA;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621
Albert Lee3aef5232005-10-04 08:47:43 -0400622 if (scsicmd[0] == VERIFY)
623 scsi_10_lba_len(scsicmd, &block, &n_block);
624 else if (scsicmd[0] == VERIFY_16)
625 scsi_16_lba_len(scsicmd, &block, &n_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626 else
Douglas Gilbertae006512005-10-09 09:09:35 -0400627 goto invalid_fld;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628
Albert Lee8bf62ec2005-05-12 15:29:42 -0400629 if (!n_block)
Douglas Gilbertae006512005-10-09 09:09:35 -0400630 goto nothing_to_do;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400631 if (block >= dev_sectors)
Douglas Gilbertae006512005-10-09 09:09:35 -0400632 goto out_of_range;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400633 if ((block + n_block) > dev_sectors)
Douglas Gilbertae006512005-10-09 09:09:35 -0400634 goto out_of_range;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635
Albert Lee07506692005-10-12 15:04:18 +0800636 if (dev->flags & ATA_DFLAG_LBA) {
637 tf->flags |= ATA_TFLAG_LBA;
638
Albert Leec6a33e22005-10-12 15:12:26 +0800639 if (lba_28_ok(block, n_block)) {
640 /* use LBA28 */
641 tf->command = ATA_CMD_VERIFY;
642 tf->device |= (block >> 24) & 0xf;
643 } else if (lba_48_ok(block, n_block)) {
644 if (!(dev->flags & ATA_DFLAG_LBA48))
645 goto out_of_range;
Albert Lee07506692005-10-12 15:04:18 +0800646
647 /* use LBA48 */
648 tf->flags |= ATA_TFLAG_LBA48;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400649 tf->command = ATA_CMD_VERIFY_EXT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650
Albert Lee8bf62ec2005-05-12 15:29:42 -0400651 tf->hob_nsect = (n_block >> 8) & 0xff;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652
Albert Lee8bf62ec2005-05-12 15:29:42 -0400653 tf->hob_lbah = (block >> 40) & 0xff;
654 tf->hob_lbam = (block >> 32) & 0xff;
655 tf->hob_lbal = (block >> 24) & 0xff;
Albert Leec6a33e22005-10-12 15:12:26 +0800656 } else
657 /* request too large even for LBA48 */
658 goto out_of_range;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400659
660 tf->nsect = n_block & 0xff;
661
662 tf->lbah = (block >> 16) & 0xff;
663 tf->lbam = (block >> 8) & 0xff;
664 tf->lbal = block & 0xff;
665
666 tf->device |= ATA_LBA;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667 } else {
Albert Lee8bf62ec2005-05-12 15:29:42 -0400668 /* CHS */
669 u32 sect, head, cyl, track;
670
Albert Leec6a33e22005-10-12 15:12:26 +0800671 if (!lba_28_ok(block, n_block))
672 goto out_of_range;
Albert Lee07506692005-10-12 15:04:18 +0800673
Albert Lee8bf62ec2005-05-12 15:29:42 -0400674 /* Convert LBA to CHS */
675 track = (u32)block / dev->sectors;
676 cyl = track / dev->heads;
677 head = track % dev->heads;
678 sect = (u32)block % dev->sectors + 1;
679
Albert Leec187c4b2005-10-04 08:46:51 -0400680 DPRINTK("block %u track %u cyl %u head %u sect %u\n",
681 (u32)block, track, cyl, head, sect);
Albert Lee8bf62ec2005-05-12 15:29:42 -0400682
683 /* Check whether the converted CHS can fit.
684 Cylinder: 0-65535
685 Head: 0-15
686 Sector: 1-255*/
687 if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect))
Douglas Gilbertae006512005-10-09 09:09:35 -0400688 goto out_of_range;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400689
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690 tf->command = ATA_CMD_VERIFY;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400691 tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */
692 tf->lbal = sect;
693 tf->lbam = cyl;
694 tf->lbah = cyl >> 8;
695 tf->device |= head;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 }
697
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698 return 0;
Douglas Gilbertae006512005-10-09 09:09:35 -0400699
700invalid_fld:
701 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x0);
702 /* "Invalid field in cbd" */
703 return 1;
704
705out_of_range:
706 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x21, 0x0);
707 /* "Logical Block Address out of range" */
708 return 1;
709
710nothing_to_do:
711 qc->scsicmd->result = SAM_STAT_GOOD;
712 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713}
714
715/**
716 * ata_scsi_rw_xlat - Translate SCSI r/w command into an ATA one
717 * @qc: Storage for translated ATA taskfile
718 * @scsicmd: SCSI command to translate
719 *
720 * Converts any of six SCSI read/write commands into the
721 * ATA counterpart, including starting sector (LBA),
722 * sector count, and taking into account the device's LBA48
723 * support.
724 *
725 * Commands %READ_6, %READ_10, %READ_16, %WRITE_6, %WRITE_10, and
726 * %WRITE_16 are currently supported.
727 *
728 * LOCKING:
729 * spin_lock_irqsave(host_set lock)
730 *
731 * RETURNS:
732 * Zero on success, non-zero on error.
733 */
734
735static unsigned int ata_scsi_rw_xlat(struct ata_queued_cmd *qc, u8 *scsicmd)
736{
737 struct ata_taskfile *tf = &qc->tf;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400738 struct ata_device *dev = qc->dev;
Albert Lee3aef5232005-10-04 08:47:43 -0400739 u64 block;
740 u32 n_block;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741
742 tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700743
Albert Lee8cbd6df2005-10-12 15:06:27 +0800744 if (scsicmd[0] == WRITE_10 || scsicmd[0] == WRITE_6 ||
745 scsicmd[0] == WRITE_16)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700746 tf->flags |= ATA_TFLAG_WRITE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747
Albert Lee8bf62ec2005-05-12 15:29:42 -0400748 /* Calculate the SCSI LBA and transfer length. */
Albert Lee3aef5232005-10-04 08:47:43 -0400749 switch (scsicmd[0]) {
750 case READ_10:
751 case WRITE_10:
752 scsi_10_lba_len(scsicmd, &block, &n_block);
753 break;
754 case READ_6:
755 case WRITE_6:
756 scsi_6_lba_len(scsicmd, &block, &n_block);
Albert Leec187c4b2005-10-04 08:46:51 -0400757
758 /* for 6-byte r/w commands, transfer length 0
759 * means 256 blocks of data, not 0 block.
760 */
Jeff Garzik76b2bf92005-08-29 19:24:43 -0400761 if (!n_block)
762 n_block = 256;
Albert Lee3aef5232005-10-04 08:47:43 -0400763 break;
764 case READ_16:
765 case WRITE_16:
766 scsi_16_lba_len(scsicmd, &block, &n_block);
767 break;
768 default:
Albert Lee8bf62ec2005-05-12 15:29:42 -0400769 DPRINTK("no-byte command\n");
Douglas Gilbertae006512005-10-09 09:09:35 -0400770 goto invalid_fld;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 }
772
Albert Lee8bf62ec2005-05-12 15:29:42 -0400773 /* Check and compose ATA command */
774 if (!n_block)
Albert Leec187c4b2005-10-04 08:46:51 -0400775 /* For 10-byte and 16-byte SCSI R/W commands, transfer
776 * length 0 means transfer 0 block of data.
777 * However, for ATA R/W commands, sector count 0 means
778 * 256 or 65536 sectors, not 0 sectors as in SCSI.
779 */
Douglas Gilbertae006512005-10-09 09:09:35 -0400780 goto nothing_to_do;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400781
Albert Lee07506692005-10-12 15:04:18 +0800782 if (dev->flags & ATA_DFLAG_LBA) {
783 tf->flags |= ATA_TFLAG_LBA;
784
Albert Leec6a33e22005-10-12 15:12:26 +0800785 if (lba_28_ok(block, n_block)) {
786 /* use LBA28 */
787 tf->device |= (block >> 24) & 0xf;
788 } else if (lba_48_ok(block, n_block)) {
789 if (!(dev->flags & ATA_DFLAG_LBA48))
Douglas Gilbertae006512005-10-09 09:09:35 -0400790 goto out_of_range;
Albert Lee8bf62ec2005-05-12 15:29:42 -0400791
Albert Lee07506692005-10-12 15:04:18 +0800792 /* use LBA48 */
793 tf->flags |= ATA_TFLAG_LBA48;
794
Albert Lee8bf62ec2005-05-12 15:29:42 -0400795 tf->hob_nsect = (n_block >> 8) & 0xff;
796
797 tf->hob_lbah = (block >> 40) & 0xff;
798 tf->hob_lbam = (block >> 32) & 0xff;
799 tf->hob_lbal = (block >> 24) & 0xff;
Albert Leec6a33e22005-10-12 15:12:26 +0800800 } else
801 /* request too large even for LBA48 */
802 goto out_of_range;
Albert Leec187c4b2005-10-04 08:46:51 -0400803
Albert Lee8cbd6df2005-10-12 15:06:27 +0800804 ata_rwcmd_protocol(qc);
805
Albert Lee8bf62ec2005-05-12 15:29:42 -0400806 qc->nsect = n_block;
807 tf->nsect = n_block & 0xff;
808
809 tf->lbah = (block >> 16) & 0xff;
810 tf->lbam = (block >> 8) & 0xff;
811 tf->lbal = block & 0xff;
812
813 tf->device |= ATA_LBA;
814 } else {
815 /* CHS */
816 u32 sect, head, cyl, track;
817
818 /* The request -may- be too large for CHS addressing. */
Albert Leec6a33e22005-10-12 15:12:26 +0800819 if (!lba_28_ok(block, n_block))
Douglas Gilbertae006512005-10-09 09:09:35 -0400820 goto out_of_range;
Albert Leec187c4b2005-10-04 08:46:51 -0400821
Albert Lee8cbd6df2005-10-12 15:06:27 +0800822 ata_rwcmd_protocol(qc);
823
Albert Lee8bf62ec2005-05-12 15:29:42 -0400824 /* Convert LBA to CHS */
825 track = (u32)block / dev->sectors;
826 cyl = track / dev->heads;
827 head = track % dev->heads;
828 sect = (u32)block % dev->sectors + 1;
829
Albert Leec187c4b2005-10-04 08:46:51 -0400830 DPRINTK("block %u track %u cyl %u head %u sect %u\n",
Albert Lee8bf62ec2005-05-12 15:29:42 -0400831 (u32)block, track, cyl, head, sect);
Albert Leec187c4b2005-10-04 08:46:51 -0400832
Albert Lee8bf62ec2005-05-12 15:29:42 -0400833 /* Check whether the converted CHS can fit.
834 Cylinder: 0-65535
835 Head: 0-15
836 Sector: 1-255*/
Albert Leec187c4b2005-10-04 08:46:51 -0400837 if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect))
Douglas Gilbertae006512005-10-09 09:09:35 -0400838 goto out_of_range;
Albert Leec187c4b2005-10-04 08:46:51 -0400839
Albert Lee8bf62ec2005-05-12 15:29:42 -0400840 qc->nsect = n_block;
841 tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */
842 tf->lbal = sect;
843 tf->lbam = cyl;
844 tf->lbah = cyl >> 8;
845 tf->device |= head;
846 }
847
848 return 0;
Douglas Gilbertae006512005-10-09 09:09:35 -0400849
850invalid_fld:
851 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x24, 0x0);
852 /* "Invalid field in cbd" */
853 return 1;
854
855out_of_range:
856 ata_scsi_set_sense(qc->scsicmd, ILLEGAL_REQUEST, 0x21, 0x0);
857 /* "Logical Block Address out of range" */
858 return 1;
859
860nothing_to_do:
861 qc->scsicmd->result = SAM_STAT_GOOD;
862 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700863}
864
865static int ata_scsi_qc_complete(struct ata_queued_cmd *qc, u8 drv_stat)
866{
867 struct scsi_cmnd *cmd = qc->scsicmd;
868
869 if (unlikely(drv_stat & (ATA_ERR | ATA_BUSY | ATA_DRQ)))
870 ata_to_sense_error(qc, drv_stat);
871 else
872 cmd->result = SAM_STAT_GOOD;
873
874 qc->scsidone(cmd);
875
876 return 0;
877}
878
879/**
880 * ata_scsi_translate - Translate then issue SCSI command to ATA device
881 * @ap: ATA port to which the command is addressed
882 * @dev: ATA device to which the command is addressed
883 * @cmd: SCSI command to execute
884 * @done: SCSI command completion function
885 * @xlat_func: Actor which translates @cmd to an ATA taskfile
886 *
887 * Our ->queuecommand() function has decided that the SCSI
888 * command issued can be directly translated into an ATA
889 * command, rather than handled internally.
890 *
891 * This function sets up an ata_queued_cmd structure for the
892 * SCSI command, and sends that ata_queued_cmd to the hardware.
893 *
Douglas Gilbertae006512005-10-09 09:09:35 -0400894 * The xlat_func argument (actor) returns 0 if ready to execute
895 * ATA command, else 1 to finish translation. If 1 is returned
896 * then cmd->result (and possibly cmd->sense_buffer) are assumed
897 * to be set reflecting an error condition or clean (early)
898 * termination.
899 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900 * LOCKING:
901 * spin_lock_irqsave(host_set lock)
902 */
903
904static void ata_scsi_translate(struct ata_port *ap, struct ata_device *dev,
905 struct scsi_cmnd *cmd,
906 void (*done)(struct scsi_cmnd *),
907 ata_xlat_func_t xlat_func)
908{
909 struct ata_queued_cmd *qc;
910 u8 *scsicmd = cmd->cmnd;
911
912 VPRINTK("ENTER\n");
913
914 qc = ata_scsi_qc_new(ap, dev, cmd, done);
915 if (!qc)
Douglas Gilbertae006512005-10-09 09:09:35 -0400916 goto err_mem;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917
918 /* data is present; dma-map it */
be7db052005-04-17 15:26:13 -0500919 if (cmd->sc_data_direction == DMA_FROM_DEVICE ||
920 cmd->sc_data_direction == DMA_TO_DEVICE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700921 if (unlikely(cmd->request_bufflen < 1)) {
922 printk(KERN_WARNING "ata%u(%u): WARNING: zero len r/w req\n",
923 ap->id, dev->devno);
Douglas Gilbertae006512005-10-09 09:09:35 -0400924 goto err_did;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925 }
926
927 if (cmd->use_sg)
928 ata_sg_init(qc, cmd->request_buffer, cmd->use_sg);
929 else
930 ata_sg_init_one(qc, cmd->request_buffer,
931 cmd->request_bufflen);
932
933 qc->dma_dir = cmd->sc_data_direction;
934 }
935
936 qc->complete_fn = ata_scsi_qc_complete;
937
938 if (xlat_func(qc, scsicmd))
Douglas Gilbertae006512005-10-09 09:09:35 -0400939 goto early_finish;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940
941 /* select device, send command to hardware */
942 if (ata_qc_issue(qc))
Douglas Gilbertae006512005-10-09 09:09:35 -0400943 goto err_did;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944
945 VPRINTK("EXIT\n");
946 return;
947
Douglas Gilbertae006512005-10-09 09:09:35 -0400948early_finish:
949 ata_qc_free(qc);
950 done(cmd);
951 DPRINTK("EXIT - early finish (good or error)\n");
952 return;
953
954err_did:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955 ata_qc_free(qc);
Douglas Gilbertae006512005-10-09 09:09:35 -0400956err_mem:
957 cmd->result = (DID_ERROR << 16);
958 done(cmd);
959 DPRINTK("EXIT - internal\n");
960 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961}
962
963/**
964 * ata_scsi_rbuf_get - Map response buffer.
965 * @cmd: SCSI command containing buffer to be mapped.
966 * @buf_out: Pointer to mapped area.
967 *
968 * Maps buffer contained within SCSI command @cmd.
969 *
970 * LOCKING:
971 * spin_lock_irqsave(host_set lock)
972 *
973 * RETURNS:
974 * Length of response buffer.
975 */
976
977static unsigned int ata_scsi_rbuf_get(struct scsi_cmnd *cmd, u8 **buf_out)
978{
979 u8 *buf;
980 unsigned int buflen;
981
982 if (cmd->use_sg) {
983 struct scatterlist *sg;
984
985 sg = (struct scatterlist *) cmd->request_buffer;
986 buf = kmap_atomic(sg->page, KM_USER0) + sg->offset;
987 buflen = sg->length;
988 } else {
989 buf = cmd->request_buffer;
990 buflen = cmd->request_bufflen;
991 }
992
993 *buf_out = buf;
994 return buflen;
995}
996
997/**
998 * ata_scsi_rbuf_put - Unmap response buffer.
999 * @cmd: SCSI command containing buffer to be unmapped.
1000 * @buf: buffer to unmap
1001 *
1002 * Unmaps response buffer contained within @cmd.
1003 *
1004 * LOCKING:
1005 * spin_lock_irqsave(host_set lock)
1006 */
1007
1008static inline void ata_scsi_rbuf_put(struct scsi_cmnd *cmd, u8 *buf)
1009{
1010 if (cmd->use_sg) {
1011 struct scatterlist *sg;
1012
1013 sg = (struct scatterlist *) cmd->request_buffer;
1014 kunmap_atomic(buf - sg->offset, KM_USER0);
1015 }
1016}
1017
1018/**
1019 * ata_scsi_rbuf_fill - wrapper for SCSI command simulators
1020 * @args: device IDENTIFY data / SCSI command of interest.
1021 * @actor: Callback hook for desired SCSI command simulator
1022 *
1023 * Takes care of the hard work of simulating a SCSI command...
1024 * Mapping the response buffer, calling the command's handler,
1025 * and handling the handler's return value. This return value
1026 * indicates whether the handler wishes the SCSI command to be
Douglas Gilbertae006512005-10-09 09:09:35 -04001027 * completed successfully (0), or not (in which case cmd->result
1028 * and sense buffer are assumed to be set).
Linus Torvalds1da177e2005-04-16 15:20:36 -07001029 *
1030 * LOCKING:
1031 * spin_lock_irqsave(host_set lock)
1032 */
1033
1034void ata_scsi_rbuf_fill(struct ata_scsi_args *args,
1035 unsigned int (*actor) (struct ata_scsi_args *args,
1036 u8 *rbuf, unsigned int buflen))
1037{
1038 u8 *rbuf;
1039 unsigned int buflen, rc;
1040 struct scsi_cmnd *cmd = args->cmd;
1041
1042 buflen = ata_scsi_rbuf_get(cmd, &rbuf);
1043 memset(rbuf, 0, buflen);
1044 rc = actor(args, rbuf, buflen);
1045 ata_scsi_rbuf_put(cmd, rbuf);
1046
Douglas Gilbertae006512005-10-09 09:09:35 -04001047 if (rc == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001048 cmd->result = SAM_STAT_GOOD;
Douglas Gilbertae006512005-10-09 09:09:35 -04001049 args->done(cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050}
1051
1052/**
1053 * ata_scsiop_inq_std - Simulate INQUIRY command
1054 * @args: device IDENTIFY data / SCSI command of interest.
1055 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1056 * @buflen: Response buffer length.
1057 *
1058 * Returns standard device identification data associated
1059 * with non-EVPD INQUIRY command output.
1060 *
1061 * LOCKING:
1062 * spin_lock_irqsave(host_set lock)
1063 */
1064
1065unsigned int ata_scsiop_inq_std(struct ata_scsi_args *args, u8 *rbuf,
1066 unsigned int buflen)
1067{
1068 u8 hdr[] = {
1069 TYPE_DISK,
1070 0,
1071 0x5, /* claim SPC-3 version compatibility */
1072 2,
1073 95 - 4
1074 };
1075
1076 /* set scsi removeable (RMB) bit per ata bit */
1077 if (ata_id_removeable(args->id))
1078 hdr[1] |= (1 << 7);
1079
1080 VPRINTK("ENTER\n");
1081
1082 memcpy(rbuf, hdr, sizeof(hdr));
1083
1084 if (buflen > 35) {
1085 memcpy(&rbuf[8], "ATA ", 8);
1086 ata_dev_id_string(args->id, &rbuf[16], ATA_ID_PROD_OFS, 16);
1087 ata_dev_id_string(args->id, &rbuf[32], ATA_ID_FW_REV_OFS, 4);
1088 if (rbuf[32] == 0 || rbuf[32] == ' ')
1089 memcpy(&rbuf[32], "n/a ", 4);
1090 }
1091
1092 if (buflen > 63) {
1093 const u8 versions[] = {
1094 0x60, /* SAM-3 (no version claimed) */
1095
1096 0x03,
1097 0x20, /* SBC-2 (no version claimed) */
1098
1099 0x02,
1100 0x60 /* SPC-3 (no version claimed) */
1101 };
1102
1103 memcpy(rbuf + 59, versions, sizeof(versions));
1104 }
1105
1106 return 0;
1107}
1108
1109/**
1110 * ata_scsiop_inq_00 - Simulate INQUIRY EVPD page 0, list of pages
1111 * @args: device IDENTIFY data / SCSI command of interest.
1112 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1113 * @buflen: Response buffer length.
1114 *
1115 * Returns list of inquiry EVPD pages available.
1116 *
1117 * LOCKING:
1118 * spin_lock_irqsave(host_set lock)
1119 */
1120
1121unsigned int ata_scsiop_inq_00(struct ata_scsi_args *args, u8 *rbuf,
1122 unsigned int buflen)
1123{
1124 const u8 pages[] = {
1125 0x00, /* page 0x00, this page */
1126 0x80, /* page 0x80, unit serial no page */
1127 0x83 /* page 0x83, device ident page */
1128 };
1129 rbuf[3] = sizeof(pages); /* number of supported EVPD pages */
1130
1131 if (buflen > 6)
1132 memcpy(rbuf + 4, pages, sizeof(pages));
1133
1134 return 0;
1135}
1136
1137/**
1138 * ata_scsiop_inq_80 - Simulate INQUIRY EVPD page 80, device serial number
1139 * @args: device IDENTIFY data / SCSI command of interest.
1140 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1141 * @buflen: Response buffer length.
1142 *
1143 * Returns ATA device serial number.
1144 *
1145 * LOCKING:
1146 * spin_lock_irqsave(host_set lock)
1147 */
1148
1149unsigned int ata_scsiop_inq_80(struct ata_scsi_args *args, u8 *rbuf,
1150 unsigned int buflen)
1151{
1152 const u8 hdr[] = {
1153 0,
1154 0x80, /* this page code */
1155 0,
1156 ATA_SERNO_LEN, /* page len */
1157 };
1158 memcpy(rbuf, hdr, sizeof(hdr));
1159
1160 if (buflen > (ATA_SERNO_LEN + 4 - 1))
1161 ata_dev_id_string(args->id, (unsigned char *) &rbuf[4],
1162 ATA_ID_SERNO_OFS, ATA_SERNO_LEN);
1163
1164 return 0;
1165}
1166
1167static const char *inq_83_str = "Linux ATA-SCSI simulator";
1168
1169/**
1170 * ata_scsiop_inq_83 - Simulate INQUIRY EVPD page 83, device identity
1171 * @args: device IDENTIFY data / SCSI command of interest.
1172 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1173 * @buflen: Response buffer length.
1174 *
1175 * Returns device identification. Currently hardcoded to
1176 * return "Linux ATA-SCSI simulator".
1177 *
1178 * LOCKING:
1179 * spin_lock_irqsave(host_set lock)
1180 */
1181
1182unsigned int ata_scsiop_inq_83(struct ata_scsi_args *args, u8 *rbuf,
1183 unsigned int buflen)
1184{
1185 rbuf[1] = 0x83; /* this page code */
1186 rbuf[3] = 4 + strlen(inq_83_str); /* page len */
1187
1188 /* our one and only identification descriptor (vendor-specific) */
1189 if (buflen > (strlen(inq_83_str) + 4 + 4 - 1)) {
1190 rbuf[4 + 0] = 2; /* code set: ASCII */
1191 rbuf[4 + 3] = strlen(inq_83_str);
1192 memcpy(rbuf + 4 + 4, inq_83_str, strlen(inq_83_str));
1193 }
1194
1195 return 0;
1196}
1197
1198/**
Jeff Garzik0cba6322005-05-30 19:49:12 -04001199 * ata_scsiop_noop - Command handler that simply returns success.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200 * @args: device IDENTIFY data / SCSI command of interest.
1201 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1202 * @buflen: Response buffer length.
1203 *
1204 * No operation. Simply returns success to caller, to indicate
1205 * that the caller should successfully complete this SCSI command.
1206 *
1207 * LOCKING:
1208 * spin_lock_irqsave(host_set lock)
1209 */
1210
1211unsigned int ata_scsiop_noop(struct ata_scsi_args *args, u8 *rbuf,
1212 unsigned int buflen)
1213{
1214 VPRINTK("ENTER\n");
1215 return 0;
1216}
1217
1218/**
1219 * ata_msense_push - Push data onto MODE SENSE data output buffer
1220 * @ptr_io: (input/output) Location to store more output data
1221 * @last: End of output data buffer
1222 * @buf: Pointer to BLOB being added to output buffer
1223 * @buflen: Length of BLOB
1224 *
1225 * Store MODE SENSE data on an output buffer.
1226 *
1227 * LOCKING:
1228 * None.
1229 */
1230
1231static void ata_msense_push(u8 **ptr_io, const u8 *last,
1232 const u8 *buf, unsigned int buflen)
1233{
1234 u8 *ptr = *ptr_io;
1235
1236 if ((ptr + buflen - 1) > last)
1237 return;
1238
1239 memcpy(ptr, buf, buflen);
1240
1241 ptr += buflen;
1242
1243 *ptr_io = ptr;
1244}
1245
1246/**
1247 * ata_msense_caching - Simulate MODE SENSE caching info page
1248 * @id: device IDENTIFY data
1249 * @ptr_io: (input/output) Location to store more output data
1250 * @last: End of output data buffer
1251 *
1252 * Generate a caching info page, which conditionally indicates
1253 * write caching to the SCSI layer, depending on device
1254 * capabilities.
1255 *
1256 * LOCKING:
1257 * None.
1258 */
1259
1260static unsigned int ata_msense_caching(u16 *id, u8 **ptr_io,
1261 const u8 *last)
1262{
1263 u8 page[] = {
1264 0x8, /* page code */
1265 0x12, /* page length */
1266 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, /* 10 zeroes */
1267 0, 0, 0, 0, 0, 0, 0, 0 /* 8 zeroes */
1268 };
1269
1270 if (ata_id_wcache_enabled(id))
1271 page[2] |= (1 << 2); /* write cache enable */
1272 if (!ata_id_rahead_enabled(id))
1273 page[12] |= (1 << 5); /* disable read ahead */
1274
1275 ata_msense_push(ptr_io, last, page, sizeof(page));
1276 return sizeof(page);
1277}
1278
1279/**
1280 * ata_msense_ctl_mode - Simulate MODE SENSE control mode page
1281 * @dev: Device associated with this MODE SENSE command
1282 * @ptr_io: (input/output) Location to store more output data
1283 * @last: End of output data buffer
1284 *
1285 * Generate a generic MODE SENSE control mode page.
1286 *
1287 * LOCKING:
1288 * None.
1289 */
1290
1291static unsigned int ata_msense_ctl_mode(u8 **ptr_io, const u8 *last)
1292{
1293 const u8 page[] = {0xa, 0xa, 6, 0, 0, 0, 0, 0, 0xff, 0xff, 0, 30};
1294
1295 /* byte 2: set the descriptor format sense data bit (bit 2)
1296 * since we need to support returning this format for SAT
1297 * commands and any SCSI commands against a 48b LBA device.
1298 */
1299
1300 ata_msense_push(ptr_io, last, page, sizeof(page));
1301 return sizeof(page);
1302}
1303
1304/**
1305 * ata_msense_rw_recovery - Simulate MODE SENSE r/w error recovery page
1306 * @dev: Device associated with this MODE SENSE command
1307 * @ptr_io: (input/output) Location to store more output data
1308 * @last: End of output data buffer
1309 *
1310 * Generate a generic MODE SENSE r/w error recovery page.
1311 *
1312 * LOCKING:
1313 * None.
1314 */
1315
1316static unsigned int ata_msense_rw_recovery(u8 **ptr_io, const u8 *last)
1317{
1318 const u8 page[] = {
1319 0x1, /* page code */
1320 0xa, /* page length */
1321 (1 << 7) | (1 << 6), /* note auto r/w reallocation */
1322 0, 0, 0, 0, 0, 0, 0, 0, 0 /* 9 zeroes */
1323 };
1324
1325 ata_msense_push(ptr_io, last, page, sizeof(page));
1326 return sizeof(page);
1327}
1328
1329/**
1330 * ata_scsiop_mode_sense - Simulate MODE SENSE 6, 10 commands
1331 * @args: device IDENTIFY data / SCSI command of interest.
1332 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1333 * @buflen: Response buffer length.
1334 *
1335 * Simulate MODE SENSE commands.
1336 *
1337 * LOCKING:
1338 * spin_lock_irqsave(host_set lock)
1339 */
1340
1341unsigned int ata_scsiop_mode_sense(struct ata_scsi_args *args, u8 *rbuf,
1342 unsigned int buflen)
1343{
1344 u8 *scsicmd = args->cmd->cmnd, *p, *last;
1345 unsigned int page_control, six_byte, output_len;
1346
1347 VPRINTK("ENTER\n");
1348
1349 six_byte = (scsicmd[0] == MODE_SENSE);
1350
1351 /* we only support saved and current values (which we treat
1352 * in the same manner)
1353 */
1354 page_control = scsicmd[2] >> 6;
Douglas Gilbertae006512005-10-09 09:09:35 -04001355 switch (page_control) {
1356 case 0: /* current */
1357 break; /* supported */
1358 case 3: /* saved */
1359 goto saving_not_supp;
1360 case 1: /* changeable */
1361 case 2: /* defaults */
1362 default:
1363 goto invalid_fld;
1364 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001365
1366 if (six_byte)
1367 output_len = 4;
1368 else
1369 output_len = 8;
1370
1371 p = rbuf + output_len;
1372 last = rbuf + buflen - 1;
1373
1374 switch(scsicmd[2] & 0x3f) {
1375 case 0x01: /* r/w error recovery */
1376 output_len += ata_msense_rw_recovery(&p, last);
1377 break;
1378
1379 case 0x08: /* caching */
1380 output_len += ata_msense_caching(args->id, &p, last);
1381 break;
1382
1383 case 0x0a: { /* control mode */
1384 output_len += ata_msense_ctl_mode(&p, last);
1385 break;
1386 }
1387
1388 case 0x3f: /* all pages */
1389 output_len += ata_msense_rw_recovery(&p, last);
1390 output_len += ata_msense_caching(args->id, &p, last);
1391 output_len += ata_msense_ctl_mode(&p, last);
1392 break;
1393
1394 default: /* invalid page code */
Douglas Gilbertae006512005-10-09 09:09:35 -04001395 goto invalid_fld;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001396 }
1397
1398 if (six_byte) {
1399 output_len--;
1400 rbuf[0] = output_len;
1401 } else {
1402 output_len -= 2;
1403 rbuf[0] = output_len >> 8;
1404 rbuf[1] = output_len;
1405 }
1406
1407 return 0;
Douglas Gilbertae006512005-10-09 09:09:35 -04001408
1409invalid_fld:
1410 ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x24, 0x0);
1411 /* "Invalid field in cbd" */
1412 return 1;
1413
1414saving_not_supp:
1415 ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x39, 0x0);
1416 /* "Saving parameters not supported" */
1417 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001418}
1419
1420/**
1421 * ata_scsiop_read_cap - Simulate READ CAPACITY[ 16] commands
1422 * @args: device IDENTIFY data / SCSI command of interest.
1423 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1424 * @buflen: Response buffer length.
1425 *
1426 * Simulate READ CAPACITY commands.
1427 *
1428 * LOCKING:
1429 * spin_lock_irqsave(host_set lock)
1430 */
1431
1432unsigned int ata_scsiop_read_cap(struct ata_scsi_args *args, u8 *rbuf,
1433 unsigned int buflen)
1434{
1435 u64 n_sectors;
1436 u32 tmp;
1437
1438 VPRINTK("ENTER\n");
1439
Albert Lee8bf62ec2005-05-12 15:29:42 -04001440 if (ata_id_has_lba(args->id)) {
1441 if (ata_id_has_lba48(args->id))
1442 n_sectors = ata_id_u64(args->id, 100);
1443 else
1444 n_sectors = ata_id_u32(args->id, 60);
1445 } else {
1446 /* CHS default translation */
1447 n_sectors = args->id[1] * args->id[3] * args->id[6];
1448
1449 if (ata_id_current_chs_valid(args->id))
1450 /* CHS current translation */
1451 n_sectors = ata_id_u32(args->id, 57);
1452 }
1453
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454 n_sectors--; /* ATA TotalUserSectors - 1 */
1455
Linus Torvalds1da177e2005-04-16 15:20:36 -07001456 if (args->cmd->cmnd[0] == READ_CAPACITY) {
Philip Pokorny0c144d02005-05-28 01:24:47 -07001457 if( n_sectors >= 0xffffffffULL )
1458 tmp = 0xffffffff ; /* Return max count on overflow */
1459 else
1460 tmp = n_sectors ;
1461
Linus Torvalds1da177e2005-04-16 15:20:36 -07001462 /* sector count, 32-bit */
1463 rbuf[0] = tmp >> (8 * 3);
1464 rbuf[1] = tmp >> (8 * 2);
1465 rbuf[2] = tmp >> (8 * 1);
1466 rbuf[3] = tmp;
1467
1468 /* sector size */
1469 tmp = ATA_SECT_SIZE;
1470 rbuf[6] = tmp >> 8;
1471 rbuf[7] = tmp;
1472
1473 } else {
1474 /* sector count, 64-bit */
Philip Pokorny0c144d02005-05-28 01:24:47 -07001475 tmp = n_sectors >> (8 * 4);
1476 rbuf[2] = tmp >> (8 * 3);
1477 rbuf[3] = tmp >> (8 * 2);
1478 rbuf[4] = tmp >> (8 * 1);
1479 rbuf[5] = tmp;
1480 tmp = n_sectors;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001481 rbuf[6] = tmp >> (8 * 3);
1482 rbuf[7] = tmp >> (8 * 2);
1483 rbuf[8] = tmp >> (8 * 1);
1484 rbuf[9] = tmp;
1485
1486 /* sector size */
1487 tmp = ATA_SECT_SIZE;
1488 rbuf[12] = tmp >> 8;
1489 rbuf[13] = tmp;
1490 }
1491
1492 return 0;
1493}
1494
1495/**
1496 * ata_scsiop_report_luns - Simulate REPORT LUNS command
1497 * @args: device IDENTIFY data / SCSI command of interest.
1498 * @rbuf: Response buffer, to which simulated SCSI cmd output is sent.
1499 * @buflen: Response buffer length.
1500 *
1501 * Simulate REPORT LUNS command.
1502 *
1503 * LOCKING:
1504 * spin_lock_irqsave(host_set lock)
1505 */
1506
1507unsigned int ata_scsiop_report_luns(struct ata_scsi_args *args, u8 *rbuf,
1508 unsigned int buflen)
1509{
1510 VPRINTK("ENTER\n");
1511 rbuf[3] = 8; /* just one lun, LUN 0, size 8 bytes */
1512
1513 return 0;
1514}
1515
1516/**
Douglas Gilbert845c5832005-10-09 08:55:41 -04001517 * ata_scsi_set_sense - Set SCSI sense data and status
1518 * @cmd: SCSI request to be handled
1519 * @sk: SCSI-defined sense key
1520 * @asc: SCSI-defined additional sense code
1521 * @ascq: SCSI-defined additional sense code qualifier
1522 *
1523 * Helper function that builds a valid fixed format, current
1524 * response code and the given sense key (sk), additional sense
1525 * code (asc) and additional sense code qualifier (ascq) with
1526 * a SCSI command status of %SAM_STAT_CHECK_CONDITION and
1527 * DRIVER_SENSE set in the upper bits of scsi_cmnd::result .
1528 *
1529 * LOCKING:
1530 * Not required
1531 */
1532
1533void ata_scsi_set_sense(struct scsi_cmnd *cmd, u8 sk, u8 asc, u8 ascq)
1534{
1535 cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION;
1536
1537 cmd->sense_buffer[0] = 0x70; /* fixed format, current */
1538 cmd->sense_buffer[2] = sk;
1539 cmd->sense_buffer[7] = 18 - 8; /* additional sense length */
1540 cmd->sense_buffer[12] = asc;
1541 cmd->sense_buffer[13] = ascq;
1542}
1543
1544/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545 * ata_scsi_badcmd - End a SCSI request with an error
1546 * @cmd: SCSI request to be handled
1547 * @done: SCSI command completion function
1548 * @asc: SCSI-defined additional sense code
1549 * @ascq: SCSI-defined additional sense code qualifier
1550 *
1551 * Helper function that completes a SCSI command with
1552 * %SAM_STAT_CHECK_CONDITION, with a sense key %ILLEGAL_REQUEST
1553 * and the specified additional sense codes.
1554 *
1555 * LOCKING:
1556 * spin_lock_irqsave(host_set lock)
1557 */
1558
1559void ata_scsi_badcmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *), u8 asc, u8 ascq)
1560{
1561 DPRINTK("ENTER\n");
Douglas Gilbertae006512005-10-09 09:09:35 -04001562 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, asc, ascq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001563
1564 done(cmd);
1565}
1566
Jeff Garzika939c962005-10-05 17:09:16 -04001567void atapi_request_sense(struct ata_port *ap, struct ata_device *dev,
1568 struct scsi_cmnd *cmd)
1569{
1570 DECLARE_COMPLETION(wait);
1571 struct ata_queued_cmd *qc;
1572 unsigned long flags;
1573 int rc;
1574
1575 DPRINTK("ATAPI request sense\n");
1576
1577 qc = ata_qc_new_init(ap, dev);
1578 BUG_ON(qc == NULL);
1579
1580 /* FIXME: is this needed? */
1581 memset(cmd->sense_buffer, 0, sizeof(cmd->sense_buffer));
1582
1583 ata_sg_init_one(qc, cmd->sense_buffer, sizeof(cmd->sense_buffer));
1584 qc->dma_dir = DMA_FROM_DEVICE;
1585
1586 memset(&qc->cdb, 0, ap->cdb_len);
1587 qc->cdb[0] = REQUEST_SENSE;
1588 qc->cdb[4] = SCSI_SENSE_BUFFERSIZE;
1589
1590 qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1591 qc->tf.command = ATA_CMD_PACKET;
1592
1593 qc->tf.protocol = ATA_PROT_ATAPI;
1594 qc->tf.lbam = (8 * 1024) & 0xff;
1595 qc->tf.lbah = (8 * 1024) >> 8;
1596 qc->nbytes = SCSI_SENSE_BUFFERSIZE;
1597
1598 qc->waiting = &wait;
1599 qc->complete_fn = ata_qc_complete_noop;
1600
1601 spin_lock_irqsave(&ap->host_set->lock, flags);
1602 rc = ata_qc_issue(qc);
1603 spin_unlock_irqrestore(&ap->host_set->lock, flags);
1604
1605 if (rc)
1606 ata_port_disable(ap);
1607 else
1608 wait_for_completion(&wait);
1609
1610 DPRINTK("EXIT\n");
1611}
1612
Linus Torvalds1da177e2005-04-16 15:20:36 -07001613static int atapi_qc_complete(struct ata_queued_cmd *qc, u8 drv_stat)
1614{
1615 struct scsi_cmnd *cmd = qc->scsicmd;
1616
Jeff Garzike12669e2005-10-05 18:39:23 -04001617 VPRINTK("ENTER, drv_stat == 0x%x\n", drv_stat);
1618
Jeff Garzika15dbeb2005-10-05 15:02:14 -04001619 if (unlikely(drv_stat & (ATA_BUSY | ATA_DRQ)))
1620 ata_to_sense_error(qc, drv_stat);
Jeff Garzike12669e2005-10-05 18:39:23 -04001621
Jeff Garzika15dbeb2005-10-05 15:02:14 -04001622 else if (unlikely(drv_stat & ATA_ERR)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001623 DPRINTK("request check condition\n");
1624
Jeff Garzika15dbeb2005-10-05 15:02:14 -04001625 /* FIXME: command completion with check condition
1626 * but no sense causes the error handler to run,
1627 * which then issues REQUEST SENSE, fills in the sense
1628 * buffer, and completes the command (for the second
1629 * time). We need to issue REQUEST SENSE some other
1630 * way, to avoid completing the command twice.
1631 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632 cmd->result = SAM_STAT_CHECK_CONDITION;
1633
1634 qc->scsidone(cmd);
1635
1636 return 1;
Jeff Garzike12669e2005-10-05 18:39:23 -04001637 }
1638
1639 else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640 u8 *scsicmd = cmd->cmnd;
1641
1642 if (scsicmd[0] == INQUIRY) {
1643 u8 *buf = NULL;
1644 unsigned int buflen;
1645
1646 buflen = ata_scsi_rbuf_get(cmd, &buf);
Jeff Garzika15dbeb2005-10-05 15:02:14 -04001647
1648 /* ATAPI devices typically report zero for their SCSI version,
1649 * and sometimes deviate from the spec WRT response data
1650 * format. If SCSI version is reported as zero like normal,
1651 * then we make the following fixups: 1) Fake MMC-5 version,
1652 * to indicate to the Linux scsi midlayer this is a modern
1653 * device. 2) Ensure response data format / ATAPI information
1654 * are always correct.
1655 */
1656 /* FIXME: do we ever override EVPD pages and the like, with
1657 * this code?
1658 */
1659 if (buf[2] == 0) {
1660 buf[2] = 0x5;
1661 buf[3] = 0x32;
1662 }
1663
Linus Torvalds1da177e2005-04-16 15:20:36 -07001664 ata_scsi_rbuf_put(cmd, buf);
1665 }
Jeff Garzika15dbeb2005-10-05 15:02:14 -04001666
Linus Torvalds1da177e2005-04-16 15:20:36 -07001667 cmd->result = SAM_STAT_GOOD;
1668 }
1669
1670 qc->scsidone(cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001671 return 0;
1672}
1673/**
1674 * atapi_xlat - Initialize PACKET taskfile
1675 * @qc: command structure to be initialized
1676 * @scsicmd: SCSI CDB associated with this PACKET command
1677 *
1678 * LOCKING:
1679 * spin_lock_irqsave(host_set lock)
1680 *
1681 * RETURNS:
1682 * Zero on success, non-zero on failure.
1683 */
1684
1685static unsigned int atapi_xlat(struct ata_queued_cmd *qc, u8 *scsicmd)
1686{
1687 struct scsi_cmnd *cmd = qc->scsicmd;
1688 struct ata_device *dev = qc->dev;
1689 int using_pio = (dev->flags & ATA_DFLAG_PIO);
be7db052005-04-17 15:26:13 -05001690 int nodata = (cmd->sc_data_direction == DMA_NONE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001691
1692 if (!using_pio)
1693 /* Check whether ATAPI DMA is safe */
1694 if (ata_check_atapi_dma(qc))
1695 using_pio = 1;
1696
1697 memcpy(&qc->cdb, scsicmd, qc->ap->cdb_len);
1698
1699 qc->complete_fn = atapi_qc_complete;
1700
1701 qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
be7db052005-04-17 15:26:13 -05001702 if (cmd->sc_data_direction == DMA_TO_DEVICE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001703 qc->tf.flags |= ATA_TFLAG_WRITE;
1704 DPRINTK("direction: write\n");
1705 }
1706
1707 qc->tf.command = ATA_CMD_PACKET;
1708
1709 /* no data, or PIO data xfer */
1710 if (using_pio || nodata) {
1711 if (nodata)
1712 qc->tf.protocol = ATA_PROT_ATAPI_NODATA;
1713 else
1714 qc->tf.protocol = ATA_PROT_ATAPI;
1715 qc->tf.lbam = (8 * 1024) & 0xff;
1716 qc->tf.lbah = (8 * 1024) >> 8;
1717 }
1718
1719 /* DMA data xfer */
1720 else {
1721 qc->tf.protocol = ATA_PROT_ATAPI_DMA;
1722 qc->tf.feature |= ATAPI_PKT_DMA;
1723
1724#ifdef ATAPI_ENABLE_DMADIR
1725 /* some SATA bridges need us to indicate data xfer direction */
be7db052005-04-17 15:26:13 -05001726 if (cmd->sc_data_direction != DMA_TO_DEVICE)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001727 qc->tf.feature |= ATAPI_DMADIR;
1728#endif
1729 }
1730
1731 qc->nbytes = cmd->bufflen;
1732
1733 return 0;
1734}
1735
1736/**
1737 * ata_scsi_find_dev - lookup ata_device from scsi_cmnd
1738 * @ap: ATA port to which the device is attached
1739 * @scsidev: SCSI device from which we derive the ATA device
1740 *
1741 * Given various information provided in struct scsi_cmnd,
1742 * map that onto an ATA bus, and using that mapping
1743 * determine which ata_device is associated with the
1744 * SCSI command to be sent.
1745 *
1746 * LOCKING:
1747 * spin_lock_irqsave(host_set lock)
1748 *
1749 * RETURNS:
1750 * Associated ATA device, or %NULL if not found.
1751 */
1752
1753static struct ata_device *
1754ata_scsi_find_dev(struct ata_port *ap, struct scsi_device *scsidev)
1755{
1756 struct ata_device *dev;
1757
1758 /* skip commands not addressed to targets we simulate */
1759 if (likely(scsidev->id < ATA_MAX_DEVICES))
1760 dev = &ap->device[scsidev->id];
1761 else
1762 return NULL;
1763
1764 if (unlikely((scsidev->channel != 0) ||
1765 (scsidev->lun != 0)))
1766 return NULL;
1767
1768 if (unlikely(!ata_dev_present(dev)))
1769 return NULL;
1770
Jeff Garzik6f106232005-08-30 21:52:18 -04001771 if (!atapi_enabled) {
Jeff Garzik1623c812005-08-30 03:37:42 -04001772 if (unlikely(dev->class == ATA_DEV_ATAPI))
1773 return NULL;
1774 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775
1776 return dev;
1777}
1778
1779/**
1780 * ata_get_xlat_func - check if SCSI to ATA translation is possible
1781 * @dev: ATA device
1782 * @cmd: SCSI command opcode to consider
1783 *
1784 * Look up the SCSI command given, and determine whether the
1785 * SCSI command is to be translated or simulated.
1786 *
1787 * RETURNS:
1788 * Pointer to translation function if possible, %NULL if not.
1789 */
1790
1791static inline ata_xlat_func_t ata_get_xlat_func(struct ata_device *dev, u8 cmd)
1792{
1793 switch (cmd) {
1794 case READ_6:
1795 case READ_10:
1796 case READ_16:
1797
1798 case WRITE_6:
1799 case WRITE_10:
1800 case WRITE_16:
1801 return ata_scsi_rw_xlat;
1802
1803 case SYNCHRONIZE_CACHE:
1804 if (ata_try_flush_cache(dev))
1805 return ata_scsi_flush_xlat;
1806 break;
1807
1808 case VERIFY:
1809 case VERIFY_16:
1810 return ata_scsi_verify_xlat;
Douglas Gilbert972dcaf2005-08-11 03:35:53 -04001811 case START_STOP:
1812 return ata_scsi_start_stop_xlat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001813 }
1814
1815 return NULL;
1816}
1817
1818/**
1819 * ata_scsi_dump_cdb - dump SCSI command contents to dmesg
1820 * @ap: ATA port to which the command was being sent
1821 * @cmd: SCSI command to dump
1822 *
1823 * Prints the contents of a SCSI command via printk().
1824 */
1825
1826static inline void ata_scsi_dump_cdb(struct ata_port *ap,
1827 struct scsi_cmnd *cmd)
1828{
1829#ifdef ATA_DEBUG
1830 struct scsi_device *scsidev = cmd->device;
1831 u8 *scsicmd = cmd->cmnd;
1832
1833 DPRINTK("CDB (%u:%d,%d,%d) %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
1834 ap->id,
1835 scsidev->channel, scsidev->id, scsidev->lun,
1836 scsicmd[0], scsicmd[1], scsicmd[2], scsicmd[3],
1837 scsicmd[4], scsicmd[5], scsicmd[6], scsicmd[7],
1838 scsicmd[8]);
1839#endif
1840}
1841
1842/**
1843 * ata_scsi_queuecmd - Issue SCSI cdb to libata-managed device
1844 * @cmd: SCSI command to be sent
1845 * @done: Completion function, called when command is complete
1846 *
1847 * In some cases, this function translates SCSI commands into
1848 * ATA taskfiles, and queues the taskfiles to be sent to
1849 * hardware. In other cases, this function simulates a
1850 * SCSI device by evaluating and responding to certain
1851 * SCSI commands. This creates the overall effect of
1852 * ATA and ATAPI devices appearing as SCSI devices.
1853 *
1854 * LOCKING:
1855 * Releases scsi-layer-held lock, and obtains host_set lock.
1856 *
1857 * RETURNS:
1858 * Zero.
1859 */
1860
1861int ata_scsi_queuecmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *))
1862{
1863 struct ata_port *ap;
1864 struct ata_device *dev;
1865 struct scsi_device *scsidev = cmd->device;
1866
1867 ap = (struct ata_port *) &scsidev->host->hostdata[0];
1868
1869 ata_scsi_dump_cdb(ap, cmd);
1870
1871 dev = ata_scsi_find_dev(ap, scsidev);
1872 if (unlikely(!dev)) {
1873 cmd->result = (DID_BAD_TARGET << 16);
1874 done(cmd);
1875 goto out_unlock;
1876 }
1877
1878 if (dev->class == ATA_DEV_ATA) {
1879 ata_xlat_func_t xlat_func = ata_get_xlat_func(dev,
1880 cmd->cmnd[0]);
1881
1882 if (xlat_func)
1883 ata_scsi_translate(ap, dev, cmd, done, xlat_func);
1884 else
1885 ata_scsi_simulate(dev->id, cmd, done);
1886 } else
1887 ata_scsi_translate(ap, dev, cmd, done, atapi_xlat);
1888
1889out_unlock:
1890 return 0;
1891}
1892
1893/**
1894 * ata_scsi_simulate - simulate SCSI command on ATA device
1895 * @id: current IDENTIFY data for target device.
1896 * @cmd: SCSI command being sent to device.
1897 * @done: SCSI command completion function.
1898 *
1899 * Interprets and directly executes a select list of SCSI commands
1900 * that can be handled internally.
1901 *
1902 * LOCKING:
1903 * spin_lock_irqsave(host_set lock)
1904 */
1905
1906void ata_scsi_simulate(u16 *id,
1907 struct scsi_cmnd *cmd,
1908 void (*done)(struct scsi_cmnd *))
1909{
1910 struct ata_scsi_args args;
1911 u8 *scsicmd = cmd->cmnd;
1912
1913 args.id = id;
1914 args.cmd = cmd;
1915 args.done = done;
1916
1917 switch(scsicmd[0]) {
1918 /* no-op's, complete with success */
1919 case SYNCHRONIZE_CACHE:
1920 case REZERO_UNIT:
1921 case SEEK_6:
1922 case SEEK_10:
1923 case TEST_UNIT_READY:
1924 case FORMAT_UNIT: /* FIXME: correct? */
1925 case SEND_DIAGNOSTIC: /* FIXME: correct? */
1926 ata_scsi_rbuf_fill(&args, ata_scsiop_noop);
1927 break;
1928
1929 case INQUIRY:
1930 if (scsicmd[1] & 2) /* is CmdDt set? */
Douglas Gilbertae006512005-10-09 09:09:35 -04001931 ata_scsi_invalid_field(cmd, done);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001932 else if ((scsicmd[1] & 1) == 0) /* is EVPD clear? */
1933 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_std);
1934 else if (scsicmd[2] == 0x00)
1935 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_00);
1936 else if (scsicmd[2] == 0x80)
1937 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_80);
1938 else if (scsicmd[2] == 0x83)
1939 ata_scsi_rbuf_fill(&args, ata_scsiop_inq_83);
1940 else
Douglas Gilbertae006512005-10-09 09:09:35 -04001941 ata_scsi_invalid_field(cmd, done);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001942 break;
1943
1944 case MODE_SENSE:
1945 case MODE_SENSE_10:
1946 ata_scsi_rbuf_fill(&args, ata_scsiop_mode_sense);
1947 break;
1948
1949 case MODE_SELECT: /* unconditionally return */
1950 case MODE_SELECT_10: /* bad-field-in-cdb */
Douglas Gilbertae006512005-10-09 09:09:35 -04001951 ata_scsi_invalid_field(cmd, done);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001952 break;
1953
1954 case READ_CAPACITY:
1955 ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
1956 break;
1957
1958 case SERVICE_ACTION_IN:
1959 if ((scsicmd[1] & 0x1f) == SAI_READ_CAPACITY_16)
1960 ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap);
1961 else
Douglas Gilbertae006512005-10-09 09:09:35 -04001962 ata_scsi_invalid_field(cmd, done);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001963 break;
1964
1965 case REPORT_LUNS:
1966 ata_scsi_rbuf_fill(&args, ata_scsiop_report_luns);
1967 break;
1968
1969 /* mandantory commands we haven't implemented yet */
1970 case REQUEST_SENSE:
1971
1972 /* all other commands */
1973 default:
Douglas Gilbertae006512005-10-09 09:09:35 -04001974 ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x20, 0x0);
1975 /* "Invalid command operation code" */
1976 done(cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001977 break;
1978 }
1979}
1980
Jeff Garzik644dd0c2005-10-03 15:55:19 -04001981void ata_scsi_scan_host(struct ata_port *ap)
1982{
Jeff Garzik3f19ee82005-10-03 21:36:41 -04001983 struct ata_device *dev;
Jeff Garzik644dd0c2005-10-03 15:55:19 -04001984 unsigned int i;
1985
1986 if (ap->flags & ATA_FLAG_PORT_DISABLED)
1987 return;
1988
Jeff Garzik3f19ee82005-10-03 21:36:41 -04001989 for (i = 0; i < ATA_MAX_DEVICES; i++) {
1990 dev = &ap->device[i];
1991
1992 if (ata_dev_present(dev))
1993 scsi_scan_target(&ap->host->shost_gendev, 0, i, 0, 0);
1994 }
Jeff Garzik644dd0c2005-10-03 15:55:19 -04001995}
1996