blob: 7214530ac161ff0eec95fb7631a9307b738ce359 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Jeff Garzikaf36d7f2005-08-28 20:18:39 -04002 * libata-core.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 http://www.t13.org/ and
31 * http://www.sata-io.org/
32 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070033 */
34
35#include <linux/config.h>
36#include <linux/kernel.h>
37#include <linux/module.h>
38#include <linux/pci.h>
39#include <linux/init.h>
40#include <linux/list.h>
41#include <linux/mm.h>
42#include <linux/highmem.h>
43#include <linux/spinlock.h>
44#include <linux/blkdev.h>
45#include <linux/delay.h>
46#include <linux/timer.h>
47#include <linux/interrupt.h>
48#include <linux/completion.h>
49#include <linux/suspend.h>
50#include <linux/workqueue.h>
Jeff Garzik67846b32005-10-05 02:58:32 -040051#include <linux/jiffies.h>
David Hardeman378f0582005-09-17 17:55:31 +100052#include <linux/scatterlist.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070053#include <scsi/scsi.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070054#include "scsi_priv.h"
Jeff Garzik193515d2005-11-07 00:59:37 -050055#include <scsi/scsi_cmnd.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070056#include <scsi/scsi_host.h>
57#include <linux/libata.h>
58#include <asm/io.h>
59#include <asm/semaphore.h>
60#include <asm/byteorder.h>
61
62#include "libata.h"
63
Tejun Heo6aff8f12006-02-15 18:24:09 +090064static unsigned int ata_dev_init_params(struct ata_port *ap,
65 struct ata_device *dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070066static void ata_set_mode(struct ata_port *ap);
Tejun Heo83206a22006-03-24 15:25:31 +090067static unsigned int ata_dev_set_xfermode(struct ata_port *ap,
68 struct ata_device *dev);
Tejun Heoacf356b2006-03-24 14:07:50 +090069static void ata_dev_xfermask(struct ata_port *ap, struct ata_device *dev);
Jeff Garzike33b9df2005-10-09 09:51:46 -040070static void ata_pio_error(struct ata_port *ap);
Linus Torvalds1da177e2005-04-16 15:20:36 -070071
72static unsigned int ata_unique_id = 1;
73static struct workqueue_struct *ata_wq;
74
Jeff Garzik418dc1f2006-03-11 20:50:08 -050075int atapi_enabled = 1;
Jeff Garzik1623c812005-08-30 03:37:42 -040076module_param(atapi_enabled, int, 0444);
77MODULE_PARM_DESC(atapi_enabled, "Enable discovery of ATAPI devices (0=off, 1=on)");
78
Jeff Garzikc3c013a2006-02-27 22:31:19 -050079int libata_fua = 0;
80module_param_named(fua, libata_fua, int, 0444);
81MODULE_PARM_DESC(fua, "FUA support (0=off, 1=on)");
82
Linus Torvalds1da177e2005-04-16 15:20:36 -070083MODULE_AUTHOR("Jeff Garzik");
84MODULE_DESCRIPTION("Library module for ATA devices");
85MODULE_LICENSE("GPL");
86MODULE_VERSION(DRV_VERSION);
87
Edward Falk0baab862005-06-02 18:17:13 -040088
89/**
Linus Torvalds1da177e2005-04-16 15:20:36 -070090 * ata_tf_to_fis - Convert ATA taskfile to SATA FIS structure
91 * @tf: Taskfile to convert
92 * @fis: Buffer into which data will output
93 * @pmp: Port multiplier port
94 *
95 * Converts a standard ATA taskfile to a Serial ATA
96 * FIS structure (Register - Host to Device).
97 *
98 * LOCKING:
99 * Inherited from caller.
100 */
101
Jeff Garzik057ace52005-10-22 14:27:05 -0400102void ata_tf_to_fis(const struct ata_taskfile *tf, u8 *fis, u8 pmp)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103{
104 fis[0] = 0x27; /* Register - Host to Device FIS */
105 fis[1] = (pmp & 0xf) | (1 << 7); /* Port multiplier number,
106 bit 7 indicates Command FIS */
107 fis[2] = tf->command;
108 fis[3] = tf->feature;
109
110 fis[4] = tf->lbal;
111 fis[5] = tf->lbam;
112 fis[6] = tf->lbah;
113 fis[7] = tf->device;
114
115 fis[8] = tf->hob_lbal;
116 fis[9] = tf->hob_lbam;
117 fis[10] = tf->hob_lbah;
118 fis[11] = tf->hob_feature;
119
120 fis[12] = tf->nsect;
121 fis[13] = tf->hob_nsect;
122 fis[14] = 0;
123 fis[15] = tf->ctl;
124
125 fis[16] = 0;
126 fis[17] = 0;
127 fis[18] = 0;
128 fis[19] = 0;
129}
130
131/**
132 * ata_tf_from_fis - Convert SATA FIS to ATA taskfile
133 * @fis: Buffer from which data will be input
134 * @tf: Taskfile to output
135 *
Mark Lorde12a1be2005-11-12 18:55:45 -0500136 * Converts a serial ATA FIS structure to a standard ATA taskfile.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 *
138 * LOCKING:
139 * Inherited from caller.
140 */
141
Jeff Garzik057ace52005-10-22 14:27:05 -0400142void ata_tf_from_fis(const u8 *fis, struct ata_taskfile *tf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143{
144 tf->command = fis[2]; /* status */
145 tf->feature = fis[3]; /* error */
146
147 tf->lbal = fis[4];
148 tf->lbam = fis[5];
149 tf->lbah = fis[6];
150 tf->device = fis[7];
151
152 tf->hob_lbal = fis[8];
153 tf->hob_lbam = fis[9];
154 tf->hob_lbah = fis[10];
155
156 tf->nsect = fis[12];
157 tf->hob_nsect = fis[13];
158}
159
Albert Lee8cbd6df2005-10-12 15:06:27 +0800160static const u8 ata_rw_cmds[] = {
161 /* pio multi */
162 ATA_CMD_READ_MULTI,
163 ATA_CMD_WRITE_MULTI,
164 ATA_CMD_READ_MULTI_EXT,
165 ATA_CMD_WRITE_MULTI_EXT,
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100166 0,
167 0,
168 0,
169 ATA_CMD_WRITE_MULTI_FUA_EXT,
Albert Lee8cbd6df2005-10-12 15:06:27 +0800170 /* pio */
171 ATA_CMD_PIO_READ,
172 ATA_CMD_PIO_WRITE,
173 ATA_CMD_PIO_READ_EXT,
174 ATA_CMD_PIO_WRITE_EXT,
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100175 0,
176 0,
177 0,
178 0,
Albert Lee8cbd6df2005-10-12 15:06:27 +0800179 /* dma */
180 ATA_CMD_READ,
181 ATA_CMD_WRITE,
182 ATA_CMD_READ_EXT,
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100183 ATA_CMD_WRITE_EXT,
184 0,
185 0,
186 0,
187 ATA_CMD_WRITE_FUA_EXT
Albert Lee8cbd6df2005-10-12 15:06:27 +0800188};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189
190/**
Albert Lee8cbd6df2005-10-12 15:06:27 +0800191 * ata_rwcmd_protocol - set taskfile r/w commands and protocol
192 * @qc: command to examine and configure
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193 *
Jeff Garzik2e9edbf2006-03-24 09:56:57 -0500194 * Examine the device configuration and tf->flags to calculate
Albert Lee8cbd6df2005-10-12 15:06:27 +0800195 * the proper read/write commands and protocol to use.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 *
197 * LOCKING:
198 * caller.
199 */
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100200int ata_rwcmd_protocol(struct ata_queued_cmd *qc)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201{
Albert Lee8cbd6df2005-10-12 15:06:27 +0800202 struct ata_taskfile *tf = &qc->tf;
203 struct ata_device *dev = qc->dev;
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100204 u8 cmd;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700205
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100206 int index, fua, lba48, write;
Jeff Garzik2e9edbf2006-03-24 09:56:57 -0500207
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100208 fua = (tf->flags & ATA_TFLAG_FUA) ? 4 : 0;
Albert Lee8cbd6df2005-10-12 15:06:27 +0800209 lba48 = (tf->flags & ATA_TFLAG_LBA48) ? 2 : 0;
210 write = (tf->flags & ATA_TFLAG_WRITE) ? 1 : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211
Albert Lee8cbd6df2005-10-12 15:06:27 +0800212 if (dev->flags & ATA_DFLAG_PIO) {
213 tf->protocol = ATA_PROT_PIO;
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100214 index = dev->multi_count ? 0 : 8;
Alan Cox8d238e02006-01-17 20:50:31 +0000215 } else if (lba48 && (qc->ap->flags & ATA_FLAG_PIO_LBA48)) {
216 /* Unable to use DMA due to host limitation */
217 tf->protocol = ATA_PROT_PIO;
Albert Leeaef9d532006-02-08 16:37:43 +0800218 index = dev->multi_count ? 0 : 8;
Albert Lee8cbd6df2005-10-12 15:06:27 +0800219 } else {
220 tf->protocol = ATA_PROT_DMA;
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100221 index = 16;
Albert Lee8cbd6df2005-10-12 15:06:27 +0800222 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223
Tejun Heo9a3dccc2006-01-06 09:56:18 +0100224 cmd = ata_rw_cmds[index + fua + lba48 + write];
225 if (cmd) {
226 tf->command = cmd;
227 return 0;
228 }
229 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230}
231
Tejun Heocb95d562006-03-06 04:31:56 +0900232/**
233 * ata_pack_xfermask - Pack pio, mwdma and udma masks into xfer_mask
234 * @pio_mask: pio_mask
235 * @mwdma_mask: mwdma_mask
236 * @udma_mask: udma_mask
237 *
238 * Pack @pio_mask, @mwdma_mask and @udma_mask into a single
239 * unsigned int xfer_mask.
240 *
241 * LOCKING:
242 * None.
243 *
244 * RETURNS:
245 * Packed xfer_mask.
246 */
247static unsigned int ata_pack_xfermask(unsigned int pio_mask,
248 unsigned int mwdma_mask,
249 unsigned int udma_mask)
250{
251 return ((pio_mask << ATA_SHIFT_PIO) & ATA_MASK_PIO) |
252 ((mwdma_mask << ATA_SHIFT_MWDMA) & ATA_MASK_MWDMA) |
253 ((udma_mask << ATA_SHIFT_UDMA) & ATA_MASK_UDMA);
254}
255
Tejun Heoc0489e42006-03-24 14:07:49 +0900256/**
257 * ata_unpack_xfermask - Unpack xfer_mask into pio, mwdma and udma masks
258 * @xfer_mask: xfer_mask to unpack
259 * @pio_mask: resulting pio_mask
260 * @mwdma_mask: resulting mwdma_mask
261 * @udma_mask: resulting udma_mask
262 *
263 * Unpack @xfer_mask into @pio_mask, @mwdma_mask and @udma_mask.
264 * Any NULL distination masks will be ignored.
265 */
266static void ata_unpack_xfermask(unsigned int xfer_mask,
267 unsigned int *pio_mask,
268 unsigned int *mwdma_mask,
269 unsigned int *udma_mask)
270{
271 if (pio_mask)
272 *pio_mask = (xfer_mask & ATA_MASK_PIO) >> ATA_SHIFT_PIO;
273 if (mwdma_mask)
274 *mwdma_mask = (xfer_mask & ATA_MASK_MWDMA) >> ATA_SHIFT_MWDMA;
275 if (udma_mask)
276 *udma_mask = (xfer_mask & ATA_MASK_UDMA) >> ATA_SHIFT_UDMA;
277}
278
Tejun Heocb95d562006-03-06 04:31:56 +0900279static const struct ata_xfer_ent {
280 unsigned int shift, bits;
281 u8 base;
282} ata_xfer_tbl[] = {
283 { ATA_SHIFT_PIO, ATA_BITS_PIO, XFER_PIO_0 },
284 { ATA_SHIFT_MWDMA, ATA_BITS_MWDMA, XFER_MW_DMA_0 },
285 { ATA_SHIFT_UDMA, ATA_BITS_UDMA, XFER_UDMA_0 },
286 { -1, },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287};
288
289/**
Tejun Heocb95d562006-03-06 04:31:56 +0900290 * ata_xfer_mask2mode - Find matching XFER_* for the given xfer_mask
291 * @xfer_mask: xfer_mask of interest
292 *
293 * Return matching XFER_* value for @xfer_mask. Only the highest
294 * bit of @xfer_mask is considered.
295 *
296 * LOCKING:
297 * None.
298 *
299 * RETURNS:
300 * Matching XFER_* value, 0 if no match found.
301 */
302static u8 ata_xfer_mask2mode(unsigned int xfer_mask)
303{
304 int highbit = fls(xfer_mask) - 1;
305 const struct ata_xfer_ent *ent;
306
307 for (ent = ata_xfer_tbl; ent->shift >= 0; ent++)
308 if (highbit >= ent->shift && highbit < ent->shift + ent->bits)
309 return ent->base + highbit - ent->shift;
310 return 0;
311}
312
313/**
314 * ata_xfer_mode2mask - Find matching xfer_mask for XFER_*
315 * @xfer_mode: XFER_* of interest
316 *
317 * Return matching xfer_mask for @xfer_mode.
318 *
319 * LOCKING:
320 * None.
321 *
322 * RETURNS:
323 * Matching xfer_mask, 0 if no match found.
324 */
325static unsigned int ata_xfer_mode2mask(u8 xfer_mode)
326{
327 const struct ata_xfer_ent *ent;
328
329 for (ent = ata_xfer_tbl; ent->shift >= 0; ent++)
330 if (xfer_mode >= ent->base && xfer_mode < ent->base + ent->bits)
331 return 1 << (ent->shift + xfer_mode - ent->base);
332 return 0;
333}
334
335/**
336 * ata_xfer_mode2shift - Find matching xfer_shift for XFER_*
337 * @xfer_mode: XFER_* of interest
338 *
339 * Return matching xfer_shift for @xfer_mode.
340 *
341 * LOCKING:
342 * None.
343 *
344 * RETURNS:
345 * Matching xfer_shift, -1 if no match found.
346 */
347static int ata_xfer_mode2shift(unsigned int xfer_mode)
348{
349 const struct ata_xfer_ent *ent;
350
351 for (ent = ata_xfer_tbl; ent->shift >= 0; ent++)
352 if (xfer_mode >= ent->base && xfer_mode < ent->base + ent->bits)
353 return ent->shift;
354 return -1;
355}
356
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357/**
Tejun Heo1da7b0d2006-03-06 04:31:56 +0900358 * ata_mode_string - convert xfer_mask to string
359 * @xfer_mask: mask of bits supported; only highest bit counts.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 *
361 * Determine string which represents the highest speed
Tejun Heo1da7b0d2006-03-06 04:31:56 +0900362 * (highest bit in @modemask).
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 *
364 * LOCKING:
365 * None.
366 *
367 * RETURNS:
368 * Constant C string representing highest speed listed in
Tejun Heo1da7b0d2006-03-06 04:31:56 +0900369 * @mode_mask, or the constant C string "<n/a>".
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370 */
Tejun Heo1da7b0d2006-03-06 04:31:56 +0900371static const char *ata_mode_string(unsigned int xfer_mask)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372{
Tejun Heo75f554b2006-03-06 04:31:57 +0900373 static const char * const xfer_mode_str[] = {
374 "PIO0",
375 "PIO1",
376 "PIO2",
377 "PIO3",
378 "PIO4",
379 "MWDMA0",
380 "MWDMA1",
381 "MWDMA2",
382 "UDMA/16",
383 "UDMA/25",
384 "UDMA/33",
385 "UDMA/44",
386 "UDMA/66",
387 "UDMA/100",
388 "UDMA/133",
389 "UDMA7",
390 };
Tejun Heo1da7b0d2006-03-06 04:31:56 +0900391 int highbit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392
Tejun Heo1da7b0d2006-03-06 04:31:56 +0900393 highbit = fls(xfer_mask) - 1;
394 if (highbit >= 0 && highbit < ARRAY_SIZE(xfer_mode_str))
395 return xfer_mode_str[highbit];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396 return "<n/a>";
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397}
398
Tejun Heo0b8efb02006-03-24 15:25:31 +0900399static void ata_dev_disable(struct ata_port *ap, struct ata_device *dev)
400{
401 if (ata_dev_present(dev)) {
402 printk(KERN_WARNING "ata%u: dev %u disabled\n",
403 ap->id, dev->devno);
404 dev->class++;
405 }
406}
407
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408/**
409 * ata_pio_devchk - PATA device presence detection
410 * @ap: ATA channel to examine
411 * @device: Device to examine (starting at zero)
412 *
413 * This technique was originally described in
414 * Hale Landis's ATADRVR (www.ata-atapi.com), and
415 * later found its way into the ATA/ATAPI spec.
416 *
417 * Write a pattern to the ATA shadow registers,
418 * and if a device is present, it will respond by
419 * correctly storing and echoing back the
420 * ATA shadow register contents.
421 *
422 * LOCKING:
423 * caller.
424 */
425
426static unsigned int ata_pio_devchk(struct ata_port *ap,
427 unsigned int device)
428{
429 struct ata_ioports *ioaddr = &ap->ioaddr;
430 u8 nsect, lbal;
431
432 ap->ops->dev_select(ap, device);
433
434 outb(0x55, ioaddr->nsect_addr);
435 outb(0xaa, ioaddr->lbal_addr);
436
437 outb(0xaa, ioaddr->nsect_addr);
438 outb(0x55, ioaddr->lbal_addr);
439
440 outb(0x55, ioaddr->nsect_addr);
441 outb(0xaa, ioaddr->lbal_addr);
442
443 nsect = inb(ioaddr->nsect_addr);
444 lbal = inb(ioaddr->lbal_addr);
445
446 if ((nsect == 0x55) && (lbal == 0xaa))
447 return 1; /* we found a device */
448
449 return 0; /* nothing found */
450}
451
452/**
453 * ata_mmio_devchk - PATA device presence detection
454 * @ap: ATA channel to examine
455 * @device: Device to examine (starting at zero)
456 *
457 * This technique was originally described in
458 * Hale Landis's ATADRVR (www.ata-atapi.com), and
459 * later found its way into the ATA/ATAPI spec.
460 *
461 * Write a pattern to the ATA shadow registers,
462 * and if a device is present, it will respond by
463 * correctly storing and echoing back the
464 * ATA shadow register contents.
465 *
466 * LOCKING:
467 * caller.
468 */
469
470static unsigned int ata_mmio_devchk(struct ata_port *ap,
471 unsigned int device)
472{
473 struct ata_ioports *ioaddr = &ap->ioaddr;
474 u8 nsect, lbal;
475
476 ap->ops->dev_select(ap, device);
477
478 writeb(0x55, (void __iomem *) ioaddr->nsect_addr);
479 writeb(0xaa, (void __iomem *) ioaddr->lbal_addr);
480
481 writeb(0xaa, (void __iomem *) ioaddr->nsect_addr);
482 writeb(0x55, (void __iomem *) ioaddr->lbal_addr);
483
484 writeb(0x55, (void __iomem *) ioaddr->nsect_addr);
485 writeb(0xaa, (void __iomem *) ioaddr->lbal_addr);
486
487 nsect = readb((void __iomem *) ioaddr->nsect_addr);
488 lbal = readb((void __iomem *) ioaddr->lbal_addr);
489
490 if ((nsect == 0x55) && (lbal == 0xaa))
491 return 1; /* we found a device */
492
493 return 0; /* nothing found */
494}
495
496/**
497 * ata_devchk - PATA device presence detection
498 * @ap: ATA channel to examine
499 * @device: Device to examine (starting at zero)
500 *
501 * Dispatch ATA device presence detection, depending
502 * on whether we are using PIO or MMIO to talk to the
503 * ATA shadow registers.
504 *
505 * LOCKING:
506 * caller.
507 */
508
509static unsigned int ata_devchk(struct ata_port *ap,
510 unsigned int device)
511{
512 if (ap->flags & ATA_FLAG_MMIO)
513 return ata_mmio_devchk(ap, device);
514 return ata_pio_devchk(ap, device);
515}
516
517/**
518 * ata_dev_classify - determine device type based on ATA-spec signature
519 * @tf: ATA taskfile register set for device to be identified
520 *
521 * Determine from taskfile register contents whether a device is
522 * ATA or ATAPI, as per "Signature and persistence" section
523 * of ATA/PI spec (volume 1, sect 5.14).
524 *
525 * LOCKING:
526 * None.
527 *
528 * RETURNS:
529 * Device type, %ATA_DEV_ATA, %ATA_DEV_ATAPI, or %ATA_DEV_UNKNOWN
530 * the event of failure.
531 */
532
Jeff Garzik057ace52005-10-22 14:27:05 -0400533unsigned int ata_dev_classify(const struct ata_taskfile *tf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534{
535 /* Apple's open source Darwin code hints that some devices only
536 * put a proper signature into the LBA mid/high registers,
537 * So, we only check those. It's sufficient for uniqueness.
538 */
539
540 if (((tf->lbam == 0) && (tf->lbah == 0)) ||
541 ((tf->lbam == 0x3c) && (tf->lbah == 0xc3))) {
542 DPRINTK("found ATA device by sig\n");
543 return ATA_DEV_ATA;
544 }
545
546 if (((tf->lbam == 0x14) && (tf->lbah == 0xeb)) ||
547 ((tf->lbam == 0x69) && (tf->lbah == 0x96))) {
548 DPRINTK("found ATAPI device by sig\n");
549 return ATA_DEV_ATAPI;
550 }
551
552 DPRINTK("unknown device\n");
553 return ATA_DEV_UNKNOWN;
554}
555
556/**
557 * ata_dev_try_classify - Parse returned ATA device signature
558 * @ap: ATA channel to examine
559 * @device: Device to examine (starting at zero)
Tejun Heob4dc7622006-01-24 17:05:22 +0900560 * @r_err: Value of error register on completion
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 *
562 * After an event -- SRST, E.D.D., or SATA COMRESET -- occurs,
563 * an ATA/ATAPI-defined set of values is placed in the ATA
564 * shadow registers, indicating the results of device detection
565 * and diagnostics.
566 *
567 * Select the ATA device, and read the values from the ATA shadow
568 * registers. Then parse according to the Error register value,
569 * and the spec-defined values examined by ata_dev_classify().
570 *
571 * LOCKING:
572 * caller.
Tejun Heob4dc7622006-01-24 17:05:22 +0900573 *
574 * RETURNS:
575 * Device type - %ATA_DEV_ATA, %ATA_DEV_ATAPI or %ATA_DEV_NONE.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576 */
577
Tejun Heob4dc7622006-01-24 17:05:22 +0900578static unsigned int
579ata_dev_try_classify(struct ata_port *ap, unsigned int device, u8 *r_err)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 struct ata_taskfile tf;
582 unsigned int class;
583 u8 err;
584
585 ap->ops->dev_select(ap, device);
586
587 memset(&tf, 0, sizeof(tf));
588
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 ap->ops->tf_read(ap, &tf);
Jeff Garzik0169e282005-10-29 21:25:10 -0400590 err = tf.feature;
Tejun Heob4dc7622006-01-24 17:05:22 +0900591 if (r_err)
592 *r_err = err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593
594 /* see if device passed diags */
595 if (err == 1)
596 /* do nothing */ ;
597 else if ((device == 0) && (err == 0x81))
598 /* do nothing */ ;
599 else
Tejun Heob4dc7622006-01-24 17:05:22 +0900600 return ATA_DEV_NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601
Tejun Heob4dc7622006-01-24 17:05:22 +0900602 /* determine if device is ATA or ATAPI */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603 class = ata_dev_classify(&tf);
Tejun Heob4dc7622006-01-24 17:05:22 +0900604
Linus Torvalds1da177e2005-04-16 15:20:36 -0700605 if (class == ATA_DEV_UNKNOWN)
Tejun Heob4dc7622006-01-24 17:05:22 +0900606 return ATA_DEV_NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607 if ((class == ATA_DEV_ATA) && (ata_chk_status(ap) == 0))
Tejun Heob4dc7622006-01-24 17:05:22 +0900608 return ATA_DEV_NONE;
609 return class;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610}
611
612/**
Tejun Heo6a62a042006-02-13 10:02:46 +0900613 * ata_id_string - Convert IDENTIFY DEVICE page into string
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 * @id: IDENTIFY DEVICE results we will examine
615 * @s: string into which data is output
616 * @ofs: offset into identify device page
617 * @len: length of string to return. must be an even number.
618 *
619 * The strings in the IDENTIFY DEVICE page are broken up into
620 * 16-bit chunks. Run through the string, and output each
621 * 8-bit chunk linearly, regardless of platform.
622 *
623 * LOCKING:
624 * caller.
625 */
626
Tejun Heo6a62a042006-02-13 10:02:46 +0900627void ata_id_string(const u16 *id, unsigned char *s,
628 unsigned int ofs, unsigned int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629{
630 unsigned int c;
631
632 while (len > 0) {
633 c = id[ofs] >> 8;
634 *s = c;
635 s++;
636
637 c = id[ofs] & 0xff;
638 *s = c;
639 s++;
640
641 ofs++;
642 len -= 2;
643 }
644}
645
Tejun Heo0e949ff2006-02-12 22:47:04 +0900646/**
Tejun Heo6a62a042006-02-13 10:02:46 +0900647 * ata_id_c_string - Convert IDENTIFY DEVICE page into C string
Tejun Heo0e949ff2006-02-12 22:47:04 +0900648 * @id: IDENTIFY DEVICE results we will examine
649 * @s: string into which data is output
650 * @ofs: offset into identify device page
651 * @len: length of string to return. must be an odd number.
652 *
Tejun Heo6a62a042006-02-13 10:02:46 +0900653 * This function is identical to ata_id_string except that it
Tejun Heo0e949ff2006-02-12 22:47:04 +0900654 * trims trailing spaces and terminates the resulting string with
655 * null. @len must be actual maximum length (even number) + 1.
656 *
657 * LOCKING:
658 * caller.
659 */
Tejun Heo6a62a042006-02-13 10:02:46 +0900660void ata_id_c_string(const u16 *id, unsigned char *s,
661 unsigned int ofs, unsigned int len)
Tejun Heo0e949ff2006-02-12 22:47:04 +0900662{
663 unsigned char *p;
664
665 WARN_ON(!(len & 1));
666
Tejun Heo6a62a042006-02-13 10:02:46 +0900667 ata_id_string(id, s, ofs, len - 1);
Tejun Heo0e949ff2006-02-12 22:47:04 +0900668
669 p = s + strnlen(s, len - 1);
670 while (p > s && p[-1] == ' ')
671 p--;
672 *p = '\0';
673}
Edward Falk0baab862005-06-02 18:17:13 -0400674
Tejun Heo29407402006-02-12 22:47:04 +0900675static u64 ata_id_n_sectors(const u16 *id)
676{
677 if (ata_id_has_lba(id)) {
678 if (ata_id_has_lba48(id))
679 return ata_id_u64(id, 100);
680 else
681 return ata_id_u32(id, 60);
682 } else {
683 if (ata_id_current_chs_valid(id))
684 return ata_id_u32(id, 57);
685 else
686 return id[1] * id[3] * id[6];
687 }
688}
Edward Falk0baab862005-06-02 18:17:13 -0400689
690/**
691 * ata_noop_dev_select - Select device 0/1 on ATA bus
692 * @ap: ATA channel to manipulate
693 * @device: ATA device (numbered from zero) to select
694 *
695 * This function performs no actual function.
696 *
697 * May be used as the dev_select() entry in ata_port_operations.
698 *
699 * LOCKING:
700 * caller.
701 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702void ata_noop_dev_select (struct ata_port *ap, unsigned int device)
703{
704}
705
Edward Falk0baab862005-06-02 18:17:13 -0400706
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707/**
708 * ata_std_dev_select - Select device 0/1 on ATA bus
709 * @ap: ATA channel to manipulate
710 * @device: ATA device (numbered from zero) to select
711 *
712 * Use the method defined in the ATA specification to
713 * make either device 0, or device 1, active on the
Edward Falk0baab862005-06-02 18:17:13 -0400714 * ATA channel. Works with both PIO and MMIO.
715 *
716 * May be used as the dev_select() entry in ata_port_operations.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717 *
718 * LOCKING:
719 * caller.
720 */
721
722void ata_std_dev_select (struct ata_port *ap, unsigned int device)
723{
724 u8 tmp;
725
726 if (device == 0)
727 tmp = ATA_DEVICE_OBS;
728 else
729 tmp = ATA_DEVICE_OBS | ATA_DEV1;
730
731 if (ap->flags & ATA_FLAG_MMIO) {
732 writeb(tmp, (void __iomem *) ap->ioaddr.device_addr);
733 } else {
734 outb(tmp, ap->ioaddr.device_addr);
735 }
736 ata_pause(ap); /* needed; also flushes, for mmio */
737}
738
739/**
740 * ata_dev_select - Select device 0/1 on ATA bus
741 * @ap: ATA channel to manipulate
742 * @device: ATA device (numbered from zero) to select
743 * @wait: non-zero to wait for Status register BSY bit to clear
744 * @can_sleep: non-zero if context allows sleeping
745 *
746 * Use the method defined in the ATA specification to
747 * make either device 0, or device 1, active on the
748 * ATA channel.
749 *
750 * This is a high-level version of ata_std_dev_select(),
751 * which additionally provides the services of inserting
752 * the proper pauses and status polling, where needed.
753 *
754 * LOCKING:
755 * caller.
756 */
757
758void ata_dev_select(struct ata_port *ap, unsigned int device,
759 unsigned int wait, unsigned int can_sleep)
760{
761 VPRINTK("ENTER, ata%u: device %u, wait %u\n",
762 ap->id, device, wait);
763
764 if (wait)
765 ata_wait_idle(ap);
766
767 ap->ops->dev_select(ap, device);
768
769 if (wait) {
770 if (can_sleep && ap->device[device].class == ATA_DEV_ATAPI)
771 msleep(150);
772 ata_wait_idle(ap);
773 }
774}
775
776/**
777 * ata_dump_id - IDENTIFY DEVICE info debugging output
Tejun Heo0bd33002006-02-12 22:47:05 +0900778 * @id: IDENTIFY DEVICE page to dump
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779 *
Tejun Heo0bd33002006-02-12 22:47:05 +0900780 * Dump selected 16-bit words from the given IDENTIFY DEVICE
781 * page.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782 *
783 * LOCKING:
784 * caller.
785 */
786
Tejun Heo0bd33002006-02-12 22:47:05 +0900787static inline void ata_dump_id(const u16 *id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788{
789 DPRINTK("49==0x%04x "
790 "53==0x%04x "
791 "63==0x%04x "
792 "64==0x%04x "
793 "75==0x%04x \n",
Tejun Heo0bd33002006-02-12 22:47:05 +0900794 id[49],
795 id[53],
796 id[63],
797 id[64],
798 id[75]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799 DPRINTK("80==0x%04x "
800 "81==0x%04x "
801 "82==0x%04x "
802 "83==0x%04x "
803 "84==0x%04x \n",
Tejun Heo0bd33002006-02-12 22:47:05 +0900804 id[80],
805 id[81],
806 id[82],
807 id[83],
808 id[84]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809 DPRINTK("88==0x%04x "
810 "93==0x%04x\n",
Tejun Heo0bd33002006-02-12 22:47:05 +0900811 id[88],
812 id[93]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813}
814
Tejun Heocb95d562006-03-06 04:31:56 +0900815/**
816 * ata_id_xfermask - Compute xfermask from the given IDENTIFY data
817 * @id: IDENTIFY data to compute xfer mask from
Alan Cox11e29e22005-10-21 18:46:32 -0400818 *
Tejun Heocb95d562006-03-06 04:31:56 +0900819 * Compute the xfermask for this device. This is not as trivial
820 * as it seems if we must consider early devices correctly.
821 *
822 * FIXME: pre IDE drive timing (do we care ?).
823 *
824 * LOCKING:
825 * None.
826 *
827 * RETURNS:
828 * Computed xfermask
Alan Cox11e29e22005-10-21 18:46:32 -0400829 */
Tejun Heocb95d562006-03-06 04:31:56 +0900830static unsigned int ata_id_xfermask(const u16 *id)
Alan Cox11e29e22005-10-21 18:46:32 -0400831{
Tejun Heocb95d562006-03-06 04:31:56 +0900832 unsigned int pio_mask, mwdma_mask, udma_mask;
Alan Cox11e29e22005-10-21 18:46:32 -0400833
Alan Coxffa29452006-01-09 17:14:40 +0000834 /* Usual case. Word 53 indicates word 64 is valid */
Tejun Heocb95d562006-03-06 04:31:56 +0900835 if (id[ATA_ID_FIELD_VALID] & (1 << 1)) {
836 pio_mask = id[ATA_ID_PIO_MODES] & 0x03;
837 pio_mask <<= 3;
838 pio_mask |= 0x7;
839 } else {
840 /* If word 64 isn't valid then Word 51 high byte holds
841 * the PIO timing number for the maximum. Turn it into
842 * a mask.
843 */
844 pio_mask = (2 << (id[ATA_ID_OLD_PIO_MODES] & 0xFF)) - 1 ;
845
846 /* But wait.. there's more. Design your standards by
847 * committee and you too can get a free iordy field to
848 * process. However its the speeds not the modes that
849 * are supported... Note drivers using the timing API
850 * will get this right anyway
851 */
Alan Cox11e29e22005-10-21 18:46:32 -0400852 }
853
Tejun Heocb95d562006-03-06 04:31:56 +0900854 mwdma_mask = id[ATA_ID_MWDMA_MODES] & 0x07;
Tejun Heofb21f0d2006-03-12 12:34:35 +0900855
856 udma_mask = 0;
857 if (id[ATA_ID_FIELD_VALID] & (1 << 2))
858 udma_mask = id[ATA_ID_UDMA_MODES] & 0xff;
Alan Cox11e29e22005-10-21 18:46:32 -0400859
Tejun Heocb95d562006-03-06 04:31:56 +0900860 return ata_pack_xfermask(pio_mask, mwdma_mask, udma_mask);
Tejun Heoc18d06f2006-02-02 00:56:10 +0900861}
862
863/**
Tejun Heo86e45b62006-03-05 15:29:09 +0900864 * ata_port_queue_task - Queue port_task
865 * @ap: The ata_port to queue port_task for
Tejun Heoc18d06f2006-02-02 00:56:10 +0900866 *
Tejun Heo86e45b62006-03-05 15:29:09 +0900867 * Schedule @fn(@data) for execution after @delay jiffies using
868 * port_task. There is one port_task per port and it's the
869 * user(low level driver)'s responsibility to make sure that only
870 * one task is active at any given time.
871 *
872 * libata core layer takes care of synchronization between
873 * port_task and EH. ata_port_queue_task() may be ignored for EH
874 * synchronization.
875 *
876 * LOCKING:
877 * Inherited from caller.
878 */
879void ata_port_queue_task(struct ata_port *ap, void (*fn)(void *), void *data,
880 unsigned long delay)
881{
882 int rc;
883
Tejun Heo2e755f62006-03-05 15:29:09 +0900884 if (ap->flags & ATA_FLAG_FLUSH_PORT_TASK)
Tejun Heo86e45b62006-03-05 15:29:09 +0900885 return;
886
887 PREPARE_WORK(&ap->port_task, fn, data);
888
889 if (!delay)
890 rc = queue_work(ata_wq, &ap->port_task);
891 else
892 rc = queue_delayed_work(ata_wq, &ap->port_task, delay);
893
894 /* rc == 0 means that another user is using port task */
895 WARN_ON(rc == 0);
896}
897
898/**
899 * ata_port_flush_task - Flush port_task
900 * @ap: The ata_port to flush port_task for
901 *
902 * After this function completes, port_task is guranteed not to
903 * be running or scheduled.
Tejun Heoc18d06f2006-02-02 00:56:10 +0900904 *
905 * LOCKING:
906 * Kernel thread context (may sleep)
907 */
Tejun Heo86e45b62006-03-05 15:29:09 +0900908void ata_port_flush_task(struct ata_port *ap)
Tejun Heoc18d06f2006-02-02 00:56:10 +0900909{
Tejun Heoc18d06f2006-02-02 00:56:10 +0900910 unsigned long flags;
911
912 DPRINTK("ENTER\n");
913
914 spin_lock_irqsave(&ap->host_set->lock, flags);
Tejun Heo2e755f62006-03-05 15:29:09 +0900915 ap->flags |= ATA_FLAG_FLUSH_PORT_TASK;
Tejun Heoc18d06f2006-02-02 00:56:10 +0900916 spin_unlock_irqrestore(&ap->host_set->lock, flags);
917
918 DPRINTK("flush #1\n");
919 flush_workqueue(ata_wq);
920
921 /*
922 * At this point, if a task is running, it's guaranteed to see
923 * the FLUSH flag; thus, it will never queue pio tasks again.
924 * Cancel and flush.
925 */
Tejun Heo86e45b62006-03-05 15:29:09 +0900926 if (!cancel_delayed_work(&ap->port_task)) {
Tejun Heoc18d06f2006-02-02 00:56:10 +0900927 DPRINTK("flush #2\n");
928 flush_workqueue(ata_wq);
929 }
930
931 spin_lock_irqsave(&ap->host_set->lock, flags);
Tejun Heo2e755f62006-03-05 15:29:09 +0900932 ap->flags &= ~ATA_FLAG_FLUSH_PORT_TASK;
Tejun Heoc18d06f2006-02-02 00:56:10 +0900933 spin_unlock_irqrestore(&ap->host_set->lock, flags);
934
935 DPRINTK("EXIT\n");
Tejun Heo95064372006-01-23 13:09:37 +0900936}
937
Tejun Heo77853bf2006-01-23 13:09:36 +0900938void ata_qc_complete_internal(struct ata_queued_cmd *qc)
Jeff Garzik64f043d2005-11-17 10:50:01 -0500939{
Tejun Heo77853bf2006-01-23 13:09:36 +0900940 struct completion *waiting = qc->private_data;
Jeff Garzik64f043d2005-11-17 10:50:01 -0500941
Tejun Heo77853bf2006-01-23 13:09:36 +0900942 qc->ap->ops->tf_read(qc->ap, &qc->tf);
Tejun Heoa2a7a662005-12-13 14:48:31 +0900943 complete(waiting);
Tejun Heoa2a7a662005-12-13 14:48:31 +0900944}
Jeff Garzik64f043d2005-11-17 10:50:01 -0500945
Tejun Heoa2a7a662005-12-13 14:48:31 +0900946/**
947 * ata_exec_internal - execute libata internal command
948 * @ap: Port to which the command is sent
949 * @dev: Device to which the command is sent
950 * @tf: Taskfile registers for the command and the result
951 * @dma_dir: Data tranfer direction of the command
952 * @buf: Data buffer of the command
953 * @buflen: Length of data buffer
954 *
955 * Executes libata internal command with timeout. @tf contains
956 * command on entry and result on return. Timeout and error
957 * conditions are reported via return value. No recovery action
958 * is taken after a command times out. It's caller's duty to
959 * clean up after timeout.
960 *
961 * LOCKING:
962 * None. Should be called with kernel context, might sleep.
963 */
964
965static unsigned
966ata_exec_internal(struct ata_port *ap, struct ata_device *dev,
967 struct ata_taskfile *tf,
968 int dma_dir, void *buf, unsigned int buflen)
969{
970 u8 command = tf->command;
971 struct ata_queued_cmd *qc;
972 DECLARE_COMPLETION(wait);
973 unsigned long flags;
Tejun Heo77853bf2006-01-23 13:09:36 +0900974 unsigned int err_mask;
Tejun Heoa2a7a662005-12-13 14:48:31 +0900975
976 spin_lock_irqsave(&ap->host_set->lock, flags);
977
978 qc = ata_qc_new_init(ap, dev);
979 BUG_ON(qc == NULL);
980
981 qc->tf = *tf;
982 qc->dma_dir = dma_dir;
983 if (dma_dir != DMA_NONE) {
984 ata_sg_init_one(qc, buf, buflen);
985 qc->nsect = buflen / ATA_SECT_SIZE;
Jeff Garzik64f043d2005-11-17 10:50:01 -0500986 }
987
Tejun Heo77853bf2006-01-23 13:09:36 +0900988 qc->private_data = &wait;
Tejun Heoa2a7a662005-12-13 14:48:31 +0900989 qc->complete_fn = ata_qc_complete_internal;
990
Tejun Heo9a3d9eb2006-01-23 13:09:36 +0900991 qc->err_mask = ata_qc_issue(qc);
992 if (qc->err_mask)
Tejun Heo8e436af2006-01-23 13:09:36 +0900993 ata_qc_complete(qc);
Tejun Heoa2a7a662005-12-13 14:48:31 +0900994
995 spin_unlock_irqrestore(&ap->host_set->lock, flags);
996
997 if (!wait_for_completion_timeout(&wait, ATA_TMOUT_INTERNAL)) {
Albert Lee41ade502006-03-14 11:19:04 +0800998 ata_port_flush_task(ap);
999
Tejun Heoa2a7a662005-12-13 14:48:31 +09001000 spin_lock_irqsave(&ap->host_set->lock, flags);
1001
1002 /* We're racing with irq here. If we lose, the
1003 * following test prevents us from completing the qc
1004 * again. If completion irq occurs after here but
1005 * before the caller cleans up, it will result in a
1006 * spurious interrupt. We can live with that.
1007 */
Tejun Heo77853bf2006-01-23 13:09:36 +09001008 if (qc->flags & ATA_QCFLAG_ACTIVE) {
Tejun Heo11a56d22006-01-23 13:09:36 +09001009 qc->err_mask = AC_ERR_TIMEOUT;
Tejun Heoa2a7a662005-12-13 14:48:31 +09001010 ata_qc_complete(qc);
1011 printk(KERN_WARNING "ata%u: qc timeout (cmd 0x%x)\n",
1012 ap->id, command);
1013 }
1014
1015 spin_unlock_irqrestore(&ap->host_set->lock, flags);
1016 }
1017
Tejun Heo77853bf2006-01-23 13:09:36 +09001018 *tf = qc->tf;
1019 err_mask = qc->err_mask;
1020
1021 ata_qc_free(qc);
1022
Tejun Heo1f7dd3e92006-03-24 15:25:30 +09001023 /* XXX - Some LLDDs (sata_mv) disable port on command failure.
1024 * Until those drivers are fixed, we detect the condition
1025 * here, fail the command with AC_ERR_SYSTEM and reenable the
1026 * port.
1027 *
1028 * Note that this doesn't change any behavior as internal
1029 * command failure results in disabling the device in the
1030 * higher layer for LLDDs without new reset/EH callbacks.
1031 *
1032 * Kill the following code as soon as those drivers are fixed.
1033 */
1034 if (ap->flags & ATA_FLAG_PORT_DISABLED) {
1035 err_mask |= AC_ERR_SYSTEM;
1036 ata_port_probe(ap);
1037 }
1038
Tejun Heo77853bf2006-01-23 13:09:36 +09001039 return err_mask;
Jeff Garzik64f043d2005-11-17 10:50:01 -05001040}
1041
Linus Torvalds1da177e2005-04-16 15:20:36 -07001042/**
Alan Cox1bc4ccf2006-01-09 17:18:14 +00001043 * ata_pio_need_iordy - check if iordy needed
1044 * @adev: ATA device
1045 *
1046 * Check if the current speed of the device requires IORDY. Used
1047 * by various controllers for chip configuration.
1048 */
1049
1050unsigned int ata_pio_need_iordy(const struct ata_device *adev)
1051{
1052 int pio;
1053 int speed = adev->pio_mode - XFER_PIO_0;
1054
1055 if (speed < 2)
1056 return 0;
1057 if (speed > 2)
1058 return 1;
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05001059
Alan Cox1bc4ccf2006-01-09 17:18:14 +00001060 /* If we have no drive specific rule, then PIO 2 is non IORDY */
1061
1062 if (adev->id[ATA_ID_FIELD_VALID] & 2) { /* EIDE */
1063 pio = adev->id[ATA_ID_EIDE_PIO];
1064 /* Is the speed faster than the drive allows non IORDY ? */
1065 if (pio) {
1066 /* This is cycle times not frequency - watch the logic! */
1067 if (pio > 240) /* PIO2 is 240nS per cycle */
1068 return 1;
1069 return 0;
1070 }
1071 }
1072 return 0;
1073}
1074
1075/**
Tejun Heo49016ac2006-02-21 02:12:11 +09001076 * ata_dev_read_id - Read ID data from the specified device
1077 * @ap: port on which target device resides
1078 * @dev: target device
1079 * @p_class: pointer to class of the target device (may be changed)
1080 * @post_reset: is this read ID post-reset?
Tejun Heod9572b12006-03-01 16:09:35 +09001081 * @p_id: read IDENTIFY page (newly allocated)
Tejun Heo49016ac2006-02-21 02:12:11 +09001082 *
1083 * Read ID data from the specified device. ATA_CMD_ID_ATA is
1084 * performed on ATA devices and ATA_CMD_ID_ATAPI on ATAPI
Tejun Heoaec5c3c2006-03-25 01:33:34 +09001085 * devices. This function also issues ATA_CMD_INIT_DEV_PARAMS
1086 * for pre-ATA4 drives.
Tejun Heo49016ac2006-02-21 02:12:11 +09001087 *
1088 * LOCKING:
1089 * Kernel thread context (may sleep)
1090 *
1091 * RETURNS:
1092 * 0 on success, -errno otherwise.
1093 */
1094static int ata_dev_read_id(struct ata_port *ap, struct ata_device *dev,
Tejun Heod9572b12006-03-01 16:09:35 +09001095 unsigned int *p_class, int post_reset, u16 **p_id)
Tejun Heo49016ac2006-02-21 02:12:11 +09001096{
1097 unsigned int class = *p_class;
Tejun Heo49016ac2006-02-21 02:12:11 +09001098 struct ata_taskfile tf;
1099 unsigned int err_mask = 0;
Tejun Heod9572b12006-03-01 16:09:35 +09001100 u16 *id;
Tejun Heo49016ac2006-02-21 02:12:11 +09001101 const char *reason;
1102 int rc;
1103
1104 DPRINTK("ENTER, host %u, dev %u\n", ap->id, dev->devno);
1105
Tejun Heo49016ac2006-02-21 02:12:11 +09001106 ata_dev_select(ap, dev->devno, 1, 1); /* select device 0/1 */
1107
Tejun Heod9572b12006-03-01 16:09:35 +09001108 id = kmalloc(sizeof(id[0]) * ATA_ID_WORDS, GFP_KERNEL);
1109 if (id == NULL) {
1110 rc = -ENOMEM;
1111 reason = "out of memory";
1112 goto err_out;
1113 }
1114
Tejun Heo49016ac2006-02-21 02:12:11 +09001115 retry:
1116 ata_tf_init(ap, &tf, dev->devno);
1117
1118 switch (class) {
1119 case ATA_DEV_ATA:
1120 tf.command = ATA_CMD_ID_ATA;
1121 break;
1122 case ATA_DEV_ATAPI:
1123 tf.command = ATA_CMD_ID_ATAPI;
1124 break;
1125 default:
1126 rc = -ENODEV;
1127 reason = "unsupported class";
1128 goto err_out;
1129 }
1130
1131 tf.protocol = ATA_PROT_PIO;
1132
1133 err_mask = ata_exec_internal(ap, dev, &tf, DMA_FROM_DEVICE,
1134 id, sizeof(id[0]) * ATA_ID_WORDS);
Tejun Heo49016ac2006-02-21 02:12:11 +09001135 if (err_mask) {
1136 rc = -EIO;
1137 reason = "I/O error";
Tejun Heo49016ac2006-02-21 02:12:11 +09001138 goto err_out;
1139 }
1140
1141 swap_buf_le16(id, ATA_ID_WORDS);
1142
Tejun Heo49016ac2006-02-21 02:12:11 +09001143 /* sanity check */
1144 if ((class == ATA_DEV_ATA) != ata_id_is_ata(id)) {
1145 rc = -EINVAL;
1146 reason = "device reports illegal type";
1147 goto err_out;
1148 }
1149
1150 if (post_reset && class == ATA_DEV_ATA) {
1151 /*
1152 * The exact sequence expected by certain pre-ATA4 drives is:
1153 * SRST RESET
1154 * IDENTIFY
1155 * INITIALIZE DEVICE PARAMETERS
1156 * anything else..
1157 * Some drives were very specific about that exact sequence.
1158 */
1159 if (ata_id_major_version(id) < 4 || !ata_id_has_lba(id)) {
1160 err_mask = ata_dev_init_params(ap, dev);
1161 if (err_mask) {
1162 rc = -EIO;
1163 reason = "INIT_DEV_PARAMS failed";
1164 goto err_out;
1165 }
1166
1167 /* current CHS translation info (id[53-58]) might be
1168 * changed. reread the identify device info.
1169 */
1170 post_reset = 0;
1171 goto retry;
1172 }
1173 }
1174
1175 *p_class = class;
Tejun Heod9572b12006-03-01 16:09:35 +09001176 *p_id = id;
Tejun Heo49016ac2006-02-21 02:12:11 +09001177 return 0;
1178
1179 err_out:
1180 printk(KERN_WARNING "ata%u: dev %u failed to IDENTIFY (%s)\n",
1181 ap->id, dev->devno, reason);
Tejun Heod9572b12006-03-01 16:09:35 +09001182 kfree(id);
Tejun Heo49016ac2006-02-21 02:12:11 +09001183 return rc;
1184}
1185
Tejun Heo4b2f3ed2006-03-01 16:09:36 +09001186static inline u8 ata_dev_knobble(const struct ata_port *ap,
1187 struct ata_device *dev)
1188{
1189 return ((ap->cbl == ATA_CBL_SATA) && (!ata_id_is_sata(dev->id)));
1190}
1191
Tejun Heo49016ac2006-02-21 02:12:11 +09001192/**
Tejun Heoffeae412006-03-01 16:09:35 +09001193 * ata_dev_configure - Configure the specified ATA/ATAPI device
1194 * @ap: Port on which target device resides
1195 * @dev: Target device to configure
Tejun Heo4c2d7212006-03-05 17:55:58 +09001196 * @print_info: Enable device info printout
Linus Torvalds1da177e2005-04-16 15:20:36 -07001197 *
Tejun Heoffeae412006-03-01 16:09:35 +09001198 * Configure @dev according to @dev->id. Generic and low-level
1199 * driver specific fixups are also applied.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200 *
1201 * LOCKING:
Tejun Heoffeae412006-03-01 16:09:35 +09001202 * Kernel thread context (may sleep)
1203 *
1204 * RETURNS:
1205 * 0 on success, -errno otherwise
Linus Torvalds1da177e2005-04-16 15:20:36 -07001206 */
Tejun Heo4c2d7212006-03-05 17:55:58 +09001207static int ata_dev_configure(struct ata_port *ap, struct ata_device *dev,
1208 int print_info)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001209{
Tejun Heo1148c3a2006-03-13 19:48:04 +09001210 const u16 *id = dev->id;
Tejun Heoff8854b2006-03-06 04:31:56 +09001211 unsigned int xfer_mask;
Tejun Heo6e7846e2006-02-12 23:32:58 +09001212 int i, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001213
1214 if (!ata_dev_present(dev)) {
1215 DPRINTK("ENTER/EXIT (host %u, dev %u) -- nodev\n",
Tejun Heoffeae412006-03-01 16:09:35 +09001216 ap->id, dev->devno);
1217 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001218 }
1219
Tejun Heoffeae412006-03-01 16:09:35 +09001220 DPRINTK("ENTER, host %u, dev %u\n", ap->id, dev->devno);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001221
Tejun Heoc39f5eb2006-03-13 19:51:19 +09001222 /* print device capabilities */
1223 if (print_info)
1224 printk(KERN_DEBUG "ata%u: dev %u cfg 49:%04x 82:%04x 83:%04x "
1225 "84:%04x 85:%04x 86:%04x 87:%04x 88:%04x\n",
1226 ap->id, dev->devno, id[49], id[82], id[83],
1227 id[84], id[85], id[86], id[87], id[88]);
1228
Tejun Heo208a9932006-03-05 17:55:58 +09001229 /* initialize to-be-configured parameters */
1230 dev->flags = 0;
1231 dev->max_sectors = 0;
1232 dev->cdb_len = 0;
1233 dev->n_sectors = 0;
1234 dev->cylinders = 0;
1235 dev->heads = 0;
1236 dev->sectors = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001237
1238 /*
1239 * common ATA, ATAPI feature tests
1240 */
1241
Tejun Heoff8854b2006-03-06 04:31:56 +09001242 /* find max transfer mode; for printk only */
Tejun Heo1148c3a2006-03-13 19:48:04 +09001243 xfer_mask = ata_id_xfermask(id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001244
Tejun Heo1148c3a2006-03-13 19:48:04 +09001245 ata_dump_id(id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001246
1247 /* ATA-specific feature tests */
1248 if (dev->class == ATA_DEV_ATA) {
Tejun Heo1148c3a2006-03-13 19:48:04 +09001249 dev->n_sectors = ata_id_n_sectors(id);
Tejun Heo29407402006-02-12 22:47:04 +09001250
Tejun Heo1148c3a2006-03-13 19:48:04 +09001251 if (ata_id_has_lba(id)) {
Tejun Heo4c2d7212006-03-05 17:55:58 +09001252 const char *lba_desc;
Albert Lee8bf62ece2005-05-12 15:29:42 -04001253
Tejun Heo4c2d7212006-03-05 17:55:58 +09001254 lba_desc = "LBA";
1255 dev->flags |= ATA_DFLAG_LBA;
Tejun Heo1148c3a2006-03-13 19:48:04 +09001256 if (ata_id_has_lba48(id)) {
Albert Lee8bf62ece2005-05-12 15:29:42 -04001257 dev->flags |= ATA_DFLAG_LBA48;
Tejun Heo4c2d7212006-03-05 17:55:58 +09001258 lba_desc = "LBA48";
1259 }
Albert Lee8bf62ece2005-05-12 15:29:42 -04001260
1261 /* print device info to dmesg */
Tejun Heo4c2d7212006-03-05 17:55:58 +09001262 if (print_info)
1263 printk(KERN_INFO "ata%u: dev %u ATA-%d, "
1264 "max %s, %Lu sectors: %s\n",
1265 ap->id, dev->devno,
Tejun Heo1148c3a2006-03-13 19:48:04 +09001266 ata_id_major_version(id),
Tejun Heoff8854b2006-03-06 04:31:56 +09001267 ata_mode_string(xfer_mask),
Tejun Heo4c2d7212006-03-05 17:55:58 +09001268 (unsigned long long)dev->n_sectors,
1269 lba_desc);
Tejun Heoffeae412006-03-01 16:09:35 +09001270 } else {
Albert Lee8bf62ece2005-05-12 15:29:42 -04001271 /* CHS */
1272
1273 /* Default translation */
Tejun Heo1148c3a2006-03-13 19:48:04 +09001274 dev->cylinders = id[1];
1275 dev->heads = id[3];
1276 dev->sectors = id[6];
Albert Lee8bf62ece2005-05-12 15:29:42 -04001277
Tejun Heo1148c3a2006-03-13 19:48:04 +09001278 if (ata_id_current_chs_valid(id)) {
Albert Lee8bf62ece2005-05-12 15:29:42 -04001279 /* Current CHS translation is valid. */
Tejun Heo1148c3a2006-03-13 19:48:04 +09001280 dev->cylinders = id[54];
1281 dev->heads = id[55];
1282 dev->sectors = id[56];
Albert Lee8bf62ece2005-05-12 15:29:42 -04001283 }
1284
1285 /* print device info to dmesg */
Tejun Heo4c2d7212006-03-05 17:55:58 +09001286 if (print_info)
1287 printk(KERN_INFO "ata%u: dev %u ATA-%d, "
1288 "max %s, %Lu sectors: CHS %u/%u/%u\n",
1289 ap->id, dev->devno,
Tejun Heo1148c3a2006-03-13 19:48:04 +09001290 ata_id_major_version(id),
Tejun Heoff8854b2006-03-06 04:31:56 +09001291 ata_mode_string(xfer_mask),
Tejun Heo4c2d7212006-03-05 17:55:58 +09001292 (unsigned long long)dev->n_sectors,
1293 dev->cylinders, dev->heads, dev->sectors);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294 }
1295
Albert Lee07f6f7d2005-11-01 19:33:20 +08001296 if (dev->id[59] & 0x100) {
1297 dev->multi_count = dev->id[59] & 0xff;
1298 DPRINTK("ata%u: dev %u multi count %u\n",
1299 ap->id, device, dev->multi_count);
1300 }
1301
Albert Lee13ee46282006-03-25 17:39:34 +08001302 dev->cdb_len = 16;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001303 }
1304
1305 /* ATAPI-specific feature tests */
Jeff Garzik2c13b7c2005-11-14 14:14:16 -05001306 else if (dev->class == ATA_DEV_ATAPI) {
Tejun Heo1148c3a2006-03-13 19:48:04 +09001307 rc = atapi_cdb_len(id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001308 if ((rc < 12) || (rc > ATAPI_CDB_LEN)) {
1309 printk(KERN_WARNING "ata%u: unsupported CDB len\n", ap->id);
Tejun Heoffeae412006-03-01 16:09:35 +09001310 rc = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001311 goto err_out_nosup;
1312 }
Tejun Heo6e7846e2006-02-12 23:32:58 +09001313 dev->cdb_len = (unsigned int) rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314
Albert Lee312f7da2005-09-27 17:38:03 +08001315 if (ata_id_cdb_intr(dev->id))
1316 dev->flags |= ATA_DFLAG_CDB_INTR;
1317
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318 /* print device info to dmesg */
Tejun Heo4c2d7212006-03-05 17:55:58 +09001319 if (print_info)
1320 printk(KERN_INFO "ata%u: dev %u ATAPI, max %s\n",
Tejun Heoff8854b2006-03-06 04:31:56 +09001321 ap->id, dev->devno, ata_mode_string(xfer_mask));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322 }
1323
Tejun Heo6e7846e2006-02-12 23:32:58 +09001324 ap->host->max_cmd_len = 0;
1325 for (i = 0; i < ATA_MAX_DEVICES; i++)
1326 ap->host->max_cmd_len = max_t(unsigned int,
1327 ap->host->max_cmd_len,
1328 ap->device[i].cdb_len);
1329
Brad Campbell6f2f3812005-05-12 15:07:47 -04001330 /* limit bridge transfers to udma5, 200 sectors */
Tejun Heo4b2f3ed2006-03-01 16:09:36 +09001331 if (ata_dev_knobble(ap, dev)) {
Tejun Heo4c2d7212006-03-05 17:55:58 +09001332 if (print_info)
1333 printk(KERN_INFO "ata%u(%u): applying bridge limits\n",
1334 ap->id, dev->devno);
Tejun Heo5a529132006-03-24 14:07:50 +09001335 dev->udma_mask &= ATA_UDMA5;
Tejun Heo4b2f3ed2006-03-01 16:09:36 +09001336 dev->max_sectors = ATA_MAX_SECTORS;
Brad Campbell6f2f3812005-05-12 15:07:47 -04001337 }
1338
1339 if (ap->ops->dev_config)
Tejun Heo4b2f3ed2006-03-01 16:09:36 +09001340 ap->ops->dev_config(ap, dev);
1341
Linus Torvalds1da177e2005-04-16 15:20:36 -07001342 DPRINTK("EXIT, drv_stat = 0x%x\n", ata_chk_status(ap));
Tejun Heoffeae412006-03-01 16:09:35 +09001343 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344
1345err_out_nosup:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346 DPRINTK("EXIT, err\n");
Tejun Heoffeae412006-03-01 16:09:35 +09001347 return rc;
Brad Campbell6f2f3812005-05-12 15:07:47 -04001348}
1349
Linus Torvalds1da177e2005-04-16 15:20:36 -07001350/**
1351 * ata_bus_probe - Reset and probe ATA bus
1352 * @ap: Bus to probe
1353 *
Jeff Garzik0cba6322005-05-30 19:49:12 -04001354 * Master ATA bus probing function. Initiates a hardware-dependent
1355 * bus reset, then attempts to identify any devices found on
1356 * the bus.
1357 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04001359 * PCI/etc. bus probe sem.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360 *
1361 * RETURNS:
1362 * Zero on success, non-zero on error.
1363 */
1364
1365static int ata_bus_probe(struct ata_port *ap)
1366{
Tejun Heo28ca5c52006-03-01 16:09:36 +09001367 unsigned int classes[ATA_MAX_DEVICES];
1368 unsigned int i, rc, found = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001369
Tejun Heo28ca5c52006-03-01 16:09:36 +09001370 ata_port_probe(ap);
1371
Tejun Heo20444702006-03-13 01:57:01 +09001372 /* reset and determine device classes */
1373 for (i = 0; i < ATA_MAX_DEVICES; i++)
1374 classes[i] = ATA_DEV_UNKNOWN;
Tejun Heoc19ba8a2006-01-24 17:05:22 +09001375
Tejun Heo20444702006-03-13 01:57:01 +09001376 if (ap->ops->probe_reset) {
Tejun Heoc19ba8a2006-01-24 17:05:22 +09001377 rc = ap->ops->probe_reset(ap, classes);
Tejun Heo28ca5c52006-03-01 16:09:36 +09001378 if (rc) {
1379 printk("ata%u: reset failed (errno=%d)\n", ap->id, rc);
1380 return rc;
Tejun Heoc19ba8a2006-01-24 17:05:22 +09001381 }
Tejun Heo28ca5c52006-03-01 16:09:36 +09001382 } else {
Tejun Heoc19ba8a2006-01-24 17:05:22 +09001383 ap->ops->phy_reset(ap);
1384
Tejun Heo20444702006-03-13 01:57:01 +09001385 if (!(ap->flags & ATA_FLAG_PORT_DISABLED))
1386 for (i = 0; i < ATA_MAX_DEVICES; i++)
Tejun Heo28ca5c52006-03-01 16:09:36 +09001387 classes[i] = ap->device[i].class;
Tejun Heo20444702006-03-13 01:57:01 +09001388
Tejun Heo28ca5c52006-03-01 16:09:36 +09001389 ata_port_probe(ap);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001390 }
1391
Tejun Heo20444702006-03-13 01:57:01 +09001392 for (i = 0; i < ATA_MAX_DEVICES; i++)
1393 if (classes[i] == ATA_DEV_UNKNOWN)
1394 classes[i] = ATA_DEV_NONE;
1395
Tejun Heo28ca5c52006-03-01 16:09:36 +09001396 /* read IDENTIFY page and configure devices */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001397 for (i = 0; i < ATA_MAX_DEVICES; i++) {
Tejun Heoffeae412006-03-01 16:09:35 +09001398 struct ata_device *dev = &ap->device[i];
1399
Tejun Heo28ca5c52006-03-01 16:09:36 +09001400 dev->class = classes[i];
1401
Tejun Heoffeae412006-03-01 16:09:35 +09001402 if (!ata_dev_present(dev))
1403 continue;
1404
1405 WARN_ON(dev->id != NULL);
1406 if (ata_dev_read_id(ap, dev, &dev->class, 1, &dev->id)) {
1407 dev->class = ATA_DEV_NONE;
1408 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409 }
Tejun Heoffeae412006-03-01 16:09:35 +09001410
Tejun Heo4c2d7212006-03-05 17:55:58 +09001411 if (ata_dev_configure(ap, dev, 1)) {
Tejun Heofcef9782006-03-24 15:25:31 +09001412 ata_dev_disable(ap, dev);
Tejun Heoffeae412006-03-01 16:09:35 +09001413 continue;
1414 }
1415
Tejun Heoffeae412006-03-01 16:09:35 +09001416 found = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001417 }
1418
Tejun Heo28ca5c52006-03-01 16:09:36 +09001419 if (!found)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001420 goto err_out_disable;
1421
1422 ata_set_mode(ap);
1423 if (ap->flags & ATA_FLAG_PORT_DISABLED)
1424 goto err_out_disable;
1425
1426 return 0;
1427
1428err_out_disable:
1429 ap->ops->port_disable(ap);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001430 return -1;
1431}
1432
1433/**
Jeff Garzik0cba6322005-05-30 19:49:12 -04001434 * ata_port_probe - Mark port as enabled
1435 * @ap: Port for which we indicate enablement
Linus Torvalds1da177e2005-04-16 15:20:36 -07001436 *
Jeff Garzik0cba6322005-05-30 19:49:12 -04001437 * Modify @ap data structure such that the system
1438 * thinks that the entire port is enabled.
1439 *
1440 * LOCKING: host_set lock, or some other form of
1441 * serialization.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 */
1443
1444void ata_port_probe(struct ata_port *ap)
1445{
1446 ap->flags &= ~ATA_FLAG_PORT_DISABLED;
1447}
1448
1449/**
Tejun Heo3be680b2005-12-19 22:35:02 +09001450 * sata_print_link_status - Print SATA link status
1451 * @ap: SATA port to printk link status about
1452 *
1453 * This function prints link speed and status of a SATA link.
1454 *
1455 * LOCKING:
1456 * None.
1457 */
1458static void sata_print_link_status(struct ata_port *ap)
1459{
1460 u32 sstatus, tmp;
1461 const char *speed;
1462
1463 if (!ap->ops->scr_read)
1464 return;
1465
1466 sstatus = scr_read(ap, SCR_STATUS);
1467
1468 if (sata_dev_present(ap)) {
1469 tmp = (sstatus >> 4) & 0xf;
1470 if (tmp & (1 << 0))
1471 speed = "1.5";
1472 else if (tmp & (1 << 1))
1473 speed = "3.0";
1474 else
1475 speed = "<unknown>";
1476 printk(KERN_INFO "ata%u: SATA link up %s Gbps (SStatus %X)\n",
1477 ap->id, speed, sstatus);
1478 } else {
1479 printk(KERN_INFO "ata%u: SATA link down (SStatus %X)\n",
1480 ap->id, sstatus);
1481 }
1482}
1483
1484/**
Jeff Garzik780a87f2005-05-30 15:41:05 -04001485 * __sata_phy_reset - Wake/reset a low-level SATA PHY
1486 * @ap: SATA port associated with target SATA PHY.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001487 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04001488 * This function issues commands to standard SATA Sxxx
1489 * PHY registers, to wake up the phy (and device), and
1490 * clear any reset condition.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001491 *
1492 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04001493 * PCI/etc. bus probe sem.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001494 *
1495 */
1496void __sata_phy_reset(struct ata_port *ap)
1497{
1498 u32 sstatus;
1499 unsigned long timeout = jiffies + (HZ * 5);
1500
1501 if (ap->flags & ATA_FLAG_SATA_RESET) {
Brett Russcdcca89e2005-03-28 15:10:27 -05001502 /* issue phy wake/reset */
1503 scr_write_flush(ap, SCR_CONTROL, 0x301);
Tejun Heo62ba2842005-06-26 23:27:19 +09001504 /* Couldn't find anything in SATA I/II specs, but
1505 * AHCI-1.1 10.4.2 says at least 1 ms. */
1506 mdelay(1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507 }
Brett Russcdcca89e2005-03-28 15:10:27 -05001508 scr_write_flush(ap, SCR_CONTROL, 0x300); /* phy wake/clear reset */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001509
1510 /* wait for phy to become ready, if necessary */
1511 do {
1512 msleep(200);
1513 sstatus = scr_read(ap, SCR_STATUS);
1514 if ((sstatus & 0xf) != 1)
1515 break;
1516 } while (time_before(jiffies, timeout));
1517
Tejun Heo3be680b2005-12-19 22:35:02 +09001518 /* print link status */
1519 sata_print_link_status(ap);
Jeff Garzik656563e2005-11-20 03:36:45 -05001520
Tejun Heo3be680b2005-12-19 22:35:02 +09001521 /* TODO: phy layer with polling, timeouts, etc. */
1522 if (sata_dev_present(ap))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001523 ata_port_probe(ap);
Tejun Heo3be680b2005-12-19 22:35:02 +09001524 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001525 ata_port_disable(ap);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001526
1527 if (ap->flags & ATA_FLAG_PORT_DISABLED)
1528 return;
1529
1530 if (ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT)) {
1531 ata_port_disable(ap);
1532 return;
1533 }
1534
1535 ap->cbl = ATA_CBL_SATA;
1536}
1537
1538/**
Jeff Garzik780a87f2005-05-30 15:41:05 -04001539 * sata_phy_reset - Reset SATA bus.
1540 * @ap: SATA port associated with target SATA PHY.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001541 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04001542 * This function resets the SATA bus, and then probes
1543 * the bus for devices.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001544 *
1545 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04001546 * PCI/etc. bus probe sem.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547 *
1548 */
1549void sata_phy_reset(struct ata_port *ap)
1550{
1551 __sata_phy_reset(ap);
1552 if (ap->flags & ATA_FLAG_PORT_DISABLED)
1553 return;
1554 ata_bus_reset(ap);
1555}
1556
1557/**
Alan Coxebdfca62006-03-23 15:38:34 +00001558 * ata_dev_pair - return other device on cable
1559 * @ap: port
1560 * @adev: device
1561 *
1562 * Obtain the other device on the same cable, or if none is
1563 * present NULL is returned
1564 */
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05001565
Alan Coxebdfca62006-03-23 15:38:34 +00001566struct ata_device *ata_dev_pair(struct ata_port *ap, struct ata_device *adev)
1567{
1568 struct ata_device *pair = &ap->device[1 - adev->devno];
1569 if (!ata_dev_present(pair))
1570 return NULL;
1571 return pair;
1572}
1573
1574/**
Jeff Garzik780a87f2005-05-30 15:41:05 -04001575 * ata_port_disable - Disable port.
1576 * @ap: Port to be disabled.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001577 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04001578 * Modify @ap data structure such that the system
1579 * thinks that the entire port is disabled, and should
1580 * never attempt to probe or communicate with devices
1581 * on this port.
1582 *
1583 * LOCKING: host_set lock, or some other form of
1584 * serialization.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001585 */
1586
1587void ata_port_disable(struct ata_port *ap)
1588{
1589 ap->device[0].class = ATA_DEV_NONE;
1590 ap->device[1].class = ATA_DEV_NONE;
1591 ap->flags |= ATA_FLAG_PORT_DISABLED;
1592}
1593
Alan Cox452503f2005-10-21 19:01:32 -04001594/*
1595 * This mode timing computation functionality is ported over from
1596 * drivers/ide/ide-timing.h and was originally written by Vojtech Pavlik
1597 */
1598/*
1599 * PIO 0-5, MWDMA 0-2 and UDMA 0-6 timings (in nanoseconds).
1600 * These were taken from ATA/ATAPI-6 standard, rev 0a, except
1601 * for PIO 5, which is a nonstandard extension and UDMA6, which
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05001602 * is currently supported only by Maxtor drives.
Alan Cox452503f2005-10-21 19:01:32 -04001603 */
1604
1605static const struct ata_timing ata_timing[] = {
1606
1607 { XFER_UDMA_6, 0, 0, 0, 0, 0, 0, 0, 15 },
1608 { XFER_UDMA_5, 0, 0, 0, 0, 0, 0, 0, 20 },
1609 { XFER_UDMA_4, 0, 0, 0, 0, 0, 0, 0, 30 },
1610 { XFER_UDMA_3, 0, 0, 0, 0, 0, 0, 0, 45 },
1611
1612 { XFER_UDMA_2, 0, 0, 0, 0, 0, 0, 0, 60 },
1613 { XFER_UDMA_1, 0, 0, 0, 0, 0, 0, 0, 80 },
1614 { XFER_UDMA_0, 0, 0, 0, 0, 0, 0, 0, 120 },
1615
1616/* { XFER_UDMA_SLOW, 0, 0, 0, 0, 0, 0, 0, 150 }, */
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05001617
Alan Cox452503f2005-10-21 19:01:32 -04001618 { XFER_MW_DMA_2, 25, 0, 0, 0, 70, 25, 120, 0 },
1619 { XFER_MW_DMA_1, 45, 0, 0, 0, 80, 50, 150, 0 },
1620 { XFER_MW_DMA_0, 60, 0, 0, 0, 215, 215, 480, 0 },
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05001621
Alan Cox452503f2005-10-21 19:01:32 -04001622 { XFER_SW_DMA_2, 60, 0, 0, 0, 120, 120, 240, 0 },
1623 { XFER_SW_DMA_1, 90, 0, 0, 0, 240, 240, 480, 0 },
1624 { XFER_SW_DMA_0, 120, 0, 0, 0, 480, 480, 960, 0 },
1625
1626/* { XFER_PIO_5, 20, 50, 30, 100, 50, 30, 100, 0 }, */
1627 { XFER_PIO_4, 25, 70, 25, 120, 70, 25, 120, 0 },
1628 { XFER_PIO_3, 30, 80, 70, 180, 80, 70, 180, 0 },
1629
1630 { XFER_PIO_2, 30, 290, 40, 330, 100, 90, 240, 0 },
1631 { XFER_PIO_1, 50, 290, 93, 383, 125, 100, 383, 0 },
1632 { XFER_PIO_0, 70, 290, 240, 600, 165, 150, 600, 0 },
1633
1634/* { XFER_PIO_SLOW, 120, 290, 240, 960, 290, 240, 960, 0 }, */
1635
1636 { 0xFF }
1637};
1638
1639#define ENOUGH(v,unit) (((v)-1)/(unit)+1)
1640#define EZ(v,unit) ((v)?ENOUGH(v,unit):0)
1641
1642static void ata_timing_quantize(const struct ata_timing *t, struct ata_timing *q, int T, int UT)
1643{
1644 q->setup = EZ(t->setup * 1000, T);
1645 q->act8b = EZ(t->act8b * 1000, T);
1646 q->rec8b = EZ(t->rec8b * 1000, T);
1647 q->cyc8b = EZ(t->cyc8b * 1000, T);
1648 q->active = EZ(t->active * 1000, T);
1649 q->recover = EZ(t->recover * 1000, T);
1650 q->cycle = EZ(t->cycle * 1000, T);
1651 q->udma = EZ(t->udma * 1000, UT);
1652}
1653
1654void ata_timing_merge(const struct ata_timing *a, const struct ata_timing *b,
1655 struct ata_timing *m, unsigned int what)
1656{
1657 if (what & ATA_TIMING_SETUP ) m->setup = max(a->setup, b->setup);
1658 if (what & ATA_TIMING_ACT8B ) m->act8b = max(a->act8b, b->act8b);
1659 if (what & ATA_TIMING_REC8B ) m->rec8b = max(a->rec8b, b->rec8b);
1660 if (what & ATA_TIMING_CYC8B ) m->cyc8b = max(a->cyc8b, b->cyc8b);
1661 if (what & ATA_TIMING_ACTIVE ) m->active = max(a->active, b->active);
1662 if (what & ATA_TIMING_RECOVER) m->recover = max(a->recover, b->recover);
1663 if (what & ATA_TIMING_CYCLE ) m->cycle = max(a->cycle, b->cycle);
1664 if (what & ATA_TIMING_UDMA ) m->udma = max(a->udma, b->udma);
1665}
1666
1667static const struct ata_timing* ata_timing_find_mode(unsigned short speed)
1668{
1669 const struct ata_timing *t;
1670
1671 for (t = ata_timing; t->mode != speed; t++)
Alan Cox91190752005-10-26 12:17:46 -04001672 if (t->mode == 0xFF)
Alan Cox452503f2005-10-21 19:01:32 -04001673 return NULL;
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05001674 return t;
Alan Cox452503f2005-10-21 19:01:32 -04001675}
1676
1677int ata_timing_compute(struct ata_device *adev, unsigned short speed,
1678 struct ata_timing *t, int T, int UT)
1679{
1680 const struct ata_timing *s;
1681 struct ata_timing p;
1682
1683 /*
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05001684 * Find the mode.
Albert Lee75b1f2f2005-11-16 17:06:18 +08001685 */
Alan Cox452503f2005-10-21 19:01:32 -04001686
1687 if (!(s = ata_timing_find_mode(speed)))
1688 return -EINVAL;
1689
Albert Lee75b1f2f2005-11-16 17:06:18 +08001690 memcpy(t, s, sizeof(*s));
1691
Alan Cox452503f2005-10-21 19:01:32 -04001692 /*
1693 * If the drive is an EIDE drive, it can tell us it needs extended
1694 * PIO/MW_DMA cycle timing.
1695 */
1696
1697 if (adev->id[ATA_ID_FIELD_VALID] & 2) { /* EIDE drive */
1698 memset(&p, 0, sizeof(p));
1699 if(speed >= XFER_PIO_0 && speed <= XFER_SW_DMA_0) {
1700 if (speed <= XFER_PIO_2) p.cycle = p.cyc8b = adev->id[ATA_ID_EIDE_PIO];
1701 else p.cycle = p.cyc8b = adev->id[ATA_ID_EIDE_PIO_IORDY];
1702 } else if(speed >= XFER_MW_DMA_0 && speed <= XFER_MW_DMA_2) {
1703 p.cycle = adev->id[ATA_ID_EIDE_DMA_MIN];
1704 }
1705 ata_timing_merge(&p, t, t, ATA_TIMING_CYCLE | ATA_TIMING_CYC8B);
1706 }
1707
1708 /*
1709 * Convert the timing to bus clock counts.
1710 */
1711
Albert Lee75b1f2f2005-11-16 17:06:18 +08001712 ata_timing_quantize(t, t, T, UT);
Alan Cox452503f2005-10-21 19:01:32 -04001713
1714 /*
Randy Dunlapc893a3a2006-01-28 13:15:32 -05001715 * Even in DMA/UDMA modes we still use PIO access for IDENTIFY,
1716 * S.M.A.R.T * and some other commands. We have to ensure that the
1717 * DMA cycle timing is slower/equal than the fastest PIO timing.
Alan Cox452503f2005-10-21 19:01:32 -04001718 */
1719
1720 if (speed > XFER_PIO_4) {
1721 ata_timing_compute(adev, adev->pio_mode, &p, T, UT);
1722 ata_timing_merge(&p, t, t, ATA_TIMING_ALL);
1723 }
1724
1725 /*
Randy Dunlapc893a3a2006-01-28 13:15:32 -05001726 * Lengthen active & recovery time so that cycle time is correct.
Alan Cox452503f2005-10-21 19:01:32 -04001727 */
1728
1729 if (t->act8b + t->rec8b < t->cyc8b) {
1730 t->act8b += (t->cyc8b - (t->act8b + t->rec8b)) / 2;
1731 t->rec8b = t->cyc8b - t->act8b;
1732 }
1733
1734 if (t->active + t->recover < t->cycle) {
1735 t->active += (t->cycle - (t->active + t->recover)) / 2;
1736 t->recover = t->cycle - t->active;
1737 }
1738
1739 return 0;
1740}
1741
Tejun Heo83206a22006-03-24 15:25:31 +09001742static int ata_dev_set_mode(struct ata_port *ap, struct ata_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001743{
Tejun Heo83206a22006-03-24 15:25:31 +09001744 unsigned int err_mask;
1745 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001746
1747 if (dev->xfer_shift == ATA_SHIFT_PIO)
1748 dev->flags |= ATA_DFLAG_PIO;
1749
Tejun Heo83206a22006-03-24 15:25:31 +09001750 err_mask = ata_dev_set_xfermode(ap, dev);
1751 if (err_mask) {
1752 printk(KERN_ERR
1753 "ata%u: failed to set xfermode (err_mask=0x%x)\n",
1754 ap->id, err_mask);
1755 return -EIO;
1756 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001757
Tejun Heo83206a22006-03-24 15:25:31 +09001758 rc = ata_dev_revalidate(ap, dev, 0);
1759 if (rc) {
1760 printk(KERN_ERR
1761 "ata%u: failed to revalidate after set xfermode\n",
1762 ap->id);
1763 return rc;
Tejun Heo48a8a142006-03-05 17:55:58 +09001764 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001765
Tejun Heo23e71c32006-03-06 04:31:57 +09001766 DPRINTK("xfer_shift=%u, xfer_mode=0x%x\n",
1767 dev->xfer_shift, (int)dev->xfer_mode);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001768
1769 printk(KERN_INFO "ata%u: dev %u configured for %s\n",
Tejun Heo23e71c32006-03-06 04:31:57 +09001770 ap->id, dev->devno,
1771 ata_mode_string(ata_xfer_mode2mask(dev->xfer_mode)));
Tejun Heo83206a22006-03-24 15:25:31 +09001772 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001773}
1774
1775static int ata_host_set_pio(struct ata_port *ap)
1776{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001777 int i;
1778
1779 for (i = 0; i < ATA_MAX_DEVICES; i++) {
1780 struct ata_device *dev = &ap->device[i];
Tejun Heoa6d5a512006-03-06 04:31:57 +09001781
1782 if (!ata_dev_present(dev))
1783 continue;
1784
1785 if (!dev->pio_mode) {
Alan Cox88f93a32006-03-21 16:04:12 +00001786 printk(KERN_WARNING "ata%u: no PIO support for device %d.\n", ap->id, i);
Tejun Heoa6d5a512006-03-06 04:31:57 +09001787 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001788 }
Tejun Heoa6d5a512006-03-06 04:31:57 +09001789
1790 dev->xfer_mode = dev->pio_mode;
1791 dev->xfer_shift = ATA_SHIFT_PIO;
1792 if (ap->ops->set_piomode)
1793 ap->ops->set_piomode(ap, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001794 }
1795
1796 return 0;
1797}
1798
Tejun Heoa6d5a512006-03-06 04:31:57 +09001799static void ata_host_set_dma(struct ata_port *ap)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800{
1801 int i;
1802
1803 for (i = 0; i < ATA_MAX_DEVICES; i++) {
1804 struct ata_device *dev = &ap->device[i];
Tejun Heoa6d5a512006-03-06 04:31:57 +09001805
1806 if (!ata_dev_present(dev) || !dev->dma_mode)
1807 continue;
1808
1809 dev->xfer_mode = dev->dma_mode;
1810 dev->xfer_shift = ata_xfer_mode2shift(dev->dma_mode);
1811 if (ap->ops->set_dmamode)
1812 ap->ops->set_dmamode(ap, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001813 }
1814}
1815
1816/**
1817 * ata_set_mode - Program timings and issue SET FEATURES - XFER
1818 * @ap: port on which timings will be programmed
1819 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04001820 * Set ATA device disk transfer mode (PIO3, UDMA6, etc.).
1821 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07001822 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04001823 * PCI/etc. bus probe sem.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001824 */
1825static void ata_set_mode(struct ata_port *ap)
1826{
Tejun Heoa6d5a512006-03-06 04:31:57 +09001827 int i, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001828
Tejun Heoa6d5a512006-03-06 04:31:57 +09001829 /* step 1: calculate xfer_mask */
1830 for (i = 0; i < ATA_MAX_DEVICES; i++) {
1831 struct ata_device *dev = &ap->device[i];
Tejun Heoacf356b2006-03-24 14:07:50 +09001832 unsigned int pio_mask, dma_mask;
Tejun Heoa6d5a512006-03-06 04:31:57 +09001833
1834 if (!ata_dev_present(dev))
1835 continue;
1836
Tejun Heoacf356b2006-03-24 14:07:50 +09001837 ata_dev_xfermask(ap, dev);
Tejun Heoa6d5a512006-03-06 04:31:57 +09001838
Tejun Heoacf356b2006-03-24 14:07:50 +09001839 /* TODO: let LLDD filter dev->*_mask here */
1840
1841 pio_mask = ata_pack_xfermask(dev->pio_mask, 0, 0);
1842 dma_mask = ata_pack_xfermask(0, dev->mwdma_mask, dev->udma_mask);
1843 dev->pio_mode = ata_xfer_mask2mode(pio_mask);
1844 dev->dma_mode = ata_xfer_mask2mode(dma_mask);
Tejun Heoa6d5a512006-03-06 04:31:57 +09001845 }
1846
1847 /* step 2: always set host PIO timings */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001848 rc = ata_host_set_pio(ap);
1849 if (rc)
1850 goto err_out;
1851
Tejun Heoa6d5a512006-03-06 04:31:57 +09001852 /* step 3: set host DMA timings */
1853 ata_host_set_dma(ap);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001854
1855 /* step 4: update devices' xfer mode */
Tejun Heo83206a22006-03-24 15:25:31 +09001856 for (i = 0; i < ATA_MAX_DEVICES; i++) {
1857 struct ata_device *dev = &ap->device[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001858
Tejun Heo83206a22006-03-24 15:25:31 +09001859 if (!ata_dev_present(dev))
1860 continue;
1861
1862 if (ata_dev_set_mode(ap, dev))
1863 goto err_out;
1864 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001865
1866 if (ap->ops->post_set_mode)
1867 ap->ops->post_set_mode(ap);
1868
Linus Torvalds1da177e2005-04-16 15:20:36 -07001869 return;
1870
1871err_out:
1872 ata_port_disable(ap);
1873}
1874
1875/**
Jeff Garzik1fdffbc2006-02-09 05:15:27 -05001876 * ata_tf_to_host - issue ATA taskfile to host controller
1877 * @ap: port to which command is being issued
1878 * @tf: ATA taskfile register set
1879 *
1880 * Issues ATA taskfile register set to ATA host controller,
1881 * with proper synchronization with interrupt handler and
1882 * other threads.
1883 *
1884 * LOCKING:
1885 * spin_lock_irqsave(host_set lock)
1886 */
1887
1888static inline void ata_tf_to_host(struct ata_port *ap,
1889 const struct ata_taskfile *tf)
1890{
1891 ap->ops->tf_load(ap, tf);
1892 ap->ops->exec_command(ap, tf);
1893}
1894
1895/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07001896 * ata_busy_sleep - sleep until BSY clears, or timeout
1897 * @ap: port containing status register to be polled
1898 * @tmout_pat: impatience timeout
1899 * @tmout: overall timeout
1900 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04001901 * Sleep until ATA Status register bit BSY clears,
1902 * or a timeout occurs.
1903 *
1904 * LOCKING: None.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001905 */
1906
Tejun Heo6f8b9952006-01-24 17:05:21 +09001907unsigned int ata_busy_sleep (struct ata_port *ap,
1908 unsigned long tmout_pat, unsigned long tmout)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001909{
1910 unsigned long timer_start, timeout;
1911 u8 status;
1912
1913 status = ata_busy_wait(ap, ATA_BUSY, 300);
1914 timer_start = jiffies;
1915 timeout = timer_start + tmout_pat;
1916 while ((status & ATA_BUSY) && (time_before(jiffies, timeout))) {
1917 msleep(50);
1918 status = ata_busy_wait(ap, ATA_BUSY, 3);
1919 }
1920
1921 if (status & ATA_BUSY)
1922 printk(KERN_WARNING "ata%u is slow to respond, "
1923 "please be patient\n", ap->id);
1924
1925 timeout = timer_start + tmout;
1926 while ((status & ATA_BUSY) && (time_before(jiffies, timeout))) {
1927 msleep(50);
1928 status = ata_chk_status(ap);
1929 }
1930
1931 if (status & ATA_BUSY) {
1932 printk(KERN_ERR "ata%u failed to respond (%lu secs)\n",
1933 ap->id, tmout / HZ);
1934 return 1;
1935 }
1936
1937 return 0;
1938}
1939
1940static void ata_bus_post_reset(struct ata_port *ap, unsigned int devmask)
1941{
1942 struct ata_ioports *ioaddr = &ap->ioaddr;
1943 unsigned int dev0 = devmask & (1 << 0);
1944 unsigned int dev1 = devmask & (1 << 1);
1945 unsigned long timeout;
1946
1947 /* if device 0 was found in ata_devchk, wait for its
1948 * BSY bit to clear
1949 */
1950 if (dev0)
1951 ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT);
1952
1953 /* if device 1 was found in ata_devchk, wait for
1954 * register access, then wait for BSY to clear
1955 */
1956 timeout = jiffies + ATA_TMOUT_BOOT;
1957 while (dev1) {
1958 u8 nsect, lbal;
1959
1960 ap->ops->dev_select(ap, 1);
1961 if (ap->flags & ATA_FLAG_MMIO) {
1962 nsect = readb((void __iomem *) ioaddr->nsect_addr);
1963 lbal = readb((void __iomem *) ioaddr->lbal_addr);
1964 } else {
1965 nsect = inb(ioaddr->nsect_addr);
1966 lbal = inb(ioaddr->lbal_addr);
1967 }
1968 if ((nsect == 1) && (lbal == 1))
1969 break;
1970 if (time_after(jiffies, timeout)) {
1971 dev1 = 0;
1972 break;
1973 }
1974 msleep(50); /* give drive a breather */
1975 }
1976 if (dev1)
1977 ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT);
1978
1979 /* is all this really necessary? */
1980 ap->ops->dev_select(ap, 0);
1981 if (dev1)
1982 ap->ops->dev_select(ap, 1);
1983 if (dev0)
1984 ap->ops->dev_select(ap, 0);
1985}
1986
Linus Torvalds1da177e2005-04-16 15:20:36 -07001987static unsigned int ata_bus_softreset(struct ata_port *ap,
1988 unsigned int devmask)
1989{
1990 struct ata_ioports *ioaddr = &ap->ioaddr;
1991
1992 DPRINTK("ata%u: bus reset via SRST\n", ap->id);
1993
1994 /* software reset. causes dev0 to be selected */
1995 if (ap->flags & ATA_FLAG_MMIO) {
1996 writeb(ap->ctl, (void __iomem *) ioaddr->ctl_addr);
1997 udelay(20); /* FIXME: flush */
1998 writeb(ap->ctl | ATA_SRST, (void __iomem *) ioaddr->ctl_addr);
1999 udelay(20); /* FIXME: flush */
2000 writeb(ap->ctl, (void __iomem *) ioaddr->ctl_addr);
2001 } else {
2002 outb(ap->ctl, ioaddr->ctl_addr);
2003 udelay(10);
2004 outb(ap->ctl | ATA_SRST, ioaddr->ctl_addr);
2005 udelay(10);
2006 outb(ap->ctl, ioaddr->ctl_addr);
2007 }
2008
2009 /* spec mandates ">= 2ms" before checking status.
2010 * We wait 150ms, because that was the magic delay used for
2011 * ATAPI devices in Hale Landis's ATADRVR, for the period of time
2012 * between when the ATA command register is written, and then
2013 * status is checked. Because waiting for "a while" before
2014 * checking status is fine, post SRST, we perform this magic
2015 * delay here as well.
Alan Cox09c7ad72006-03-22 15:52:40 +00002016 *
2017 * Old drivers/ide uses the 2mS rule and then waits for ready
Linus Torvalds1da177e2005-04-16 15:20:36 -07002018 */
2019 msleep(150);
2020
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05002021
2022 /* Before we perform post reset processing we want to see if
Alan Cox09c7ad72006-03-22 15:52:40 +00002023 the bus shows 0xFF because the odd clown forgets the D7 pulldown
2024 resistor */
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05002025
Alan Cox09c7ad72006-03-22 15:52:40 +00002026 if (ata_check_status(ap) == 0xFF)
2027 return 1; /* Positive is failure for some reason */
2028
Linus Torvalds1da177e2005-04-16 15:20:36 -07002029 ata_bus_post_reset(ap, devmask);
2030
2031 return 0;
2032}
2033
2034/**
2035 * ata_bus_reset - reset host port and associated ATA channel
2036 * @ap: port to reset
2037 *
2038 * This is typically the first time we actually start issuing
2039 * commands to the ATA channel. We wait for BSY to clear, then
2040 * issue EXECUTE DEVICE DIAGNOSTIC command, polling for its
2041 * result. Determine what devices, if any, are on the channel
2042 * by looking at the device 0/1 error register. Look at the signature
2043 * stored in each device's taskfile registers, to determine if
2044 * the device is ATA or ATAPI.
2045 *
2046 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04002047 * PCI/etc. bus probe sem.
2048 * Obtains host_set lock.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049 *
2050 * SIDE EFFECTS:
2051 * Sets ATA_FLAG_PORT_DISABLED if bus reset fails.
2052 */
2053
2054void ata_bus_reset(struct ata_port *ap)
2055{
2056 struct ata_ioports *ioaddr = &ap->ioaddr;
2057 unsigned int slave_possible = ap->flags & ATA_FLAG_SLAVE_POSS;
2058 u8 err;
Tejun Heoaec5c3c2006-03-25 01:33:34 +09002059 unsigned int dev0, dev1 = 0, devmask = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002060
2061 DPRINTK("ENTER, host %u, port %u\n", ap->id, ap->port_no);
2062
2063 /* determine if device 0/1 are present */
2064 if (ap->flags & ATA_FLAG_SATA_RESET)
2065 dev0 = 1;
2066 else {
2067 dev0 = ata_devchk(ap, 0);
2068 if (slave_possible)
2069 dev1 = ata_devchk(ap, 1);
2070 }
2071
2072 if (dev0)
2073 devmask |= (1 << 0);
2074 if (dev1)
2075 devmask |= (1 << 1);
2076
2077 /* select device 0 again */
2078 ap->ops->dev_select(ap, 0);
2079
2080 /* issue bus reset */
2081 if (ap->flags & ATA_FLAG_SRST)
Tejun Heoaec5c3c2006-03-25 01:33:34 +09002082 if (ata_bus_softreset(ap, devmask))
2083 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002084
2085 /*
2086 * determine by signature whether we have ATA or ATAPI devices
2087 */
Tejun Heob4dc7622006-01-24 17:05:22 +09002088 ap->device[0].class = ata_dev_try_classify(ap, 0, &err);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002089 if ((slave_possible) && (err != 0x81))
Tejun Heob4dc7622006-01-24 17:05:22 +09002090 ap->device[1].class = ata_dev_try_classify(ap, 1, &err);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002091
2092 /* re-enable interrupts */
2093 if (ap->ioaddr.ctl_addr) /* FIXME: hack. create a hook instead */
2094 ata_irq_on(ap);
2095
2096 /* is double-select really necessary? */
2097 if (ap->device[1].class != ATA_DEV_NONE)
2098 ap->ops->dev_select(ap, 1);
2099 if (ap->device[0].class != ATA_DEV_NONE)
2100 ap->ops->dev_select(ap, 0);
2101
2102 /* if no devices were detected, disable this port */
2103 if ((ap->device[0].class == ATA_DEV_NONE) &&
2104 (ap->device[1].class == ATA_DEV_NONE))
2105 goto err_out;
2106
2107 if (ap->flags & (ATA_FLAG_SATA_RESET | ATA_FLAG_SRST)) {
2108 /* set up device control for ATA_FLAG_SATA_RESET */
2109 if (ap->flags & ATA_FLAG_MMIO)
2110 writeb(ap->ctl, (void __iomem *) ioaddr->ctl_addr);
2111 else
2112 outb(ap->ctl, ioaddr->ctl_addr);
2113 }
2114
2115 DPRINTK("EXIT\n");
2116 return;
2117
2118err_out:
2119 printk(KERN_ERR "ata%u: disabling port\n", ap->id);
2120 ap->ops->port_disable(ap);
2121
2122 DPRINTK("EXIT\n");
2123}
2124
Tejun Heo7a7921e2006-02-02 18:20:00 +09002125static int sata_phy_resume(struct ata_port *ap)
2126{
2127 unsigned long timeout = jiffies + (HZ * 5);
2128 u32 sstatus;
2129
2130 scr_write_flush(ap, SCR_CONTROL, 0x300);
2131
2132 /* Wait for phy to become ready, if necessary. */
2133 do {
2134 msleep(200);
2135 sstatus = scr_read(ap, SCR_STATUS);
2136 if ((sstatus & 0xf) != 1)
2137 return 0;
2138 } while (time_before(jiffies, timeout));
2139
2140 return -1;
2141}
2142
Tejun Heoc2bd5802006-01-24 17:05:22 +09002143/**
Tejun Heo8a19ac82006-02-02 18:20:00 +09002144 * ata_std_probeinit - initialize probing
2145 * @ap: port to be probed
2146 *
2147 * @ap is about to be probed. Initialize it. This function is
2148 * to be used as standard callback for ata_drive_probe_reset().
Tejun Heo3a397462006-02-10 23:58:48 +09002149 *
2150 * NOTE!!! Do not use this function as probeinit if a low level
2151 * driver implements only hardreset. Just pass NULL as probeinit
2152 * in that case. Using this function is probably okay but doing
2153 * so makes reset sequence different from the original
2154 * ->phy_reset implementation and Jeff nervous. :-P
Tejun Heo8a19ac82006-02-02 18:20:00 +09002155 */
2156extern void ata_std_probeinit(struct ata_port *ap)
2157{
Tejun Heo3a397462006-02-10 23:58:48 +09002158 if (ap->flags & ATA_FLAG_SATA && ap->ops->scr_read) {
Tejun Heo8a19ac82006-02-02 18:20:00 +09002159 sata_phy_resume(ap);
Tejun Heo3a397462006-02-10 23:58:48 +09002160 if (sata_dev_present(ap))
2161 ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT);
2162 }
Tejun Heo8a19ac82006-02-02 18:20:00 +09002163}
2164
2165/**
Tejun Heoc2bd5802006-01-24 17:05:22 +09002166 * ata_std_softreset - reset host port via ATA SRST
2167 * @ap: port to reset
2168 * @verbose: fail verbosely
2169 * @classes: resulting classes of attached devices
2170 *
2171 * Reset host port using ATA SRST. This function is to be used
2172 * as standard callback for ata_drive_*_reset() functions.
2173 *
2174 * LOCKING:
2175 * Kernel thread context (may sleep)
2176 *
2177 * RETURNS:
2178 * 0 on success, -errno otherwise.
2179 */
2180int ata_std_softreset(struct ata_port *ap, int verbose, unsigned int *classes)
2181{
2182 unsigned int slave_possible = ap->flags & ATA_FLAG_SLAVE_POSS;
2183 unsigned int devmask = 0, err_mask;
2184 u8 err;
2185
2186 DPRINTK("ENTER\n");
2187
Tejun Heo3a397462006-02-10 23:58:48 +09002188 if (ap->ops->scr_read && !sata_dev_present(ap)) {
2189 classes[0] = ATA_DEV_NONE;
2190 goto out;
2191 }
2192
Tejun Heoc2bd5802006-01-24 17:05:22 +09002193 /* determine if device 0/1 are present */
2194 if (ata_devchk(ap, 0))
2195 devmask |= (1 << 0);
2196 if (slave_possible && ata_devchk(ap, 1))
2197 devmask |= (1 << 1);
2198
Tejun Heoc2bd5802006-01-24 17:05:22 +09002199 /* select device 0 again */
2200 ap->ops->dev_select(ap, 0);
2201
2202 /* issue bus reset */
2203 DPRINTK("about to softreset, devmask=%x\n", devmask);
2204 err_mask = ata_bus_softreset(ap, devmask);
2205 if (err_mask) {
2206 if (verbose)
2207 printk(KERN_ERR "ata%u: SRST failed (err_mask=0x%x)\n",
2208 ap->id, err_mask);
2209 else
2210 DPRINTK("EXIT, softreset failed (err_mask=0x%x)\n",
2211 err_mask);
2212 return -EIO;
2213 }
2214
2215 /* determine by signature whether we have ATA or ATAPI devices */
2216 classes[0] = ata_dev_try_classify(ap, 0, &err);
2217 if (slave_possible && err != 0x81)
2218 classes[1] = ata_dev_try_classify(ap, 1, &err);
2219
Tejun Heo3a397462006-02-10 23:58:48 +09002220 out:
Tejun Heoc2bd5802006-01-24 17:05:22 +09002221 DPRINTK("EXIT, classes[0]=%u [1]=%u\n", classes[0], classes[1]);
2222 return 0;
2223}
2224
2225/**
2226 * sata_std_hardreset - reset host port via SATA phy reset
2227 * @ap: port to reset
2228 * @verbose: fail verbosely
2229 * @class: resulting class of attached device
2230 *
2231 * SATA phy-reset host port using DET bits of SControl register.
2232 * This function is to be used as standard callback for
2233 * ata_drive_*_reset().
2234 *
2235 * LOCKING:
2236 * Kernel thread context (may sleep)
2237 *
2238 * RETURNS:
2239 * 0 on success, -errno otherwise.
2240 */
2241int sata_std_hardreset(struct ata_port *ap, int verbose, unsigned int *class)
2242{
Tejun Heoc2bd5802006-01-24 17:05:22 +09002243 DPRINTK("ENTER\n");
2244
2245 /* Issue phy wake/reset */
2246 scr_write_flush(ap, SCR_CONTROL, 0x301);
2247
2248 /*
2249 * Couldn't find anything in SATA I/II specs, but AHCI-1.1
2250 * 10.4.2 says at least 1 ms.
2251 */
2252 msleep(1);
2253
Tejun Heo7a7921e2006-02-02 18:20:00 +09002254 /* Bring phy back */
2255 sata_phy_resume(ap);
Tejun Heoc2bd5802006-01-24 17:05:22 +09002256
Tejun Heoc2bd5802006-01-24 17:05:22 +09002257 /* TODO: phy layer with polling, timeouts, etc. */
2258 if (!sata_dev_present(ap)) {
2259 *class = ATA_DEV_NONE;
2260 DPRINTK("EXIT, link offline\n");
2261 return 0;
2262 }
2263
2264 if (ata_busy_sleep(ap, ATA_TMOUT_BOOT_QUICK, ATA_TMOUT_BOOT)) {
2265 if (verbose)
2266 printk(KERN_ERR "ata%u: COMRESET failed "
2267 "(device not ready)\n", ap->id);
2268 else
2269 DPRINTK("EXIT, device not ready\n");
2270 return -EIO;
2271 }
2272
Tejun Heo3a397462006-02-10 23:58:48 +09002273 ap->ops->dev_select(ap, 0); /* probably unnecessary */
2274
Tejun Heoc2bd5802006-01-24 17:05:22 +09002275 *class = ata_dev_try_classify(ap, 0, NULL);
2276
2277 DPRINTK("EXIT, class=%u\n", *class);
2278 return 0;
2279}
2280
2281/**
2282 * ata_std_postreset - standard postreset callback
2283 * @ap: the target ata_port
2284 * @classes: classes of attached devices
2285 *
2286 * This function is invoked after a successful reset. Note that
2287 * the device might have been reset more than once using
2288 * different reset methods before postreset is invoked.
Tejun Heoc2bd5802006-01-24 17:05:22 +09002289 *
2290 * This function is to be used as standard callback for
2291 * ata_drive_*_reset().
2292 *
2293 * LOCKING:
2294 * Kernel thread context (may sleep)
2295 */
2296void ata_std_postreset(struct ata_port *ap, unsigned int *classes)
2297{
2298 DPRINTK("ENTER\n");
2299
Tejun Heo56497bd2006-02-15 15:01:42 +09002300 /* set cable type if it isn't already set */
Tejun Heoc2bd5802006-01-24 17:05:22 +09002301 if (ap->cbl == ATA_CBL_NONE && ap->flags & ATA_FLAG_SATA)
2302 ap->cbl = ATA_CBL_SATA;
2303
2304 /* print link status */
2305 if (ap->cbl == ATA_CBL_SATA)
2306 sata_print_link_status(ap);
2307
Tejun Heo3a397462006-02-10 23:58:48 +09002308 /* re-enable interrupts */
2309 if (ap->ioaddr.ctl_addr) /* FIXME: hack. create a hook instead */
2310 ata_irq_on(ap);
Tejun Heoc2bd5802006-01-24 17:05:22 +09002311
2312 /* is double-select really necessary? */
2313 if (classes[0] != ATA_DEV_NONE)
2314 ap->ops->dev_select(ap, 1);
2315 if (classes[1] != ATA_DEV_NONE)
2316 ap->ops->dev_select(ap, 0);
2317
Tejun Heo3a397462006-02-10 23:58:48 +09002318 /* bail out if no device is present */
2319 if (classes[0] == ATA_DEV_NONE && classes[1] == ATA_DEV_NONE) {
2320 DPRINTK("EXIT, no device\n");
2321 return;
2322 }
2323
2324 /* set up device control */
2325 if (ap->ioaddr.ctl_addr) {
2326 if (ap->flags & ATA_FLAG_MMIO)
2327 writeb(ap->ctl, (void __iomem *) ap->ioaddr.ctl_addr);
2328 else
2329 outb(ap->ctl, ap->ioaddr.ctl_addr);
2330 }
Tejun Heoc2bd5802006-01-24 17:05:22 +09002331
2332 DPRINTK("EXIT\n");
2333}
2334
2335/**
2336 * ata_std_probe_reset - standard probe reset method
2337 * @ap: prot to perform probe-reset
2338 * @classes: resulting classes of attached devices
2339 *
2340 * The stock off-the-shelf ->probe_reset method.
2341 *
2342 * LOCKING:
2343 * Kernel thread context (may sleep)
2344 *
2345 * RETURNS:
2346 * 0 on success, -errno otherwise.
2347 */
2348int ata_std_probe_reset(struct ata_port *ap, unsigned int *classes)
2349{
2350 ata_reset_fn_t hardreset;
2351
2352 hardreset = NULL;
Tejun Heob911fc32006-02-02 18:20:00 +09002353 if (ap->flags & ATA_FLAG_SATA && ap->ops->scr_read)
Tejun Heoc2bd5802006-01-24 17:05:22 +09002354 hardreset = sata_std_hardreset;
2355
Tejun Heo8a19ac82006-02-02 18:20:00 +09002356 return ata_drive_probe_reset(ap, ata_std_probeinit,
Tejun Heo7944ea92006-02-02 18:20:00 +09002357 ata_std_softreset, hardreset,
Tejun Heoc2bd5802006-01-24 17:05:22 +09002358 ata_std_postreset, classes);
2359}
2360
Tejun Heoa62c0fc2006-01-24 17:05:22 +09002361static int do_probe_reset(struct ata_port *ap, ata_reset_fn_t reset,
2362 ata_postreset_fn_t postreset,
2363 unsigned int *classes)
2364{
2365 int i, rc;
2366
2367 for (i = 0; i < ATA_MAX_DEVICES; i++)
2368 classes[i] = ATA_DEV_UNKNOWN;
2369
2370 rc = reset(ap, 0, classes);
2371 if (rc)
2372 return rc;
2373
2374 /* If any class isn't ATA_DEV_UNKNOWN, consider classification
2375 * is complete and convert all ATA_DEV_UNKNOWN to
2376 * ATA_DEV_NONE.
2377 */
2378 for (i = 0; i < ATA_MAX_DEVICES; i++)
2379 if (classes[i] != ATA_DEV_UNKNOWN)
2380 break;
2381
2382 if (i < ATA_MAX_DEVICES)
2383 for (i = 0; i < ATA_MAX_DEVICES; i++)
2384 if (classes[i] == ATA_DEV_UNKNOWN)
2385 classes[i] = ATA_DEV_NONE;
2386
2387 if (postreset)
2388 postreset(ap, classes);
2389
2390 return classes[0] != ATA_DEV_UNKNOWN ? 0 : -ENODEV;
2391}
2392
2393/**
2394 * ata_drive_probe_reset - Perform probe reset with given methods
2395 * @ap: port to reset
Tejun Heo7944ea92006-02-02 18:20:00 +09002396 * @probeinit: probeinit method (can be NULL)
Tejun Heoa62c0fc2006-01-24 17:05:22 +09002397 * @softreset: softreset method (can be NULL)
2398 * @hardreset: hardreset method (can be NULL)
2399 * @postreset: postreset method (can be NULL)
2400 * @classes: resulting classes of attached devices
2401 *
2402 * Reset the specified port and classify attached devices using
2403 * given methods. This function prefers softreset but tries all
2404 * possible reset sequences to reset and classify devices. This
2405 * function is intended to be used for constructing ->probe_reset
2406 * callback by low level drivers.
2407 *
2408 * Reset methods should follow the following rules.
2409 *
2410 * - Return 0 on sucess, -errno on failure.
2411 * - If classification is supported, fill classes[] with
2412 * recognized class codes.
2413 * - If classification is not supported, leave classes[] alone.
2414 * - If verbose is non-zero, print error message on failure;
2415 * otherwise, shut up.
2416 *
2417 * LOCKING:
2418 * Kernel thread context (may sleep)
2419 *
2420 * RETURNS:
2421 * 0 on success, -EINVAL if no reset method is avaliable, -ENODEV
2422 * if classification fails, and any error code from reset
2423 * methods.
2424 */
Tejun Heo7944ea92006-02-02 18:20:00 +09002425int ata_drive_probe_reset(struct ata_port *ap, ata_probeinit_fn_t probeinit,
Tejun Heoa62c0fc2006-01-24 17:05:22 +09002426 ata_reset_fn_t softreset, ata_reset_fn_t hardreset,
2427 ata_postreset_fn_t postreset, unsigned int *classes)
2428{
2429 int rc = -EINVAL;
2430
Tejun Heo7944ea92006-02-02 18:20:00 +09002431 if (probeinit)
2432 probeinit(ap);
2433
Tejun Heoa62c0fc2006-01-24 17:05:22 +09002434 if (softreset) {
2435 rc = do_probe_reset(ap, softreset, postreset, classes);
2436 if (rc == 0)
2437 return 0;
2438 }
2439
2440 if (!hardreset)
2441 return rc;
2442
2443 rc = do_probe_reset(ap, hardreset, postreset, classes);
2444 if (rc == 0 || rc != -ENODEV)
2445 return rc;
2446
2447 if (softreset)
2448 rc = do_probe_reset(ap, softreset, postreset, classes);
2449
2450 return rc;
2451}
2452
Tejun Heo623a3122006-03-05 17:55:58 +09002453/**
2454 * ata_dev_same_device - Determine whether new ID matches configured device
2455 * @ap: port on which the device to compare against resides
2456 * @dev: device to compare against
2457 * @new_class: class of the new device
2458 * @new_id: IDENTIFY page of the new device
2459 *
2460 * Compare @new_class and @new_id against @dev and determine
2461 * whether @dev is the device indicated by @new_class and
2462 * @new_id.
2463 *
2464 * LOCKING:
2465 * None.
2466 *
2467 * RETURNS:
2468 * 1 if @dev matches @new_class and @new_id, 0 otherwise.
2469 */
2470static int ata_dev_same_device(struct ata_port *ap, struct ata_device *dev,
2471 unsigned int new_class, const u16 *new_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002472{
Tejun Heo623a3122006-03-05 17:55:58 +09002473 const u16 *old_id = dev->id;
2474 unsigned char model[2][41], serial[2][21];
2475 u64 new_n_sectors;
2476
2477 if (dev->class != new_class) {
2478 printk(KERN_INFO
2479 "ata%u: dev %u class mismatch %d != %d\n",
2480 ap->id, dev->devno, dev->class, new_class);
2481 return 0;
2482 }
2483
2484 ata_id_c_string(old_id, model[0], ATA_ID_PROD_OFS, sizeof(model[0]));
2485 ata_id_c_string(new_id, model[1], ATA_ID_PROD_OFS, sizeof(model[1]));
2486 ata_id_c_string(old_id, serial[0], ATA_ID_SERNO_OFS, sizeof(serial[0]));
2487 ata_id_c_string(new_id, serial[1], ATA_ID_SERNO_OFS, sizeof(serial[1]));
2488 new_n_sectors = ata_id_n_sectors(new_id);
2489
2490 if (strcmp(model[0], model[1])) {
2491 printk(KERN_INFO
2492 "ata%u: dev %u model number mismatch '%s' != '%s'\n",
2493 ap->id, dev->devno, model[0], model[1]);
2494 return 0;
2495 }
2496
2497 if (strcmp(serial[0], serial[1])) {
2498 printk(KERN_INFO
2499 "ata%u: dev %u serial number mismatch '%s' != '%s'\n",
2500 ap->id, dev->devno, serial[0], serial[1]);
2501 return 0;
2502 }
2503
2504 if (dev->class == ATA_DEV_ATA && dev->n_sectors != new_n_sectors) {
2505 printk(KERN_INFO
2506 "ata%u: dev %u n_sectors mismatch %llu != %llu\n",
2507 ap->id, dev->devno, (unsigned long long)dev->n_sectors,
2508 (unsigned long long)new_n_sectors);
2509 return 0;
2510 }
2511
2512 return 1;
2513}
2514
2515/**
2516 * ata_dev_revalidate - Revalidate ATA device
2517 * @ap: port on which the device to revalidate resides
2518 * @dev: device to revalidate
2519 * @post_reset: is this revalidation after reset?
2520 *
2521 * Re-read IDENTIFY page and make sure @dev is still attached to
2522 * the port.
2523 *
2524 * LOCKING:
2525 * Kernel thread context (may sleep)
2526 *
2527 * RETURNS:
2528 * 0 on success, negative errno otherwise
2529 */
2530int ata_dev_revalidate(struct ata_port *ap, struct ata_device *dev,
2531 int post_reset)
2532{
2533 unsigned int class;
2534 u16 *id;
2535 int rc;
2536
2537 if (!ata_dev_present(dev))
2538 return -ENODEV;
2539
2540 class = dev->class;
2541 id = NULL;
2542
2543 /* allocate & read ID data */
2544 rc = ata_dev_read_id(ap, dev, &class, post_reset, &id);
2545 if (rc)
2546 goto fail;
2547
2548 /* is the device still there? */
2549 if (!ata_dev_same_device(ap, dev, class, id)) {
2550 rc = -ENODEV;
2551 goto fail;
2552 }
2553
2554 kfree(dev->id);
2555 dev->id = id;
2556
2557 /* configure device according to the new ID */
2558 return ata_dev_configure(ap, dev, 0);
2559
2560 fail:
2561 printk(KERN_ERR "ata%u: dev %u revalidation failed (errno=%d)\n",
2562 ap->id, dev->devno, rc);
2563 kfree(id);
2564 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002565}
2566
Arjan van de Ven98ac62d2005-11-28 10:06:23 +01002567static const char * const ata_dma_blacklist [] = {
Alan Coxf4b15fe2006-03-22 15:54:04 +00002568 "WDC AC11000H", NULL,
2569 "WDC AC22100H", NULL,
2570 "WDC AC32500H", NULL,
2571 "WDC AC33100H", NULL,
2572 "WDC AC31600H", NULL,
2573 "WDC AC32100H", "24.09P07",
2574 "WDC AC23200L", "21.10N21",
2575 "Compaq CRD-8241B", NULL,
2576 "CRD-8400B", NULL,
2577 "CRD-8480B", NULL,
2578 "CRD-8482B", NULL,
2579 "CRD-84", NULL,
2580 "SanDisk SDP3B", NULL,
2581 "SanDisk SDP3B-64", NULL,
2582 "SANYO CD-ROM CRD", NULL,
2583 "HITACHI CDR-8", NULL,
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05002584 "HITACHI CDR-8335", NULL,
Alan Coxf4b15fe2006-03-22 15:54:04 +00002585 "HITACHI CDR-8435", NULL,
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05002586 "Toshiba CD-ROM XM-6202B", NULL,
2587 "TOSHIBA CD-ROM XM-1702BC", NULL,
2588 "CD-532E-A", NULL,
2589 "E-IDE CD-ROM CR-840", NULL,
2590 "CD-ROM Drive/F5A", NULL,
2591 "WPI CDD-820", NULL,
Alan Coxf4b15fe2006-03-22 15:54:04 +00002592 "SAMSUNG CD-ROM SC-148C", NULL,
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05002593 "SAMSUNG CD-ROM SC", NULL,
Alan Coxf4b15fe2006-03-22 15:54:04 +00002594 "SanDisk SDP3B-64", NULL,
2595 "ATAPI CD-ROM DRIVE 40X MAXIMUM",NULL,
2596 "_NEC DV5800A", NULL,
2597 "SAMSUNG CD-ROM SN-124", "N001"
Linus Torvalds1da177e2005-04-16 15:20:36 -07002598};
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05002599
Alan Coxf4b15fe2006-03-22 15:54:04 +00002600static int ata_strim(char *s, size_t len)
2601{
2602 len = strnlen(s, len);
2603
2604 /* ATAPI specifies that empty space is blank-filled; remove blanks */
2605 while ((len > 0) && (s[len - 1] == ' ')) {
2606 len--;
2607 s[len] = 0;
2608 }
2609 return len;
2610}
Linus Torvalds1da177e2005-04-16 15:20:36 -07002611
Jeff Garzik057ace52005-10-22 14:27:05 -04002612static int ata_dma_blacklisted(const struct ata_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002613{
Alan Coxf4b15fe2006-03-22 15:54:04 +00002614 unsigned char model_num[40];
2615 unsigned char model_rev[16];
2616 unsigned int nlen, rlen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002617 int i;
2618
Alan Coxf4b15fe2006-03-22 15:54:04 +00002619 ata_id_string(dev->id, model_num, ATA_ID_PROD_OFS,
2620 sizeof(model_num));
2621 ata_id_string(dev->id, model_rev, ATA_ID_FW_REV_OFS,
2622 sizeof(model_rev));
2623 nlen = ata_strim(model_num, sizeof(model_num));
2624 rlen = ata_strim(model_rev, sizeof(model_rev));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002625
Alan Coxf4b15fe2006-03-22 15:54:04 +00002626 for (i = 0; i < ARRAY_SIZE(ata_dma_blacklist); i += 2) {
2627 if (!strncmp(ata_dma_blacklist[i], model_num, nlen)) {
2628 if (ata_dma_blacklist[i+1] == NULL)
2629 return 1;
2630 if (!strncmp(ata_dma_blacklist[i], model_rev, rlen))
2631 return 1;
2632 }
2633 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002634 return 0;
2635}
2636
Linus Torvalds1da177e2005-04-16 15:20:36 -07002637/**
Tejun Heoa6d5a512006-03-06 04:31:57 +09002638 * ata_dev_xfermask - Compute supported xfermask of the given device
2639 * @ap: Port on which the device to compute xfermask for resides
2640 * @dev: Device to compute xfermask for
Linus Torvalds1da177e2005-04-16 15:20:36 -07002641 *
Tejun Heoacf356b2006-03-24 14:07:50 +09002642 * Compute supported xfermask of @dev and store it in
2643 * dev->*_mask. This function is responsible for applying all
2644 * known limits including host controller limits, device
2645 * blacklist, etc...
Jeff Garzik0cba6322005-05-30 19:49:12 -04002646 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002647 * LOCKING:
Tejun Heoa6d5a512006-03-06 04:31:57 +09002648 * None.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002649 */
Tejun Heoacf356b2006-03-24 14:07:50 +09002650static void ata_dev_xfermask(struct ata_port *ap, struct ata_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002651{
Tejun Heoa6d5a512006-03-06 04:31:57 +09002652 unsigned long xfer_mask;
2653 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002654
Tejun Heoa6d5a512006-03-06 04:31:57 +09002655 xfer_mask = ata_pack_xfermask(ap->pio_mask, ap->mwdma_mask,
2656 ap->udma_mask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002657
Tejun Heoa6d5a512006-03-06 04:31:57 +09002658 /* use port-wide xfermask for now */
2659 for (i = 0; i < ATA_MAX_DEVICES; i++) {
2660 struct ata_device *d = &ap->device[i];
2661 if (!ata_dev_present(d))
2662 continue;
Tejun Heoacf356b2006-03-24 14:07:50 +09002663 xfer_mask &= ata_pack_xfermask(d->pio_mask, d->mwdma_mask,
2664 d->udma_mask);
Tejun Heoa6d5a512006-03-06 04:31:57 +09002665 xfer_mask &= ata_id_xfermask(d->id);
2666 if (ata_dma_blacklisted(d))
2667 xfer_mask &= ~(ATA_MASK_MWDMA | ATA_MASK_UDMA);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002668 }
2669
Tejun Heoa6d5a512006-03-06 04:31:57 +09002670 if (ata_dma_blacklisted(dev))
2671 printk(KERN_WARNING "ata%u: dev %u is on DMA blacklist, "
2672 "disabling DMA\n", ap->id, dev->devno);
2673
Tejun Heoacf356b2006-03-24 14:07:50 +09002674 ata_unpack_xfermask(xfer_mask, &dev->pio_mask, &dev->mwdma_mask,
2675 &dev->udma_mask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002676}
2677
2678/**
2679 * ata_dev_set_xfermode - Issue SET FEATURES - XFER MODE command
2680 * @ap: Port associated with device @dev
2681 * @dev: Device to which command will be sent
2682 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04002683 * Issue SET FEATURES - XFER MODE command to device @dev
2684 * on port @ap.
2685 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002686 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04002687 * PCI/etc. bus probe sem.
Tejun Heo83206a22006-03-24 15:25:31 +09002688 *
2689 * RETURNS:
2690 * 0 on success, AC_ERR_* mask otherwise.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002691 */
2692
Tejun Heo83206a22006-03-24 15:25:31 +09002693static unsigned int ata_dev_set_xfermode(struct ata_port *ap,
2694 struct ata_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002695{
Tejun Heoa0123702005-12-13 14:49:31 +09002696 struct ata_taskfile tf;
Tejun Heo83206a22006-03-24 15:25:31 +09002697 unsigned int err_mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002698
2699 /* set up set-features taskfile */
2700 DPRINTK("set features - xfer mode\n");
2701
Tejun Heoa0123702005-12-13 14:49:31 +09002702 ata_tf_init(ap, &tf, dev->devno);
2703 tf.command = ATA_CMD_SET_FEATURES;
2704 tf.feature = SETFEATURES_XFER;
2705 tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
2706 tf.protocol = ATA_PROT_NODATA;
2707 tf.nsect = dev->xfer_mode;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002708
Tejun Heo83206a22006-03-24 15:25:31 +09002709 err_mask = ata_exec_internal(ap, dev, &tf, DMA_NONE, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002710
Tejun Heo83206a22006-03-24 15:25:31 +09002711 DPRINTK("EXIT, err_mask=%x\n", err_mask);
2712 return err_mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002713}
2714
2715/**
Albert Lee8bf62ece2005-05-12 15:29:42 -04002716 * ata_dev_init_params - Issue INIT DEV PARAMS command
2717 * @ap: Port associated with device @dev
2718 * @dev: Device to which command will be sent
2719 *
2720 * LOCKING:
Tejun Heo6aff8f12006-02-15 18:24:09 +09002721 * Kernel thread context (may sleep)
2722 *
2723 * RETURNS:
2724 * 0 on success, AC_ERR_* mask otherwise.
Albert Lee8bf62ece2005-05-12 15:29:42 -04002725 */
2726
Tejun Heo6aff8f12006-02-15 18:24:09 +09002727static unsigned int ata_dev_init_params(struct ata_port *ap,
2728 struct ata_device *dev)
Albert Lee8bf62ece2005-05-12 15:29:42 -04002729{
Tejun Heoa0123702005-12-13 14:49:31 +09002730 struct ata_taskfile tf;
Tejun Heo6aff8f12006-02-15 18:24:09 +09002731 unsigned int err_mask;
Albert Lee8bf62ece2005-05-12 15:29:42 -04002732 u16 sectors = dev->id[6];
2733 u16 heads = dev->id[3];
2734
2735 /* Number of sectors per track 1-255. Number of heads 1-16 */
2736 if (sectors < 1 || sectors > 255 || heads < 1 || heads > 16)
Tejun Heo6aff8f12006-02-15 18:24:09 +09002737 return 0;
Albert Lee8bf62ece2005-05-12 15:29:42 -04002738
2739 /* set up init dev params taskfile */
2740 DPRINTK("init dev params \n");
2741
Tejun Heoa0123702005-12-13 14:49:31 +09002742 ata_tf_init(ap, &tf, dev->devno);
2743 tf.command = ATA_CMD_INIT_DEV_PARAMS;
2744 tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
2745 tf.protocol = ATA_PROT_NODATA;
2746 tf.nsect = sectors;
2747 tf.device |= (heads - 1) & 0x0f; /* max head = num. of heads - 1 */
Albert Lee8bf62ece2005-05-12 15:29:42 -04002748
Tejun Heo6aff8f12006-02-15 18:24:09 +09002749 err_mask = ata_exec_internal(ap, dev, &tf, DMA_NONE, NULL, 0);
Albert Lee8bf62ece2005-05-12 15:29:42 -04002750
Tejun Heo6aff8f12006-02-15 18:24:09 +09002751 DPRINTK("EXIT, err_mask=%x\n", err_mask);
2752 return err_mask;
Albert Lee8bf62ece2005-05-12 15:29:42 -04002753}
2754
2755/**
Jeff Garzik0cba6322005-05-30 19:49:12 -04002756 * ata_sg_clean - Unmap DMA memory associated with command
2757 * @qc: Command containing DMA memory to be released
2758 *
2759 * Unmap all mapped DMA memory associated with this command.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002760 *
2761 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04002762 * spin_lock_irqsave(host_set lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002763 */
2764
2765static void ata_sg_clean(struct ata_queued_cmd *qc)
2766{
2767 struct ata_port *ap = qc->ap;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002768 struct scatterlist *sg = qc->__sg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002769 int dir = qc->dma_dir;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002770 void *pad_buf = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002771
Tejun Heoa46314742006-02-11 19:11:13 +09002772 WARN_ON(!(qc->flags & ATA_QCFLAG_DMAMAP));
2773 WARN_ON(sg == NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002774
2775 if (qc->flags & ATA_QCFLAG_SINGLE)
Jeff Garzikf1318832006-02-20 16:55:56 -05002776 WARN_ON(qc->n_elem > 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002777
Jeff Garzik2c13b7c2005-11-14 14:14:16 -05002778 VPRINTK("unmapping %u sg elements\n", qc->n_elem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002779
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002780 /* if we padded the buffer out to 32-bit bound, and data
2781 * xfer direction is from-device, we must copy from the
2782 * pad buffer back into the supplied buffer
2783 */
2784 if (qc->pad_len && !(qc->tf.flags & ATA_TFLAG_WRITE))
2785 pad_buf = ap->pad + (qc->tag * ATA_DMA_PAD_SZ);
2786
2787 if (qc->flags & ATA_QCFLAG_SG) {
Jeff Garzike1410f22005-11-14 14:06:26 -05002788 if (qc->n_elem)
Brian King2f1f6102006-03-23 17:30:15 -06002789 dma_unmap_sg(ap->dev, sg, qc->n_elem, dir);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002790 /* restore last sg */
2791 sg[qc->orig_n_elem - 1].length += qc->pad_len;
2792 if (pad_buf) {
2793 struct scatterlist *psg = &qc->pad_sgent;
2794 void *addr = kmap_atomic(psg->page, KM_IRQ0);
2795 memcpy(addr + psg->offset, pad_buf, qc->pad_len);
Mark Lorddfa15982005-12-12 23:19:28 -05002796 kunmap_atomic(addr, KM_IRQ0);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002797 }
2798 } else {
Tejun Heo2e242fa2006-02-20 23:48:38 +09002799 if (qc->n_elem)
Brian King2f1f6102006-03-23 17:30:15 -06002800 dma_unmap_single(ap->dev,
Jeff Garzike1410f22005-11-14 14:06:26 -05002801 sg_dma_address(&sg[0]), sg_dma_len(&sg[0]),
2802 dir);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002803 /* restore sg */
2804 sg->length += qc->pad_len;
2805 if (pad_buf)
2806 memcpy(qc->buf_virt + sg->length - qc->pad_len,
2807 pad_buf, qc->pad_len);
2808 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002809
2810 qc->flags &= ~ATA_QCFLAG_DMAMAP;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002811 qc->__sg = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002812}
2813
2814/**
2815 * ata_fill_sg - Fill PCI IDE PRD table
2816 * @qc: Metadata associated with taskfile to be transferred
2817 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04002818 * Fill PCI IDE PRD (scatter-gather) table with segments
2819 * associated with the current disk command.
2820 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002821 * LOCKING:
Jeff Garzik780a87f2005-05-30 15:41:05 -04002822 * spin_lock_irqsave(host_set lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002823 *
2824 */
2825static void ata_fill_sg(struct ata_queued_cmd *qc)
2826{
Linus Torvalds1da177e2005-04-16 15:20:36 -07002827 struct ata_port *ap = qc->ap;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002828 struct scatterlist *sg;
2829 unsigned int idx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002830
Tejun Heoa46314742006-02-11 19:11:13 +09002831 WARN_ON(qc->__sg == NULL);
Jeff Garzikf1318832006-02-20 16:55:56 -05002832 WARN_ON(qc->n_elem == 0 && qc->pad_len == 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002833
2834 idx = 0;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002835 ata_for_each_sg(sg, qc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002836 u32 addr, offset;
2837 u32 sg_len, len;
2838
2839 /* determine if physical DMA addr spans 64K boundary.
2840 * Note h/w doesn't support 64-bit, so we unconditionally
2841 * truncate dma_addr_t to u32.
2842 */
2843 addr = (u32) sg_dma_address(sg);
2844 sg_len = sg_dma_len(sg);
2845
2846 while (sg_len) {
2847 offset = addr & 0xffff;
2848 len = sg_len;
2849 if ((offset + sg_len) > 0x10000)
2850 len = 0x10000 - offset;
2851
2852 ap->prd[idx].addr = cpu_to_le32(addr);
2853 ap->prd[idx].flags_len = cpu_to_le32(len & 0xffff);
2854 VPRINTK("PRD[%u] = (0x%X, 0x%X)\n", idx, addr, len);
2855
2856 idx++;
2857 sg_len -= len;
2858 addr += len;
2859 }
2860 }
2861
2862 if (idx)
2863 ap->prd[idx - 1].flags_len |= cpu_to_le32(ATA_PRD_EOT);
2864}
2865/**
2866 * ata_check_atapi_dma - Check whether ATAPI DMA can be supported
2867 * @qc: Metadata associated with taskfile to check
2868 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04002869 * Allow low-level driver to filter ATA PACKET commands, returning
2870 * a status indicating whether or not it is OK to use DMA for the
2871 * supplied PACKET command.
2872 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002873 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04002874 * spin_lock_irqsave(host_set lock)
2875 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002876 * RETURNS: 0 when ATAPI DMA can be used
2877 * nonzero otherwise
2878 */
2879int ata_check_atapi_dma(struct ata_queued_cmd *qc)
2880{
2881 struct ata_port *ap = qc->ap;
2882 int rc = 0; /* Assume ATAPI DMA is OK by default */
2883
2884 if (ap->ops->check_atapi_dma)
2885 rc = ap->ops->check_atapi_dma(qc);
2886
2887 return rc;
2888}
2889/**
2890 * ata_qc_prep - Prepare taskfile for submission
2891 * @qc: Metadata associated with taskfile to be prepared
2892 *
Jeff Garzik780a87f2005-05-30 15:41:05 -04002893 * Prepare ATA taskfile for submission.
2894 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002895 * LOCKING:
2896 * spin_lock_irqsave(host_set lock)
2897 */
2898void ata_qc_prep(struct ata_queued_cmd *qc)
2899{
2900 if (!(qc->flags & ATA_QCFLAG_DMAMAP))
2901 return;
2902
2903 ata_fill_sg(qc);
2904}
2905
Brian Kinge46834c2006-03-17 17:04:03 -06002906void ata_noop_qc_prep(struct ata_queued_cmd *qc) { }
2907
Jeff Garzik0cba6322005-05-30 19:49:12 -04002908/**
2909 * ata_sg_init_one - Associate command with memory buffer
2910 * @qc: Command to be associated
2911 * @buf: Memory buffer
2912 * @buflen: Length of memory buffer, in bytes.
2913 *
2914 * Initialize the data-related elements of queued_cmd @qc
2915 * to point to a single memory buffer, @buf of byte length @buflen.
2916 *
2917 * LOCKING:
2918 * spin_lock_irqsave(host_set lock)
2919 */
2920
Linus Torvalds1da177e2005-04-16 15:20:36 -07002921void ata_sg_init_one(struct ata_queued_cmd *qc, void *buf, unsigned int buflen)
2922{
2923 struct scatterlist *sg;
2924
2925 qc->flags |= ATA_QCFLAG_SINGLE;
2926
2927 memset(&qc->sgent, 0, sizeof(qc->sgent));
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002928 qc->__sg = &qc->sgent;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002929 qc->n_elem = 1;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002930 qc->orig_n_elem = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002931 qc->buf_virt = buf;
2932
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002933 sg = qc->__sg;
Jeff Garzikf0612bb2005-10-30 01:58:18 -05002934 sg_init_one(sg, buf, buflen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002935}
2936
Jeff Garzik0cba6322005-05-30 19:49:12 -04002937/**
2938 * ata_sg_init - Associate command with scatter-gather table.
2939 * @qc: Command to be associated
2940 * @sg: Scatter-gather table.
2941 * @n_elem: Number of elements in s/g table.
2942 *
2943 * Initialize the data-related elements of queued_cmd @qc
2944 * to point to a scatter-gather table @sg, containing @n_elem
2945 * elements.
2946 *
2947 * LOCKING:
2948 * spin_lock_irqsave(host_set lock)
2949 */
2950
Linus Torvalds1da177e2005-04-16 15:20:36 -07002951void ata_sg_init(struct ata_queued_cmd *qc, struct scatterlist *sg,
2952 unsigned int n_elem)
2953{
2954 qc->flags |= ATA_QCFLAG_SG;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002955 qc->__sg = sg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002956 qc->n_elem = n_elem;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002957 qc->orig_n_elem = n_elem;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002958}
2959
2960/**
Jeff Garzik0cba6322005-05-30 19:49:12 -04002961 * ata_sg_setup_one - DMA-map the memory buffer associated with a command.
2962 * @qc: Command with memory buffer to be mapped.
2963 *
2964 * DMA-map the memory buffer associated with queued_cmd @qc.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002965 *
2966 * LOCKING:
2967 * spin_lock_irqsave(host_set lock)
2968 *
2969 * RETURNS:
Jeff Garzik0cba6322005-05-30 19:49:12 -04002970 * Zero on success, negative on error.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002971 */
2972
2973static int ata_sg_setup_one(struct ata_queued_cmd *qc)
2974{
2975 struct ata_port *ap = qc->ap;
2976 int dir = qc->dma_dir;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002977 struct scatterlist *sg = qc->__sg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002978 dma_addr_t dma_address;
Tejun Heo2e242fa2006-02-20 23:48:38 +09002979 int trim_sg = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002980
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002981 /* we must lengthen transfers to end on a 32-bit boundary */
2982 qc->pad_len = sg->length & 3;
2983 if (qc->pad_len) {
2984 void *pad_buf = ap->pad + (qc->tag * ATA_DMA_PAD_SZ);
2985 struct scatterlist *psg = &qc->pad_sgent;
2986
Tejun Heoa46314742006-02-11 19:11:13 +09002987 WARN_ON(qc->dev->class != ATA_DEV_ATAPI);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04002988
2989 memset(pad_buf, 0, ATA_DMA_PAD_SZ);
2990
2991 if (qc->tf.flags & ATA_TFLAG_WRITE)
2992 memcpy(pad_buf, qc->buf_virt + sg->length - qc->pad_len,
2993 qc->pad_len);
2994
2995 sg_dma_address(psg) = ap->pad_dma + (qc->tag * ATA_DMA_PAD_SZ);
2996 sg_dma_len(psg) = ATA_DMA_PAD_SZ;
2997 /* trim sg */
2998 sg->length -= qc->pad_len;
Tejun Heo2e242fa2006-02-20 23:48:38 +09002999 if (sg->length == 0)
3000 trim_sg = 1;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003001
3002 DPRINTK("padding done, sg->length=%u pad_len=%u\n",
3003 sg->length, qc->pad_len);
3004 }
3005
Tejun Heo2e242fa2006-02-20 23:48:38 +09003006 if (trim_sg) {
3007 qc->n_elem--;
Jeff Garzike1410f22005-11-14 14:06:26 -05003008 goto skip_map;
3009 }
3010
Brian King2f1f6102006-03-23 17:30:15 -06003011 dma_address = dma_map_single(ap->dev, qc->buf_virt,
Albert Lee32529e02005-05-26 03:49:42 -04003012 sg->length, dir);
Tejun Heo537a95d2005-11-05 14:29:01 -05003013 if (dma_mapping_error(dma_address)) {
3014 /* restore sg */
3015 sg->length += qc->pad_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003016 return -1;
Tejun Heo537a95d2005-11-05 14:29:01 -05003017 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003018
3019 sg_dma_address(sg) = dma_address;
Albert Lee32529e02005-05-26 03:49:42 -04003020 sg_dma_len(sg) = sg->length;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003021
Tejun Heo2e242fa2006-02-20 23:48:38 +09003022skip_map:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003023 DPRINTK("mapped buffer of %d bytes for %s\n", sg_dma_len(sg),
3024 qc->tf.flags & ATA_TFLAG_WRITE ? "write" : "read");
3025
3026 return 0;
3027}
3028
3029/**
Jeff Garzik0cba6322005-05-30 19:49:12 -04003030 * ata_sg_setup - DMA-map the scatter-gather table associated with a command.
3031 * @qc: Command with scatter-gather table to be mapped.
3032 *
3033 * DMA-map the scatter-gather table associated with queued_cmd @qc.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003034 *
3035 * LOCKING:
3036 * spin_lock_irqsave(host_set lock)
3037 *
3038 * RETURNS:
Jeff Garzik0cba6322005-05-30 19:49:12 -04003039 * Zero on success, negative on error.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003040 *
3041 */
3042
3043static int ata_sg_setup(struct ata_queued_cmd *qc)
3044{
3045 struct ata_port *ap = qc->ap;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003046 struct scatterlist *sg = qc->__sg;
3047 struct scatterlist *lsg = &sg[qc->n_elem - 1];
Jeff Garzike1410f22005-11-14 14:06:26 -05003048 int n_elem, pre_n_elem, dir, trim_sg = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003049
3050 VPRINTK("ENTER, ata%u\n", ap->id);
Tejun Heoa46314742006-02-11 19:11:13 +09003051 WARN_ON(!(qc->flags & ATA_QCFLAG_SG));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003052
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003053 /* we must lengthen transfers to end on a 32-bit boundary */
3054 qc->pad_len = lsg->length & 3;
3055 if (qc->pad_len) {
3056 void *pad_buf = ap->pad + (qc->tag * ATA_DMA_PAD_SZ);
3057 struct scatterlist *psg = &qc->pad_sgent;
3058 unsigned int offset;
3059
Tejun Heoa46314742006-02-11 19:11:13 +09003060 WARN_ON(qc->dev->class != ATA_DEV_ATAPI);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003061
3062 memset(pad_buf, 0, ATA_DMA_PAD_SZ);
3063
3064 /*
3065 * psg->page/offset are used to copy to-be-written
3066 * data in this function or read data in ata_sg_clean.
3067 */
3068 offset = lsg->offset + lsg->length - qc->pad_len;
3069 psg->page = nth_page(lsg->page, offset >> PAGE_SHIFT);
3070 psg->offset = offset_in_page(offset);
3071
3072 if (qc->tf.flags & ATA_TFLAG_WRITE) {
3073 void *addr = kmap_atomic(psg->page, KM_IRQ0);
3074 memcpy(pad_buf, addr + psg->offset, qc->pad_len);
Mark Lorddfa15982005-12-12 23:19:28 -05003075 kunmap_atomic(addr, KM_IRQ0);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003076 }
3077
3078 sg_dma_address(psg) = ap->pad_dma + (qc->tag * ATA_DMA_PAD_SZ);
3079 sg_dma_len(psg) = ATA_DMA_PAD_SZ;
3080 /* trim last sg */
3081 lsg->length -= qc->pad_len;
Jeff Garzike1410f22005-11-14 14:06:26 -05003082 if (lsg->length == 0)
3083 trim_sg = 1;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003084
3085 DPRINTK("padding done, sg[%d].length=%u pad_len=%u\n",
3086 qc->n_elem - 1, lsg->length, qc->pad_len);
3087 }
3088
Jeff Garzike1410f22005-11-14 14:06:26 -05003089 pre_n_elem = qc->n_elem;
3090 if (trim_sg && pre_n_elem)
3091 pre_n_elem--;
3092
3093 if (!pre_n_elem) {
3094 n_elem = 0;
3095 goto skip_map;
3096 }
3097
Linus Torvalds1da177e2005-04-16 15:20:36 -07003098 dir = qc->dma_dir;
Brian King2f1f6102006-03-23 17:30:15 -06003099 n_elem = dma_map_sg(ap->dev, sg, pre_n_elem, dir);
Tejun Heo537a95d2005-11-05 14:29:01 -05003100 if (n_elem < 1) {
3101 /* restore last sg */
3102 lsg->length += qc->pad_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003103 return -1;
Tejun Heo537a95d2005-11-05 14:29:01 -05003104 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003105
3106 DPRINTK("%d sg elements mapped\n", n_elem);
3107
Jeff Garzike1410f22005-11-14 14:06:26 -05003108skip_map:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003109 qc->n_elem = n_elem;
3110
3111 return 0;
3112}
3113
3114/**
Tejun Heo40e8c822005-08-22 17:12:45 +09003115 * ata_poll_qc_complete - turn irq back on and finish qc
3116 * @qc: Command to complete
Randy Dunlap8e8b77d2005-11-01 21:29:27 -08003117 * @err_mask: ATA status register content
Tejun Heo40e8c822005-08-22 17:12:45 +09003118 *
3119 * LOCKING:
3120 * None. (grabs host lock)
3121 */
3122
Albert Leea22e2eb2005-12-05 15:38:02 +08003123void ata_poll_qc_complete(struct ata_queued_cmd *qc)
Tejun Heo40e8c822005-08-22 17:12:45 +09003124{
3125 struct ata_port *ap = qc->ap;
Jeff Garzikb8f61532005-08-25 22:01:20 -04003126 unsigned long flags;
Tejun Heo40e8c822005-08-22 17:12:45 +09003127
Jeff Garzikb8f61532005-08-25 22:01:20 -04003128 spin_lock_irqsave(&ap->host_set->lock, flags);
Tejun Heo40e8c822005-08-22 17:12:45 +09003129 ata_irq_on(ap);
Albert Leea22e2eb2005-12-05 15:38:02 +08003130 ata_qc_complete(qc);
Jeff Garzikb8f61532005-08-25 22:01:20 -04003131 spin_unlock_irqrestore(&ap->host_set->lock, flags);
Tejun Heo40e8c822005-08-22 17:12:45 +09003132}
3133
3134/**
Randy Dunlapc893a3a2006-01-28 13:15:32 -05003135 * ata_pio_poll - poll using PIO, depending on current state
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04003136 * @ap: the target ata_port
Linus Torvalds1da177e2005-04-16 15:20:36 -07003137 *
3138 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04003139 * None. (executing in kernel thread context)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003140 *
3141 * RETURNS:
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04003142 * timeout value to use
Linus Torvalds1da177e2005-04-16 15:20:36 -07003143 */
3144
3145static unsigned long ata_pio_poll(struct ata_port *ap)
3146{
Albert Leec14b8332005-12-05 15:36:08 +08003147 struct ata_queued_cmd *qc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003148 u8 status;
Albert Lee14be71f2005-09-27 17:36:35 +08003149 unsigned int poll_state = HSM_ST_UNKNOWN;
3150 unsigned int reg_state = HSM_ST_UNKNOWN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003151
Albert Leec14b8332005-12-05 15:36:08 +08003152 qc = ata_qc_from_tag(ap, ap->active_tag);
Tejun Heoa46314742006-02-11 19:11:13 +09003153 WARN_ON(qc == NULL);
Albert Leec14b8332005-12-05 15:36:08 +08003154
Albert Lee14be71f2005-09-27 17:36:35 +08003155 switch (ap->hsm_task_state) {
3156 case HSM_ST:
3157 case HSM_ST_POLL:
3158 poll_state = HSM_ST_POLL;
3159 reg_state = HSM_ST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003160 break;
Albert Lee14be71f2005-09-27 17:36:35 +08003161 case HSM_ST_LAST:
3162 case HSM_ST_LAST_POLL:
3163 poll_state = HSM_ST_LAST_POLL;
3164 reg_state = HSM_ST_LAST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003165 break;
3166 default:
3167 BUG();
3168 break;
3169 }
3170
3171 status = ata_chk_status(ap);
3172 if (status & ATA_BUSY) {
3173 if (time_after(jiffies, ap->pio_task_timeout)) {
Tejun Heo11a56d22006-01-23 13:09:36 +09003174 qc->err_mask |= AC_ERR_TIMEOUT;
Albert Lee7c398332005-11-09 13:03:30 +08003175 ap->hsm_task_state = HSM_ST_TMOUT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003176 return 0;
3177 }
Albert Lee14be71f2005-09-27 17:36:35 +08003178 ap->hsm_task_state = poll_state;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003179 return ATA_SHORT_PAUSE;
3180 }
3181
Albert Lee14be71f2005-09-27 17:36:35 +08003182 ap->hsm_task_state = reg_state;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003183 return 0;
3184}
3185
3186/**
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04003187 * ata_pio_complete - check if drive is busy or idle
3188 * @ap: the target ata_port
Linus Torvalds1da177e2005-04-16 15:20:36 -07003189 *
3190 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04003191 * None. (executing in kernel thread context)
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003192 *
3193 * RETURNS:
Albert Leefbcdd802005-11-01 19:30:05 +08003194 * Zero if qc completed.
3195 * Non-zero if has next.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003196 */
3197
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003198static int ata_pio_complete (struct ata_port *ap)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003199{
3200 struct ata_queued_cmd *qc;
3201 u8 drv_stat;
3202
3203 /*
Alan Cox31433ea2005-08-26 15:56:47 +01003204 * This is purely heuristic. This is a fast path. Sometimes when
3205 * we enter, BSY will be cleared in a chk-status or two. If not,
3206 * the drive is probably seeking or something. Snooze for a couple
3207 * msecs, then chk-status again. If still busy, fall back to
Albert Lee07f6f7d2005-11-01 19:33:20 +08003208 * HSM_ST_LAST_POLL state.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003209 */
Albert Leefe79e682005-12-06 11:34:59 +08003210 drv_stat = ata_busy_wait(ap, ATA_BUSY, 10);
3211 if (drv_stat & ATA_BUSY) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003212 msleep(2);
Albert Leefe79e682005-12-06 11:34:59 +08003213 drv_stat = ata_busy_wait(ap, ATA_BUSY, 10);
3214 if (drv_stat & ATA_BUSY) {
Albert Lee14be71f2005-09-27 17:36:35 +08003215 ap->hsm_task_state = HSM_ST_LAST_POLL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003216 ap->pio_task_timeout = jiffies + ATA_TMOUT_PIO;
Albert Leefbcdd802005-11-01 19:30:05 +08003217 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003218 }
3219 }
3220
Albert Leec14b8332005-12-05 15:36:08 +08003221 qc = ata_qc_from_tag(ap, ap->active_tag);
Tejun Heoa46314742006-02-11 19:11:13 +09003222 WARN_ON(qc == NULL);
Albert Leec14b8332005-12-05 15:36:08 +08003223
Linus Torvalds1da177e2005-04-16 15:20:36 -07003224 drv_stat = ata_wait_idle(ap);
3225 if (!ata_ok(drv_stat)) {
Albert Lee1c848982005-12-05 15:40:15 +08003226 qc->err_mask |= __ac_err_mask(drv_stat);
Albert Lee14be71f2005-09-27 17:36:35 +08003227 ap->hsm_task_state = HSM_ST_ERR;
Albert Leefbcdd802005-11-01 19:30:05 +08003228 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003229 }
3230
Albert Lee14be71f2005-09-27 17:36:35 +08003231 ap->hsm_task_state = HSM_ST_IDLE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003232
Tejun Heoa46314742006-02-11 19:11:13 +09003233 WARN_ON(qc->err_mask);
Albert Leea22e2eb2005-12-05 15:38:02 +08003234 ata_poll_qc_complete(qc);
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003235
3236 /* another command may start at this point */
3237
Albert Leefbcdd802005-11-01 19:30:05 +08003238 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003239}
3240
Edward Falk0baab862005-06-02 18:17:13 -04003241
3242/**
Randy Dunlapc893a3a2006-01-28 13:15:32 -05003243 * swap_buf_le16 - swap halves of 16-bit words in place
Edward Falk0baab862005-06-02 18:17:13 -04003244 * @buf: Buffer to swap
3245 * @buf_words: Number of 16-bit words in buffer.
3246 *
3247 * Swap halves of 16-bit words if needed to convert from
3248 * little-endian byte order to native cpu byte order, or
3249 * vice-versa.
3250 *
3251 * LOCKING:
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04003252 * Inherited from caller.
Edward Falk0baab862005-06-02 18:17:13 -04003253 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003254void swap_buf_le16(u16 *buf, unsigned int buf_words)
3255{
3256#ifdef __BIG_ENDIAN
3257 unsigned int i;
3258
3259 for (i = 0; i < buf_words; i++)
3260 buf[i] = le16_to_cpu(buf[i]);
3261#endif /* __BIG_ENDIAN */
3262}
3263
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003264/**
3265 * ata_mmio_data_xfer - Transfer data by MMIO
3266 * @ap: port to read/write
3267 * @buf: data buffer
3268 * @buflen: buffer length
Jeff Garzik344baba2005-09-07 01:15:17 -04003269 * @write_data: read/write
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003270 *
3271 * Transfer data from/to the device data register by MMIO.
3272 *
3273 * LOCKING:
3274 * Inherited from caller.
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003275 */
3276
Linus Torvalds1da177e2005-04-16 15:20:36 -07003277static void ata_mmio_data_xfer(struct ata_port *ap, unsigned char *buf,
3278 unsigned int buflen, int write_data)
3279{
3280 unsigned int i;
3281 unsigned int words = buflen >> 1;
3282 u16 *buf16 = (u16 *) buf;
3283 void __iomem *mmio = (void __iomem *)ap->ioaddr.data_addr;
3284
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003285 /* Transfer multiple of 2 bytes */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003286 if (write_data) {
3287 for (i = 0; i < words; i++)
3288 writew(le16_to_cpu(buf16[i]), mmio);
3289 } else {
3290 for (i = 0; i < words; i++)
3291 buf16[i] = cpu_to_le16(readw(mmio));
3292 }
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003293
3294 /* Transfer trailing 1 byte, if any. */
3295 if (unlikely(buflen & 0x01)) {
3296 u16 align_buf[1] = { 0 };
3297 unsigned char *trailing_buf = buf + buflen - 1;
3298
3299 if (write_data) {
3300 memcpy(align_buf, trailing_buf, 1);
3301 writew(le16_to_cpu(align_buf[0]), mmio);
3302 } else {
3303 align_buf[0] = cpu_to_le16(readw(mmio));
3304 memcpy(trailing_buf, align_buf, 1);
3305 }
3306 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003307}
3308
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003309/**
3310 * ata_pio_data_xfer - Transfer data by PIO
3311 * @ap: port to read/write
3312 * @buf: data buffer
3313 * @buflen: buffer length
Jeff Garzik344baba2005-09-07 01:15:17 -04003314 * @write_data: read/write
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003315 *
3316 * Transfer data from/to the device data register by PIO.
3317 *
3318 * LOCKING:
3319 * Inherited from caller.
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003320 */
3321
Linus Torvalds1da177e2005-04-16 15:20:36 -07003322static void ata_pio_data_xfer(struct ata_port *ap, unsigned char *buf,
3323 unsigned int buflen, int write_data)
3324{
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003325 unsigned int words = buflen >> 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003326
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003327 /* Transfer multiple of 2 bytes */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003328 if (write_data)
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003329 outsw(ap->ioaddr.data_addr, buf, words);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003330 else
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003331 insw(ap->ioaddr.data_addr, buf, words);
3332
3333 /* Transfer trailing 1 byte, if any. */
3334 if (unlikely(buflen & 0x01)) {
3335 u16 align_buf[1] = { 0 };
3336 unsigned char *trailing_buf = buf + buflen - 1;
3337
3338 if (write_data) {
3339 memcpy(align_buf, trailing_buf, 1);
3340 outw(le16_to_cpu(align_buf[0]), ap->ioaddr.data_addr);
3341 } else {
3342 align_buf[0] = cpu_to_le16(inw(ap->ioaddr.data_addr));
3343 memcpy(trailing_buf, align_buf, 1);
3344 }
3345 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003346}
3347
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003348/**
3349 * ata_data_xfer - Transfer data from/to the data register.
3350 * @ap: port to read/write
3351 * @buf: data buffer
3352 * @buflen: buffer length
3353 * @do_write: read/write
3354 *
3355 * Transfer data from/to the device data register.
3356 *
3357 * LOCKING:
3358 * Inherited from caller.
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003359 */
3360
Linus Torvalds1da177e2005-04-16 15:20:36 -07003361static void ata_data_xfer(struct ata_port *ap, unsigned char *buf,
3362 unsigned int buflen, int do_write)
3363{
Alan Coxa1bd9e62006-01-17 20:53:50 +00003364 /* Make the crap hardware pay the costs not the good stuff */
3365 if (unlikely(ap->flags & ATA_FLAG_IRQ_MASK)) {
3366 unsigned long flags;
3367 local_irq_save(flags);
3368 if (ap->flags & ATA_FLAG_MMIO)
3369 ata_mmio_data_xfer(ap, buf, buflen, do_write);
3370 else
3371 ata_pio_data_xfer(ap, buf, buflen, do_write);
3372 local_irq_restore(flags);
3373 } else {
3374 if (ap->flags & ATA_FLAG_MMIO)
3375 ata_mmio_data_xfer(ap, buf, buflen, do_write);
3376 else
3377 ata_pio_data_xfer(ap, buf, buflen, do_write);
3378 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003379}
3380
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003381/**
3382 * ata_pio_sector - Transfer ATA_SECT_SIZE (512 bytes) of data.
3383 * @qc: Command on going
3384 *
3385 * Transfer ATA_SECT_SIZE of data from/to the ATA device.
3386 *
3387 * LOCKING:
3388 * Inherited from caller.
3389 */
3390
Linus Torvalds1da177e2005-04-16 15:20:36 -07003391static void ata_pio_sector(struct ata_queued_cmd *qc)
3392{
3393 int do_write = (qc->tf.flags & ATA_TFLAG_WRITE);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003394 struct scatterlist *sg = qc->__sg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003395 struct ata_port *ap = qc->ap;
3396 struct page *page;
3397 unsigned int offset;
3398 unsigned char *buf;
3399
3400 if (qc->cursect == (qc->nsect - 1))
Albert Lee14be71f2005-09-27 17:36:35 +08003401 ap->hsm_task_state = HSM_ST_LAST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003402
3403 page = sg[qc->cursg].page;
3404 offset = sg[qc->cursg].offset + qc->cursg_ofs * ATA_SECT_SIZE;
3405
3406 /* get the current page and offset */
3407 page = nth_page(page, (offset >> PAGE_SHIFT));
3408 offset %= PAGE_SIZE;
3409
Albert Lee7282aa42005-10-09 09:46:07 -04003410 DPRINTK("data %s\n", qc->tf.flags & ATA_TFLAG_WRITE ? "write" : "read");
3411
Albert Lee91b8b312005-10-09 09:48:44 -04003412 if (PageHighMem(page)) {
3413 unsigned long flags;
Albert Lee7282aa42005-10-09 09:46:07 -04003414
Albert Lee91b8b312005-10-09 09:48:44 -04003415 local_irq_save(flags);
3416 buf = kmap_atomic(page, KM_IRQ0);
Albert Lee083958d2005-10-09 09:47:31 -04003417
Albert Lee91b8b312005-10-09 09:48:44 -04003418 /* do the actual data transfer */
3419 ata_data_xfer(ap, buf + offset, ATA_SECT_SIZE, do_write);
3420
3421 kunmap_atomic(buf, KM_IRQ0);
3422 local_irq_restore(flags);
3423 } else {
3424 buf = page_address(page);
3425 ata_data_xfer(ap, buf + offset, ATA_SECT_SIZE, do_write);
3426 }
Albert Lee7282aa42005-10-09 09:46:07 -04003427
Linus Torvalds1da177e2005-04-16 15:20:36 -07003428 qc->cursect++;
3429 qc->cursg_ofs++;
3430
Albert Lee32529e02005-05-26 03:49:42 -04003431 if ((qc->cursg_ofs * ATA_SECT_SIZE) == (&sg[qc->cursg])->length) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003432 qc->cursg++;
3433 qc->cursg_ofs = 0;
3434 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003435}
3436
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003437/**
Albert Lee07f6f7d2005-11-01 19:33:20 +08003438 * ata_pio_sectors - Transfer one or many 512-byte sectors.
3439 * @qc: Command on going
3440 *
3441 * Transfer one or many ATA_SECT_SIZE of data from/to the
3442 * ATA device for the DRQ request.
3443 *
3444 * LOCKING:
3445 * Inherited from caller.
3446 */
3447
3448static void ata_pio_sectors(struct ata_queued_cmd *qc)
3449{
3450 if (is_multi_taskfile(&qc->tf)) {
3451 /* READ/WRITE MULTIPLE */
3452 unsigned int nsect;
3453
Jeff Garzik587005d2006-02-11 18:17:32 -05003454 WARN_ON(qc->dev->multi_count == 0);
Albert Lee07f6f7d2005-11-01 19:33:20 +08003455
3456 nsect = min(qc->nsect - qc->cursect, qc->dev->multi_count);
3457 while (nsect--)
3458 ata_pio_sector(qc);
3459 } else
3460 ata_pio_sector(qc);
3461}
3462
3463/**
Albert Leec71c1852005-10-04 06:03:45 -04003464 * atapi_send_cdb - Write CDB bytes to hardware
3465 * @ap: Port to which ATAPI device is attached.
3466 * @qc: Taskfile currently active
3467 *
3468 * When device has indicated its readiness to accept
3469 * a CDB, this function is called. Send the CDB.
3470 *
3471 * LOCKING:
3472 * caller.
3473 */
3474
3475static void atapi_send_cdb(struct ata_port *ap, struct ata_queued_cmd *qc)
3476{
3477 /* send SCSI cdb */
3478 DPRINTK("send cdb\n");
Jeff Garzikdb024d52006-02-13 00:23:57 -05003479 WARN_ON(qc->dev->cdb_len < 12);
Albert Leec71c1852005-10-04 06:03:45 -04003480
Jeff Garzikdb024d52006-02-13 00:23:57 -05003481 ata_data_xfer(ap, qc->cdb, qc->dev->cdb_len, 1);
Albert Leec71c1852005-10-04 06:03:45 -04003482 ata_altstatus(ap); /* flush */
3483
3484 switch (qc->tf.protocol) {
3485 case ATA_PROT_ATAPI:
3486 ap->hsm_task_state = HSM_ST;
3487 break;
3488 case ATA_PROT_ATAPI_NODATA:
3489 ap->hsm_task_state = HSM_ST_LAST;
3490 break;
3491 case ATA_PROT_ATAPI_DMA:
3492 ap->hsm_task_state = HSM_ST_LAST;
3493 /* initiate bmdma */
3494 ap->ops->bmdma_start(qc);
3495 break;
3496 }
3497}
3498
3499/**
Albert Leee27486d2005-11-01 19:24:49 +08003500 * ata_pio_first_block - Write first data block to hardware
3501 * @ap: Port to which ATA/ATAPI device is attached.
Albert Leec71c1852005-10-04 06:03:45 -04003502 *
3503 * When device has indicated its readiness to accept
3504 * the data, this function sends out the CDB or
3505 * the first data block by PIO.
3506 * After this,
3507 * - If polling, ata_pio_task() handles the rest.
3508 * - Otherwise, interrupt handler takes over.
3509 *
3510 * LOCKING:
3511 * Kernel thread context (may sleep)
Albert Leefbcdd802005-11-01 19:30:05 +08003512 *
3513 * RETURNS:
3514 * Zero if irq handler takes over
3515 * Non-zero if has next (polling).
Albert Leec71c1852005-10-04 06:03:45 -04003516 */
3517
Albert Leefbcdd802005-11-01 19:30:05 +08003518static int ata_pio_first_block(struct ata_port *ap)
Albert Leec71c1852005-10-04 06:03:45 -04003519{
Albert Leec71c1852005-10-04 06:03:45 -04003520 struct ata_queued_cmd *qc;
3521 u8 status;
3522 unsigned long flags;
Albert Leefbcdd802005-11-01 19:30:05 +08003523 int has_next;
Albert Leec71c1852005-10-04 06:03:45 -04003524
3525 qc = ata_qc_from_tag(ap, ap->active_tag);
Jeff Garzik587005d2006-02-11 18:17:32 -05003526 WARN_ON(qc == NULL);
3527 WARN_ON((qc->flags & ATA_QCFLAG_ACTIVE) == 0);
Albert Leec71c1852005-10-04 06:03:45 -04003528
Albert Leefbcdd802005-11-01 19:30:05 +08003529 /* if polling, we will stay in the work queue after sending the data.
3530 * otherwise, interrupt handler takes over after sending the data.
3531 */
3532 has_next = (qc->tf.flags & ATA_TFLAG_POLLING);
3533
Albert Leec71c1852005-10-04 06:03:45 -04003534 /* sleep-wait for BSY to clear */
3535 DPRINTK("busy wait\n");
Albert Leefbcdd802005-11-01 19:30:05 +08003536 if (ata_busy_sleep(ap, ATA_TMOUT_DATAOUT_QUICK, ATA_TMOUT_DATAOUT)) {
Albert Lee555a8962006-02-08 16:50:29 +08003537 qc->err_mask |= AC_ERR_TIMEOUT;
Albert Leefbcdd802005-11-01 19:30:05 +08003538 ap->hsm_task_state = HSM_ST_TMOUT;
Albert Leec71c1852005-10-04 06:03:45 -04003539 goto err_out;
Albert Leefbcdd802005-11-01 19:30:05 +08003540 }
Albert Leec71c1852005-10-04 06:03:45 -04003541
3542 /* make sure DRQ is set */
3543 status = ata_chk_status(ap);
Albert Leefbcdd802005-11-01 19:30:05 +08003544 if ((status & (ATA_BUSY | ATA_DRQ)) != ATA_DRQ) {
3545 /* device status error */
Albert Lee555a8962006-02-08 16:50:29 +08003546 qc->err_mask |= AC_ERR_HSM;
Albert Leefbcdd802005-11-01 19:30:05 +08003547 ap->hsm_task_state = HSM_ST_ERR;
Albert Leec71c1852005-10-04 06:03:45 -04003548 goto err_out;
Albert Leefbcdd802005-11-01 19:30:05 +08003549 }
Albert Leec71c1852005-10-04 06:03:45 -04003550
3551 /* Send the CDB (atapi) or the first data block (ata pio out).
3552 * During the state transition, interrupt handler shouldn't
3553 * be invoked before the data transfer is complete and
3554 * hsm_task_state is changed. Hence, the following locking.
3555 */
3556 spin_lock_irqsave(&ap->host_set->lock, flags);
3557
3558 if (qc->tf.protocol == ATA_PROT_PIO) {
3559 /* PIO data out protocol.
3560 * send first data block.
3561 */
3562
Albert Lee07f6f7d2005-11-01 19:33:20 +08003563 /* ata_pio_sectors() might change the state to HSM_ST_LAST.
3564 * so, the state is changed here before ata_pio_sectors().
Albert Leec71c1852005-10-04 06:03:45 -04003565 */
3566 ap->hsm_task_state = HSM_ST;
Albert Lee07f6f7d2005-11-01 19:33:20 +08003567 ata_pio_sectors(qc);
Albert Leec71c1852005-10-04 06:03:45 -04003568 ata_altstatus(ap); /* flush */
3569 } else
3570 /* send CDB */
3571 atapi_send_cdb(ap, qc);
3572
Albert Leefbcdd802005-11-01 19:30:05 +08003573 spin_unlock_irqrestore(&ap->host_set->lock, flags);
3574
Albert Leec71c1852005-10-04 06:03:45 -04003575 /* if polling, ata_pio_task() handles the rest.
3576 * otherwise, interrupt handler takes over from here.
3577 */
Albert Leefbcdd802005-11-01 19:30:05 +08003578 return has_next;
Albert Leec71c1852005-10-04 06:03:45 -04003579
3580err_out:
Albert Leefbcdd802005-11-01 19:30:05 +08003581 return 1; /* has next */
Albert Leec71c1852005-10-04 06:03:45 -04003582}
3583
3584/**
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003585 * __atapi_pio_bytes - Transfer data from/to the ATAPI device.
3586 * @qc: Command on going
3587 * @bytes: number of bytes
3588 *
3589 * Transfer Transfer data from/to the ATAPI device.
3590 *
3591 * LOCKING:
3592 * Inherited from caller.
3593 *
3594 */
3595
Linus Torvalds1da177e2005-04-16 15:20:36 -07003596static void __atapi_pio_bytes(struct ata_queued_cmd *qc, unsigned int bytes)
3597{
3598 int do_write = (qc->tf.flags & ATA_TFLAG_WRITE);
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003599 struct scatterlist *sg = qc->__sg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003600 struct ata_port *ap = qc->ap;
3601 struct page *page;
3602 unsigned char *buf;
3603 unsigned int offset, count;
3604
Albert Lee563a6e12005-08-12 14:17:50 +08003605 if (qc->curbytes + bytes >= qc->nbytes)
Albert Lee14be71f2005-09-27 17:36:35 +08003606 ap->hsm_task_state = HSM_ST_LAST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003607
3608next_sg:
Albert Lee563a6e12005-08-12 14:17:50 +08003609 if (unlikely(qc->cursg >= qc->n_elem)) {
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003610 /*
Albert Lee563a6e12005-08-12 14:17:50 +08003611 * The end of qc->sg is reached and the device expects
3612 * more data to transfer. In order not to overrun qc->sg
3613 * and fulfill length specified in the byte count register,
3614 * - for read case, discard trailing data from the device
3615 * - for write case, padding zero data to the device
3616 */
3617 u16 pad_buf[1] = { 0 };
3618 unsigned int words = bytes >> 1;
3619 unsigned int i;
3620
3621 if (words) /* warning if bytes > 1 */
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003622 printk(KERN_WARNING "ata%u: %u bytes trailing data\n",
Albert Lee563a6e12005-08-12 14:17:50 +08003623 ap->id, bytes);
3624
3625 for (i = 0; i < words; i++)
3626 ata_data_xfer(ap, (unsigned char*)pad_buf, 2, do_write);
3627
Albert Lee14be71f2005-09-27 17:36:35 +08003628 ap->hsm_task_state = HSM_ST_LAST;
Albert Lee563a6e12005-08-12 14:17:50 +08003629 return;
3630 }
3631
Jeff Garzikcedc9a42005-10-05 07:13:30 -04003632 sg = &qc->__sg[qc->cursg];
Linus Torvalds1da177e2005-04-16 15:20:36 -07003633
Linus Torvalds1da177e2005-04-16 15:20:36 -07003634 page = sg->page;
3635 offset = sg->offset + qc->cursg_ofs;
3636
3637 /* get the current page and offset */
3638 page = nth_page(page, (offset >> PAGE_SHIFT));
3639 offset %= PAGE_SIZE;
3640
Albert Lee6952df02005-06-06 15:56:03 +08003641 /* don't overrun current sg */
Albert Lee32529e02005-05-26 03:49:42 -04003642 count = min(sg->length - qc->cursg_ofs, bytes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003643
3644 /* don't cross page boundaries */
3645 count = min(count, (unsigned int)PAGE_SIZE - offset);
3646
Albert Lee7282aa42005-10-09 09:46:07 -04003647 DPRINTK("data %s\n", qc->tf.flags & ATA_TFLAG_WRITE ? "write" : "read");
3648
Albert Lee91b8b312005-10-09 09:48:44 -04003649 if (PageHighMem(page)) {
3650 unsigned long flags;
Albert Lee7282aa42005-10-09 09:46:07 -04003651
Albert Lee91b8b312005-10-09 09:48:44 -04003652 local_irq_save(flags);
3653 buf = kmap_atomic(page, KM_IRQ0);
Albert Lee083958d2005-10-09 09:47:31 -04003654
Albert Lee91b8b312005-10-09 09:48:44 -04003655 /* do the actual data transfer */
3656 ata_data_xfer(ap, buf + offset, count, do_write);
3657
3658 kunmap_atomic(buf, KM_IRQ0);
3659 local_irq_restore(flags);
3660 } else {
3661 buf = page_address(page);
3662 ata_data_xfer(ap, buf + offset, count, do_write);
3663 }
Albert Lee7282aa42005-10-09 09:46:07 -04003664
Linus Torvalds1da177e2005-04-16 15:20:36 -07003665 bytes -= count;
3666 qc->curbytes += count;
3667 qc->cursg_ofs += count;
3668
Albert Lee32529e02005-05-26 03:49:42 -04003669 if (qc->cursg_ofs == sg->length) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003670 qc->cursg++;
3671 qc->cursg_ofs = 0;
3672 }
3673
Albert Lee563a6e12005-08-12 14:17:50 +08003674 if (bytes)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003675 goto next_sg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003676}
3677
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003678/**
3679 * atapi_pio_bytes - Transfer data from/to the ATAPI device.
3680 * @qc: Command on going
3681 *
3682 * Transfer Transfer data from/to the ATAPI device.
3683 *
3684 * LOCKING:
3685 * Inherited from caller.
Albert Lee6ae4cfb2005-08-12 14:15:34 +08003686 */
3687
Linus Torvalds1da177e2005-04-16 15:20:36 -07003688static void atapi_pio_bytes(struct ata_queued_cmd *qc)
3689{
3690 struct ata_port *ap = qc->ap;
3691 struct ata_device *dev = qc->dev;
3692 unsigned int ireason, bc_lo, bc_hi, bytes;
3693 int i_write, do_write = (qc->tf.flags & ATA_TFLAG_WRITE) ? 1 : 0;
3694
3695 ap->ops->tf_read(ap, &qc->tf);
3696 ireason = qc->tf.nsect;
3697 bc_lo = qc->tf.lbam;
3698 bc_hi = qc->tf.lbah;
3699 bytes = (bc_hi << 8) | bc_lo;
3700
3701 /* shall be cleared to zero, indicating xfer of data */
3702 if (ireason & (1 << 0))
3703 goto err_out;
3704
3705 /* make sure transfer direction matches expected */
3706 i_write = ((ireason & (1 << 1)) == 0) ? 1 : 0;
3707 if (do_write != i_write)
3708 goto err_out;
3709
Albert Lee312f7da2005-09-27 17:38:03 +08003710 VPRINTK("ata%u: xfering %d bytes\n", ap->id, bytes);
3711
Linus Torvalds1da177e2005-04-16 15:20:36 -07003712 __atapi_pio_bytes(qc, bytes);
3713
3714 return;
3715
3716err_out:
3717 printk(KERN_INFO "ata%u: dev %u: ATAPI check failed\n",
3718 ap->id, dev->devno);
Tejun Heo11a56d22006-01-23 13:09:36 +09003719 qc->err_mask |= AC_ERR_HSM;
Albert Lee14be71f2005-09-27 17:36:35 +08003720 ap->hsm_task_state = HSM_ST_ERR;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003721}
3722
3723/**
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04003724 * ata_pio_block - start PIO on a block
3725 * @ap: the target ata_port
Linus Torvalds1da177e2005-04-16 15:20:36 -07003726 *
3727 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04003728 * None. (executing in kernel thread context)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003729 */
3730
3731static void ata_pio_block(struct ata_port *ap)
3732{
3733 struct ata_queued_cmd *qc;
3734 u8 status;
3735
3736 /*
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04003737 * This is purely heuristic. This is a fast path.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003738 * Sometimes when we enter, BSY will be cleared in
3739 * a chk-status or two. If not, the drive is probably seeking
3740 * or something. Snooze for a couple msecs, then
3741 * chk-status again. If still busy, fall back to
Albert Lee14be71f2005-09-27 17:36:35 +08003742 * HSM_ST_POLL state.
Linus Torvalds1da177e2005-04-16 15:20:36 -07003743 */
3744 status = ata_busy_wait(ap, ATA_BUSY, 5);
3745 if (status & ATA_BUSY) {
3746 msleep(2);
3747 status = ata_busy_wait(ap, ATA_BUSY, 10);
3748 if (status & ATA_BUSY) {
Albert Lee14be71f2005-09-27 17:36:35 +08003749 ap->hsm_task_state = HSM_ST_POLL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003750 ap->pio_task_timeout = jiffies + ATA_TMOUT_PIO;
3751 return;
3752 }
3753 }
3754
3755 qc = ata_qc_from_tag(ap, ap->active_tag);
Tejun Heoa46314742006-02-11 19:11:13 +09003756 WARN_ON(qc == NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003757
Albert Leefe79e682005-12-06 11:34:59 +08003758 /* check error */
3759 if (status & (ATA_ERR | ATA_DF)) {
3760 qc->err_mask |= AC_ERR_DEV;
3761 ap->hsm_task_state = HSM_ST_ERR;
3762 return;
3763 }
3764
3765 /* transfer data if any */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003766 if (is_atapi_taskfile(&qc->tf)) {
Albert Leefe79e682005-12-06 11:34:59 +08003767 /* DRQ=0 means no more data to transfer */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003768 if ((status & ATA_DRQ) == 0) {
Albert Lee14be71f2005-09-27 17:36:35 +08003769 ap->hsm_task_state = HSM_ST_LAST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003770 return;
3771 }
3772
3773 atapi_pio_bytes(qc);
3774 } else {
3775 /* handle BSY=0, DRQ=0 as error */
3776 if ((status & ATA_DRQ) == 0) {
Tejun Heo11a56d22006-01-23 13:09:36 +09003777 qc->err_mask |= AC_ERR_HSM;
Albert Lee14be71f2005-09-27 17:36:35 +08003778 ap->hsm_task_state = HSM_ST_ERR;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003779 return;
3780 }
3781
Albert Lee07f6f7d2005-11-01 19:33:20 +08003782 ata_pio_sectors(qc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003783 }
Albert Lee467b16d2005-11-01 19:19:01 +08003784
3785 ata_altstatus(ap); /* flush */
Linus Torvalds1da177e2005-04-16 15:20:36 -07003786}
3787
3788static void ata_pio_error(struct ata_port *ap)
3789{
3790 struct ata_queued_cmd *qc;
Jeff Garzika7dac442005-10-30 04:44:42 -05003791
Linus Torvalds1da177e2005-04-16 15:20:36 -07003792 qc = ata_qc_from_tag(ap, ap->active_tag);
Tejun Heoa46314742006-02-11 19:11:13 +09003793 WARN_ON(qc == NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003794
Albert Lee000080c2005-12-26 16:48:00 +08003795 if (qc->tf.command != ATA_CMD_PACKET)
3796 printk(KERN_WARNING "ata%u: PIO error\n", ap->id);
3797
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05003798 /* make sure qc->err_mask is available to
Albert Lee1c848982005-12-05 15:40:15 +08003799 * know what's wrong and recover
3800 */
Tejun Heoa46314742006-02-11 19:11:13 +09003801 WARN_ON(qc->err_mask == 0);
Albert Lee1c848982005-12-05 15:40:15 +08003802
Albert Lee14be71f2005-09-27 17:36:35 +08003803 ap->hsm_task_state = HSM_ST_IDLE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003804
Albert Leea22e2eb2005-12-05 15:38:02 +08003805 ata_poll_qc_complete(qc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003806}
3807
Albert Leee2cec772006-03-25 17:43:49 +08003808static void ata_hsm_move(struct ata_port *ap, struct ata_queued_cmd *qc,
3809 u8 status)
3810{
3811 /* check error */
3812 if (unlikely(status & (ATA_ERR | ATA_DF))) {
3813 qc->err_mask |= AC_ERR_DEV;
3814 ap->hsm_task_state = HSM_ST_ERR;
3815 }
3816
3817fsm_start:
3818 switch (ap->hsm_task_state) {
3819 case HSM_ST_FIRST:
3820 /* Some pre-ATAPI-4 devices assert INTRQ
3821 * at this state when ready to receive CDB.
3822 */
3823
3824 /* check device status */
3825 if (unlikely((status & (ATA_BUSY | ATA_DRQ)) != ATA_DRQ)) {
3826 /* Wrong status. Let EH handle this */
3827 qc->err_mask |= AC_ERR_HSM;
3828 ap->hsm_task_state = HSM_ST_ERR;
3829 goto fsm_start;
3830 }
3831
3832 atapi_send_cdb(ap, qc);
3833
3834 break;
3835
3836 case HSM_ST:
3837 /* complete command or read/write the data register */
3838 if (qc->tf.protocol == ATA_PROT_ATAPI) {
3839 /* ATAPI PIO protocol */
3840 if ((status & ATA_DRQ) == 0) {
3841 /* no more data to transfer */
3842 ap->hsm_task_state = HSM_ST_LAST;
3843 goto fsm_start;
3844 }
3845
3846 atapi_pio_bytes(qc);
3847
3848 if (unlikely(ap->hsm_task_state == HSM_ST_ERR))
3849 /* bad ireason reported by device */
3850 goto fsm_start;
3851
3852 } else {
3853 /* ATA PIO protocol */
3854 if (unlikely((status & ATA_DRQ) == 0)) {
3855 /* handle BSY=0, DRQ=0 as error */
3856 qc->err_mask |= AC_ERR_HSM;
3857 ap->hsm_task_state = HSM_ST_ERR;
3858 goto fsm_start;
3859 }
3860
3861 ata_pio_sectors(qc);
3862
3863 if (ap->hsm_task_state == HSM_ST_LAST &&
3864 (!(qc->tf.flags & ATA_TFLAG_WRITE))) {
3865 /* all data read */
3866 ata_altstatus(ap);
3867 status = ata_chk_status(ap);
3868 goto fsm_start;
3869 }
3870 }
3871
3872 ata_altstatus(ap); /* flush */
3873 break;
3874
3875 case HSM_ST_LAST:
3876 if (unlikely(status & ATA_DRQ)) {
3877 /* handle DRQ=1 as error */
3878 qc->err_mask |= AC_ERR_HSM;
3879 ap->hsm_task_state = HSM_ST_ERR;
3880 goto fsm_start;
3881 }
3882
3883 /* no more data to transfer */
3884 DPRINTK("ata%u: command complete, drv_stat 0x%x\n",
3885 ap->id, status);
3886
3887 ap->hsm_task_state = HSM_ST_IDLE;
3888
3889 /* complete taskfile transaction */
3890 qc->err_mask |= ac_err_mask(status);
3891 ata_qc_complete(qc);
3892 break;
3893
3894 case HSM_ST_ERR:
3895 if (qc->tf.command != ATA_CMD_PACKET)
3896 printk(KERN_ERR "ata%u: command error, drv_stat 0x%x host_stat 0x%x\n",
3897 ap->id, status, host_stat);
3898
3899 /* make sure qc->err_mask is available to
3900 * know what's wrong and recover
3901 */
3902 WARN_ON(qc->err_mask == 0);
3903
3904 ap->hsm_task_state = HSM_ST_IDLE;
3905 ata_qc_complete(qc);
3906 break;
3907 default:
3908 goto idle_irq;
3909 }
3910
3911}
3912
Linus Torvalds1da177e2005-04-16 15:20:36 -07003913static void ata_pio_task(void *_data)
3914{
3915 struct ata_port *ap = _data;
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003916 unsigned long timeout;
Albert Leefbcdd802005-11-01 19:30:05 +08003917 int has_next;
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003918
3919fsm_start:
3920 timeout = 0;
Albert Leefbcdd802005-11-01 19:30:05 +08003921 has_next = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003922
Albert Lee14be71f2005-09-27 17:36:35 +08003923 switch (ap->hsm_task_state) {
Albert Leee27486d2005-11-01 19:24:49 +08003924 case HSM_ST_FIRST:
Albert Leefbcdd802005-11-01 19:30:05 +08003925 has_next = ata_pio_first_block(ap);
3926 break;
Albert Leee27486d2005-11-01 19:24:49 +08003927
Albert Lee14be71f2005-09-27 17:36:35 +08003928 case HSM_ST:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003929 ata_pio_block(ap);
3930 break;
3931
Albert Lee14be71f2005-09-27 17:36:35 +08003932 case HSM_ST_LAST:
Albert Leefbcdd802005-11-01 19:30:05 +08003933 has_next = ata_pio_complete(ap);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003934 break;
3935
Albert Lee14be71f2005-09-27 17:36:35 +08003936 case HSM_ST_POLL:
3937 case HSM_ST_LAST_POLL:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003938 timeout = ata_pio_poll(ap);
3939 break;
3940
Albert Lee14be71f2005-09-27 17:36:35 +08003941 case HSM_ST_TMOUT:
3942 case HSM_ST_ERR:
Linus Torvalds1da177e2005-04-16 15:20:36 -07003943 ata_pio_error(ap);
3944 return;
Albert Lee467b16d2005-11-01 19:19:01 +08003945
3946 default:
3947 BUG();
3948 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003949 }
3950
3951 if (timeout)
Tejun Heo8061f5f2006-03-05 15:29:09 +09003952 ata_port_queue_task(ap, ata_pio_task, ap, timeout);
Jeff Garzik46e202e2006-03-11 19:25:47 -05003953 else if (has_next)
Jeff Garzik7fb6ec22005-09-16 06:01:48 -04003954 goto fsm_start;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003955}
3956
Linus Torvalds1da177e2005-04-16 15:20:36 -07003957/**
3958 * ata_qc_timeout - Handle timeout of queued command
3959 * @qc: Command that timed out
3960 *
3961 * Some part of the kernel (currently, only the SCSI layer)
3962 * has noticed that the active command on port @ap has not
3963 * completed after a specified length of time. Handle this
3964 * condition by disabling DMA (if necessary) and completing
3965 * transactions, with error if necessary.
3966 *
3967 * This also handles the case of the "lost interrupt", where
3968 * for some reason (possibly hardware bug, possibly driver bug)
3969 * an interrupt was not delivered to the driver, even though the
3970 * transaction completed successfully.
3971 *
3972 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04003973 * Inherited from SCSI layer (none, can sleep)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003974 */
3975
3976static void ata_qc_timeout(struct ata_queued_cmd *qc)
3977{
3978 struct ata_port *ap = qc->ap;
Jeff Garzikb8f61532005-08-25 22:01:20 -04003979 struct ata_host_set *host_set = ap->host_set;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003980 u8 host_stat = 0, drv_stat;
Jeff Garzikb8f61532005-08-25 22:01:20 -04003981 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003982
3983 DPRINTK("ENTER\n");
3984
Tejun Heoc18d06f2006-02-02 00:56:10 +09003985 ap->hsm_task_state = HSM_ST_IDLE;
3986
Jeff Garzikb8f61532005-08-25 22:01:20 -04003987 spin_lock_irqsave(&host_set->lock, flags);
3988
Linus Torvalds1da177e2005-04-16 15:20:36 -07003989 switch (qc->tf.protocol) {
3990
3991 case ATA_PROT_DMA:
3992 case ATA_PROT_ATAPI_DMA:
3993 host_stat = ap->ops->bmdma_status(ap);
3994
3995 /* before we do anything else, clear DMA-Start bit */
Alan Coxb73fc892005-08-26 16:03:19 +01003996 ap->ops->bmdma_stop(qc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003997
3998 /* fall through */
3999
4000 default:
4001 ata_altstatus(ap);
4002 drv_stat = ata_chk_status(ap);
4003
4004 /* ack bmdma irq events */
4005 ap->ops->irq_clear(ap);
4006
4007 printk(KERN_ERR "ata%u: command 0x%x timeout, stat 0x%x host_stat 0x%x\n",
4008 ap->id, qc->tf.command, drv_stat, host_stat);
4009
Albert Lee312f7da2005-09-27 17:38:03 +08004010 ap->hsm_task_state = HSM_ST_IDLE;
4011
Linus Torvalds1da177e2005-04-16 15:20:36 -07004012 /* complete taskfile transaction */
Albert Lee555a8962006-02-08 16:50:29 +08004013 qc->err_mask |= AC_ERR_TIMEOUT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004014 break;
4015 }
Jeff Garzikb8f61532005-08-25 22:01:20 -04004016
4017 spin_unlock_irqrestore(&host_set->lock, flags);
4018
Tejun Heoa72ec4c2006-01-23 13:09:37 +09004019 ata_eh_qc_complete(qc);
4020
Linus Torvalds1da177e2005-04-16 15:20:36 -07004021 DPRINTK("EXIT\n");
4022}
4023
4024/**
4025 * ata_eng_timeout - Handle timeout of queued command
4026 * @ap: Port on which timed-out command is active
4027 *
4028 * Some part of the kernel (currently, only the SCSI layer)
4029 * has noticed that the active command on port @ap has not
4030 * completed after a specified length of time. Handle this
4031 * condition by disabling DMA (if necessary) and completing
4032 * transactions, with error if necessary.
4033 *
4034 * This also handles the case of the "lost interrupt", where
4035 * for some reason (possibly hardware bug, possibly driver bug)
4036 * an interrupt was not delivered to the driver, even though the
4037 * transaction completed successfully.
4038 *
4039 * LOCKING:
4040 * Inherited from SCSI layer (none, can sleep)
4041 */
4042
4043void ata_eng_timeout(struct ata_port *ap)
4044{
Linus Torvalds1da177e2005-04-16 15:20:36 -07004045 DPRINTK("ENTER\n");
4046
Tejun Heof6379022006-02-10 15:10:48 +09004047 ata_qc_timeout(ata_qc_from_tag(ap, ap->active_tag));
Linus Torvalds1da177e2005-04-16 15:20:36 -07004048
Linus Torvalds1da177e2005-04-16 15:20:36 -07004049 DPRINTK("EXIT\n");
4050}
4051
4052/**
4053 * ata_qc_new - Request an available ATA command, for queueing
4054 * @ap: Port associated with device @dev
4055 * @dev: Device from whom we request an available command structure
4056 *
4057 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004058 * None.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004059 */
4060
4061static struct ata_queued_cmd *ata_qc_new(struct ata_port *ap)
4062{
4063 struct ata_queued_cmd *qc = NULL;
4064 unsigned int i;
4065
4066 for (i = 0; i < ATA_MAX_QUEUE; i++)
4067 if (!test_and_set_bit(i, &ap->qactive)) {
4068 qc = ata_qc_from_tag(ap, i);
4069 break;
4070 }
4071
4072 if (qc)
4073 qc->tag = i;
4074
4075 return qc;
4076}
4077
4078/**
4079 * ata_qc_new_init - Request an available ATA command, and initialize it
4080 * @ap: Port associated with device @dev
4081 * @dev: Device from whom we request an available command structure
4082 *
4083 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004084 * None.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004085 */
4086
4087struct ata_queued_cmd *ata_qc_new_init(struct ata_port *ap,
4088 struct ata_device *dev)
4089{
4090 struct ata_queued_cmd *qc;
4091
4092 qc = ata_qc_new(ap);
4093 if (qc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004094 qc->scsicmd = NULL;
4095 qc->ap = ap;
4096 qc->dev = dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004097
Jeff Garzik2c13b7c2005-11-14 14:14:16 -05004098 ata_qc_reinit(qc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004099 }
4100
4101 return qc;
4102}
4103
Linus Torvalds1da177e2005-04-16 15:20:36 -07004104/**
4105 * ata_qc_free - free unused ata_queued_cmd
4106 * @qc: Command to complete
4107 *
4108 * Designed to free unused ata_queued_cmd object
4109 * in case something prevents using it.
4110 *
4111 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004112 * spin_lock_irqsave(host_set lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004113 */
4114void ata_qc_free(struct ata_queued_cmd *qc)
4115{
Tejun Heo4ba946e2006-01-23 13:09:36 +09004116 struct ata_port *ap = qc->ap;
4117 unsigned int tag;
4118
Tejun Heoa46314742006-02-11 19:11:13 +09004119 WARN_ON(qc == NULL); /* ata_qc_from_tag _might_ return NULL */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004120
Tejun Heo4ba946e2006-01-23 13:09:36 +09004121 qc->flags = 0;
4122 tag = qc->tag;
4123 if (likely(ata_tag_valid(tag))) {
4124 if (tag == ap->active_tag)
4125 ap->active_tag = ATA_TAG_POISON;
4126 qc->tag = ATA_TAG_POISON;
4127 clear_bit(tag, &ap->qactive);
4128 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004129}
4130
Tejun Heo76014422006-02-11 15:13:49 +09004131void __ata_qc_complete(struct ata_queued_cmd *qc)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004132{
Tejun Heoa46314742006-02-11 19:11:13 +09004133 WARN_ON(qc == NULL); /* ata_qc_from_tag _might_ return NULL */
4134 WARN_ON(!(qc->flags & ATA_QCFLAG_ACTIVE));
Linus Torvalds1da177e2005-04-16 15:20:36 -07004135
4136 if (likely(qc->flags & ATA_QCFLAG_DMAMAP))
4137 ata_sg_clean(qc);
4138
Albert Lee3f3791d2005-08-16 14:25:38 +08004139 /* atapi: mark qc as inactive to prevent the interrupt handler
4140 * from completing the command twice later, before the error handler
4141 * is called. (when rc != 0 and atapi request sense is needed)
4142 */
4143 qc->flags &= ~ATA_QCFLAG_ACTIVE;
4144
Linus Torvalds1da177e2005-04-16 15:20:36 -07004145 /* call completion callback */
Tejun Heo77853bf2006-01-23 13:09:36 +09004146 qc->complete_fn(qc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004147}
4148
4149static inline int ata_should_dma_map(struct ata_queued_cmd *qc)
4150{
4151 struct ata_port *ap = qc->ap;
4152
4153 switch (qc->tf.protocol) {
4154 case ATA_PROT_DMA:
4155 case ATA_PROT_ATAPI_DMA:
4156 return 1;
4157
4158 case ATA_PROT_ATAPI:
4159 case ATA_PROT_PIO:
Linus Torvalds1da177e2005-04-16 15:20:36 -07004160 if (ap->flags & ATA_FLAG_PIO_DMA)
4161 return 1;
4162
4163 /* fall through */
4164
4165 default:
4166 return 0;
4167 }
4168
4169 /* never reached */
4170}
4171
4172/**
4173 * ata_qc_issue - issue taskfile to device
4174 * @qc: command to issue to device
4175 *
4176 * Prepare an ATA command to submission to device.
4177 * This includes mapping the data into a DMA-able
4178 * area, filling in the S/G table, and finally
4179 * writing the taskfile to hardware, starting the command.
4180 *
4181 * LOCKING:
4182 * spin_lock_irqsave(host_set lock)
4183 *
4184 * RETURNS:
Tejun Heo9a3d9eb2006-01-23 13:09:36 +09004185 * Zero on success, AC_ERR_* mask on failure
Linus Torvalds1da177e2005-04-16 15:20:36 -07004186 */
4187
Tejun Heo9a3d9eb2006-01-23 13:09:36 +09004188unsigned int ata_qc_issue(struct ata_queued_cmd *qc)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004189{
4190 struct ata_port *ap = qc->ap;
4191
4192 if (ata_should_dma_map(qc)) {
4193 if (qc->flags & ATA_QCFLAG_SG) {
4194 if (ata_sg_setup(qc))
Tejun Heo8e436af2006-01-23 13:09:36 +09004195 goto sg_err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004196 } else if (qc->flags & ATA_QCFLAG_SINGLE) {
4197 if (ata_sg_setup_one(qc))
Tejun Heo8e436af2006-01-23 13:09:36 +09004198 goto sg_err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004199 }
4200 } else {
4201 qc->flags &= ~ATA_QCFLAG_DMAMAP;
4202 }
4203
4204 ap->ops->qc_prep(qc);
4205
4206 qc->ap->active_tag = qc->tag;
4207 qc->flags |= ATA_QCFLAG_ACTIVE;
4208
4209 return ap->ops->qc_issue(qc);
4210
Tejun Heo8e436af2006-01-23 13:09:36 +09004211sg_err:
4212 qc->flags &= ~ATA_QCFLAG_DMAMAP;
Tejun Heo9a3d9eb2006-01-23 13:09:36 +09004213 return AC_ERR_SYSTEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004214}
4215
Edward Falk0baab862005-06-02 18:17:13 -04004216
Linus Torvalds1da177e2005-04-16 15:20:36 -07004217/**
4218 * ata_qc_issue_prot - issue taskfile to device in proto-dependent manner
4219 * @qc: command to issue to device
4220 *
4221 * Using various libata functions and hooks, this function
4222 * starts an ATA command. ATA commands are grouped into
4223 * classes called "protocols", and issuing each type of protocol
4224 * is slightly different.
4225 *
Edward Falk0baab862005-06-02 18:17:13 -04004226 * May be used as the qc_issue() entry in ata_port_operations.
4227 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07004228 * LOCKING:
4229 * spin_lock_irqsave(host_set lock)
4230 *
4231 * RETURNS:
Tejun Heo9a3d9eb2006-01-23 13:09:36 +09004232 * Zero on success, AC_ERR_* mask on failure
Linus Torvalds1da177e2005-04-16 15:20:36 -07004233 */
4234
Tejun Heo9a3d9eb2006-01-23 13:09:36 +09004235unsigned int ata_qc_issue_prot(struct ata_queued_cmd *qc)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004236{
4237 struct ata_port *ap = qc->ap;
4238
Albert Leee50362e2005-09-27 17:39:50 +08004239 /* Use polling pio if the LLD doesn't handle
4240 * interrupt driven pio and atapi CDB interrupt.
4241 */
4242 if (ap->flags & ATA_FLAG_PIO_POLLING) {
4243 switch (qc->tf.protocol) {
4244 case ATA_PROT_PIO:
4245 case ATA_PROT_ATAPI:
4246 case ATA_PROT_ATAPI_NODATA:
4247 qc->tf.flags |= ATA_TFLAG_POLLING;
4248 break;
4249 case ATA_PROT_ATAPI_DMA:
4250 if (qc->dev->flags & ATA_DFLAG_CDB_INTR)
4251 BUG();
4252 break;
4253 default:
4254 break;
4255 }
4256 }
4257
Albert Lee312f7da2005-09-27 17:38:03 +08004258 /* select the device */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004259 ata_dev_select(ap, qc->dev->devno, 1, 0);
4260
Albert Lee312f7da2005-09-27 17:38:03 +08004261 /* start the command */
Linus Torvalds1da177e2005-04-16 15:20:36 -07004262 switch (qc->tf.protocol) {
4263 case ATA_PROT_NODATA:
Albert Lee312f7da2005-09-27 17:38:03 +08004264 if (qc->tf.flags & ATA_TFLAG_POLLING)
4265 ata_qc_set_polling(qc);
4266
Jeff Garzike5338252005-10-30 21:37:17 -05004267 ata_tf_to_host(ap, &qc->tf);
Albert Lee312f7da2005-09-27 17:38:03 +08004268 ap->hsm_task_state = HSM_ST_LAST;
4269
4270 if (qc->tf.flags & ATA_TFLAG_POLLING)
Jeff Garzik46e202e2006-03-11 19:25:47 -05004271 ata_port_queue_task(ap, ata_pio_task, ap, 0);
Albert Lee312f7da2005-09-27 17:38:03 +08004272
Linus Torvalds1da177e2005-04-16 15:20:36 -07004273 break;
4274
4275 case ATA_PROT_DMA:
Jeff Garzik587005d2006-02-11 18:17:32 -05004276 WARN_ON(qc->tf.flags & ATA_TFLAG_POLLING);
Albert Lee312f7da2005-09-27 17:38:03 +08004277
Linus Torvalds1da177e2005-04-16 15:20:36 -07004278 ap->ops->tf_load(ap, &qc->tf); /* load tf registers */
4279 ap->ops->bmdma_setup(qc); /* set up bmdma */
4280 ap->ops->bmdma_start(qc); /* initiate bmdma */
Albert Lee312f7da2005-09-27 17:38:03 +08004281 ap->hsm_task_state = HSM_ST_LAST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004282 break;
4283
Albert Lee312f7da2005-09-27 17:38:03 +08004284 case ATA_PROT_PIO:
4285 if (qc->tf.flags & ATA_TFLAG_POLLING)
4286 ata_qc_set_polling(qc);
4287
Jeff Garzike5338252005-10-30 21:37:17 -05004288 ata_tf_to_host(ap, &qc->tf);
Albert Lee312f7da2005-09-27 17:38:03 +08004289
Albert Lee54f00382005-09-30 19:14:19 +08004290 if (qc->tf.flags & ATA_TFLAG_WRITE) {
4291 /* PIO data out protocol */
4292 ap->hsm_task_state = HSM_ST_FIRST;
Jeff Garzikce1e7a22006-03-11 19:21:17 -05004293 ata_port_queue_task(ap, ata_pio_task, ap, 0);
Albert Lee54f00382005-09-30 19:14:19 +08004294
4295 /* always send first data block using
Albert Leee27486d2005-11-01 19:24:49 +08004296 * the ata_pio_task() codepath.
Albert Lee54f00382005-09-30 19:14:19 +08004297 */
Albert Lee312f7da2005-09-27 17:38:03 +08004298 } else {
Albert Lee54f00382005-09-30 19:14:19 +08004299 /* PIO data in protocol */
4300 ap->hsm_task_state = HSM_ST;
Albert Lee312f7da2005-09-27 17:38:03 +08004301
Albert Lee54f00382005-09-30 19:14:19 +08004302 if (qc->tf.flags & ATA_TFLAG_POLLING)
Jeff Garzikce1e7a22006-03-11 19:21:17 -05004303 ata_port_queue_task(ap, ata_pio_task, ap, 0);
Albert Lee312f7da2005-09-27 17:38:03 +08004304
Albert Lee54f00382005-09-30 19:14:19 +08004305 /* if polling, ata_pio_task() handles the rest.
4306 * otherwise, interrupt handler takes over from here.
4307 */
Albert Lee312f7da2005-09-27 17:38:03 +08004308 }
4309
Linus Torvalds1da177e2005-04-16 15:20:36 -07004310 break;
4311
4312 case ATA_PROT_ATAPI:
Linus Torvalds1da177e2005-04-16 15:20:36 -07004313 case ATA_PROT_ATAPI_NODATA:
Albert Lee312f7da2005-09-27 17:38:03 +08004314 if (qc->tf.flags & ATA_TFLAG_POLLING)
4315 ata_qc_set_polling(qc);
4316
Jeff Garzike5338252005-10-30 21:37:17 -05004317 ata_tf_to_host(ap, &qc->tf);
Jeff Garzikf6ef65e2006-01-27 02:45:00 -05004318
Albert Lee312f7da2005-09-27 17:38:03 +08004319 ap->hsm_task_state = HSM_ST_FIRST;
4320
4321 /* send cdb by polling if no cdb interrupt */
4322 if ((!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) ||
4323 (qc->tf.flags & ATA_TFLAG_POLLING))
Albert Lee13ee46282006-03-25 17:39:34 +08004324 ata_port_queue_task(ap, ata_pio_task, ap, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004325 break;
4326
4327 case ATA_PROT_ATAPI_DMA:
Jeff Garzik587005d2006-02-11 18:17:32 -05004328 WARN_ON(qc->tf.flags & ATA_TFLAG_POLLING);
Albert Lee312f7da2005-09-27 17:38:03 +08004329
Linus Torvalds1da177e2005-04-16 15:20:36 -07004330 ap->ops->tf_load(ap, &qc->tf); /* load tf registers */
4331 ap->ops->bmdma_setup(qc); /* set up bmdma */
Albert Lee312f7da2005-09-27 17:38:03 +08004332 ap->hsm_task_state = HSM_ST_FIRST;
4333
4334 /* send cdb by polling if no cdb interrupt */
4335 if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR))
Albert Lee13ee46282006-03-25 17:39:34 +08004336 ata_port_queue_task(ap, ata_pio_task, ap, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004337 break;
4338
4339 default:
4340 WARN_ON(1);
Tejun Heo9a3d9eb2006-01-23 13:09:36 +09004341 return AC_ERR_SYSTEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004342 }
4343
4344 return 0;
4345}
4346
4347/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07004348 * ata_host_intr - Handle host interrupt for given (port, task)
4349 * @ap: Port on which interrupt arrived (possibly...)
4350 * @qc: Taskfile currently active in engine
4351 *
4352 * Handle host interrupt for given queued command. Currently,
4353 * only DMA interrupts are handled. All other commands are
4354 * handled via polling with interrupts disabled (nIEN bit).
4355 *
4356 * LOCKING:
4357 * spin_lock_irqsave(host_set lock)
4358 *
4359 * RETURNS:
4360 * One if interrupt was handled, zero if not (shared irq).
4361 */
4362
4363inline unsigned int ata_host_intr (struct ata_port *ap,
4364 struct ata_queued_cmd *qc)
4365{
Albert Lee312f7da2005-09-27 17:38:03 +08004366 u8 status, host_stat = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004367
Albert Lee312f7da2005-09-27 17:38:03 +08004368 VPRINTK("ata%u: protocol %d task_state %d\n",
4369 ap->id, qc->tf.protocol, ap->hsm_task_state);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004370
Albert Lee312f7da2005-09-27 17:38:03 +08004371 /* Check whether we are expecting interrupt in this state */
4372 switch (ap->hsm_task_state) {
4373 case HSM_ST_FIRST:
4374 /* Check the ATA_DFLAG_CDB_INTR flag is enough here.
4375 * The flag was turned on only for atapi devices.
4376 * No need to check is_atapi_taskfile(&qc->tf) again.
4377 */
4378 if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004379 goto idle_irq;
Albert Lee312f7da2005-09-27 17:38:03 +08004380 break;
4381 case HSM_ST_LAST:
4382 if (qc->tf.protocol == ATA_PROT_DMA ||
4383 qc->tf.protocol == ATA_PROT_ATAPI_DMA) {
4384 /* check status of DMA engine */
4385 host_stat = ap->ops->bmdma_status(ap);
4386 VPRINTK("ata%u: host_stat 0x%X\n", ap->id, host_stat);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004387
Albert Lee312f7da2005-09-27 17:38:03 +08004388 /* if it's not our irq... */
4389 if (!(host_stat & ATA_DMA_INTR))
4390 goto idle_irq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004391
Albert Lee312f7da2005-09-27 17:38:03 +08004392 /* before we do anything else, clear DMA-Start bit */
4393 ap->ops->bmdma_stop(qc);
Albert Leea4f16612005-12-26 16:40:53 +08004394
4395 if (unlikely(host_stat & ATA_DMA_ERR)) {
4396 /* error when transfering data to/from memory */
4397 qc->err_mask |= AC_ERR_HOST_BUS;
4398 ap->hsm_task_state = HSM_ST_ERR;
4399 }
Albert Lee312f7da2005-09-27 17:38:03 +08004400 }
4401 break;
4402 case HSM_ST:
4403 break;
4404 default:
4405 goto idle_irq;
4406 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004407
Albert Lee312f7da2005-09-27 17:38:03 +08004408 /* check altstatus */
4409 status = ata_altstatus(ap);
4410 if (status & ATA_BUSY)
4411 goto idle_irq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004412
Albert Lee312f7da2005-09-27 17:38:03 +08004413 /* check main status, clearing INTRQ */
4414 status = ata_chk_status(ap);
4415 if (unlikely(status & ATA_BUSY))
4416 goto idle_irq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004417
Albert Lee312f7da2005-09-27 17:38:03 +08004418 DPRINTK("ata%u: protocol %d task_state %d (dev_stat 0x%X)\n",
4419 ap->id, qc->tf.protocol, ap->hsm_task_state, status);
4420
4421 /* ack bmdma irq events */
4422 ap->ops->irq_clear(ap);
4423
Albert Leee2cec772006-03-25 17:43:49 +08004424 ata_hsm_move(ap, qc, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004425 return 1; /* irq handled */
4426
4427idle_irq:
4428 ap->stats.idle_irq++;
4429
4430#ifdef ATA_IRQ_TRAP
4431 if ((ap->stats.idle_irq % 1000) == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004432 ata_irq_ack(ap, 0); /* debug trap */
4433 printk(KERN_WARNING "ata%d: irq trap\n", ap->id);
Alan Cox23cfce82006-03-21 16:06:53 +00004434 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004435 }
4436#endif
4437 return 0; /* irq not handled */
4438}
4439
4440/**
4441 * ata_interrupt - Default ATA host interrupt handler
Jeff Garzik0cba6322005-05-30 19:49:12 -04004442 * @irq: irq line (unused)
4443 * @dev_instance: pointer to our ata_host_set information structure
Linus Torvalds1da177e2005-04-16 15:20:36 -07004444 * @regs: unused
4445 *
Jeff Garzik0cba6322005-05-30 19:49:12 -04004446 * Default interrupt handler for PCI IDE devices. Calls
4447 * ata_host_intr() for each port that is not disabled.
4448 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07004449 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004450 * Obtains host_set lock during operation.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004451 *
4452 * RETURNS:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004453 * IRQ_NONE or IRQ_HANDLED.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004454 */
4455
4456irqreturn_t ata_interrupt (int irq, void *dev_instance, struct pt_regs *regs)
4457{
4458 struct ata_host_set *host_set = dev_instance;
4459 unsigned int i;
4460 unsigned int handled = 0;
4461 unsigned long flags;
4462
4463 /* TODO: make _irqsave conditional on x86 PCI IDE legacy mode */
4464 spin_lock_irqsave(&host_set->lock, flags);
4465
4466 for (i = 0; i < host_set->n_ports; i++) {
4467 struct ata_port *ap;
4468
4469 ap = host_set->ports[i];
Tejun Heoc1389502005-08-22 14:59:24 +09004470 if (ap &&
Albert Lee312f7da2005-09-27 17:38:03 +08004471 !(ap->flags & ATA_FLAG_PORT_DISABLED)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07004472 struct ata_queued_cmd *qc;
4473
4474 qc = ata_qc_from_tag(ap, ap->active_tag);
Albert Lee312f7da2005-09-27 17:38:03 +08004475 if (qc && (!(qc->tf.flags & ATA_TFLAG_POLLING)) &&
Albert Lee21b1ed72005-04-29 17:34:59 +08004476 (qc->flags & ATA_QCFLAG_ACTIVE))
Linus Torvalds1da177e2005-04-16 15:20:36 -07004477 handled |= ata_host_intr(ap, qc);
4478 }
4479 }
4480
4481 spin_unlock_irqrestore(&host_set->lock, flags);
4482
4483 return IRQ_RETVAL(handled);
4484}
4485
Edward Falk0baab862005-06-02 18:17:13 -04004486
Jens Axboe9b847542006-01-06 09:28:07 +01004487/*
4488 * Execute a 'simple' command, that only consists of the opcode 'cmd' itself,
4489 * without filling any other registers
4490 */
4491static int ata_do_simple_cmd(struct ata_port *ap, struct ata_device *dev,
4492 u8 cmd)
4493{
4494 struct ata_taskfile tf;
4495 int err;
4496
4497 ata_tf_init(ap, &tf, dev->devno);
4498
4499 tf.command = cmd;
4500 tf.flags |= ATA_TFLAG_DEVICE;
4501 tf.protocol = ATA_PROT_NODATA;
4502
4503 err = ata_exec_internal(ap, dev, &tf, DMA_NONE, NULL, 0);
4504 if (err)
4505 printk(KERN_ERR "%s: ata command failed: %d\n",
4506 __FUNCTION__, err);
4507
4508 return err;
4509}
4510
4511static int ata_flush_cache(struct ata_port *ap, struct ata_device *dev)
4512{
4513 u8 cmd;
4514
4515 if (!ata_try_flush_cache(dev))
4516 return 0;
4517
4518 if (ata_id_has_flush_ext(dev->id))
4519 cmd = ATA_CMD_FLUSH_EXT;
4520 else
4521 cmd = ATA_CMD_FLUSH;
4522
4523 return ata_do_simple_cmd(ap, dev, cmd);
4524}
4525
4526static int ata_standby_drive(struct ata_port *ap, struct ata_device *dev)
4527{
4528 return ata_do_simple_cmd(ap, dev, ATA_CMD_STANDBYNOW1);
4529}
4530
4531static int ata_start_drive(struct ata_port *ap, struct ata_device *dev)
4532{
4533 return ata_do_simple_cmd(ap, dev, ATA_CMD_IDLEIMMEDIATE);
4534}
4535
4536/**
4537 * ata_device_resume - wakeup a previously suspended devices
Randy Dunlapc893a3a2006-01-28 13:15:32 -05004538 * @ap: port the device is connected to
4539 * @dev: the device to resume
Jens Axboe9b847542006-01-06 09:28:07 +01004540 *
4541 * Kick the drive back into action, by sending it an idle immediate
4542 * command and making sure its transfer mode matches between drive
4543 * and host.
4544 *
4545 */
4546int ata_device_resume(struct ata_port *ap, struct ata_device *dev)
4547{
4548 if (ap->flags & ATA_FLAG_SUSPENDED) {
4549 ap->flags &= ~ATA_FLAG_SUSPENDED;
4550 ata_set_mode(ap);
4551 }
4552 if (!ata_dev_present(dev))
4553 return 0;
4554 if (dev->class == ATA_DEV_ATA)
4555 ata_start_drive(ap, dev);
4556
4557 return 0;
4558}
4559
4560/**
4561 * ata_device_suspend - prepare a device for suspend
Randy Dunlapc893a3a2006-01-28 13:15:32 -05004562 * @ap: port the device is connected to
4563 * @dev: the device to suspend
Jens Axboe9b847542006-01-06 09:28:07 +01004564 *
4565 * Flush the cache on the drive, if appropriate, then issue a
4566 * standbynow command.
Jens Axboe9b847542006-01-06 09:28:07 +01004567 */
Nigel Cunningham082776e2006-03-23 23:22:16 +10004568int ata_device_suspend(struct ata_port *ap, struct ata_device *dev, pm_message_t state)
Jens Axboe9b847542006-01-06 09:28:07 +01004569{
4570 if (!ata_dev_present(dev))
4571 return 0;
4572 if (dev->class == ATA_DEV_ATA)
4573 ata_flush_cache(ap, dev);
4574
Nigel Cunningham082776e2006-03-23 23:22:16 +10004575 if (state.event != PM_EVENT_FREEZE)
4576 ata_standby_drive(ap, dev);
Jens Axboe9b847542006-01-06 09:28:07 +01004577 ap->flags |= ATA_FLAG_SUSPENDED;
4578 return 0;
4579}
4580
Albert Lee332b5a52006-02-08 16:51:34 +08004581/**
4582 * ata_port_start - Set port up for dma.
4583 * @ap: Port to initialize
4584 *
4585 * Called just after data structures for each port are
4586 * initialized. Allocates space for PRD table.
4587 *
4588 * May be used as the port_start() entry in ata_port_operations.
4589 *
4590 * LOCKING:
4591 * Inherited from caller.
4592 */
4593
Linus Torvalds1da177e2005-04-16 15:20:36 -07004594int ata_port_start (struct ata_port *ap)
4595{
Brian King2f1f6102006-03-23 17:30:15 -06004596 struct device *dev = ap->dev;
Jeff Garzik6037d6b2005-11-04 22:08:00 -05004597 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004598
4599 ap->prd = dma_alloc_coherent(dev, ATA_PRD_TBL_SZ, &ap->prd_dma, GFP_KERNEL);
4600 if (!ap->prd)
4601 return -ENOMEM;
4602
Jeff Garzik6037d6b2005-11-04 22:08:00 -05004603 rc = ata_pad_alloc(ap, dev);
4604 if (rc) {
Jeff Garzikcedc9a42005-10-05 07:13:30 -04004605 dma_free_coherent(dev, ATA_PRD_TBL_SZ, ap->prd, ap->prd_dma);
Jeff Garzik6037d6b2005-11-04 22:08:00 -05004606 return rc;
Jeff Garzikcedc9a42005-10-05 07:13:30 -04004607 }
4608
Linus Torvalds1da177e2005-04-16 15:20:36 -07004609 DPRINTK("prd alloc, virt %p, dma %llx\n", ap->prd, (unsigned long long) ap->prd_dma);
4610
4611 return 0;
4612}
4613
Edward Falk0baab862005-06-02 18:17:13 -04004614
4615/**
4616 * ata_port_stop - Undo ata_port_start()
4617 * @ap: Port to shut down
4618 *
4619 * Frees the PRD table.
4620 *
4621 * May be used as the port_stop() entry in ata_port_operations.
4622 *
4623 * LOCKING:
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04004624 * Inherited from caller.
Edward Falk0baab862005-06-02 18:17:13 -04004625 */
4626
Linus Torvalds1da177e2005-04-16 15:20:36 -07004627void ata_port_stop (struct ata_port *ap)
4628{
Brian King2f1f6102006-03-23 17:30:15 -06004629 struct device *dev = ap->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004630
4631 dma_free_coherent(dev, ATA_PRD_TBL_SZ, ap->prd, ap->prd_dma);
Jeff Garzik6037d6b2005-11-04 22:08:00 -05004632 ata_pad_free(ap, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004633}
4634
Jeff Garzikaa8f0dc2005-05-26 21:54:27 -04004635void ata_host_stop (struct ata_host_set *host_set)
4636{
4637 if (host_set->mmio_base)
4638 iounmap(host_set->mmio_base);
4639}
4640
4641
Linus Torvalds1da177e2005-04-16 15:20:36 -07004642/**
4643 * ata_host_remove - Unregister SCSI host structure with upper layers
4644 * @ap: Port to unregister
4645 * @do_unregister: 1 if we fully unregister, 0 to just stop the port
4646 *
4647 * LOCKING:
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04004648 * Inherited from caller.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004649 */
4650
4651static void ata_host_remove(struct ata_port *ap, unsigned int do_unregister)
4652{
4653 struct Scsi_Host *sh = ap->host;
4654
4655 DPRINTK("ENTER\n");
4656
4657 if (do_unregister)
4658 scsi_remove_host(sh);
4659
4660 ap->ops->port_stop(ap);
4661}
4662
4663/**
4664 * ata_host_init - Initialize an ata_port structure
4665 * @ap: Structure to initialize
4666 * @host: associated SCSI mid-layer structure
4667 * @host_set: Collection of hosts to which @ap belongs
4668 * @ent: Probe information provided by low-level driver
4669 * @port_no: Port number associated with this ata_port
4670 *
Jeff Garzik0cba6322005-05-30 19:49:12 -04004671 * Initialize a new ata_port structure, and its associated
4672 * scsi_host.
4673 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07004674 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004675 * Inherited from caller.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004676 */
4677
4678static void ata_host_init(struct ata_port *ap, struct Scsi_Host *host,
4679 struct ata_host_set *host_set,
Jeff Garzik057ace52005-10-22 14:27:05 -04004680 const struct ata_probe_ent *ent, unsigned int port_no)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004681{
4682 unsigned int i;
4683
4684 host->max_id = 16;
4685 host->max_lun = 1;
4686 host->max_channel = 1;
4687 host->unique_id = ata_unique_id++;
4688 host->max_cmd_len = 12;
Christoph Hellwig12413192005-06-11 01:05:01 +02004689
Linus Torvalds1da177e2005-04-16 15:20:36 -07004690 ap->flags = ATA_FLAG_PORT_DISABLED;
4691 ap->id = host->unique_id;
4692 ap->host = host;
4693 ap->ctl = ATA_DEVCTL_OBS;
4694 ap->host_set = host_set;
Brian King2f1f6102006-03-23 17:30:15 -06004695 ap->dev = ent->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004696 ap->port_no = port_no;
4697 ap->hard_port_no =
4698 ent->legacy_mode ? ent->hard_port_no : port_no;
4699 ap->pio_mask = ent->pio_mask;
4700 ap->mwdma_mask = ent->mwdma_mask;
4701 ap->udma_mask = ent->udma_mask;
4702 ap->flags |= ent->host_flags;
4703 ap->ops = ent->port_ops;
4704 ap->cbl = ATA_CBL_NONE;
4705 ap->active_tag = ATA_TAG_POISON;
4706 ap->last_ctl = 0xFF;
4707
Tejun Heo86e45b62006-03-05 15:29:09 +09004708 INIT_WORK(&ap->port_task, NULL, NULL);
Tejun Heoa72ec4c2006-01-23 13:09:37 +09004709 INIT_LIST_HEAD(&ap->eh_done_q);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004710
Tejun Heoacf356b2006-03-24 14:07:50 +09004711 for (i = 0; i < ATA_MAX_DEVICES; i++) {
4712 struct ata_device *dev = &ap->device[i];
4713 dev->devno = i;
4714 dev->pio_mask = UINT_MAX;
4715 dev->mwdma_mask = UINT_MAX;
4716 dev->udma_mask = UINT_MAX;
4717 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07004718
4719#ifdef ATA_IRQ_TRAP
4720 ap->stats.unhandled_irq = 1;
4721 ap->stats.idle_irq = 1;
4722#endif
4723
4724 memcpy(&ap->ioaddr, &ent->port[port_no], sizeof(struct ata_ioports));
4725}
4726
4727/**
4728 * ata_host_add - Attach low-level ATA driver to system
4729 * @ent: Information provided by low-level driver
4730 * @host_set: Collections of ports to which we add
4731 * @port_no: Port number associated with this host
4732 *
Jeff Garzik0cba6322005-05-30 19:49:12 -04004733 * Attach low-level ATA driver to system.
4734 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07004735 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004736 * PCI/etc. bus probe sem.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004737 *
4738 * RETURNS:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004739 * New ata_port on success, for NULL on error.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004740 */
4741
Jeff Garzik057ace52005-10-22 14:27:05 -04004742static struct ata_port * ata_host_add(const struct ata_probe_ent *ent,
Linus Torvalds1da177e2005-04-16 15:20:36 -07004743 struct ata_host_set *host_set,
4744 unsigned int port_no)
4745{
4746 struct Scsi_Host *host;
4747 struct ata_port *ap;
4748 int rc;
4749
4750 DPRINTK("ENTER\n");
Tejun Heoaec5c3c2006-03-25 01:33:34 +09004751
4752 if (!ent->port_ops->probe_reset &&
4753 !(ent->host_flags & (ATA_FLAG_SATA_RESET | ATA_FLAG_SRST))) {
4754 printk(KERN_ERR "ata%u: no reset mechanism available\n",
4755 port_no);
4756 return NULL;
4757 }
4758
Linus Torvalds1da177e2005-04-16 15:20:36 -07004759 host = scsi_host_alloc(ent->sht, sizeof(struct ata_port));
4760 if (!host)
4761 return NULL;
4762
Tejun Heo30afc842006-03-18 18:40:14 +09004763 host->transportt = &ata_scsi_transport_template;
4764
Linus Torvalds1da177e2005-04-16 15:20:36 -07004765 ap = (struct ata_port *) &host->hostdata[0];
4766
4767 ata_host_init(ap, host, host_set, ent, port_no);
4768
4769 rc = ap->ops->port_start(ap);
4770 if (rc)
4771 goto err_out;
4772
4773 return ap;
4774
4775err_out:
4776 scsi_host_put(host);
4777 return NULL;
4778}
4779
4780/**
Jeff Garzik0cba6322005-05-30 19:49:12 -04004781 * ata_device_add - Register hardware device with ATA and SCSI layers
4782 * @ent: Probe information describing hardware device to be registered
4783 *
4784 * This function processes the information provided in the probe
4785 * information struct @ent, allocates the necessary ATA and SCSI
4786 * host information structures, initializes them, and registers
4787 * everything with requisite kernel subsystems.
4788 *
4789 * This function requests irqs, probes the ATA bus, and probes
4790 * the SCSI bus.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004791 *
4792 * LOCKING:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004793 * PCI/etc. bus probe sem.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004794 *
4795 * RETURNS:
Jeff Garzik0cba6322005-05-30 19:49:12 -04004796 * Number of ports registered. Zero on error (no ports registered).
Linus Torvalds1da177e2005-04-16 15:20:36 -07004797 */
4798
Jeff Garzik057ace52005-10-22 14:27:05 -04004799int ata_device_add(const struct ata_probe_ent *ent)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004800{
4801 unsigned int count = 0, i;
4802 struct device *dev = ent->dev;
4803 struct ata_host_set *host_set;
4804
4805 DPRINTK("ENTER\n");
4806 /* alloc a container for our list of ATA ports (buses) */
Randy Dunlap57f3bda2005-10-28 20:37:23 -07004807 host_set = kzalloc(sizeof(struct ata_host_set) +
Linus Torvalds1da177e2005-04-16 15:20:36 -07004808 (ent->n_ports * sizeof(void *)), GFP_KERNEL);
4809 if (!host_set)
4810 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004811 spin_lock_init(&host_set->lock);
4812
4813 host_set->dev = dev;
4814 host_set->n_ports = ent->n_ports;
4815 host_set->irq = ent->irq;
4816 host_set->mmio_base = ent->mmio_base;
4817 host_set->private_data = ent->private_data;
4818 host_set->ops = ent->port_ops;
4819
4820 /* register each port bound to this device */
4821 for (i = 0; i < ent->n_ports; i++) {
4822 struct ata_port *ap;
4823 unsigned long xfer_mode_mask;
4824
4825 ap = ata_host_add(ent, host_set, i);
4826 if (!ap)
4827 goto err_out;
4828
4829 host_set->ports[i] = ap;
4830 xfer_mode_mask =(ap->udma_mask << ATA_SHIFT_UDMA) |
4831 (ap->mwdma_mask << ATA_SHIFT_MWDMA) |
4832 (ap->pio_mask << ATA_SHIFT_PIO);
4833
4834 /* print per-port info to dmesg */
4835 printk(KERN_INFO "ata%u: %cATA max %s cmd 0x%lX ctl 0x%lX "
4836 "bmdma 0x%lX irq %lu\n",
4837 ap->id,
4838 ap->flags & ATA_FLAG_SATA ? 'S' : 'P',
4839 ata_mode_string(xfer_mode_mask),
4840 ap->ioaddr.cmd_addr,
4841 ap->ioaddr.ctl_addr,
4842 ap->ioaddr.bmdma_addr,
4843 ent->irq);
4844
4845 ata_chk_status(ap);
4846 host_set->ops->irq_clear(ap);
4847 count++;
4848 }
4849
Randy Dunlap57f3bda2005-10-28 20:37:23 -07004850 if (!count)
4851 goto err_free_ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004852
4853 /* obtain irq, that is shared between channels */
4854 if (request_irq(ent->irq, ent->port_ops->irq_handler, ent->irq_flags,
4855 DRV_NAME, host_set))
4856 goto err_out;
4857
4858 /* perform each probe synchronously */
4859 DPRINTK("probe begin\n");
4860 for (i = 0; i < count; i++) {
4861 struct ata_port *ap;
4862 int rc;
4863
4864 ap = host_set->ports[i];
4865
Randy Dunlapc893a3a2006-01-28 13:15:32 -05004866 DPRINTK("ata%u: bus probe begin\n", ap->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004867 rc = ata_bus_probe(ap);
Randy Dunlapc893a3a2006-01-28 13:15:32 -05004868 DPRINTK("ata%u: bus probe end\n", ap->id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004869
4870 if (rc) {
4871 /* FIXME: do something useful here?
4872 * Current libata behavior will
4873 * tear down everything when
4874 * the module is removed
4875 * or the h/w is unplugged.
4876 */
4877 }
4878
4879 rc = scsi_add_host(ap->host, dev);
4880 if (rc) {
4881 printk(KERN_ERR "ata%u: scsi_add_host failed\n",
4882 ap->id);
4883 /* FIXME: do something useful here */
4884 /* FIXME: handle unconditional calls to
4885 * scsi_scan_host and ata_host_remove, below,
4886 * at the very least
4887 */
4888 }
4889 }
4890
4891 /* probes are done, now scan each port's disk(s) */
Randy Dunlapc893a3a2006-01-28 13:15:32 -05004892 DPRINTK("host probe begin\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07004893 for (i = 0; i < count; i++) {
4894 struct ata_port *ap = host_set->ports[i];
4895
Jeff Garzik644dd0c2005-10-03 15:55:19 -04004896 ata_scsi_scan_host(ap);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004897 }
4898
4899 dev_set_drvdata(dev, host_set);
4900
4901 VPRINTK("EXIT, returning %u\n", ent->n_ports);
4902 return ent->n_ports; /* success */
4903
4904err_out:
4905 for (i = 0; i < count; i++) {
4906 ata_host_remove(host_set->ports[i], 1);
4907 scsi_host_put(host_set->ports[i]->host);
4908 }
Randy Dunlap57f3bda2005-10-28 20:37:23 -07004909err_free_ret:
Linus Torvalds1da177e2005-04-16 15:20:36 -07004910 kfree(host_set);
4911 VPRINTK("EXIT, returning 0\n");
4912 return 0;
4913}
4914
4915/**
Alan Cox17b14452005-09-15 15:44:00 +01004916 * ata_host_set_remove - PCI layer callback for device removal
4917 * @host_set: ATA host set that was removed
4918 *
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05004919 * Unregister all objects associated with this host set. Free those
Alan Cox17b14452005-09-15 15:44:00 +01004920 * objects.
4921 *
4922 * LOCKING:
4923 * Inherited from calling layer (may sleep).
4924 */
4925
Alan Cox17b14452005-09-15 15:44:00 +01004926void ata_host_set_remove(struct ata_host_set *host_set)
4927{
4928 struct ata_port *ap;
4929 unsigned int i;
4930
4931 for (i = 0; i < host_set->n_ports; i++) {
4932 ap = host_set->ports[i];
4933 scsi_remove_host(ap->host);
4934 }
4935
4936 free_irq(host_set->irq, host_set);
4937
4938 for (i = 0; i < host_set->n_ports; i++) {
4939 ap = host_set->ports[i];
4940
4941 ata_scsi_release(ap->host);
4942
4943 if ((ap->flags & ATA_FLAG_NO_LEGACY) == 0) {
4944 struct ata_ioports *ioaddr = &ap->ioaddr;
4945
4946 if (ioaddr->cmd_addr == 0x1f0)
4947 release_region(0x1f0, 8);
4948 else if (ioaddr->cmd_addr == 0x170)
4949 release_region(0x170, 8);
4950 }
4951
4952 scsi_host_put(ap->host);
4953 }
4954
4955 if (host_set->ops->host_stop)
4956 host_set->ops->host_stop(host_set);
4957
4958 kfree(host_set);
4959}
4960
4961/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07004962 * ata_scsi_release - SCSI layer callback hook for host unload
4963 * @host: libata host to be unloaded
4964 *
4965 * Performs all duties necessary to shut down a libata port...
4966 * Kill port kthread, disable port, and release resources.
4967 *
4968 * LOCKING:
4969 * Inherited from SCSI layer.
4970 *
4971 * RETURNS:
4972 * One.
4973 */
4974
4975int ata_scsi_release(struct Scsi_Host *host)
4976{
4977 struct ata_port *ap = (struct ata_port *) &host->hostdata[0];
Tejun Heod9572b12006-03-01 16:09:35 +09004978 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004979
4980 DPRINTK("ENTER\n");
4981
4982 ap->ops->port_disable(ap);
4983 ata_host_remove(ap, 0);
Tejun Heod9572b12006-03-01 16:09:35 +09004984 for (i = 0; i < ATA_MAX_DEVICES; i++)
4985 kfree(ap->device[i].id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004986
4987 DPRINTK("EXIT\n");
4988 return 1;
4989}
4990
4991/**
4992 * ata_std_ports - initialize ioaddr with standard port offsets.
4993 * @ioaddr: IO address structure to be initialized
Edward Falk0baab862005-06-02 18:17:13 -04004994 *
4995 * Utility function which initializes data_addr, error_addr,
4996 * feature_addr, nsect_addr, lbal_addr, lbam_addr, lbah_addr,
4997 * device_addr, status_addr, and command_addr to standard offsets
4998 * relative to cmd_addr.
4999 *
5000 * Does not set ctl_addr, altstatus_addr, bmdma_addr, or scr_addr.
Linus Torvalds1da177e2005-04-16 15:20:36 -07005001 */
Edward Falk0baab862005-06-02 18:17:13 -04005002
Linus Torvalds1da177e2005-04-16 15:20:36 -07005003void ata_std_ports(struct ata_ioports *ioaddr)
5004{
5005 ioaddr->data_addr = ioaddr->cmd_addr + ATA_REG_DATA;
5006 ioaddr->error_addr = ioaddr->cmd_addr + ATA_REG_ERR;
5007 ioaddr->feature_addr = ioaddr->cmd_addr + ATA_REG_FEATURE;
5008 ioaddr->nsect_addr = ioaddr->cmd_addr + ATA_REG_NSECT;
5009 ioaddr->lbal_addr = ioaddr->cmd_addr + ATA_REG_LBAL;
5010 ioaddr->lbam_addr = ioaddr->cmd_addr + ATA_REG_LBAM;
5011 ioaddr->lbah_addr = ioaddr->cmd_addr + ATA_REG_LBAH;
5012 ioaddr->device_addr = ioaddr->cmd_addr + ATA_REG_DEVICE;
5013 ioaddr->status_addr = ioaddr->cmd_addr + ATA_REG_STATUS;
5014 ioaddr->command_addr = ioaddr->cmd_addr + ATA_REG_CMD;
5015}
5016
Edward Falk0baab862005-06-02 18:17:13 -04005017
Jeff Garzik374b1872005-08-30 05:42:52 -04005018#ifdef CONFIG_PCI
5019
5020void ata_pci_host_stop (struct ata_host_set *host_set)
5021{
5022 struct pci_dev *pdev = to_pci_dev(host_set->dev);
5023
5024 pci_iounmap(pdev, host_set->mmio_base);
5025}
5026
Edward Falk0baab862005-06-02 18:17:13 -04005027/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07005028 * ata_pci_remove_one - PCI layer callback for device removal
5029 * @pdev: PCI device that was removed
5030 *
5031 * PCI layer indicates to libata via this hook that
Randy Dunlap6f0ef4f2005-10-25 01:44:30 -04005032 * hot-unplug or module unload event has occurred.
Linus Torvalds1da177e2005-04-16 15:20:36 -07005033 * Handle this by unregistering all objects associated
5034 * with this PCI device. Free those objects. Then finally
5035 * release PCI resources and disable device.
5036 *
5037 * LOCKING:
5038 * Inherited from PCI layer (may sleep).
5039 */
5040
5041void ata_pci_remove_one (struct pci_dev *pdev)
5042{
5043 struct device *dev = pci_dev_to_dev(pdev);
5044 struct ata_host_set *host_set = dev_get_drvdata(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005045
Alan Cox17b14452005-09-15 15:44:00 +01005046 ata_host_set_remove(host_set);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005047 pci_release_regions(pdev);
5048 pci_disable_device(pdev);
5049 dev_set_drvdata(dev, NULL);
5050}
5051
5052/* move to PCI subsystem */
Jeff Garzik057ace52005-10-22 14:27:05 -04005053int pci_test_config_bits(struct pci_dev *pdev, const struct pci_bits *bits)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005054{
5055 unsigned long tmp = 0;
5056
5057 switch (bits->width) {
5058 case 1: {
5059 u8 tmp8 = 0;
5060 pci_read_config_byte(pdev, bits->reg, &tmp8);
5061 tmp = tmp8;
5062 break;
5063 }
5064 case 2: {
5065 u16 tmp16 = 0;
5066 pci_read_config_word(pdev, bits->reg, &tmp16);
5067 tmp = tmp16;
5068 break;
5069 }
5070 case 4: {
5071 u32 tmp32 = 0;
5072 pci_read_config_dword(pdev, bits->reg, &tmp32);
5073 tmp = tmp32;
5074 break;
5075 }
5076
5077 default:
5078 return -EINVAL;
5079 }
5080
5081 tmp &= bits->mask;
5082
5083 return (tmp == bits->val) ? 1 : 0;
5084}
Jens Axboe9b847542006-01-06 09:28:07 +01005085
5086int ata_pci_device_suspend(struct pci_dev *pdev, pm_message_t state)
5087{
5088 pci_save_state(pdev);
5089 pci_disable_device(pdev);
5090 pci_set_power_state(pdev, PCI_D3hot);
5091 return 0;
5092}
5093
5094int ata_pci_device_resume(struct pci_dev *pdev)
5095{
5096 pci_set_power_state(pdev, PCI_D0);
5097 pci_restore_state(pdev);
5098 pci_enable_device(pdev);
5099 pci_set_master(pdev);
5100 return 0;
5101}
Linus Torvalds1da177e2005-04-16 15:20:36 -07005102#endif /* CONFIG_PCI */
5103
5104
Linus Torvalds1da177e2005-04-16 15:20:36 -07005105static int __init ata_init(void)
5106{
5107 ata_wq = create_workqueue("ata");
5108 if (!ata_wq)
5109 return -ENOMEM;
5110
5111 printk(KERN_DEBUG "libata version " DRV_VERSION " loaded.\n");
5112 return 0;
5113}
5114
5115static void __exit ata_exit(void)
5116{
5117 destroy_workqueue(ata_wq);
5118}
5119
5120module_init(ata_init);
5121module_exit(ata_exit);
5122
Jeff Garzik67846b32005-10-05 02:58:32 -04005123static unsigned long ratelimit_time;
5124static spinlock_t ata_ratelimit_lock = SPIN_LOCK_UNLOCKED;
5125
5126int ata_ratelimit(void)
5127{
5128 int rc;
5129 unsigned long flags;
5130
5131 spin_lock_irqsave(&ata_ratelimit_lock, flags);
5132
5133 if (time_after(jiffies, ratelimit_time)) {
5134 rc = 1;
5135 ratelimit_time = jiffies + (HZ/5);
5136 } else
5137 rc = 0;
5138
5139 spin_unlock_irqrestore(&ata_ratelimit_lock, flags);
5140
5141 return rc;
5142}
5143
Linus Torvalds1da177e2005-04-16 15:20:36 -07005144/*
5145 * libata is essentially a library of internal helper functions for
5146 * low-level ATA host controller drivers. As such, the API/ABI is
5147 * likely to change as new drivers are added and updated.
5148 * Do not depend on ABI/API stability.
5149 */
5150
5151EXPORT_SYMBOL_GPL(ata_std_bios_param);
5152EXPORT_SYMBOL_GPL(ata_std_ports);
5153EXPORT_SYMBOL_GPL(ata_device_add);
Alan Cox17b14452005-09-15 15:44:00 +01005154EXPORT_SYMBOL_GPL(ata_host_set_remove);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005155EXPORT_SYMBOL_GPL(ata_sg_init);
5156EXPORT_SYMBOL_GPL(ata_sg_init_one);
Tejun Heo76014422006-02-11 15:13:49 +09005157EXPORT_SYMBOL_GPL(__ata_qc_complete);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005158EXPORT_SYMBOL_GPL(ata_qc_issue_prot);
5159EXPORT_SYMBOL_GPL(ata_eng_timeout);
5160EXPORT_SYMBOL_GPL(ata_tf_load);
5161EXPORT_SYMBOL_GPL(ata_tf_read);
5162EXPORT_SYMBOL_GPL(ata_noop_dev_select);
5163EXPORT_SYMBOL_GPL(ata_std_dev_select);
5164EXPORT_SYMBOL_GPL(ata_tf_to_fis);
5165EXPORT_SYMBOL_GPL(ata_tf_from_fis);
5166EXPORT_SYMBOL_GPL(ata_check_status);
5167EXPORT_SYMBOL_GPL(ata_altstatus);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005168EXPORT_SYMBOL_GPL(ata_exec_command);
5169EXPORT_SYMBOL_GPL(ata_port_start);
5170EXPORT_SYMBOL_GPL(ata_port_stop);
Jeff Garzikaa8f0dc2005-05-26 21:54:27 -04005171EXPORT_SYMBOL_GPL(ata_host_stop);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005172EXPORT_SYMBOL_GPL(ata_interrupt);
5173EXPORT_SYMBOL_GPL(ata_qc_prep);
Brian Kinge46834c2006-03-17 17:04:03 -06005174EXPORT_SYMBOL_GPL(ata_noop_qc_prep);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005175EXPORT_SYMBOL_GPL(ata_bmdma_setup);
5176EXPORT_SYMBOL_GPL(ata_bmdma_start);
5177EXPORT_SYMBOL_GPL(ata_bmdma_irq_clear);
5178EXPORT_SYMBOL_GPL(ata_bmdma_status);
5179EXPORT_SYMBOL_GPL(ata_bmdma_stop);
5180EXPORT_SYMBOL_GPL(ata_port_probe);
5181EXPORT_SYMBOL_GPL(sata_phy_reset);
5182EXPORT_SYMBOL_GPL(__sata_phy_reset);
5183EXPORT_SYMBOL_GPL(ata_bus_reset);
Tejun Heo8a19ac82006-02-02 18:20:00 +09005184EXPORT_SYMBOL_GPL(ata_std_probeinit);
Tejun Heoc2bd5802006-01-24 17:05:22 +09005185EXPORT_SYMBOL_GPL(ata_std_softreset);
5186EXPORT_SYMBOL_GPL(sata_std_hardreset);
5187EXPORT_SYMBOL_GPL(ata_std_postreset);
5188EXPORT_SYMBOL_GPL(ata_std_probe_reset);
Tejun Heoa62c0fc2006-01-24 17:05:22 +09005189EXPORT_SYMBOL_GPL(ata_drive_probe_reset);
Tejun Heo623a3122006-03-05 17:55:58 +09005190EXPORT_SYMBOL_GPL(ata_dev_revalidate);
Jeff Garzik2e9edbf2006-03-24 09:56:57 -05005191EXPORT_SYMBOL_GPL(ata_dev_classify);
5192EXPORT_SYMBOL_GPL(ata_dev_pair);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005193EXPORT_SYMBOL_GPL(ata_port_disable);
Jeff Garzik67846b32005-10-05 02:58:32 -04005194EXPORT_SYMBOL_GPL(ata_ratelimit);
Tejun Heo6f8b9952006-01-24 17:05:21 +09005195EXPORT_SYMBOL_GPL(ata_busy_sleep);
Tejun Heo86e45b62006-03-05 15:29:09 +09005196EXPORT_SYMBOL_GPL(ata_port_queue_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005197EXPORT_SYMBOL_GPL(ata_scsi_ioctl);
5198EXPORT_SYMBOL_GPL(ata_scsi_queuecmd);
5199EXPORT_SYMBOL_GPL(ata_scsi_error);
5200EXPORT_SYMBOL_GPL(ata_scsi_slave_config);
5201EXPORT_SYMBOL_GPL(ata_scsi_release);
5202EXPORT_SYMBOL_GPL(ata_host_intr);
Tejun Heo6a62a042006-02-13 10:02:46 +09005203EXPORT_SYMBOL_GPL(ata_id_string);
5204EXPORT_SYMBOL_GPL(ata_id_c_string);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005205EXPORT_SYMBOL_GPL(ata_scsi_simulate);
Tejun Heoa72ec4c2006-01-23 13:09:37 +09005206EXPORT_SYMBOL_GPL(ata_eh_qc_complete);
5207EXPORT_SYMBOL_GPL(ata_eh_qc_retry);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005208
Alan Cox1bc4ccf2006-01-09 17:18:14 +00005209EXPORT_SYMBOL_GPL(ata_pio_need_iordy);
Alan Cox452503f2005-10-21 19:01:32 -04005210EXPORT_SYMBOL_GPL(ata_timing_compute);
5211EXPORT_SYMBOL_GPL(ata_timing_merge);
5212
Linus Torvalds1da177e2005-04-16 15:20:36 -07005213#ifdef CONFIG_PCI
5214EXPORT_SYMBOL_GPL(pci_test_config_bits);
Jeff Garzik374b1872005-08-30 05:42:52 -04005215EXPORT_SYMBOL_GPL(ata_pci_host_stop);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005216EXPORT_SYMBOL_GPL(ata_pci_init_native_mode);
5217EXPORT_SYMBOL_GPL(ata_pci_init_one);
5218EXPORT_SYMBOL_GPL(ata_pci_remove_one);
Jens Axboe9b847542006-01-06 09:28:07 +01005219EXPORT_SYMBOL_GPL(ata_pci_device_suspend);
5220EXPORT_SYMBOL_GPL(ata_pci_device_resume);
Alan Cox67951ad2006-03-22 15:55:54 +00005221EXPORT_SYMBOL_GPL(ata_pci_default_filter);
5222EXPORT_SYMBOL_GPL(ata_pci_clear_simplex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005223#endif /* CONFIG_PCI */
Jens Axboe9b847542006-01-06 09:28:07 +01005224
5225EXPORT_SYMBOL_GPL(ata_device_suspend);
5226EXPORT_SYMBOL_GPL(ata_device_resume);
5227EXPORT_SYMBOL_GPL(ata_scsi_device_suspend);
5228EXPORT_SYMBOL_GPL(ata_scsi_device_resume);