]> git.ipfire.org Git - people/ms/linux.git/blame - drivers/ata/libata-core.c
ata: libata-core: fix sloppy parameter type in ata_exec_internal[_sg]()
[people/ms/linux.git] / drivers / ata / libata-core.c
CommitLineData
c82ee6d3 1// SPDX-License-Identifier: GPL-2.0-or-later
1da177e4 2/*
af36d7f0
JG
3 * libata-core.c - helper library for ATA
4 *
af36d7f0
JG
5 * Copyright 2003-2004 Red Hat, Inc. All rights reserved.
6 * Copyright 2003-2004 Jeff Garzik
7 *
af36d7f0 8 * libata documentation is available via 'make {ps|pdf}docs',
19285f3c 9 * as Documentation/driver-api/libata.rst
af36d7f0
JG
10 *
11 * Hardware documentation available from http://www.t13.org/ and
12 * http://www.sata-io.org/
13 *
92c52c52
AC
14 * Standards documents from:
15 * http://www.t13.org (ATA standards, PCI DMA IDE spec)
16 * http://www.t10.org (SCSI MMC - for ATAPI MMC)
17 * http://www.sata-io.org (SATA)
18 * http://www.compactflash.org (CF)
19 * http://www.qic.org (QIC157 - Tape and DSC)
20 * http://www.ce-ata.org (CE-ATA: not supported)
a52fbcfc
BZ
21 *
22 * libata is essentially a library of internal helper functions for
23 * low-level ATA host controller drivers. As such, the API/ABI is
24 * likely to change as new drivers are added and updated.
25 * Do not depend on ABI/API stability.
1da177e4
LT
26 */
27
1da177e4
LT
28#include <linux/kernel.h>
29#include <linux/module.h>
30#include <linux/pci.h>
31#include <linux/init.h>
32#include <linux/list.h>
33#include <linux/mm.h>
1da177e4
LT
34#include <linux/spinlock.h>
35#include <linux/blkdev.h>
36#include <linux/delay.h>
37#include <linux/timer.h>
848c3920 38#include <linux/time.h>
1da177e4
LT
39#include <linux/interrupt.h>
40#include <linux/completion.h>
41#include <linux/suspend.h>
42#include <linux/workqueue.h>
378f058c 43#include <linux/scatterlist.h>
2dcb407e 44#include <linux/io.h>
e18086d6 45#include <linux/log2.h>
5a0e3ad6 46#include <linux/slab.h>
428ac5fc 47#include <linux/glob.h>
1da177e4 48#include <scsi/scsi.h>
193515d5 49#include <scsi/scsi_cmnd.h>
1da177e4
LT
50#include <scsi/scsi_host.h>
51#include <linux/libata.h>
1da177e4 52#include <asm/byteorder.h>
fe5af0cc 53#include <asm/unaligned.h>
140b5e59 54#include <linux/cdrom.h>
9990b6f3 55#include <linux/ratelimit.h>
eb25cb99 56#include <linux/leds.h>
9ee4f393 57#include <linux/pm_runtime.h>
b7db04d9 58#include <linux/platform_device.h>
bbf5a097 59#include <asm/setup.h>
1da177e4 60
255c03d1
HR
61#define CREATE_TRACE_POINTS
62#include <trace/events/libata.h>
63
1da177e4 64#include "libata.h"
d9027470 65#include "libata-transport.h"
fda0efc5 66
029cfd6b 67const struct ata_port_operations ata_base_port_ops = {
0aa1113d 68 .prereset = ata_std_prereset,
203c75b8 69 .postreset = ata_std_postreset,
a1efdaba 70 .error_handler = ata_std_error_handler,
e4a9c373
DW
71 .sched_eh = ata_std_sched_eh,
72 .end_eh = ata_std_end_eh,
029cfd6b
TH
73};
74
75const struct ata_port_operations sata_port_ops = {
76 .inherits = &ata_base_port_ops,
77
78 .qc_defer = ata_std_qc_defer,
57c9efdf 79 .hardreset = sata_std_hardreset,
029cfd6b 80};
a52fbcfc 81EXPORT_SYMBOL_GPL(sata_port_ops);
029cfd6b 82
3373efd8
TH
83static unsigned int ata_dev_init_params(struct ata_device *dev,
84 u16 heads, u16 sectors);
85static unsigned int ata_dev_set_xfermode(struct ata_device *dev);
86static void ata_dev_xfermask(struct ata_device *dev);
75683fe7 87static unsigned long ata_dev_blacklisted(const struct ata_device *dev);
1da177e4 88
a78f57af 89atomic_t ata_print_id = ATOMIC_INIT(0);
1da177e4 90
bf89b0bf 91#ifdef CONFIG_ATA_FORCE
33267325
TH
92struct ata_force_param {
93 const char *name;
8ba5a45c
BZ
94 u8 cbl;
95 u8 spd_limit;
f0a6d77b 96 unsigned int xfer_mask;
33267325
TH
97 unsigned int horkage_on;
98 unsigned int horkage_off;
3af9ca4d
DLM
99 u16 lflags_on;
100 u16 lflags_off;
33267325
TH
101};
102
103struct ata_force_ent {
104 int port;
105 int device;
106 struct ata_force_param param;
107};
108
109static struct ata_force_ent *ata_force_tbl;
110static int ata_force_tbl_size;
111
bbf5a097 112static char ata_force_param_buf[COMMAND_LINE_SIZE] __initdata;
7afb4222
TH
113/* param_buf is thrown away after initialization, disallow read */
114module_param_string(force, ata_force_param_buf, sizeof(ata_force_param_buf), 0);
8c27ceff 115MODULE_PARM_DESC(force, "Force ATA configurations including cable type, link speed and transfer mode (see Documentation/admin-guide/kernel-parameters.rst for details)");
bf89b0bf 116#endif
33267325 117
2486fa56 118static int atapi_enabled = 1;
1623c81e 119module_param(atapi_enabled, int, 0444);
ad5d8eac 120MODULE_PARM_DESC(atapi_enabled, "Enable discovery of ATAPI devices (0=off, 1=on [default])");
1623c81e 121
c5c61bda 122static int atapi_dmadir = 0;
95de719a 123module_param(atapi_dmadir, int, 0444);
ad5d8eac 124MODULE_PARM_DESC(atapi_dmadir, "Enable ATAPI DMADIR bridge support (0=off [default], 1=on)");
95de719a 125
baf4fdfa
ML
126int atapi_passthru16 = 1;
127module_param(atapi_passthru16, int, 0444);
ad5d8eac 128MODULE_PARM_DESC(atapi_passthru16, "Enable ATA_16 passthru for ATAPI devices (0=off, 1=on [default])");
baf4fdfa 129
c3c013a2
JG
130int libata_fua = 0;
131module_param_named(fua, libata_fua, int, 0444);
ad5d8eac 132MODULE_PARM_DESC(fua, "FUA support (0=off [default], 1=on)");
c3c013a2 133
2dcb407e 134static int ata_ignore_hpa;
1e999736
AC
135module_param_named(ignore_hpa, ata_ignore_hpa, int, 0644);
136MODULE_PARM_DESC(ignore_hpa, "Ignore HPA limit (0=keep BIOS limits, 1=ignore limits, using full disk)");
137
b3a70601
AC
138static int libata_dma_mask = ATA_DMA_MASK_ATA|ATA_DMA_MASK_ATAPI|ATA_DMA_MASK_CFA;
139module_param_named(dma, libata_dma_mask, int, 0444);
140MODULE_PARM_DESC(dma, "DMA enable/disable (0x1==ATA, 0x2==ATAPI, 0x4==CF)");
141
87fbc5a0 142static int ata_probe_timeout;
a8601e5f
AM
143module_param(ata_probe_timeout, int, 0444);
144MODULE_PARM_DESC(ata_probe_timeout, "Set ATA probing timeout (seconds)");
145
6ebe9d86 146int libata_noacpi = 0;
d7d0dad6 147module_param_named(noacpi, libata_noacpi, int, 0444);
ad5d8eac 148MODULE_PARM_DESC(noacpi, "Disable the use of ACPI in probe/suspend/resume (0=off [default], 1=on)");
11ef697b 149
ae8d4ee7
AC
150int libata_allow_tpm = 0;
151module_param_named(allow_tpm, libata_allow_tpm, int, 0444);
ad5d8eac 152MODULE_PARM_DESC(allow_tpm, "Permit the use of TPM commands (0=off [default], 1=on)");
ae8d4ee7 153
e7ecd435
TH
154static int atapi_an;
155module_param(atapi_an, int, 0444);
156MODULE_PARM_DESC(atapi_an, "Enable ATAPI AN media presence notification (0=0ff [default], 1=on)");
157
1da177e4
LT
158MODULE_AUTHOR("Jeff Garzik");
159MODULE_DESCRIPTION("Library module for ATA devices");
160MODULE_LICENSE("GPL");
161MODULE_VERSION(DRV_VERSION);
162
891fd7c6
DLM
163static inline bool ata_dev_print_info(struct ata_device *dev)
164{
165 struct ata_eh_context *ehc = &dev->link->eh_context;
166
167 return ehc->i.flags & ATA_EHI_PRINTINFO;
168}
0baab86b 169
9913ff8a
TH
170static bool ata_sstatus_online(u32 sstatus)
171{
172 return (sstatus & 0xf) == 0x3;
173}
174
1eca4365
TH
175/**
176 * ata_link_next - link iteration helper
177 * @link: the previous link, NULL to start
178 * @ap: ATA port containing links to iterate
179 * @mode: iteration mode, one of ATA_LITER_*
180 *
181 * LOCKING:
182 * Host lock or EH context.
aadffb68 183 *
1eca4365
TH
184 * RETURNS:
185 * Pointer to the next link.
aadffb68 186 */
1eca4365
TH
187struct ata_link *ata_link_next(struct ata_link *link, struct ata_port *ap,
188 enum ata_link_iter_mode mode)
aadffb68 189{
1eca4365
TH
190 BUG_ON(mode != ATA_LITER_EDGE &&
191 mode != ATA_LITER_PMP_FIRST && mode != ATA_LITER_HOST_FIRST);
192
aadffb68 193 /* NULL link indicates start of iteration */
1eca4365
TH
194 if (!link)
195 switch (mode) {
196 case ATA_LITER_EDGE:
197 case ATA_LITER_PMP_FIRST:
198 if (sata_pmp_attached(ap))
199 return ap->pmp_link;
df561f66 200 fallthrough;
1eca4365
TH
201 case ATA_LITER_HOST_FIRST:
202 return &ap->link;
203 }
aadffb68 204
1eca4365
TH
205 /* we just iterated over the host link, what's next? */
206 if (link == &ap->link)
207 switch (mode) {
208 case ATA_LITER_HOST_FIRST:
209 if (sata_pmp_attached(ap))
210 return ap->pmp_link;
df561f66 211 fallthrough;
1eca4365
TH
212 case ATA_LITER_PMP_FIRST:
213 if (unlikely(ap->slave_link))
b1c72916 214 return ap->slave_link;
df561f66 215 fallthrough;
1eca4365 216 case ATA_LITER_EDGE:
aadffb68 217 return NULL;
b1c72916 218 }
aadffb68 219
b1c72916
TH
220 /* slave_link excludes PMP */
221 if (unlikely(link == ap->slave_link))
222 return NULL;
223
1eca4365 224 /* we were over a PMP link */
aadffb68
TH
225 if (++link < ap->pmp_link + ap->nr_pmp_links)
226 return link;
1eca4365
TH
227
228 if (mode == ATA_LITER_PMP_FIRST)
229 return &ap->link;
230
aadffb68
TH
231 return NULL;
232}
a52fbcfc 233EXPORT_SYMBOL_GPL(ata_link_next);
aadffb68 234
1eca4365
TH
235/**
236 * ata_dev_next - device iteration helper
237 * @dev: the previous device, NULL to start
238 * @link: ATA link containing devices to iterate
239 * @mode: iteration mode, one of ATA_DITER_*
240 *
241 * LOCKING:
242 * Host lock or EH context.
243 *
244 * RETURNS:
245 * Pointer to the next device.
246 */
247struct ata_device *ata_dev_next(struct ata_device *dev, struct ata_link *link,
248 enum ata_dev_iter_mode mode)
249{
250 BUG_ON(mode != ATA_DITER_ENABLED && mode != ATA_DITER_ENABLED_REVERSE &&
251 mode != ATA_DITER_ALL && mode != ATA_DITER_ALL_REVERSE);
252
253 /* NULL dev indicates start of iteration */
254 if (!dev)
255 switch (mode) {
256 case ATA_DITER_ENABLED:
257 case ATA_DITER_ALL:
258 dev = link->device;
259 goto check;
260 case ATA_DITER_ENABLED_REVERSE:
261 case ATA_DITER_ALL_REVERSE:
262 dev = link->device + ata_link_max_devices(link) - 1;
263 goto check;
264 }
265
266 next:
267 /* move to the next one */
268 switch (mode) {
269 case ATA_DITER_ENABLED:
270 case ATA_DITER_ALL:
271 if (++dev < link->device + ata_link_max_devices(link))
272 goto check;
273 return NULL;
274 case ATA_DITER_ENABLED_REVERSE:
275 case ATA_DITER_ALL_REVERSE:
276 if (--dev >= link->device)
277 goto check;
278 return NULL;
279 }
280
281 check:
282 if ((mode == ATA_DITER_ENABLED || mode == ATA_DITER_ENABLED_REVERSE) &&
283 !ata_dev_enabled(dev))
284 goto next;
285 return dev;
286}
a52fbcfc 287EXPORT_SYMBOL_GPL(ata_dev_next);
1eca4365 288
b1c72916
TH
289/**
290 * ata_dev_phys_link - find physical link for a device
291 * @dev: ATA device to look up physical link for
292 *
293 * Look up physical link which @dev is attached to. Note that
294 * this is different from @dev->link only when @dev is on slave
295 * link. For all other cases, it's the same as @dev->link.
296 *
297 * LOCKING:
298 * Don't care.
299 *
300 * RETURNS:
301 * Pointer to the found physical link.
302 */
303struct ata_link *ata_dev_phys_link(struct ata_device *dev)
304{
305 struct ata_port *ap = dev->link->ap;
306
307 if (!ap->slave_link)
308 return dev->link;
309 if (!dev->devno)
310 return &ap->link;
311 return ap->slave_link;
312}
313
bf89b0bf 314#ifdef CONFIG_ATA_FORCE
33267325
TH
315/**
316 * ata_force_cbl - force cable type according to libata.force
4cdfa1b3 317 * @ap: ATA port of interest
33267325
TH
318 *
319 * Force cable type according to libata.force and whine about it.
320 * The last entry which has matching port number is used, so it
321 * can be specified as part of device force parameters. For
322 * example, both "a:40c,1.00:udma4" and "1.00:40c,udma4" have the
323 * same effect.
324 *
325 * LOCKING:
326 * EH context.
327 */
328void ata_force_cbl(struct ata_port *ap)
329{
330 int i;
331
332 for (i = ata_force_tbl_size - 1; i >= 0; i--) {
333 const struct ata_force_ent *fe = &ata_force_tbl[i];
334
335 if (fe->port != -1 && fe->port != ap->print_id)
336 continue;
337
338 if (fe->param.cbl == ATA_CBL_NONE)
339 continue;
340
341 ap->cbl = fe->param.cbl;
a9a79dfe 342 ata_port_notice(ap, "FORCE: cable set to %s\n", fe->param.name);
33267325
TH
343 return;
344 }
345}
346
347/**
05944bdf 348 * ata_force_link_limits - force link limits according to libata.force
33267325
TH
349 * @link: ATA link of interest
350 *
05944bdf
TH
351 * Force link flags and SATA spd limit according to libata.force
352 * and whine about it. When only the port part is specified
353 * (e.g. 1:), the limit applies to all links connected to both
354 * the host link and all fan-out ports connected via PMP. If the
355 * device part is specified as 0 (e.g. 1.00:), it specifies the
356 * first fan-out link not the host link. Device number 15 always
b1c72916
TH
357 * points to the host link whether PMP is attached or not. If the
358 * controller has slave link, device number 16 points to it.
33267325
TH
359 *
360 * LOCKING:
361 * EH context.
362 */
05944bdf 363static void ata_force_link_limits(struct ata_link *link)
33267325 364{
05944bdf 365 bool did_spd = false;
b1c72916
TH
366 int linkno = link->pmp;
367 int i;
33267325
TH
368
369 if (ata_is_host_link(link))
b1c72916 370 linkno += 15;
33267325
TH
371
372 for (i = ata_force_tbl_size - 1; i >= 0; i--) {
373 const struct ata_force_ent *fe = &ata_force_tbl[i];
374
375 if (fe->port != -1 && fe->port != link->ap->print_id)
376 continue;
377
378 if (fe->device != -1 && fe->device != linkno)
379 continue;
380
05944bdf
TH
381 /* only honor the first spd limit */
382 if (!did_spd && fe->param.spd_limit) {
383 link->hw_sata_spd_limit = (1 << fe->param.spd_limit) - 1;
a9a79dfe 384 ata_link_notice(link, "FORCE: PHY spd limit set to %s\n",
05944bdf
TH
385 fe->param.name);
386 did_spd = true;
387 }
33267325 388
05944bdf 389 /* let lflags stack */
3af9ca4d
DLM
390 if (fe->param.lflags_on) {
391 link->flags |= fe->param.lflags_on;
a9a79dfe 392 ata_link_notice(link,
05944bdf 393 "FORCE: link flag 0x%x forced -> 0x%x\n",
3af9ca4d
DLM
394 fe->param.lflags_on, link->flags);
395 }
396 if (fe->param.lflags_off) {
397 link->flags &= ~fe->param.lflags_off;
398 ata_link_notice(link,
399 "FORCE: link flag 0x%x cleared -> 0x%x\n",
400 fe->param.lflags_off, link->flags);
05944bdf 401 }
33267325
TH
402 }
403}
404
405/**
406 * ata_force_xfermask - force xfermask according to libata.force
407 * @dev: ATA device of interest
408 *
409 * Force xfer_mask according to libata.force and whine about it.
410 * For consistency with link selection, device number 15 selects
411 * the first device connected to the host link.
412 *
413 * LOCKING:
414 * EH context.
415 */
416static void ata_force_xfermask(struct ata_device *dev)
417{
418 int devno = dev->link->pmp + dev->devno;
419 int alt_devno = devno;
420 int i;
421
b1c72916
TH
422 /* allow n.15/16 for devices attached to host port */
423 if (ata_is_host_link(dev->link))
424 alt_devno += 15;
33267325
TH
425
426 for (i = ata_force_tbl_size - 1; i >= 0; i--) {
427 const struct ata_force_ent *fe = &ata_force_tbl[i];
f0a6d77b 428 unsigned int pio_mask, mwdma_mask, udma_mask;
33267325
TH
429
430 if (fe->port != -1 && fe->port != dev->link->ap->print_id)
431 continue;
432
433 if (fe->device != -1 && fe->device != devno &&
434 fe->device != alt_devno)
435 continue;
436
437 if (!fe->param.xfer_mask)
438 continue;
439
440 ata_unpack_xfermask(fe->param.xfer_mask,
441 &pio_mask, &mwdma_mask, &udma_mask);
442 if (udma_mask)
443 dev->udma_mask = udma_mask;
444 else if (mwdma_mask) {
445 dev->udma_mask = 0;
446 dev->mwdma_mask = mwdma_mask;
447 } else {
448 dev->udma_mask = 0;
449 dev->mwdma_mask = 0;
450 dev->pio_mask = pio_mask;
451 }
452
a9a79dfe
JP
453 ata_dev_notice(dev, "FORCE: xfer_mask set to %s\n",
454 fe->param.name);
33267325
TH
455 return;
456 }
457}
458
459/**
460 * ata_force_horkage - force horkage according to libata.force
461 * @dev: ATA device of interest
462 *
463 * Force horkage according to libata.force and whine about it.
464 * For consistency with link selection, device number 15 selects
465 * the first device connected to the host link.
466 *
467 * LOCKING:
468 * EH context.
469 */
470static void ata_force_horkage(struct ata_device *dev)
471{
472 int devno = dev->link->pmp + dev->devno;
473 int alt_devno = devno;
474 int i;
475
b1c72916
TH
476 /* allow n.15/16 for devices attached to host port */
477 if (ata_is_host_link(dev->link))
478 alt_devno += 15;
33267325
TH
479
480 for (i = 0; i < ata_force_tbl_size; i++) {
481 const struct ata_force_ent *fe = &ata_force_tbl[i];
482
483 if (fe->port != -1 && fe->port != dev->link->ap->print_id)
484 continue;
485
486 if (fe->device != -1 && fe->device != devno &&
487 fe->device != alt_devno)
488 continue;
489
490 if (!(~dev->horkage & fe->param.horkage_on) &&
491 !(dev->horkage & fe->param.horkage_off))
492 continue;
493
494 dev->horkage |= fe->param.horkage_on;
495 dev->horkage &= ~fe->param.horkage_off;
496
a9a79dfe
JP
497 ata_dev_notice(dev, "FORCE: horkage modified (%s)\n",
498 fe->param.name);
33267325
TH
499 }
500}
bf89b0bf
BZ
501#else
502static inline void ata_force_link_limits(struct ata_link *link) { }
503static inline void ata_force_xfermask(struct ata_device *dev) { }
504static inline void ata_force_horkage(struct ata_device *dev) { }
505#endif
33267325 506
436d34b3
TH
507/**
508 * atapi_cmd_type - Determine ATAPI command type from SCSI opcode
509 * @opcode: SCSI opcode
510 *
511 * Determine ATAPI command type from @opcode.
512 *
513 * LOCKING:
514 * None.
515 *
516 * RETURNS:
517 * ATAPI_{READ|WRITE|READ_CD|PASS_THRU|MISC}
518 */
519int atapi_cmd_type(u8 opcode)
520{
521 switch (opcode) {
522 case GPCMD_READ_10:
523 case GPCMD_READ_12:
524 return ATAPI_READ;
525
526 case GPCMD_WRITE_10:
527 case GPCMD_WRITE_12:
528 case GPCMD_WRITE_AND_VERIFY_10:
529 return ATAPI_WRITE;
530
531 case GPCMD_READ_CD:
532 case GPCMD_READ_CD_MSF:
533 return ATAPI_READ_CD;
534
e52dcc48
TH
535 case ATA_16:
536 case ATA_12:
537 if (atapi_passthru16)
538 return ATAPI_PASS_THRU;
df561f66 539 fallthrough;
436d34b3
TH
540 default:
541 return ATAPI_MISC;
542 }
543}
a52fbcfc 544EXPORT_SYMBOL_GPL(atapi_cmd_type);
436d34b3 545
8cbd6df1
AL
546static const u8 ata_rw_cmds[] = {
547 /* pio multi */
548 ATA_CMD_READ_MULTI,
549 ATA_CMD_WRITE_MULTI,
550 ATA_CMD_READ_MULTI_EXT,
551 ATA_CMD_WRITE_MULTI_EXT,
9a3dccc4
TH
552 0,
553 0,
554 0,
555 ATA_CMD_WRITE_MULTI_FUA_EXT,
8cbd6df1
AL
556 /* pio */
557 ATA_CMD_PIO_READ,
558 ATA_CMD_PIO_WRITE,
559 ATA_CMD_PIO_READ_EXT,
560 ATA_CMD_PIO_WRITE_EXT,
9a3dccc4
TH
561 0,
562 0,
563 0,
564 0,
8cbd6df1
AL
565 /* dma */
566 ATA_CMD_READ,
567 ATA_CMD_WRITE,
568 ATA_CMD_READ_EXT,
9a3dccc4
TH
569 ATA_CMD_WRITE_EXT,
570 0,
571 0,
572 0,
573 ATA_CMD_WRITE_FUA_EXT
8cbd6df1 574};
1da177e4
LT
575
576/**
8cbd6df1 577 * ata_rwcmd_protocol - set taskfile r/w commands and protocol
bd056d7e
TH
578 * @tf: command to examine and configure
579 * @dev: device tf belongs to
1da177e4 580 *
2e9edbf8 581 * Examine the device configuration and tf->flags to calculate
8cbd6df1 582 * the proper read/write commands and protocol to use.
1da177e4
LT
583 *
584 * LOCKING:
585 * caller.
586 */
bd056d7e 587static int ata_rwcmd_protocol(struct ata_taskfile *tf, struct ata_device *dev)
1da177e4 588{
9a3dccc4 589 u8 cmd;
1da177e4 590
9a3dccc4 591 int index, fua, lba48, write;
2e9edbf8 592
9a3dccc4 593 fua = (tf->flags & ATA_TFLAG_FUA) ? 4 : 0;
8cbd6df1
AL
594 lba48 = (tf->flags & ATA_TFLAG_LBA48) ? 2 : 0;
595 write = (tf->flags & ATA_TFLAG_WRITE) ? 1 : 0;
1da177e4 596
8cbd6df1
AL
597 if (dev->flags & ATA_DFLAG_PIO) {
598 tf->protocol = ATA_PROT_PIO;
9a3dccc4 599 index = dev->multi_count ? 0 : 8;
9af5c9c9 600 } else if (lba48 && (dev->link->ap->flags & ATA_FLAG_PIO_LBA48)) {
8d238e01
AC
601 /* Unable to use DMA due to host limitation */
602 tf->protocol = ATA_PROT_PIO;
0565c26d 603 index = dev->multi_count ? 0 : 8;
8cbd6df1
AL
604 } else {
605 tf->protocol = ATA_PROT_DMA;
9a3dccc4 606 index = 16;
8cbd6df1 607 }
1da177e4 608
9a3dccc4
TH
609 cmd = ata_rw_cmds[index + fua + lba48 + write];
610 if (cmd) {
611 tf->command = cmd;
612 return 0;
613 }
614 return -1;
1da177e4
LT
615}
616
35b649fe
TH
617/**
618 * ata_tf_read_block - Read block address from ATA taskfile
619 * @tf: ATA taskfile of interest
620 * @dev: ATA device @tf belongs to
621 *
622 * LOCKING:
623 * None.
624 *
625 * Read block address from @tf. This function can handle all
626 * three address formats - LBA, LBA48 and CHS. tf->protocol and
627 * flags select the address format to use.
628 *
629 * RETURNS:
630 * Block address read from @tf.
631 */
cffd1ee9 632u64 ata_tf_read_block(const struct ata_taskfile *tf, struct ata_device *dev)
35b649fe
TH
633{
634 u64 block = 0;
635
fe16d4f2 636 if (tf->flags & ATA_TFLAG_LBA) {
35b649fe
TH
637 if (tf->flags & ATA_TFLAG_LBA48) {
638 block |= (u64)tf->hob_lbah << 40;
639 block |= (u64)tf->hob_lbam << 32;
44901a96 640 block |= (u64)tf->hob_lbal << 24;
35b649fe
TH
641 } else
642 block |= (tf->device & 0xf) << 24;
643
644 block |= tf->lbah << 16;
645 block |= tf->lbam << 8;
646 block |= tf->lbal;
647 } else {
648 u32 cyl, head, sect;
649
650 cyl = tf->lbam | (tf->lbah << 8);
651 head = tf->device & 0xf;
652 sect = tf->lbal;
653
ac8672ea 654 if (!sect) {
a9a79dfe
JP
655 ata_dev_warn(dev,
656 "device reported invalid CHS sector 0\n");
cffd1ee9 657 return U64_MAX;
ac8672ea
TH
658 }
659
660 block = (cyl * dev->heads + head) * dev->sectors + sect - 1;
35b649fe
TH
661 }
662
663 return block;
664}
665
bd056d7e
TH
666/**
667 * ata_build_rw_tf - Build ATA taskfile for given read/write request
668 * @tf: Target ATA taskfile
669 * @dev: ATA device @tf belongs to
670 * @block: Block address
671 * @n_block: Number of blocks
672 * @tf_flags: RW/FUA etc...
673 * @tag: tag
8e061784 674 * @class: IO priority class
bd056d7e
TH
675 *
676 * LOCKING:
677 * None.
678 *
679 * Build ATA taskfile @tf for read/write request described by
680 * @block, @n_block, @tf_flags and @tag on @dev.
681 *
682 * RETURNS:
683 *
684 * 0 on success, -ERANGE if the request is too large for @dev,
685 * -EINVAL if the request is invalid.
686 */
687int ata_build_rw_tf(struct ata_taskfile *tf, struct ata_device *dev,
688 u64 block, u32 n_block, unsigned int tf_flags,
8e061784 689 unsigned int tag, int class)
bd056d7e
TH
690{
691 tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
692 tf->flags |= tf_flags;
693
2e2cc676 694 if (ata_ncq_enabled(dev) && !ata_tag_internal(tag)) {
bd056d7e
TH
695 /* yay, NCQ */
696 if (!lba_48_ok(block, n_block))
697 return -ERANGE;
698
699 tf->protocol = ATA_PROT_NCQ;
700 tf->flags |= ATA_TFLAG_LBA | ATA_TFLAG_LBA48;
701
702 if (tf->flags & ATA_TFLAG_WRITE)
703 tf->command = ATA_CMD_FPDMA_WRITE;
704 else
705 tf->command = ATA_CMD_FPDMA_READ;
706
707 tf->nsect = tag << 3;
708 tf->hob_feature = (n_block >> 8) & 0xff;
709 tf->feature = n_block & 0xff;
710
711 tf->hob_lbah = (block >> 40) & 0xff;
712 tf->hob_lbam = (block >> 32) & 0xff;
713 tf->hob_lbal = (block >> 24) & 0xff;
714 tf->lbah = (block >> 16) & 0xff;
715 tf->lbam = (block >> 8) & 0xff;
716 tf->lbal = block & 0xff;
717
9ca7cfa4 718 tf->device = ATA_LBA;
bd056d7e
TH
719 if (tf->flags & ATA_TFLAG_FUA)
720 tf->device |= 1 << 7;
8e061784 721
2360fa18
DLM
722 if (dev->flags & ATA_DFLAG_NCQ_PRIO_ENABLE &&
723 class == IOPRIO_CLASS_RT)
724 tf->hob_nsect |= ATA_PRIO_HIGH << ATA_SHIFT_PRIO;
bd056d7e
TH
725 } else if (dev->flags & ATA_DFLAG_LBA) {
726 tf->flags |= ATA_TFLAG_LBA;
727
728 if (lba_28_ok(block, n_block)) {
729 /* use LBA28 */
730 tf->device |= (block >> 24) & 0xf;
731 } else if (lba_48_ok(block, n_block)) {
732 if (!(dev->flags & ATA_DFLAG_LBA48))
733 return -ERANGE;
734
735 /* use LBA48 */
736 tf->flags |= ATA_TFLAG_LBA48;
737
738 tf->hob_nsect = (n_block >> 8) & 0xff;
739
740 tf->hob_lbah = (block >> 40) & 0xff;
741 tf->hob_lbam = (block >> 32) & 0xff;
742 tf->hob_lbal = (block >> 24) & 0xff;
743 } else
744 /* request too large even for LBA48 */
745 return -ERANGE;
746
747 if (unlikely(ata_rwcmd_protocol(tf, dev) < 0))
748 return -EINVAL;
749
750 tf->nsect = n_block & 0xff;
751
752 tf->lbah = (block >> 16) & 0xff;
753 tf->lbam = (block >> 8) & 0xff;
754 tf->lbal = block & 0xff;
755
756 tf->device |= ATA_LBA;
757 } else {
758 /* CHS */
759 u32 sect, head, cyl, track;
760
761 /* The request -may- be too large for CHS addressing. */
762 if (!lba_28_ok(block, n_block))
763 return -ERANGE;
764
765 if (unlikely(ata_rwcmd_protocol(tf, dev) < 0))
766 return -EINVAL;
767
768 /* Convert LBA to CHS */
769 track = (u32)block / dev->sectors;
770 cyl = track / dev->heads;
771 head = track % dev->heads;
772 sect = (u32)block % dev->sectors + 1;
773
bd056d7e
TH
774 /* Check whether the converted CHS can fit.
775 Cylinder: 0-65535
776 Head: 0-15
777 Sector: 1-255*/
778 if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect))
779 return -ERANGE;
780
781 tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */
782 tf->lbal = sect;
783 tf->lbam = cyl;
784 tf->lbah = cyl >> 8;
785 tf->device |= head;
786 }
787
788 return 0;
789}
790
cb95d562
TH
791/**
792 * ata_pack_xfermask - Pack pio, mwdma and udma masks into xfer_mask
793 * @pio_mask: pio_mask
794 * @mwdma_mask: mwdma_mask
795 * @udma_mask: udma_mask
796 *
797 * Pack @pio_mask, @mwdma_mask and @udma_mask into a single
798 * unsigned int xfer_mask.
799 *
800 * LOCKING:
801 * None.
802 *
803 * RETURNS:
804 * Packed xfer_mask.
805 */
f0a6d77b
SS
806unsigned int ata_pack_xfermask(unsigned int pio_mask,
807 unsigned int mwdma_mask,
808 unsigned int udma_mask)
cb95d562 809{
f0a6d77b 810 return ((pio_mask << ATA_SHIFT_PIO) & ATA_MASK_PIO) |
cb95d562
TH
811 ((mwdma_mask << ATA_SHIFT_MWDMA) & ATA_MASK_MWDMA) |
812 ((udma_mask << ATA_SHIFT_UDMA) & ATA_MASK_UDMA);
813}
a52fbcfc 814EXPORT_SYMBOL_GPL(ata_pack_xfermask);
cb95d562 815
c0489e4e
TH
816/**
817 * ata_unpack_xfermask - Unpack xfer_mask into pio, mwdma and udma masks
818 * @xfer_mask: xfer_mask to unpack
819 * @pio_mask: resulting pio_mask
820 * @mwdma_mask: resulting mwdma_mask
821 * @udma_mask: resulting udma_mask
822 *
823 * Unpack @xfer_mask into @pio_mask, @mwdma_mask and @udma_mask.
c9b5560a 824 * Any NULL destination masks will be ignored.
c0489e4e 825 */
f0a6d77b
SS
826void ata_unpack_xfermask(unsigned int xfer_mask, unsigned int *pio_mask,
827 unsigned int *mwdma_mask, unsigned int *udma_mask)
c0489e4e
TH
828{
829 if (pio_mask)
830 *pio_mask = (xfer_mask & ATA_MASK_PIO) >> ATA_SHIFT_PIO;
831 if (mwdma_mask)
832 *mwdma_mask = (xfer_mask & ATA_MASK_MWDMA) >> ATA_SHIFT_MWDMA;
833 if (udma_mask)
834 *udma_mask = (xfer_mask & ATA_MASK_UDMA) >> ATA_SHIFT_UDMA;
835}
836
cb95d562 837static const struct ata_xfer_ent {
be9a50c8 838 int shift, bits;
cb95d562
TH
839 u8 base;
840} ata_xfer_tbl[] = {
70cd071e
TH
841 { ATA_SHIFT_PIO, ATA_NR_PIO_MODES, XFER_PIO_0 },
842 { ATA_SHIFT_MWDMA, ATA_NR_MWDMA_MODES, XFER_MW_DMA_0 },
843 { ATA_SHIFT_UDMA, ATA_NR_UDMA_MODES, XFER_UDMA_0 },
cb95d562
TH
844 { -1, },
845};
846
847/**
848 * ata_xfer_mask2mode - Find matching XFER_* for the given xfer_mask
849 * @xfer_mask: xfer_mask of interest
850 *
851 * Return matching XFER_* value for @xfer_mask. Only the highest
852 * bit of @xfer_mask is considered.
853 *
854 * LOCKING:
855 * None.
856 *
857 * RETURNS:
70cd071e 858 * Matching XFER_* value, 0xff if no match found.
cb95d562 859 */
f0a6d77b 860u8 ata_xfer_mask2mode(unsigned int xfer_mask)
cb95d562
TH
861{
862 int highbit = fls(xfer_mask) - 1;
863 const struct ata_xfer_ent *ent;
864
865 for (ent = ata_xfer_tbl; ent->shift >= 0; ent++)
866 if (highbit >= ent->shift && highbit < ent->shift + ent->bits)
867 return ent->base + highbit - ent->shift;
70cd071e 868 return 0xff;
cb95d562 869}
a52fbcfc 870EXPORT_SYMBOL_GPL(ata_xfer_mask2mode);
cb95d562
TH
871
872/**
873 * ata_xfer_mode2mask - Find matching xfer_mask for XFER_*
874 * @xfer_mode: XFER_* of interest
875 *
876 * Return matching xfer_mask for @xfer_mode.
877 *
878 * LOCKING:
879 * None.
880 *
881 * RETURNS:
882 * Matching xfer_mask, 0 if no match found.
883 */
f0a6d77b 884unsigned int ata_xfer_mode2mask(u8 xfer_mode)
cb95d562
TH
885{
886 const struct ata_xfer_ent *ent;
887
888 for (ent = ata_xfer_tbl; ent->shift >= 0; ent++)
889 if (xfer_mode >= ent->base && xfer_mode < ent->base + ent->bits)
70cd071e
TH
890 return ((2 << (ent->shift + xfer_mode - ent->base)) - 1)
891 & ~((1 << ent->shift) - 1);
cb95d562
TH
892 return 0;
893}
a52fbcfc 894EXPORT_SYMBOL_GPL(ata_xfer_mode2mask);
cb95d562
TH
895
896/**
897 * ata_xfer_mode2shift - Find matching xfer_shift for XFER_*
898 * @xfer_mode: XFER_* of interest
899 *
900 * Return matching xfer_shift for @xfer_mode.
901 *
902 * LOCKING:
903 * None.
904 *
905 * RETURNS:
906 * Matching xfer_shift, -1 if no match found.
907 */
a28c1ab3 908int ata_xfer_mode2shift(u8 xfer_mode)
cb95d562
TH
909{
910 const struct ata_xfer_ent *ent;
911
912 for (ent = ata_xfer_tbl; ent->shift >= 0; ent++)
913 if (xfer_mode >= ent->base && xfer_mode < ent->base + ent->bits)
914 return ent->shift;
915 return -1;
916}
a52fbcfc 917EXPORT_SYMBOL_GPL(ata_xfer_mode2shift);
cb95d562 918
1da177e4 919/**
1da7b0d0
TH
920 * ata_mode_string - convert xfer_mask to string
921 * @xfer_mask: mask of bits supported; only highest bit counts.
1da177e4
LT
922 *
923 * Determine string which represents the highest speed
1da7b0d0 924 * (highest bit in @modemask).
1da177e4
LT
925 *
926 * LOCKING:
927 * None.
928 *
929 * RETURNS:
930 * Constant C string representing highest speed listed in
1da7b0d0 931 * @mode_mask, or the constant C string "<n/a>".
1da177e4 932 */
f0a6d77b 933const char *ata_mode_string(unsigned int xfer_mask)
1da177e4 934{
75f554bc
TH
935 static const char * const xfer_mode_str[] = {
936 "PIO0",
937 "PIO1",
938 "PIO2",
939 "PIO3",
940 "PIO4",
b352e57d
AC
941 "PIO5",
942 "PIO6",
75f554bc
TH
943 "MWDMA0",
944 "MWDMA1",
945 "MWDMA2",
b352e57d
AC
946 "MWDMA3",
947 "MWDMA4",
75f554bc
TH
948 "UDMA/16",
949 "UDMA/25",
950 "UDMA/33",
951 "UDMA/44",
952 "UDMA/66",
953 "UDMA/100",
954 "UDMA/133",
955 "UDMA7",
956 };
1da7b0d0 957 int highbit;
1da177e4 958
1da7b0d0
TH
959 highbit = fls(xfer_mask) - 1;
960 if (highbit >= 0 && highbit < ARRAY_SIZE(xfer_mode_str))
961 return xfer_mode_str[highbit];
1da177e4 962 return "<n/a>";
1da177e4 963}
a52fbcfc 964EXPORT_SYMBOL_GPL(ata_mode_string);
1da177e4 965
d9027470 966const char *sata_spd_string(unsigned int spd)
4c360c81
TH
967{
968 static const char * const spd_str[] = {
969 "1.5 Gbps",
970 "3.0 Gbps",
8522ee25 971 "6.0 Gbps",
4c360c81
TH
972 };
973
974 if (spd == 0 || (spd - 1) >= ARRAY_SIZE(spd_str))
975 return "<unknown>";
976 return spd_str[spd - 1];
977}
978
1da177e4
LT
979/**
980 * ata_dev_classify - determine device type based on ATA-spec signature
981 * @tf: ATA taskfile register set for device to be identified
982 *
983 * Determine from taskfile register contents whether a device is
984 * ATA or ATAPI, as per "Signature and persistence" section
985 * of ATA/PI spec (volume 1, sect 5.14).
986 *
987 * LOCKING:
988 * None.
989 *
990 * RETURNS:
9162c657
HR
991 * Device type, %ATA_DEV_ATA, %ATA_DEV_ATAPI, %ATA_DEV_PMP,
992 * %ATA_DEV_ZAC, or %ATA_DEV_UNKNOWN the event of failure.
1da177e4 993 */
057ace5e 994unsigned int ata_dev_classify(const struct ata_taskfile *tf)
1da177e4
LT
995{
996 /* Apple's open source Darwin code hints that some devices only
997 * put a proper signature into the LBA mid/high registers,
998 * So, we only check those. It's sufficient for uniqueness.
633273a3
TH
999 *
1000 * ATA/ATAPI-7 (d1532v1r1: Feb. 19, 2003) specified separate
1001 * signatures for ATA and ATAPI devices attached on SerialATA,
1002 * 0x3c/0xc3 and 0x69/0x96 respectively. However, SerialATA
1003 * spec has never mentioned about using different signatures
1004 * for ATA/ATAPI devices. Then, Serial ATA II: Port
1005 * Multiplier specification began to use 0x69/0x96 to identify
1006 * port multpliers and 0x3c/0xc3 to identify SEMB device.
1007 * ATA/ATAPI-7 dropped descriptions about 0x3c/0xc3 and
1008 * 0x69/0x96 shortly and described them as reserved for
1009 * SerialATA.
1010 *
1011 * We follow the current spec and consider that 0x69/0x96
1012 * identifies a port multiplier and 0x3c/0xc3 a SEMB device.
79b42bab
TH
1013 * Unfortunately, WDC WD1600JS-62MHB5 (a hard drive) reports
1014 * SEMB signature. This is worked around in
1015 * ata_dev_read_id().
1da177e4 1016 */
6c952a0d 1017 if (tf->lbam == 0 && tf->lbah == 0)
1da177e4 1018 return ATA_DEV_ATA;
1da177e4 1019
6c952a0d 1020 if (tf->lbam == 0x14 && tf->lbah == 0xeb)
1da177e4 1021 return ATA_DEV_ATAPI;
1da177e4 1022
6c952a0d 1023 if (tf->lbam == 0x69 && tf->lbah == 0x96)
633273a3 1024 return ATA_DEV_PMP;
633273a3 1025
6c952a0d 1026 if (tf->lbam == 0x3c && tf->lbah == 0xc3)
79b42bab 1027 return ATA_DEV_SEMB;
633273a3 1028
6c952a0d 1029 if (tf->lbam == 0xcd && tf->lbah == 0xab)
9162c657 1030 return ATA_DEV_ZAC;
9162c657 1031
1da177e4
LT
1032 return ATA_DEV_UNKNOWN;
1033}
a52fbcfc 1034EXPORT_SYMBOL_GPL(ata_dev_classify);
1da177e4 1035
1da177e4 1036/**
6a62a04d 1037 * ata_id_string - Convert IDENTIFY DEVICE page into string
1da177e4
LT
1038 * @id: IDENTIFY DEVICE results we will examine
1039 * @s: string into which data is output
1040 * @ofs: offset into identify device page
1041 * @len: length of string to return. must be an even number.
1042 *
1043 * The strings in the IDENTIFY DEVICE page are broken up into
1044 * 16-bit chunks. Run through the string, and output each
1045 * 8-bit chunk linearly, regardless of platform.
1046 *
1047 * LOCKING:
1048 * caller.
1049 */
1050
6a62a04d
TH
1051void ata_id_string(const u16 *id, unsigned char *s,
1052 unsigned int ofs, unsigned int len)
1da177e4
LT
1053{
1054 unsigned int c;
1055
963e4975
AC
1056 BUG_ON(len & 1);
1057
1da177e4
LT
1058 while (len > 0) {
1059 c = id[ofs] >> 8;
1060 *s = c;
1061 s++;
1062
1063 c = id[ofs] & 0xff;
1064 *s = c;
1065 s++;
1066
1067 ofs++;
1068 len -= 2;
1069 }
1070}
a52fbcfc 1071EXPORT_SYMBOL_GPL(ata_id_string);
1da177e4 1072
0e949ff3 1073/**
6a62a04d 1074 * ata_id_c_string - Convert IDENTIFY DEVICE page into C string
0e949ff3
TH
1075 * @id: IDENTIFY DEVICE results we will examine
1076 * @s: string into which data is output
1077 * @ofs: offset into identify device page
1078 * @len: length of string to return. must be an odd number.
1079 *
6a62a04d 1080 * This function is identical to ata_id_string except that it
0e949ff3
TH
1081 * trims trailing spaces and terminates the resulting string with
1082 * null. @len must be actual maximum length (even number) + 1.
1083 *
1084 * LOCKING:
1085 * caller.
1086 */
6a62a04d
TH
1087void ata_id_c_string(const u16 *id, unsigned char *s,
1088 unsigned int ofs, unsigned int len)
0e949ff3
TH
1089{
1090 unsigned char *p;
1091
6a62a04d 1092 ata_id_string(id, s, ofs, len - 1);
0e949ff3
TH
1093
1094 p = s + strnlen(s, len - 1);
1095 while (p > s && p[-1] == ' ')
1096 p--;
1097 *p = '\0';
1098}
a52fbcfc 1099EXPORT_SYMBOL_GPL(ata_id_c_string);
0baab86b 1100
db6f8759
TH
1101static u64 ata_id_n_sectors(const u16 *id)
1102{
1103 if (ata_id_has_lba(id)) {
1104 if (ata_id_has_lba48(id))
968e594a 1105 return ata_id_u64(id, ATA_ID_LBA_CAPACITY_2);
5eb8deb4
SS
1106
1107 return ata_id_u32(id, ATA_ID_LBA_CAPACITY);
db6f8759 1108 }
5eb8deb4
SS
1109
1110 if (ata_id_current_chs_valid(id))
1111 return (u32)id[ATA_ID_CUR_CYLS] * (u32)id[ATA_ID_CUR_HEADS] *
1112 (u32)id[ATA_ID_CUR_SECTORS];
1113
1114 return (u32)id[ATA_ID_CYLS] * (u32)id[ATA_ID_HEADS] *
1115 (u32)id[ATA_ID_SECTORS];
db6f8759
TH
1116}
1117
a5987e0a 1118u64 ata_tf_to_lba48(const struct ata_taskfile *tf)
1e999736
AC
1119{
1120 u64 sectors = 0;
1121
1122 sectors |= ((u64)(tf->hob_lbah & 0xff)) << 40;
1123 sectors |= ((u64)(tf->hob_lbam & 0xff)) << 32;
ba14a9c2 1124 sectors |= ((u64)(tf->hob_lbal & 0xff)) << 24;
1e999736
AC
1125 sectors |= (tf->lbah & 0xff) << 16;
1126 sectors |= (tf->lbam & 0xff) << 8;
1127 sectors |= (tf->lbal & 0xff);
1128
a5987e0a 1129 return sectors;
1e999736
AC
1130}
1131
a5987e0a 1132u64 ata_tf_to_lba(const struct ata_taskfile *tf)
1e999736
AC
1133{
1134 u64 sectors = 0;
1135
1136 sectors |= (tf->device & 0x0f) << 24;
1137 sectors |= (tf->lbah & 0xff) << 16;
1138 sectors |= (tf->lbam & 0xff) << 8;
1139 sectors |= (tf->lbal & 0xff);
1140
a5987e0a 1141 return sectors;
1e999736
AC
1142}
1143
1144/**
c728a914
TH
1145 * ata_read_native_max_address - Read native max address
1146 * @dev: target device
1147 * @max_sectors: out parameter for the result native max address
1e999736 1148 *
c728a914
TH
1149 * Perform an LBA48 or LBA28 native size query upon the device in
1150 * question.
1e999736 1151 *
c728a914
TH
1152 * RETURNS:
1153 * 0 on success, -EACCES if command is aborted by the drive.
1154 * -EIO on other errors.
1e999736 1155 */
c728a914 1156static int ata_read_native_max_address(struct ata_device *dev, u64 *max_sectors)
1e999736 1157{
c728a914 1158 unsigned int err_mask;
1e999736 1159 struct ata_taskfile tf;
c728a914 1160 int lba48 = ata_id_has_lba48(dev->id);
1e999736
AC
1161
1162 ata_tf_init(dev, &tf);
1163
c728a914 1164 /* always clear all address registers */
1e999736 1165 tf.flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
1e999736 1166
c728a914
TH
1167 if (lba48) {
1168 tf.command = ATA_CMD_READ_NATIVE_MAX_EXT;
1169 tf.flags |= ATA_TFLAG_LBA48;
1170 } else
1171 tf.command = ATA_CMD_READ_NATIVE_MAX;
1e999736 1172
bd18bc04 1173 tf.protocol = ATA_PROT_NODATA;
c728a914
TH
1174 tf.device |= ATA_LBA;
1175
2b789108 1176 err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
c728a914 1177 if (err_mask) {
a9a79dfe
JP
1178 ata_dev_warn(dev,
1179 "failed to read native max address (err_mask=0x%x)\n",
1180 err_mask);
efcef265 1181 if (err_mask == AC_ERR_DEV && (tf.error & ATA_ABORTED))
c728a914
TH
1182 return -EACCES;
1183 return -EIO;
1184 }
1e999736 1185
c728a914 1186 if (lba48)
a5987e0a 1187 *max_sectors = ata_tf_to_lba48(&tf) + 1;
c728a914 1188 else
a5987e0a 1189 *max_sectors = ata_tf_to_lba(&tf) + 1;
2dcb407e 1190 if (dev->horkage & ATA_HORKAGE_HPA_SIZE)
93328e11 1191 (*max_sectors)--;
c728a914 1192 return 0;
1e999736
AC
1193}
1194
1195/**
c728a914
TH
1196 * ata_set_max_sectors - Set max sectors
1197 * @dev: target device
6b38d1d1 1198 * @new_sectors: new max sectors value to set for the device
1e999736 1199 *
c728a914
TH
1200 * Set max sectors of @dev to @new_sectors.
1201 *
1202 * RETURNS:
1203 * 0 on success, -EACCES if command is aborted or denied (due to
1204 * previous non-volatile SET_MAX) by the drive. -EIO on other
1205 * errors.
1e999736 1206 */
05027adc 1207static int ata_set_max_sectors(struct ata_device *dev, u64 new_sectors)
1e999736 1208{
c728a914 1209 unsigned int err_mask;
1e999736 1210 struct ata_taskfile tf;
c728a914 1211 int lba48 = ata_id_has_lba48(dev->id);
1e999736
AC
1212
1213 new_sectors--;
1214
1215 ata_tf_init(dev, &tf);
1216
1e999736 1217 tf.flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
c728a914
TH
1218
1219 if (lba48) {
1220 tf.command = ATA_CMD_SET_MAX_EXT;
1221 tf.flags |= ATA_TFLAG_LBA48;
1222
1223 tf.hob_lbal = (new_sectors >> 24) & 0xff;
1224 tf.hob_lbam = (new_sectors >> 32) & 0xff;
1225 tf.hob_lbah = (new_sectors >> 40) & 0xff;
1e582ba4 1226 } else {
c728a914
TH
1227 tf.command = ATA_CMD_SET_MAX;
1228
1e582ba4
TH
1229 tf.device |= (new_sectors >> 24) & 0xf;
1230 }
1231
bd18bc04 1232 tf.protocol = ATA_PROT_NODATA;
c728a914 1233 tf.device |= ATA_LBA;
1e999736
AC
1234
1235 tf.lbal = (new_sectors >> 0) & 0xff;
1236 tf.lbam = (new_sectors >> 8) & 0xff;
1237 tf.lbah = (new_sectors >> 16) & 0xff;
1e999736 1238
2b789108 1239 err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
c728a914 1240 if (err_mask) {
a9a79dfe
JP
1241 ata_dev_warn(dev,
1242 "failed to set max address (err_mask=0x%x)\n",
1243 err_mask);
c728a914 1244 if (err_mask == AC_ERR_DEV &&
efcef265 1245 (tf.error & (ATA_ABORTED | ATA_IDNF)))
c728a914
TH
1246 return -EACCES;
1247 return -EIO;
1248 }
1249
c728a914 1250 return 0;
1e999736
AC
1251}
1252
1253/**
1254 * ata_hpa_resize - Resize a device with an HPA set
1255 * @dev: Device to resize
1256 *
1257 * Read the size of an LBA28 or LBA48 disk with HPA features and resize
1258 * it if required to the full size of the media. The caller must check
1259 * the drive has the HPA feature set enabled.
05027adc
TH
1260 *
1261 * RETURNS:
1262 * 0 on success, -errno on failure.
1e999736 1263 */
05027adc 1264static int ata_hpa_resize(struct ata_device *dev)
1e999736 1265{
891fd7c6 1266 bool print_info = ata_dev_print_info(dev);
445d211b 1267 bool unlock_hpa = ata_ignore_hpa || dev->flags & ATA_DFLAG_UNLOCK_HPA;
05027adc
TH
1268 u64 sectors = ata_id_n_sectors(dev->id);
1269 u64 native_sectors;
c728a914 1270 int rc;
a617c09f 1271
05027adc 1272 /* do we need to do it? */
9162c657 1273 if ((dev->class != ATA_DEV_ATA && dev->class != ATA_DEV_ZAC) ||
05027adc
TH
1274 !ata_id_has_lba(dev->id) || !ata_id_hpa_enabled(dev->id) ||
1275 (dev->horkage & ATA_HORKAGE_BROKEN_HPA))
c728a914 1276 return 0;
1e999736 1277
05027adc
TH
1278 /* read native max address */
1279 rc = ata_read_native_max_address(dev, &native_sectors);
1280 if (rc) {
dda7aba1
TH
1281 /* If device aborted the command or HPA isn't going to
1282 * be unlocked, skip HPA resizing.
05027adc 1283 */
445d211b 1284 if (rc == -EACCES || !unlock_hpa) {
a9a79dfe
JP
1285 ata_dev_warn(dev,
1286 "HPA support seems broken, skipping HPA handling\n");
05027adc
TH
1287 dev->horkage |= ATA_HORKAGE_BROKEN_HPA;
1288
1289 /* we can continue if device aborted the command */
1290 if (rc == -EACCES)
1291 rc = 0;
1e999736 1292 }
37301a55 1293
05027adc
TH
1294 return rc;
1295 }
5920dadf 1296 dev->n_native_sectors = native_sectors;
05027adc
TH
1297
1298 /* nothing to do? */
445d211b 1299 if (native_sectors <= sectors || !unlock_hpa) {
05027adc
TH
1300 if (!print_info || native_sectors == sectors)
1301 return 0;
1302
1303 if (native_sectors > sectors)
a9a79dfe 1304 ata_dev_info(dev,
05027adc
TH
1305 "HPA detected: current %llu, native %llu\n",
1306 (unsigned long long)sectors,
1307 (unsigned long long)native_sectors);
1308 else if (native_sectors < sectors)
a9a79dfe
JP
1309 ata_dev_warn(dev,
1310 "native sectors (%llu) is smaller than sectors (%llu)\n",
05027adc
TH
1311 (unsigned long long)native_sectors,
1312 (unsigned long long)sectors);
1313 return 0;
1314 }
1315
1316 /* let's unlock HPA */
1317 rc = ata_set_max_sectors(dev, native_sectors);
1318 if (rc == -EACCES) {
1319 /* if device aborted the command, skip HPA resizing */
a9a79dfe
JP
1320 ata_dev_warn(dev,
1321 "device aborted resize (%llu -> %llu), skipping HPA handling\n",
1322 (unsigned long long)sectors,
1323 (unsigned long long)native_sectors);
05027adc
TH
1324 dev->horkage |= ATA_HORKAGE_BROKEN_HPA;
1325 return 0;
1326 } else if (rc)
1327 return rc;
1328
1329 /* re-read IDENTIFY data */
1330 rc = ata_dev_reread_id(dev, 0);
1331 if (rc) {
a9a79dfe
JP
1332 ata_dev_err(dev,
1333 "failed to re-read IDENTIFY data after HPA resizing\n");
05027adc
TH
1334 return rc;
1335 }
1336
1337 if (print_info) {
1338 u64 new_sectors = ata_id_n_sectors(dev->id);
a9a79dfe 1339 ata_dev_info(dev,
05027adc
TH
1340 "HPA unlocked: %llu -> %llu, native %llu\n",
1341 (unsigned long long)sectors,
1342 (unsigned long long)new_sectors,
1343 (unsigned long long)native_sectors);
1344 }
1345
1346 return 0;
1e999736
AC
1347}
1348
1da177e4
LT
1349/**
1350 * ata_dump_id - IDENTIFY DEVICE info debugging output
6044f3c4 1351 * @dev: device from which the information is fetched
0bd3300a 1352 * @id: IDENTIFY DEVICE page to dump
1da177e4 1353 *
0bd3300a
TH
1354 * Dump selected 16-bit words from the given IDENTIFY DEVICE
1355 * page.
1da177e4
LT
1356 *
1357 * LOCKING:
1358 * caller.
1359 */
1360
6044f3c4 1361static inline void ata_dump_id(struct ata_device *dev, const u16 *id)
1da177e4 1362{
6044f3c4
HR
1363 ata_dev_dbg(dev,
1364 "49==0x%04x 53==0x%04x 63==0x%04x 64==0x%04x 75==0x%04x\n"
1365 "80==0x%04x 81==0x%04x 82==0x%04x 83==0x%04x 84==0x%04x\n"
1366 "88==0x%04x 93==0x%04x\n",
1367 id[49], id[53], id[63], id[64], id[75], id[80],
1368 id[81], id[82], id[83], id[84], id[88], id[93]);
1da177e4
LT
1369}
1370
cb95d562
TH
1371/**
1372 * ata_id_xfermask - Compute xfermask from the given IDENTIFY data
1373 * @id: IDENTIFY data to compute xfer mask from
1374 *
1375 * Compute the xfermask for this device. This is not as trivial
1376 * as it seems if we must consider early devices correctly.
1377 *
1378 * FIXME: pre IDE drive timing (do we care ?).
1379 *
1380 * LOCKING:
1381 * None.
1382 *
1383 * RETURNS:
1384 * Computed xfermask
1385 */
f0a6d77b 1386unsigned int ata_id_xfermask(const u16 *id)
cb95d562 1387{
f0a6d77b 1388 unsigned int pio_mask, mwdma_mask, udma_mask;
cb95d562
TH
1389
1390 /* Usual case. Word 53 indicates word 64 is valid */
1391 if (id[ATA_ID_FIELD_VALID] & (1 << 1)) {
1392 pio_mask = id[ATA_ID_PIO_MODES] & 0x03;
1393 pio_mask <<= 3;
1394 pio_mask |= 0x7;
1395 } else {
1396 /* If word 64 isn't valid then Word 51 high byte holds
1397 * the PIO timing number for the maximum. Turn it into
1398 * a mask.
1399 */
7a0f1c8a 1400 u8 mode = (id[ATA_ID_OLD_PIO_MODES] >> 8) & 0xFF;
46767aeb 1401 if (mode < 5) /* Valid PIO range */
2dcb407e 1402 pio_mask = (2 << mode) - 1;
46767aeb
AC
1403 else
1404 pio_mask = 1;
cb95d562
TH
1405
1406 /* But wait.. there's more. Design your standards by
1407 * committee and you too can get a free iordy field to
e0af10ac 1408 * process. However it is the speeds not the modes that
cb95d562
TH
1409 * are supported... Note drivers using the timing API
1410 * will get this right anyway
1411 */
1412 }
1413
1414 mwdma_mask = id[ATA_ID_MWDMA_MODES] & 0x07;
fb21f0d0 1415
b352e57d
AC
1416 if (ata_id_is_cfa(id)) {
1417 /*
1418 * Process compact flash extended modes
1419 */
62afe5d7
SS
1420 int pio = (id[ATA_ID_CFA_MODES] >> 0) & 0x7;
1421 int dma = (id[ATA_ID_CFA_MODES] >> 3) & 0x7;
b352e57d
AC
1422
1423 if (pio)
1424 pio_mask |= (1 << 5);
1425 if (pio > 1)
1426 pio_mask |= (1 << 6);
1427 if (dma)
1428 mwdma_mask |= (1 << 3);
1429 if (dma > 1)
1430 mwdma_mask |= (1 << 4);
1431 }
1432
fb21f0d0
TH
1433 udma_mask = 0;
1434 if (id[ATA_ID_FIELD_VALID] & (1 << 2))
1435 udma_mask = id[ATA_ID_UDMA_MODES] & 0xff;
cb95d562
TH
1436
1437 return ata_pack_xfermask(pio_mask, mwdma_mask, udma_mask);
1438}
a52fbcfc 1439EXPORT_SYMBOL_GPL(ata_id_xfermask);
cb95d562 1440
7102d230 1441static void ata_qc_complete_internal(struct ata_queued_cmd *qc)
a2a7a662 1442{
77853bf2 1443 struct completion *waiting = qc->private_data;
a2a7a662 1444
a2a7a662 1445 complete(waiting);
a2a7a662
TH
1446}
1447
1448/**
2432697b 1449 * ata_exec_internal_sg - execute libata internal command
a2a7a662
TH
1450 * @dev: Device to which the command is sent
1451 * @tf: Taskfile registers for the command and the result
d69cf37d 1452 * @cdb: CDB for packet command
e227867f 1453 * @dma_dir: Data transfer direction of the command
5c1ad8b3 1454 * @sgl: sg list for the data buffer of the command
2432697b 1455 * @n_elem: Number of sg entries
2b789108 1456 * @timeout: Timeout in msecs (0 for default)
a2a7a662
TH
1457 *
1458 * Executes libata internal command with timeout. @tf contains
1459 * command on entry and result on return. Timeout and error
1460 * conditions are reported via return value. No recovery action
1461 * is taken after a command times out. It's caller's duty to
1462 * clean up after timeout.
1463 *
1464 * LOCKING:
1465 * None. Should be called with kernel context, might sleep.
551e8889
TH
1466 *
1467 * RETURNS:
1468 * Zero on success, AC_ERR_* mask on failure
a2a7a662 1469 */
4d6119f0
SS
1470static unsigned ata_exec_internal_sg(struct ata_device *dev,
1471 struct ata_taskfile *tf, const u8 *cdb,
1472 int dma_dir, struct scatterlist *sgl,
61176eed 1473 unsigned int n_elem, unsigned int timeout)
a2a7a662 1474{
9af5c9c9
TH
1475 struct ata_link *link = dev->link;
1476 struct ata_port *ap = link->ap;
a2a7a662 1477 u8 command = tf->command;
87fbc5a0 1478 int auto_timeout = 0;
a2a7a662 1479 struct ata_queued_cmd *qc;
28361c40 1480 unsigned int preempted_tag;
e3ed8939
JA
1481 u32 preempted_sactive;
1482 u64 preempted_qc_active;
da917d69 1483 int preempted_nr_active_links;
60be6b9a 1484 DECLARE_COMPLETION_ONSTACK(wait);
a2a7a662 1485 unsigned long flags;
77853bf2 1486 unsigned int err_mask;
d95a717f 1487 int rc;
a2a7a662 1488
ba6a1308 1489 spin_lock_irqsave(ap->lock, flags);
a2a7a662 1490
e3180499 1491 /* no internal command while frozen */
b51e9e5d 1492 if (ap->pflags & ATA_PFLAG_FROZEN) {
ba6a1308 1493 spin_unlock_irqrestore(ap->lock, flags);
e3180499
TH
1494 return AC_ERR_SYSTEM;
1495 }
1496
2ab7db1f 1497 /* initialize internal qc */
28361c40 1498 qc = __ata_qc_from_tag(ap, ATA_TAG_INTERNAL);
a2a7a662 1499
28361c40
JA
1500 qc->tag = ATA_TAG_INTERNAL;
1501 qc->hw_tag = 0;
2ab7db1f
TH
1502 qc->scsicmd = NULL;
1503 qc->ap = ap;
1504 qc->dev = dev;
1505 ata_qc_reinit(qc);
1506
9af5c9c9
TH
1507 preempted_tag = link->active_tag;
1508 preempted_sactive = link->sactive;
dedaf2b0 1509 preempted_qc_active = ap->qc_active;
da917d69 1510 preempted_nr_active_links = ap->nr_active_links;
9af5c9c9
TH
1511 link->active_tag = ATA_TAG_POISON;
1512 link->sactive = 0;
dedaf2b0 1513 ap->qc_active = 0;
da917d69 1514 ap->nr_active_links = 0;
2ab7db1f
TH
1515
1516 /* prepare & issue qc */
a2a7a662 1517 qc->tf = *tf;
d69cf37d
TH
1518 if (cdb)
1519 memcpy(qc->cdb, cdb, ATAPI_CDB_LEN);
e771451c
VP
1520
1521 /* some SATA bridges need us to indicate data xfer direction */
1522 if (tf->protocol == ATAPI_PROT_DMA && (dev->flags & ATA_DFLAG_DMADIR) &&
1523 dma_dir == DMA_FROM_DEVICE)
1524 qc->tf.feature |= ATAPI_DMADIR;
1525
e61e0672 1526 qc->flags |= ATA_QCFLAG_RESULT_TF;
a2a7a662
TH
1527 qc->dma_dir = dma_dir;
1528 if (dma_dir != DMA_NONE) {
2432697b 1529 unsigned int i, buflen = 0;
87260216 1530 struct scatterlist *sg;
2432697b 1531
87260216
JA
1532 for_each_sg(sgl, sg, n_elem, i)
1533 buflen += sg->length;
2432697b 1534
87260216 1535 ata_sg_init(qc, sgl, n_elem);
49c80429 1536 qc->nbytes = buflen;
a2a7a662
TH
1537 }
1538
77853bf2 1539 qc->private_data = &wait;
a2a7a662
TH
1540 qc->complete_fn = ata_qc_complete_internal;
1541
8e0e694a 1542 ata_qc_issue(qc);
a2a7a662 1543
ba6a1308 1544 spin_unlock_irqrestore(ap->lock, flags);
a2a7a662 1545
87fbc5a0
TH
1546 if (!timeout) {
1547 if (ata_probe_timeout)
1548 timeout = ata_probe_timeout * 1000;
1549 else {
1550 timeout = ata_internal_cmd_timeout(dev, command);
1551 auto_timeout = 1;
1552 }
1553 }
2b789108 1554
c0c362b6
TH
1555 if (ap->ops->error_handler)
1556 ata_eh_release(ap);
1557
2b789108 1558 rc = wait_for_completion_timeout(&wait, msecs_to_jiffies(timeout));
d95a717f 1559
c0c362b6
TH
1560 if (ap->ops->error_handler)
1561 ata_eh_acquire(ap);
1562
c429137a 1563 ata_sff_flush_pio_task(ap);
41ade50c 1564
d95a717f 1565 if (!rc) {
ba6a1308 1566 spin_lock_irqsave(ap->lock, flags);
a2a7a662
TH
1567
1568 /* We're racing with irq here. If we lose, the
1569 * following test prevents us from completing the qc
d95a717f
TH
1570 * twice. If we win, the port is frozen and will be
1571 * cleaned up by ->post_internal_cmd().
a2a7a662 1572 */
77853bf2 1573 if (qc->flags & ATA_QCFLAG_ACTIVE) {
d95a717f
TH
1574 qc->err_mask |= AC_ERR_TIMEOUT;
1575
1576 if (ap->ops->error_handler)
1577 ata_port_freeze(ap);
1578 else
1579 ata_qc_complete(qc);
f15a1daf 1580
16d42467
HR
1581 ata_dev_warn(dev, "qc timeout (cmd 0x%x)\n",
1582 command);
a2a7a662
TH
1583 }
1584
ba6a1308 1585 spin_unlock_irqrestore(ap->lock, flags);
a2a7a662
TH
1586 }
1587
d95a717f
TH
1588 /* do post_internal_cmd */
1589 if (ap->ops->post_internal_cmd)
1590 ap->ops->post_internal_cmd(qc);
1591
a51d644a
TH
1592 /* perform minimal error analysis */
1593 if (qc->flags & ATA_QCFLAG_FAILED) {
efcef265 1594 if (qc->result_tf.status & (ATA_ERR | ATA_DF))
a51d644a
TH
1595 qc->err_mask |= AC_ERR_DEV;
1596
1597 if (!qc->err_mask)
1598 qc->err_mask |= AC_ERR_OTHER;
1599
1600 if (qc->err_mask & ~AC_ERR_OTHER)
1601 qc->err_mask &= ~AC_ERR_OTHER;
2dae9955 1602 } else if (qc->tf.command == ATA_CMD_REQ_SENSE_DATA) {
efcef265 1603 qc->result_tf.status |= ATA_SENSE;
d95a717f
TH
1604 }
1605
15869303 1606 /* finish up */
ba6a1308 1607 spin_lock_irqsave(ap->lock, flags);
15869303 1608
e61e0672 1609 *tf = qc->result_tf;
77853bf2
TH
1610 err_mask = qc->err_mask;
1611
1612 ata_qc_free(qc);
9af5c9c9
TH
1613 link->active_tag = preempted_tag;
1614 link->sactive = preempted_sactive;
dedaf2b0 1615 ap->qc_active = preempted_qc_active;
da917d69 1616 ap->nr_active_links = preempted_nr_active_links;
77853bf2 1617
ba6a1308 1618 spin_unlock_irqrestore(ap->lock, flags);
15869303 1619
87fbc5a0
TH
1620 if ((err_mask & AC_ERR_TIMEOUT) && auto_timeout)
1621 ata_internal_cmd_timed_out(dev, command);
1622
77853bf2 1623 return err_mask;
a2a7a662
TH
1624}
1625
2432697b 1626/**
33480a0e 1627 * ata_exec_internal - execute libata internal command
2432697b
TH
1628 * @dev: Device to which the command is sent
1629 * @tf: Taskfile registers for the command and the result
1630 * @cdb: CDB for packet command
e227867f 1631 * @dma_dir: Data transfer direction of the command
2432697b
TH
1632 * @buf: Data buffer of the command
1633 * @buflen: Length of data buffer
2b789108 1634 * @timeout: Timeout in msecs (0 for default)
2432697b
TH
1635 *
1636 * Wrapper around ata_exec_internal_sg() which takes simple
1637 * buffer instead of sg list.
1638 *
1639 * LOCKING:
1640 * None. Should be called with kernel context, might sleep.
1641 *
1642 * RETURNS:
1643 * Zero on success, AC_ERR_* mask on failure
1644 */
1645unsigned ata_exec_internal(struct ata_device *dev,
1646 struct ata_taskfile *tf, const u8 *cdb,
2b789108 1647 int dma_dir, void *buf, unsigned int buflen,
61176eed 1648 unsigned int timeout)
2432697b 1649{
33480a0e
TH
1650 struct scatterlist *psg = NULL, sg;
1651 unsigned int n_elem = 0;
2432697b 1652
33480a0e
TH
1653 if (dma_dir != DMA_NONE) {
1654 WARN_ON(!buf);
1655 sg_init_one(&sg, buf, buflen);
1656 psg = &sg;
1657 n_elem++;
1658 }
2432697b 1659
2b789108
TH
1660 return ata_exec_internal_sg(dev, tf, cdb, dma_dir, psg, n_elem,
1661 timeout);
2432697b
TH
1662}
1663
1bc4ccff
AC
1664/**
1665 * ata_pio_need_iordy - check if iordy needed
1666 * @adev: ATA device
1667 *
1668 * Check if the current speed of the device requires IORDY. Used
1669 * by various controllers for chip configuration.
1670 */
1bc4ccff
AC
1671unsigned int ata_pio_need_iordy(const struct ata_device *adev)
1672{
0d9e6659
TH
1673 /* Don't set IORDY if we're preparing for reset. IORDY may
1674 * lead to controller lock up on certain controllers if the
1675 * port is not occupied. See bko#11703 for details.
1676 */
1677 if (adev->link->ap->pflags & ATA_PFLAG_RESETTING)
1678 return 0;
1679 /* Controller doesn't support IORDY. Probably a pointless
1680 * check as the caller should know this.
1681 */
9af5c9c9 1682 if (adev->link->ap->flags & ATA_FLAG_NO_IORDY)
1bc4ccff 1683 return 0;
5c18c4d2
DD
1684 /* CF spec. r4.1 Table 22 says no iordy on PIO5 and PIO6. */
1685 if (ata_id_is_cfa(adev->id)
1686 && (adev->pio_mode == XFER_PIO_5 || adev->pio_mode == XFER_PIO_6))
1687 return 0;
432729f0
AC
1688 /* PIO3 and higher it is mandatory */
1689 if (adev->pio_mode > XFER_PIO_2)
1690 return 1;
1691 /* We turn it on when possible */
1692 if (ata_id_has_iordy(adev->id))
1bc4ccff 1693 return 1;
432729f0
AC
1694 return 0;
1695}
a52fbcfc 1696EXPORT_SYMBOL_GPL(ata_pio_need_iordy);
2e9edbf8 1697
432729f0
AC
1698/**
1699 * ata_pio_mask_no_iordy - Return the non IORDY mask
1700 * @adev: ATA device
1701 *
1702 * Compute the highest mode possible if we are not using iordy. Return
1703 * -1 if no iordy mode is available.
1704 */
432729f0
AC
1705static u32 ata_pio_mask_no_iordy(const struct ata_device *adev)
1706{
1bc4ccff 1707 /* If we have no drive specific rule, then PIO 2 is non IORDY */
1bc4ccff 1708 if (adev->id[ATA_ID_FIELD_VALID] & 2) { /* EIDE */
432729f0 1709 u16 pio = adev->id[ATA_ID_EIDE_PIO];
1bc4ccff
AC
1710 /* Is the speed faster than the drive allows non IORDY ? */
1711 if (pio) {
1712 /* This is cycle times not frequency - watch the logic! */
1713 if (pio > 240) /* PIO2 is 240nS per cycle */
432729f0
AC
1714 return 3 << ATA_SHIFT_PIO;
1715 return 7 << ATA_SHIFT_PIO;
1bc4ccff
AC
1716 }
1717 }
432729f0 1718 return 3 << ATA_SHIFT_PIO;
1bc4ccff
AC
1719}
1720
963e4975
AC
1721/**
1722 * ata_do_dev_read_id - default ID read method
1723 * @dev: device
1724 * @tf: proposed taskfile
1725 * @id: data buffer
1726 *
1727 * Issue the identify taskfile and hand back the buffer containing
1728 * identify data. For some RAID controllers and for pre ATA devices
1729 * this function is wrapped or replaced by the driver
1730 */
1731unsigned int ata_do_dev_read_id(struct ata_device *dev,
0561e514 1732 struct ata_taskfile *tf, __le16 *id)
963e4975
AC
1733{
1734 return ata_exec_internal(dev, tf, NULL, DMA_FROM_DEVICE,
1735 id, sizeof(id[0]) * ATA_ID_WORDS, 0);
1736}
a52fbcfc 1737EXPORT_SYMBOL_GPL(ata_do_dev_read_id);
963e4975 1738
1da177e4 1739/**
49016aca 1740 * ata_dev_read_id - Read ID data from the specified device
49016aca
TH
1741 * @dev: target device
1742 * @p_class: pointer to class of the target device (may be changed)
bff04647 1743 * @flags: ATA_READID_* flags
fe635c7e 1744 * @id: buffer to read IDENTIFY data into
1da177e4 1745 *
49016aca
TH
1746 * Read ID data from the specified device. ATA_CMD_ID_ATA is
1747 * performed on ATA devices and ATA_CMD_ID_ATAPI on ATAPI
aec5c3c1
TH
1748 * devices. This function also issues ATA_CMD_INIT_DEV_PARAMS
1749 * for pre-ATA4 drives.
1da177e4 1750 *
50a99018 1751 * FIXME: ATA_CMD_ID_ATA is optional for early drives and right
2dcb407e 1752 * now we abort if we hit that case.
50a99018 1753 *
1da177e4 1754 * LOCKING:
49016aca
TH
1755 * Kernel thread context (may sleep)
1756 *
1757 * RETURNS:
1758 * 0 on success, -errno otherwise.
1da177e4 1759 */
a9beec95 1760int ata_dev_read_id(struct ata_device *dev, unsigned int *p_class,
bff04647 1761 unsigned int flags, u16 *id)
1da177e4 1762{
9af5c9c9 1763 struct ata_port *ap = dev->link->ap;
49016aca 1764 unsigned int class = *p_class;
a0123703 1765 struct ata_taskfile tf;
49016aca
TH
1766 unsigned int err_mask = 0;
1767 const char *reason;
79b42bab 1768 bool is_semb = class == ATA_DEV_SEMB;
54936f8b 1769 int may_fallback = 1, tried_spinup = 0;
49016aca 1770 int rc;
1da177e4 1771
963e4975 1772retry:
3373efd8 1773 ata_tf_init(dev, &tf);
a0123703 1774
49016aca 1775 switch (class) {
79b42bab
TH
1776 case ATA_DEV_SEMB:
1777 class = ATA_DEV_ATA; /* some hard drives report SEMB sig */
df561f66 1778 fallthrough;
49016aca 1779 case ATA_DEV_ATA:
9162c657 1780 case ATA_DEV_ZAC:
a0123703 1781 tf.command = ATA_CMD_ID_ATA;
49016aca
TH
1782 break;
1783 case ATA_DEV_ATAPI:
a0123703 1784 tf.command = ATA_CMD_ID_ATAPI;
49016aca
TH
1785 break;
1786 default:
1787 rc = -ENODEV;
1788 reason = "unsupported class";
1789 goto err_out;
1da177e4
LT
1790 }
1791
a0123703 1792 tf.protocol = ATA_PROT_PIO;
81afe893
TH
1793
1794 /* Some devices choke if TF registers contain garbage. Make
1795 * sure those are properly initialized.
1796 */
1797 tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1798
1799 /* Device presence detection is unreliable on some
1800 * controllers. Always poll IDENTIFY if available.
1801 */
1802 tf.flags |= ATA_TFLAG_POLLING;
1da177e4 1803
963e4975 1804 if (ap->ops->read_id)
0561e514 1805 err_mask = ap->ops->read_id(dev, &tf, (__le16 *)id);
963e4975 1806 else
0561e514 1807 err_mask = ata_do_dev_read_id(dev, &tf, (__le16 *)id);
963e4975 1808
a0123703 1809 if (err_mask) {
800b3996 1810 if (err_mask & AC_ERR_NODEV_HINT) {
a9a79dfe 1811 ata_dev_dbg(dev, "NODEV after polling detection\n");
55a8e2c8
TH
1812 return -ENOENT;
1813 }
1814
79b42bab 1815 if (is_semb) {
a9a79dfe
JP
1816 ata_dev_info(dev,
1817 "IDENTIFY failed on device w/ SEMB sig, disabled\n");
79b42bab
TH
1818 /* SEMB is not supported yet */
1819 *p_class = ATA_DEV_SEMB_UNSUP;
1820 return 0;
1821 }
1822
efcef265 1823 if ((err_mask == AC_ERR_DEV) && (tf.error & ATA_ABORTED)) {
1ffc151f
TH
1824 /* Device or controller might have reported
1825 * the wrong device class. Give a shot at the
1826 * other IDENTIFY if the current one is
1827 * aborted by the device.
1828 */
1829 if (may_fallback) {
1830 may_fallback = 0;
1831
1832 if (class == ATA_DEV_ATA)
1833 class = ATA_DEV_ATAPI;
1834 else
1835 class = ATA_DEV_ATA;
1836 goto retry;
1837 }
1838
1839 /* Control reaches here iff the device aborted
1840 * both flavors of IDENTIFYs which happens
1841 * sometimes with phantom devices.
1842 */
a9a79dfe
JP
1843 ata_dev_dbg(dev,
1844 "both IDENTIFYs aborted, assuming NODEV\n");
1ffc151f 1845 return -ENOENT;
54936f8b
TH
1846 }
1847
49016aca
TH
1848 rc = -EIO;
1849 reason = "I/O error";
1da177e4
LT
1850 goto err_out;
1851 }
1852
43c9c591 1853 if (dev->horkage & ATA_HORKAGE_DUMP_ID) {
4baa5745 1854 ata_dev_info(dev, "dumping IDENTIFY data, "
a9a79dfe
JP
1855 "class=%d may_fallback=%d tried_spinup=%d\n",
1856 class, may_fallback, tried_spinup);
4baa5745 1857 print_hex_dump(KERN_INFO, "", DUMP_PREFIX_OFFSET,
43c9c591
TH
1858 16, 2, id, ATA_ID_WORDS * sizeof(*id), true);
1859 }
1860
54936f8b
TH
1861 /* Falling back doesn't make sense if ID data was read
1862 * successfully at least once.
1863 */
1864 may_fallback = 0;
1865
49016aca 1866 swap_buf_le16(id, ATA_ID_WORDS);
1da177e4 1867
49016aca 1868 /* sanity check */
a4f5749b 1869 rc = -EINVAL;
6070068b 1870 reason = "device reports invalid type";
a4f5749b 1871
9162c657 1872 if (class == ATA_DEV_ATA || class == ATA_DEV_ZAC) {
a4f5749b
TH
1873 if (!ata_id_is_ata(id) && !ata_id_is_cfa(id))
1874 goto err_out;
db63a4c8
AW
1875 if (ap->host->flags & ATA_HOST_IGNORE_ATA &&
1876 ata_id_is_ata(id)) {
1877 ata_dev_dbg(dev,
1878 "host indicates ignore ATA devices, ignored\n");
1879 return -ENOENT;
1880 }
a4f5749b
TH
1881 } else {
1882 if (ata_id_is_ata(id))
1883 goto err_out;
49016aca
TH
1884 }
1885
169439c2
ML
1886 if (!tried_spinup && (id[2] == 0x37c8 || id[2] == 0x738c)) {
1887 tried_spinup = 1;
1888 /*
1889 * Drive powered-up in standby mode, and requires a specific
1890 * SET_FEATURES spin-up subcommand before it will accept
1891 * anything other than the original IDENTIFY command.
1892 */
218f3d30 1893 err_mask = ata_dev_set_feature(dev, SETFEATURES_SPINUP, 0);
fb0582f9 1894 if (err_mask && id[2] != 0x738c) {
169439c2
ML
1895 rc = -EIO;
1896 reason = "SPINUP failed";
1897 goto err_out;
1898 }
1899 /*
1900 * If the drive initially returned incomplete IDENTIFY info,
1901 * we now must reissue the IDENTIFY command.
1902 */
1903 if (id[2] == 0x37c8)
1904 goto retry;
1905 }
1906
9162c657
HR
1907 if ((flags & ATA_READID_POSTRESET) &&
1908 (class == ATA_DEV_ATA || class == ATA_DEV_ZAC)) {
49016aca
TH
1909 /*
1910 * The exact sequence expected by certain pre-ATA4 drives is:
1911 * SRST RESET
50a99018
AC
1912 * IDENTIFY (optional in early ATA)
1913 * INITIALIZE DEVICE PARAMETERS (later IDE and ATA)
49016aca
TH
1914 * anything else..
1915 * Some drives were very specific about that exact sequence.
50a99018
AC
1916 *
1917 * Note that ATA4 says lba is mandatory so the second check
c9404c9c 1918 * should never trigger.
49016aca
TH
1919 */
1920 if (ata_id_major_version(id) < 4 || !ata_id_has_lba(id)) {
3373efd8 1921 err_mask = ata_dev_init_params(dev, id[3], id[6]);
49016aca
TH
1922 if (err_mask) {
1923 rc = -EIO;
1924 reason = "INIT_DEV_PARAMS failed";
1925 goto err_out;
1926 }
1927
1928 /* current CHS translation info (id[53-58]) might be
1929 * changed. reread the identify device info.
1930 */
bff04647 1931 flags &= ~ATA_READID_POSTRESET;
49016aca
TH
1932 goto retry;
1933 }
1934 }
1935
1936 *p_class = class;
fe635c7e 1937
49016aca
TH
1938 return 0;
1939
1940 err_out:
16d42467
HR
1941 ata_dev_warn(dev, "failed to IDENTIFY (%s, err_mask=0x%x)\n",
1942 reason, err_mask);
49016aca
TH
1943 return rc;
1944}
1945
f01f62c2
CH
1946/**
1947 * ata_read_log_page - read a specific log page
1948 * @dev: target device
1949 * @log: log to read
1950 * @page: page to read
1951 * @buf: buffer to store read page
1952 * @sectors: number of sectors to read
1953 *
1954 * Read log page using READ_LOG_EXT command.
1955 *
1956 * LOCKING:
1957 * Kernel thread context (may sleep).
1958 *
1959 * RETURNS:
1960 * 0 on success, AC_ERR_* mask otherwise.
1961 */
1962unsigned int ata_read_log_page(struct ata_device *dev, u8 log,
1963 u8 page, void *buf, unsigned int sectors)
1964{
1965 unsigned long ap_flags = dev->link->ap->flags;
1966 struct ata_taskfile tf;
1967 unsigned int err_mask;
1968 bool dma = false;
1969
4633778b 1970 ata_dev_dbg(dev, "read log page - log 0x%x, page 0x%x\n", log, page);
f01f62c2
CH
1971
1972 /*
1973 * Return error without actually issuing the command on controllers
1974 * which e.g. lockup on a read log page.
1975 */
1976 if (ap_flags & ATA_FLAG_NO_LOG_PAGE)
1977 return AC_ERR_DEV;
1978
1979retry:
1980 ata_tf_init(dev, &tf);
f971a854 1981 if (ata_dma_enabled(dev) && ata_id_has_read_log_dma_ext(dev->id) &&
7cfdfdc8 1982 !(dev->horkage & ATA_HORKAGE_NO_DMA_LOG)) {
f01f62c2
CH
1983 tf.command = ATA_CMD_READ_LOG_DMA_EXT;
1984 tf.protocol = ATA_PROT_DMA;
1985 dma = true;
1986 } else {
1987 tf.command = ATA_CMD_READ_LOG_EXT;
1988 tf.protocol = ATA_PROT_PIO;
1989 dma = false;
1990 }
1991 tf.lbal = log;
1992 tf.lbam = page;
1993 tf.nsect = sectors;
1994 tf.hob_nsect = sectors >> 8;
1995 tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_LBA48 | ATA_TFLAG_DEVICE;
1996
1997 err_mask = ata_exec_internal(dev, &tf, NULL, DMA_FROM_DEVICE,
1998 buf, sectors * ATA_SECT_SIZE, 0);
1999
fc5c8aa7
DLM
2000 if (err_mask) {
2001 if (dma) {
2002 dev->horkage |= ATA_HORKAGE_NO_DMA_LOG;
2003 goto retry;
2004 }
23ef63d5
DLM
2005 ata_dev_err(dev,
2006 "Read log 0x%02x page 0x%02x failed, Emask 0x%x\n",
2007 (unsigned int)log, (unsigned int)page, err_mask);
f01f62c2
CH
2008 }
2009
f01f62c2
CH
2010 return err_mask;
2011}
2012
c745dfc5 2013static int ata_log_supported(struct ata_device *dev, u8 log)
efe205a3
CH
2014{
2015 struct ata_port *ap = dev->link->ap;
2016
ac9f0c81 2017 if (dev->horkage & ATA_HORKAGE_NO_LOG_DIR)
c745dfc5 2018 return 0;
ac9f0c81 2019
efe205a3 2020 if (ata_read_log_page(dev, ATA_LOG_DIRECTORY, 0, ap->sector_buf, 1))
c745dfc5
TE
2021 return 0;
2022 return get_unaligned_le16(&ap->sector_buf[log * 2]);
efe205a3
CH
2023}
2024
a0fd2454
CH
2025static bool ata_identify_page_supported(struct ata_device *dev, u8 page)
2026{
2027 struct ata_port *ap = dev->link->ap;
2028 unsigned int err, i;
2029
636f6e2a
DLM
2030 if (dev->horkage & ATA_HORKAGE_NO_ID_DEV_LOG)
2031 return false;
2032
a0fd2454 2033 if (!ata_log_supported(dev, ATA_LOG_IDENTIFY_DEVICE)) {
636f6e2a
DLM
2034 /*
2035 * IDENTIFY DEVICE data log is defined as mandatory starting
2036 * with ACS-3 (ATA version 10). Warn about the missing log
2037 * for drives which implement this ATA level or above.
2038 */
2039 if (ata_id_major_version(dev->id) >= 10)
2040 ata_dev_warn(dev,
2041 "ATA Identify Device Log not supported\n");
2042 dev->horkage |= ATA_HORKAGE_NO_ID_DEV_LOG;
a0fd2454
CH
2043 return false;
2044 }
2045
2046 /*
2047 * Read IDENTIFY DEVICE data log, page 0, to figure out if the page is
2048 * supported.
2049 */
2050 err = ata_read_log_page(dev, ATA_LOG_IDENTIFY_DEVICE, 0, ap->sector_buf,
2051 1);
fc5c8aa7 2052 if (err)
a0fd2454 2053 return false;
a0fd2454
CH
2054
2055 for (i = 0; i < ap->sector_buf[8]; i++) {
2056 if (ap->sector_buf[9 + i] == page)
2057 return true;
2058 }
2059
2060 return false;
2061}
2062
9062712f
TH
2063static int ata_do_link_spd_horkage(struct ata_device *dev)
2064{
2065 struct ata_link *plink = ata_dev_phys_link(dev);
2066 u32 target, target_limit;
2067
2068 if (!sata_scr_valid(plink))
2069 return 0;
2070
2071 if (dev->horkage & ATA_HORKAGE_1_5_GBPS)
2072 target = 1;
2073 else
2074 return 0;
2075
2076 target_limit = (1 << target) - 1;
2077
2078 /* if already on stricter limit, no need to push further */
2079 if (plink->sata_spd_limit <= target_limit)
2080 return 0;
2081
2082 plink->sata_spd_limit = target_limit;
2083
2084 /* Request another EH round by returning -EAGAIN if link is
2085 * going faster than the target speed. Forward progress is
2086 * guaranteed by setting sata_spd_limit to target_limit above.
2087 */
2088 if (plink->sata_spd > target) {
a9a79dfe
JP
2089 ata_dev_info(dev, "applying link speed limit horkage to %s\n",
2090 sata_spd_string(target));
9062712f
TH
2091 return -EAGAIN;
2092 }
2093 return 0;
2094}
2095
3373efd8 2096static inline u8 ata_dev_knobble(struct ata_device *dev)
4b2f3ede 2097{
9af5c9c9 2098 struct ata_port *ap = dev->link->ap;
9ce8e307
JA
2099
2100 if (ata_dev_blacklisted(dev) & ATA_HORKAGE_BRIDGE_OK)
2101 return 0;
2102
9af5c9c9 2103 return ((ap->cbl == ATA_CBL_SATA) && (!ata_id_is_sata(dev->id)));
4b2f3ede
TH
2104}
2105
5a233551
HR
2106static void ata_dev_config_ncq_send_recv(struct ata_device *dev)
2107{
2108 struct ata_port *ap = dev->link->ap;
2109 unsigned int err_mask;
2110
efe205a3
CH
2111 if (!ata_log_supported(dev, ATA_LOG_NCQ_SEND_RECV)) {
2112 ata_dev_warn(dev, "NCQ Send/Recv Log not supported\n");
fe5af0cc
HR
2113 return;
2114 }
5a233551
HR
2115 err_mask = ata_read_log_page(dev, ATA_LOG_NCQ_SEND_RECV,
2116 0, ap->sector_buf, 1);
fc5c8aa7 2117 if (!err_mask) {
5a233551
HR
2118 u8 *cmds = dev->ncq_send_recv_cmds;
2119
2120 dev->flags |= ATA_DFLAG_NCQ_SEND_RECV;
2121 memcpy(cmds, ap->sector_buf, ATA_LOG_NCQ_SEND_RECV_SIZE);
2122
2123 if (dev->horkage & ATA_HORKAGE_NO_NCQ_TRIM) {
2124 ata_dev_dbg(dev, "disabling queued TRIM support\n");
2125 cmds[ATA_LOG_NCQ_SEND_RECV_DSM_OFFSET] &=
2126 ~ATA_LOG_NCQ_SEND_RECV_DSM_TRIM;
2127 }
2128 }
2129}
2130
284b3b77
HR
2131static void ata_dev_config_ncq_non_data(struct ata_device *dev)
2132{
2133 struct ata_port *ap = dev->link->ap;
2134 unsigned int err_mask;
284b3b77 2135
efe205a3 2136 if (!ata_log_supported(dev, ATA_LOG_NCQ_NON_DATA)) {
284b3b77
HR
2137 ata_dev_warn(dev,
2138 "NCQ Send/Recv Log not supported\n");
2139 return;
2140 }
2141 err_mask = ata_read_log_page(dev, ATA_LOG_NCQ_NON_DATA,
2142 0, ap->sector_buf, 1);
fc5c8aa7 2143 if (!err_mask) {
284b3b77
HR
2144 u8 *cmds = dev->ncq_non_data_cmds;
2145
2146 memcpy(cmds, ap->sector_buf, ATA_LOG_NCQ_NON_DATA_SIZE);
2147 }
2148}
2149
8e061784
AM
2150static void ata_dev_config_ncq_prio(struct ata_device *dev)
2151{
2152 struct ata_port *ap = dev->link->ap;
2153 unsigned int err_mask;
2154
06f6c4c6
DLM
2155 if (!ata_identify_page_supported(dev, ATA_LOG_SATA_SETTINGS))
2156 return;
2157
8e061784 2158 err_mask = ata_read_log_page(dev,
1d51d5f3 2159 ATA_LOG_IDENTIFY_DEVICE,
8e061784
AM
2160 ATA_LOG_SATA_SETTINGS,
2161 ap->sector_buf,
2162 1);
fc5c8aa7 2163 if (err_mask)
2360fa18 2164 goto not_supported;
8e061784 2165
2360fa18
DLM
2166 if (!(ap->sector_buf[ATA_LOG_NCQ_PRIO_OFFSET] & BIT(3)))
2167 goto not_supported;
2168
2169 dev->flags |= ATA_DFLAG_NCQ_PRIO;
2170
2171 return;
8e061784 2172
2360fa18
DLM
2173not_supported:
2174 dev->flags &= ~ATA_DFLAG_NCQ_PRIO_ENABLE;
2175 dev->flags &= ~ATA_DFLAG_NCQ_PRIO;
8e061784
AM
2176}
2177
7a8526a5
KH
2178static bool ata_dev_check_adapter(struct ata_device *dev,
2179 unsigned short vendor_id)
2180{
2181 struct pci_dev *pcidev = NULL;
2182 struct device *parent_dev = NULL;
2183
2184 for (parent_dev = dev->tdev.parent; parent_dev != NULL;
2185 parent_dev = parent_dev->parent) {
2186 if (dev_is_pci(parent_dev)) {
2187 pcidev = to_pci_dev(parent_dev);
2188 if (pcidev->vendor == vendor_id)
2189 return true;
2190 break;
2191 }
2192 }
2193
2194 return false;
2195}
2196
388539f3 2197static int ata_dev_config_ncq(struct ata_device *dev,
a6e6ce8e
TH
2198 char *desc, size_t desc_sz)
2199{
9af5c9c9 2200 struct ata_port *ap = dev->link->ap;
a6e6ce8e 2201 int hdepth = 0, ddepth = ata_id_queue_depth(dev->id);
388539f3
SL
2202 unsigned int err_mask;
2203 char *aa_desc = "";
a6e6ce8e
TH
2204
2205 if (!ata_id_has_ncq(dev->id)) {
2206 desc[0] = '\0';
388539f3 2207 return 0;
a6e6ce8e 2208 }
cba97ea1
BZ
2209 if (!IS_ENABLED(CONFIG_SATA_HOST))
2210 return 0;
75683fe7 2211 if (dev->horkage & ATA_HORKAGE_NONCQ) {
6919a0a6 2212 snprintf(desc, desc_sz, "NCQ (not used)");
388539f3 2213 return 0;
6919a0a6 2214 }
7a8526a5
KH
2215
2216 if (dev->horkage & ATA_HORKAGE_NO_NCQ_ON_ATI &&
2217 ata_dev_check_adapter(dev, PCI_VENDOR_ID_ATI)) {
2218 snprintf(desc, desc_sz, "NCQ (not used)");
2219 return 0;
2220 }
2221
a6e6ce8e 2222 if (ap->flags & ATA_FLAG_NCQ) {
69278f79 2223 hdepth = min(ap->scsi_host->can_queue, ATA_MAX_QUEUE);
a6e6ce8e
TH
2224 dev->flags |= ATA_DFLAG_NCQ;
2225 }
2226
388539f3
SL
2227 if (!(dev->horkage & ATA_HORKAGE_BROKEN_FPDMA_AA) &&
2228 (ap->flags & ATA_FLAG_FPDMA_AA) &&
2229 ata_id_has_fpdma_aa(dev->id)) {
2230 err_mask = ata_dev_set_feature(dev, SETFEATURES_SATA_ENABLE,
2231 SATA_FPDMA_AA);
2232 if (err_mask) {
a9a79dfe
JP
2233 ata_dev_err(dev,
2234 "failed to enable AA (error_mask=0x%x)\n",
2235 err_mask);
388539f3
SL
2236 if (err_mask != AC_ERR_DEV) {
2237 dev->horkage |= ATA_HORKAGE_BROKEN_FPDMA_AA;
2238 return -EIO;
2239 }
2240 } else
2241 aa_desc = ", AA";
2242 }
2243
a6e6ce8e 2244 if (hdepth >= ddepth)
388539f3 2245 snprintf(desc, desc_sz, "NCQ (depth %d)%s", ddepth, aa_desc);
a6e6ce8e 2246 else
388539f3
SL
2247 snprintf(desc, desc_sz, "NCQ (depth %d/%d)%s", hdepth,
2248 ddepth, aa_desc);
ed36911c 2249
284b3b77
HR
2250 if ((ap->flags & ATA_FLAG_FPDMA_AUX)) {
2251 if (ata_id_has_ncq_send_and_recv(dev->id))
2252 ata_dev_config_ncq_send_recv(dev);
2253 if (ata_id_has_ncq_non_data(dev->id))
2254 ata_dev_config_ncq_non_data(dev);
8e061784
AM
2255 if (ata_id_has_ncq_prio(dev->id))
2256 ata_dev_config_ncq_prio(dev);
284b3b77 2257 }
f78dea06 2258
388539f3 2259 return 0;
a6e6ce8e 2260}
f78dea06 2261
e87fd28c
HR
2262static void ata_dev_config_sense_reporting(struct ata_device *dev)
2263{
2264 unsigned int err_mask;
2265
2266 if (!ata_id_has_sense_reporting(dev->id))
2267 return;
2268
2269 if (ata_id_sense_reporting_enabled(dev->id))
2270 return;
2271
2272 err_mask = ata_dev_set_feature(dev, SETFEATURE_SENSE_DATA, 0x1);
2273 if (err_mask) {
2274 ata_dev_dbg(dev,
2275 "failed to enable Sense Data Reporting, Emask 0x%x\n",
2276 err_mask);
2277 }
2278}
2279
6d1003ae
HR
2280static void ata_dev_config_zac(struct ata_device *dev)
2281{
2282 struct ata_port *ap = dev->link->ap;
2283 unsigned int err_mask;
2284 u8 *identify_buf = ap->sector_buf;
6d1003ae
HR
2285
2286 dev->zac_zones_optimal_open = U32_MAX;
2287 dev->zac_zones_optimal_nonseq = U32_MAX;
2288 dev->zac_zones_max_open = U32_MAX;
2289
2290 /*
2291 * Always set the 'ZAC' flag for Host-managed devices.
2292 */
2293 if (dev->class == ATA_DEV_ZAC)
2294 dev->flags |= ATA_DFLAG_ZAC;
2295 else if (ata_id_zoned_cap(dev->id) == 0x01)
2296 /*
2297 * Check for host-aware devices.
2298 */
2299 dev->flags |= ATA_DFLAG_ZAC;
2300
2301 if (!(dev->flags & ATA_DFLAG_ZAC))
2302 return;
2303
a0fd2454 2304 if (!ata_identify_page_supported(dev, ATA_LOG_ZONED_INFORMATION)) {
6d1003ae
HR
2305 ata_dev_warn(dev,
2306 "ATA Zoned Information Log not supported\n");
2307 return;
2308 }
ed36911c 2309
6d1003ae
HR
2310 /*
2311 * Read IDENTIFY DEVICE data log, page 9 (Zoned-device information)
2312 */
1d51d5f3 2313 err_mask = ata_read_log_page(dev, ATA_LOG_IDENTIFY_DEVICE,
6d1003ae
HR
2314 ATA_LOG_ZONED_INFORMATION,
2315 identify_buf, 1);
2316 if (!err_mask) {
2317 u64 zoned_cap, opt_open, opt_nonseq, max_open;
2318
2319 zoned_cap = get_unaligned_le64(&identify_buf[8]);
2320 if ((zoned_cap >> 63))
2321 dev->zac_zoned_cap = (zoned_cap & 1);
2322 opt_open = get_unaligned_le64(&identify_buf[24]);
2323 if ((opt_open >> 63))
2324 dev->zac_zones_optimal_open = (u32)opt_open;
2325 opt_nonseq = get_unaligned_le64(&identify_buf[32]);
2326 if ((opt_nonseq >> 63))
2327 dev->zac_zones_optimal_nonseq = (u32)opt_nonseq;
2328 max_open = get_unaligned_le64(&identify_buf[40]);
2329 if ((max_open >> 63))
2330 dev->zac_zones_max_open = (u32)max_open;
2331 }
a6e6ce8e
TH
2332}
2333
818831c8
CH
2334static void ata_dev_config_trusted(struct ata_device *dev)
2335{
2336 struct ata_port *ap = dev->link->ap;
2337 u64 trusted_cap;
2338 unsigned int err;
2339
e8f11db9
CH
2340 if (!ata_id_has_trusted(dev->id))
2341 return;
2342
818831c8
CH
2343 if (!ata_identify_page_supported(dev, ATA_LOG_SECURITY)) {
2344 ata_dev_warn(dev,
2345 "Security Log not supported\n");
2346 return;
2347 }
2348
2349 err = ata_read_log_page(dev, ATA_LOG_IDENTIFY_DEVICE, ATA_LOG_SECURITY,
2350 ap->sector_buf, 1);
fc5c8aa7 2351 if (err)
818831c8 2352 return;
818831c8
CH
2353
2354 trusted_cap = get_unaligned_le64(&ap->sector_buf[40]);
2355 if (!(trusted_cap & (1ULL << 63))) {
2356 ata_dev_dbg(dev,
2357 "Trusted Computing capability qword not valid!\n");
2358 return;
2359 }
2360
2361 if (trusted_cap & (1 << 0))
2362 dev->flags |= ATA_DFLAG_TRUSTED;
2363}
2364
891fd7c6
DLM
2365static int ata_dev_config_lba(struct ata_device *dev)
2366{
891fd7c6
DLM
2367 const u16 *id = dev->id;
2368 const char *lba_desc;
2369 char ncq_desc[24];
2370 int ret;
2371
2372 dev->flags |= ATA_DFLAG_LBA;
2373
2374 if (ata_id_has_lba48(id)) {
2375 lba_desc = "LBA48";
2376 dev->flags |= ATA_DFLAG_LBA48;
2377 if (dev->n_sectors >= (1UL << 28) &&
2378 ata_id_has_flush_ext(id))
2379 dev->flags |= ATA_DFLAG_FLUSH_EXT;
2380 } else {
2381 lba_desc = "LBA";
2382 }
2383
2384 /* config NCQ */
2385 ret = ata_dev_config_ncq(dev, ncq_desc, sizeof(ncq_desc));
2386
2387 /* print device info to dmesg */
1c95a27c 2388 if (ata_dev_print_info(dev))
891fd7c6
DLM
2389 ata_dev_info(dev,
2390 "%llu sectors, multi %u: %s %s\n",
2391 (unsigned long long)dev->n_sectors,
2392 dev->multi_count, lba_desc, ncq_desc);
2393
2394 return ret;
2395}
2396
2397static void ata_dev_config_chs(struct ata_device *dev)
2398{
891fd7c6
DLM
2399 const u16 *id = dev->id;
2400
2401 if (ata_id_current_chs_valid(id)) {
2402 /* Current CHS translation is valid. */
2403 dev->cylinders = id[54];
2404 dev->heads = id[55];
2405 dev->sectors = id[56];
2406 } else {
2407 /* Default translation */
2408 dev->cylinders = id[1];
2409 dev->heads = id[3];
2410 dev->sectors = id[6];
2411 }
2412
2413 /* print device info to dmesg */
1c95a27c 2414 if (ata_dev_print_info(dev))
891fd7c6
DLM
2415 ata_dev_info(dev,
2416 "%llu sectors, multi %u, CHS %u/%u/%u\n",
2417 (unsigned long long)dev->n_sectors,
2418 dev->multi_count, dev->cylinders,
2419 dev->heads, dev->sectors);
2420}
2421
d8d8778c
DLM
2422static void ata_dev_config_devslp(struct ata_device *dev)
2423{
2424 u8 *sata_setting = dev->link->ap->sector_buf;
2425 unsigned int err_mask;
2426 int i, j;
2427
2428 /*
2429 * Check device sleep capability. Get DevSlp timing variables
2430 * from SATA Settings page of Identify Device Data Log.
2431 */
06f6c4c6
DLM
2432 if (!ata_id_has_devslp(dev->id) ||
2433 !ata_identify_page_supported(dev, ATA_LOG_SATA_SETTINGS))
d8d8778c
DLM
2434 return;
2435
2436 err_mask = ata_read_log_page(dev,
2437 ATA_LOG_IDENTIFY_DEVICE,
2438 ATA_LOG_SATA_SETTINGS,
2439 sata_setting, 1);
fc5c8aa7 2440 if (err_mask)
d8d8778c 2441 return;
d8d8778c
DLM
2442
2443 dev->flags |= ATA_DFLAG_DEVSLP;
2444 for (i = 0; i < ATA_LOG_DEVSLP_SIZE; i++) {
2445 j = ATA_LOG_DEVSLP_OFFSET + i;
2446 dev->devslp_timing[i] = sata_setting[j];
2447 }
2448}
2449
fe22e1c2
DLM
2450static void ata_dev_config_cpr(struct ata_device *dev)
2451{
2452 unsigned int err_mask;
2453 size_t buf_len;
2454 int i, nr_cpr = 0;
2455 struct ata_cpr_log *cpr_log = NULL;
2456 u8 *desc, *buf = NULL;
2457
c745dfc5
TE
2458 if (ata_id_major_version(dev->id) < 11)
2459 goto out;
2460
2461 buf_len = ata_log_supported(dev, ATA_LOG_CONCURRENT_POSITIONING_RANGES);
2462 if (buf_len == 0)
fe22e1c2
DLM
2463 goto out;
2464
2465 /*
fda17afc 2466 * Read the concurrent positioning ranges log (0x47). We can have at
c745dfc5
TE
2467 * most 255 32B range descriptors plus a 64B header. This log varies in
2468 * size, so use the size reported in the GPL directory. Reading beyond
2469 * the supported length will result in an error.
fe22e1c2 2470 */
c745dfc5 2471 buf_len <<= 9;
fe22e1c2
DLM
2472 buf = kzalloc(buf_len, GFP_KERNEL);
2473 if (!buf)
2474 goto out;
2475
fda17afc
DLM
2476 err_mask = ata_read_log_page(dev, ATA_LOG_CONCURRENT_POSITIONING_RANGES,
2477 0, buf, buf_len >> 9);
fe22e1c2
DLM
2478 if (err_mask)
2479 goto out;
2480
2481 nr_cpr = buf[0];
2482 if (!nr_cpr)
2483 goto out;
2484
2485 cpr_log = kzalloc(struct_size(cpr_log, cpr, nr_cpr), GFP_KERNEL);
2486 if (!cpr_log)
2487 goto out;
2488
2489 cpr_log->nr_cpr = nr_cpr;
2490 desc = &buf[64];
2491 for (i = 0; i < nr_cpr; i++, desc += 32) {
2492 cpr_log->cpr[i].num = desc[0];
2493 cpr_log->cpr[i].num_storage_elements = desc[1];
2494 cpr_log->cpr[i].start_lba = get_unaligned_le64(&desc[8]);
2495 cpr_log->cpr[i].num_lbas = get_unaligned_le64(&desc[16]);
2496 }
2497
2498out:
2499 swap(dev->cpr_log, cpr_log);
2500 kfree(cpr_log);
2501 kfree(buf);
2502}
2503
d633b8a7
DLM
2504static void ata_dev_print_features(struct ata_device *dev)
2505{
2506 if (!(dev->flags & ATA_DFLAG_FEATURES_MASK))
2507 return;
2508
2509 ata_dev_info(dev,
fe22e1c2 2510 "Features:%s%s%s%s%s%s\n",
d633b8a7
DLM
2511 dev->flags & ATA_DFLAG_TRUSTED ? " Trust" : "",
2512 dev->flags & ATA_DFLAG_DA ? " Dev-Attention" : "",
2513 dev->flags & ATA_DFLAG_DEVSLP ? " Dev-Sleep" : "",
2514 dev->flags & ATA_DFLAG_NCQ_SEND_RECV ? " NCQ-sndrcv" : "",
fe22e1c2
DLM
2515 dev->flags & ATA_DFLAG_NCQ_PRIO ? " NCQ-prio" : "",
2516 dev->cpr_log ? " CPR" : "");
d633b8a7
DLM
2517}
2518
49016aca 2519/**
ffeae418 2520 * ata_dev_configure - Configure the specified ATA/ATAPI device
ffeae418
TH
2521 * @dev: Target device to configure
2522 *
2523 * Configure @dev according to @dev->id. Generic and low-level
2524 * driver specific fixups are also applied.
49016aca
TH
2525 *
2526 * LOCKING:
ffeae418
TH
2527 * Kernel thread context (may sleep)
2528 *
2529 * RETURNS:
2530 * 0 on success, -errno otherwise
49016aca 2531 */
efdaedc4 2532int ata_dev_configure(struct ata_device *dev)
49016aca 2533{
9af5c9c9 2534 struct ata_port *ap = dev->link->ap;
891fd7c6 2535 bool print_info = ata_dev_print_info(dev);
1148c3a7 2536 const u16 *id = dev->id;
f0a6d77b 2537 unsigned int xfer_mask;
65fe1f0f 2538 unsigned int err_mask;
b352e57d 2539 char revbuf[7]; /* XYZ-99\0 */
3f64f565
EM
2540 char fwrevbuf[ATA_ID_FW_REV_LEN+1];
2541 char modelbuf[ATA_ID_PROD_LEN+1];
e6d902a3 2542 int rc;
49016aca 2543
96c810f2
HR
2544 if (!ata_dev_enabled(dev)) {
2545 ata_dev_dbg(dev, "no device\n");
ffeae418 2546 return 0;
49016aca
TH
2547 }
2548
75683fe7
TH
2549 /* set horkage */
2550 dev->horkage |= ata_dev_blacklisted(dev);
33267325 2551 ata_force_horkage(dev);
75683fe7 2552
50af2fa1 2553 if (dev->horkage & ATA_HORKAGE_DISABLE) {
a9a79dfe 2554 ata_dev_info(dev, "unsupported device, disabling\n");
50af2fa1
TH
2555 ata_dev_disable(dev);
2556 return 0;
2557 }
2558
2486fa56
TH
2559 if ((!atapi_enabled || (ap->flags & ATA_FLAG_NO_ATAPI)) &&
2560 dev->class == ATA_DEV_ATAPI) {
a9a79dfe
JP
2561 ata_dev_warn(dev, "WARNING: ATAPI is %s, device ignored\n",
2562 atapi_enabled ? "not supported with this driver"
2563 : "disabled");
2486fa56
TH
2564 ata_dev_disable(dev);
2565 return 0;
2566 }
2567
9062712f
TH
2568 rc = ata_do_link_spd_horkage(dev);
2569 if (rc)
2570 return rc;
2571
ecd75ad5
TH
2572 /* some WD SATA-1 drives have issues with LPM, turn on NOLPM for them */
2573 if ((dev->horkage & ATA_HORKAGE_WD_BROKEN_LPM) &&
2574 (id[ATA_ID_SATA_CAPABILITY] & 0xe) == 0x2)
2575 dev->horkage |= ATA_HORKAGE_NOLPM;
2576
240630e6
HG
2577 if (ap->flags & ATA_FLAG_NO_LPM)
2578 dev->horkage |= ATA_HORKAGE_NOLPM;
2579
ecd75ad5
TH
2580 if (dev->horkage & ATA_HORKAGE_NOLPM) {
2581 ata_dev_warn(dev, "LPM support broken, forcing max_power\n");
2582 dev->link->ap->target_lpm_policy = ATA_LPM_MAX_POWER;
2583 }
2584
6746544c
TH
2585 /* let ACPI work its magic */
2586 rc = ata_acpi_on_devcfg(dev);
2587 if (rc)
2588 return rc;
08573a86 2589
05027adc
TH
2590 /* massage HPA, do it early as it might change IDENTIFY data */
2591 rc = ata_hpa_resize(dev);
2592 if (rc)
2593 return rc;
2594
c39f5ebe 2595 /* print device capabilities */
17a1e1be
HR
2596 ata_dev_dbg(dev,
2597 "%s: cfg 49:%04x 82:%04x 83:%04x 84:%04x "
2598 "85:%04x 86:%04x 87:%04x 88:%04x\n",
2599 __func__,
2600 id[49], id[82], id[83], id[84],
2601 id[85], id[86], id[87], id[88]);
c39f5ebe 2602
208a9933 2603 /* initialize to-be-configured parameters */
ea1dd4e1 2604 dev->flags &= ~ATA_DFLAG_CFG_MASK;
208a9933
TH
2605 dev->max_sectors = 0;
2606 dev->cdb_len = 0;
2607 dev->n_sectors = 0;
2608 dev->cylinders = 0;
2609 dev->heads = 0;
2610 dev->sectors = 0;
e18086d6 2611 dev->multi_count = 0;
208a9933 2612
1da177e4
LT
2613 /*
2614 * common ATA, ATAPI feature tests
2615 */
2616
ff8854b2 2617 /* find max transfer mode; for printk only */
1148c3a7 2618 xfer_mask = ata_id_xfermask(id);
1da177e4 2619
6044f3c4 2620 ata_dump_id(dev, id);
1da177e4 2621
ef143d57
AL
2622 /* SCSI only uses 4-char revisions, dump full 8 chars from ATA */
2623 ata_id_c_string(dev->id, fwrevbuf, ATA_ID_FW_REV,
2624 sizeof(fwrevbuf));
2625
2626 ata_id_c_string(dev->id, modelbuf, ATA_ID_PROD,
2627 sizeof(modelbuf));
2628
1da177e4 2629 /* ATA-specific feature tests */
9162c657 2630 if (dev->class == ATA_DEV_ATA || dev->class == ATA_DEV_ZAC) {
b352e57d 2631 if (ata_id_is_cfa(id)) {
62afe5d7
SS
2632 /* CPRM may make this media unusable */
2633 if (id[ATA_ID_CFA_KEY_MGMT] & 1)
a9a79dfe
JP
2634 ata_dev_warn(dev,
2635 "supports DRM functions and may not be fully accessible\n");
b352e57d 2636 snprintf(revbuf, 7, "CFA");
ae8d4ee7 2637 } else {
2dcb407e 2638 snprintf(revbuf, 7, "ATA-%d", ata_id_major_version(id));
ae8d4ee7
AC
2639 /* Warn the user if the device has TPM extensions */
2640 if (ata_id_has_tpm(id))
a9a79dfe
JP
2641 ata_dev_warn(dev,
2642 "supports DRM functions and may not be fully accessible\n");
ae8d4ee7 2643 }
b352e57d 2644
1148c3a7 2645 dev->n_sectors = ata_id_n_sectors(id);
2940740b 2646
e18086d6
ML
2647 /* get current R/W Multiple count setting */
2648 if ((dev->id[47] >> 8) == 0x80 && (dev->id[59] & 0x100)) {
2649 unsigned int max = dev->id[47] & 0xff;
2650 unsigned int cnt = dev->id[59] & 0xff;
2651 /* only recognize/allow powers of two here */
2652 if (is_power_of_2(max) && is_power_of_2(cnt))
2653 if (cnt <= max)
2654 dev->multi_count = cnt;
2655 }
3f64f565 2656
891fd7c6 2657 /* print device info to dmesg */
1c95a27c 2658 if (print_info)
891fd7c6
DLM
2659 ata_dev_info(dev, "%s: %s, %s, max %s\n",
2660 revbuf, modelbuf, fwrevbuf,
2661 ata_mode_string(xfer_mask));
8bf62ece 2662
891fd7c6
DLM
2663 if (ata_id_has_lba(id)) {
2664 rc = ata_dev_config_lba(dev);
388539f3
SL
2665 if (rc)
2666 return rc;
ffeae418 2667 } else {
891fd7c6 2668 ata_dev_config_chs(dev);
07f6f7d0
AL
2669 }
2670
d8d8778c 2671 ata_dev_config_devslp(dev);
e87fd28c 2672 ata_dev_config_sense_reporting(dev);
6d1003ae 2673 ata_dev_config_zac(dev);
818831c8 2674 ata_dev_config_trusted(dev);
fe22e1c2 2675 ata_dev_config_cpr(dev);
b1ffbf85 2676 dev->cdb_len = 32;
d633b8a7 2677
1c95a27c 2678 if (print_info)
d633b8a7 2679 ata_dev_print_features(dev);
1da177e4
LT
2680 }
2681
2682 /* ATAPI-specific feature tests */
2c13b7ce 2683 else if (dev->class == ATA_DEV_ATAPI) {
854c73a2
TH
2684 const char *cdb_intr_string = "";
2685 const char *atapi_an_string = "";
91163006 2686 const char *dma_dir_string = "";
7d77b247 2687 u32 sntf;
08a556db 2688
1148c3a7 2689 rc = atapi_cdb_len(id);
1da177e4 2690 if ((rc < 12) || (rc > ATAPI_CDB_LEN)) {
16d42467 2691 ata_dev_warn(dev, "unsupported CDB len %d\n", rc);
ffeae418 2692 rc = -EINVAL;
1da177e4
LT
2693 goto err_out_nosup;
2694 }
6e7846e9 2695 dev->cdb_len = (unsigned int) rc;
1da177e4 2696
7d77b247
TH
2697 /* Enable ATAPI AN if both the host and device have
2698 * the support. If PMP is attached, SNTF is required
2699 * to enable ATAPI AN to discern between PHY status
2700 * changed notifications and ATAPI ANs.
9f45cbd3 2701 */
e7ecd435
TH
2702 if (atapi_an &&
2703 (ap->flags & ATA_FLAG_AN) && ata_id_has_atapi_AN(id) &&
071f44b1 2704 (!sata_pmp_attached(ap) ||
7d77b247 2705 sata_scr_read(&ap->link, SCR_NOTIFICATION, &sntf) == 0)) {
9f45cbd3 2706 /* issue SET feature command to turn this on */
218f3d30
JG
2707 err_mask = ata_dev_set_feature(dev,
2708 SETFEATURES_SATA_ENABLE, SATA_AN);
854c73a2 2709 if (err_mask)
a9a79dfe
JP
2710 ata_dev_err(dev,
2711 "failed to enable ATAPI AN (err_mask=0x%x)\n",
2712 err_mask);
854c73a2 2713 else {
9f45cbd3 2714 dev->flags |= ATA_DFLAG_AN;
854c73a2
TH
2715 atapi_an_string = ", ATAPI AN";
2716 }
9f45cbd3
KCA
2717 }
2718
08a556db 2719 if (ata_id_cdb_intr(dev->id)) {
312f7da2 2720 dev->flags |= ATA_DFLAG_CDB_INTR;
08a556db
AL
2721 cdb_intr_string = ", CDB intr";
2722 }
312f7da2 2723
966fbe19 2724 if (atapi_dmadir || (dev->horkage & ATA_HORKAGE_ATAPI_DMADIR) || atapi_id_dmadir(dev->id)) {
91163006
TH
2725 dev->flags |= ATA_DFLAG_DMADIR;
2726 dma_dir_string = ", DMADIR";
2727 }
2728
afe75951 2729 if (ata_id_has_da(dev->id)) {
b1354cbb 2730 dev->flags |= ATA_DFLAG_DA;
afe75951
AL
2731 zpodd_init(dev);
2732 }
b1354cbb 2733
1da177e4 2734 /* print device info to dmesg */
1c95a27c 2735 if (print_info)
a9a79dfe
JP
2736 ata_dev_info(dev,
2737 "ATAPI: %s, %s, max %s%s%s%s\n",
2738 modelbuf, fwrevbuf,
2739 ata_mode_string(xfer_mask),
2740 cdb_intr_string, atapi_an_string,
2741 dma_dir_string);
1da177e4
LT
2742 }
2743
914ed354
TH
2744 /* determine max_sectors */
2745 dev->max_sectors = ATA_MAX_SECTORS;
2746 if (dev->flags & ATA_DFLAG_LBA48)
2747 dev->max_sectors = ATA_MAX_SECTORS_LBA48;
2748
c5038fc0
AC
2749 /* Limit PATA drive on SATA cable bridge transfers to udma5,
2750 200 sectors */
3373efd8 2751 if (ata_dev_knobble(dev)) {
1c95a27c 2752 if (print_info)
a9a79dfe 2753 ata_dev_info(dev, "applying bridge limits\n");
5a529139 2754 dev->udma_mask &= ATA_UDMA5;
4b2f3ede
TH
2755 dev->max_sectors = ATA_MAX_SECTORS;
2756 }
2757
f8d8e579 2758 if ((dev->class == ATA_DEV_ATAPI) &&
f442cd86 2759 (atapi_command_packet_set(id) == TYPE_TAPE)) {
f8d8e579 2760 dev->max_sectors = ATA_MAX_SECTORS_TAPE;
f442cd86
AL
2761 dev->horkage |= ATA_HORKAGE_STUCK_ERR;
2762 }
f8d8e579 2763
75683fe7 2764 if (dev->horkage & ATA_HORKAGE_MAX_SEC_128)
03ec52de
TH
2765 dev->max_sectors = min_t(unsigned int, ATA_MAX_SECTORS_128,
2766 dev->max_sectors);
18d6e9d5 2767
af34d637
DM
2768 if (dev->horkage & ATA_HORKAGE_MAX_SEC_1024)
2769 dev->max_sectors = min_t(unsigned int, ATA_MAX_SECTORS_1024,
2770 dev->max_sectors);
2771
a32450e1
SH
2772 if (dev->horkage & ATA_HORKAGE_MAX_SEC_LBA48)
2773 dev->max_sectors = ATA_MAX_SECTORS_LBA48;
2774
4b2f3ede 2775 if (ap->ops->dev_config)
cd0d3bbc 2776 ap->ops->dev_config(dev);
4b2f3ede 2777
c5038fc0
AC
2778 if (dev->horkage & ATA_HORKAGE_DIAGNOSTIC) {
2779 /* Let the user know. We don't want to disallow opens for
2780 rescue purposes, or in case the vendor is just a blithering
2781 idiot. Do this after the dev_config call as some controllers
2782 with buggy firmware may want to avoid reporting false device
2783 bugs */
2784
2785 if (print_info) {
a9a79dfe 2786 ata_dev_warn(dev,
c5038fc0 2787"Drive reports diagnostics failure. This may indicate a drive\n");
a9a79dfe 2788 ata_dev_warn(dev,
c5038fc0
AC
2789"fault or invalid emulation. Contact drive vendor for information.\n");
2790 }
2791 }
2792
ac70a964 2793 if ((dev->horkage & ATA_HORKAGE_FIRMWARE_WARN) && print_info) {
a9a79dfe
JP
2794 ata_dev_warn(dev, "WARNING: device requires firmware update to be fully functional\n");
2795 ata_dev_warn(dev, " contact the vendor or visit http://ata.wiki.kernel.org\n");
ac70a964
TH
2796 }
2797
ffeae418 2798 return 0;
1da177e4
LT
2799
2800err_out_nosup:
ffeae418 2801 return rc;
1da177e4
LT
2802}
2803
be0d18df 2804/**
2e41e8e6 2805 * ata_cable_40wire - return 40 wire cable type
be0d18df
AC
2806 * @ap: port
2807 *
2e41e8e6 2808 * Helper method for drivers which want to hardwire 40 wire cable
be0d18df
AC
2809 * detection.
2810 */
2811
2812int ata_cable_40wire(struct ata_port *ap)
2813{
2814 return ATA_CBL_PATA40;
2815}
a52fbcfc 2816EXPORT_SYMBOL_GPL(ata_cable_40wire);
be0d18df
AC
2817
2818/**
2e41e8e6 2819 * ata_cable_80wire - return 80 wire cable type
be0d18df
AC
2820 * @ap: port
2821 *
2e41e8e6 2822 * Helper method for drivers which want to hardwire 80 wire cable
be0d18df
AC
2823 * detection.
2824 */
2825
2826int ata_cable_80wire(struct ata_port *ap)
2827{
2828 return ATA_CBL_PATA80;
2829}
a52fbcfc 2830EXPORT_SYMBOL_GPL(ata_cable_80wire);
be0d18df
AC
2831
2832/**
2833 * ata_cable_unknown - return unknown PATA cable.
2834 * @ap: port
2835 *
2836 * Helper method for drivers which have no PATA cable detection.
2837 */
2838
2839int ata_cable_unknown(struct ata_port *ap)
2840{
2841 return ATA_CBL_PATA_UNK;
2842}
a52fbcfc 2843EXPORT_SYMBOL_GPL(ata_cable_unknown);
be0d18df 2844
c88f90c3
TH
2845/**
2846 * ata_cable_ignore - return ignored PATA cable.
2847 * @ap: port
2848 *
2849 * Helper method for drivers which don't use cable type to limit
2850 * transfer mode.
2851 */
2852int ata_cable_ignore(struct ata_port *ap)
2853{
2854 return ATA_CBL_PATA_IGN;
2855}
a52fbcfc 2856EXPORT_SYMBOL_GPL(ata_cable_ignore);
c88f90c3 2857
be0d18df
AC
2858/**
2859 * ata_cable_sata - return SATA cable type
2860 * @ap: port
2861 *
2862 * Helper method for drivers which have SATA cables
2863 */
2864
2865int ata_cable_sata(struct ata_port *ap)
2866{
2867 return ATA_CBL_SATA;
2868}
a52fbcfc 2869EXPORT_SYMBOL_GPL(ata_cable_sata);
be0d18df 2870
1da177e4
LT
2871/**
2872 * ata_bus_probe - Reset and probe ATA bus
2873 * @ap: Bus to probe
2874 *
0cba632b
JG
2875 * Master ATA bus probing function. Initiates a hardware-dependent
2876 * bus reset, then attempts to identify any devices found on
2877 * the bus.
2878 *
1da177e4 2879 * LOCKING:
0cba632b 2880 * PCI/etc. bus probe sem.
1da177e4
LT
2881 *
2882 * RETURNS:
96072e69 2883 * Zero on success, negative errno otherwise.
1da177e4
LT
2884 */
2885
80289167 2886int ata_bus_probe(struct ata_port *ap)
1da177e4 2887{
28ca5c57 2888 unsigned int classes[ATA_MAX_DEVICES];
14d2bac1 2889 int tries[ATA_MAX_DEVICES];
f58229f8 2890 int rc;
e82cbdb9 2891 struct ata_device *dev;
1da177e4 2892
1eca4365 2893 ata_for_each_dev(dev, &ap->link, ALL)
f58229f8 2894 tries[dev->devno] = ATA_PROBE_MAX_TRIES;
14d2bac1
TH
2895
2896 retry:
1eca4365 2897 ata_for_each_dev(dev, &ap->link, ALL) {
cdeab114
TH
2898 /* If we issue an SRST then an ATA drive (not ATAPI)
2899 * may change configuration and be in PIO0 timing. If
2900 * we do a hard reset (or are coming from power on)
2901 * this is true for ATA or ATAPI. Until we've set a
2902 * suitable controller mode we should not touch the
2903 * bus as we may be talking too fast.
2904 */
2905 dev->pio_mode = XFER_PIO_0;
5416912a 2906 dev->dma_mode = 0xff;
cdeab114
TH
2907
2908 /* If the controller has a pio mode setup function
2909 * then use it to set the chipset to rights. Don't
2910 * touch the DMA setup as that will be dealt with when
2911 * configuring devices.
2912 */
2913 if (ap->ops->set_piomode)
2914 ap->ops->set_piomode(ap, dev);
2915 }
2916
2044470c 2917 /* reset and determine device classes */
52783c5d 2918 ap->ops->phy_reset(ap);
2061a47a 2919
1eca4365 2920 ata_for_each_dev(dev, &ap->link, ALL) {
3e4ec344 2921 if (dev->class != ATA_DEV_UNKNOWN)
52783c5d
TH
2922 classes[dev->devno] = dev->class;
2923 else
2924 classes[dev->devno] = ATA_DEV_NONE;
2044470c 2925
52783c5d 2926 dev->class = ATA_DEV_UNKNOWN;
28ca5c57 2927 }
1da177e4 2928
f31f0cc2
JG
2929 /* read IDENTIFY page and configure devices. We have to do the identify
2930 specific sequence bass-ackwards so that PDIAG- is released by
2931 the slave device */
2932
1eca4365 2933 ata_for_each_dev(dev, &ap->link, ALL_REVERSE) {
f58229f8
TH
2934 if (tries[dev->devno])
2935 dev->class = classes[dev->devno];
ffeae418 2936
14d2bac1 2937 if (!ata_dev_enabled(dev))
ffeae418 2938 continue;
ffeae418 2939
bff04647
TH
2940 rc = ata_dev_read_id(dev, &dev->class, ATA_READID_POSTRESET,
2941 dev->id);
14d2bac1
TH
2942 if (rc)
2943 goto fail;
f31f0cc2
JG
2944 }
2945
be0d18df
AC
2946 /* Now ask for the cable type as PDIAG- should have been released */
2947 if (ap->ops->cable_detect)
2948 ap->cbl = ap->ops->cable_detect(ap);
2949
1eca4365
TH
2950 /* We may have SATA bridge glue hiding here irrespective of
2951 * the reported cable types and sensed types. When SATA
2952 * drives indicate we have a bridge, we don't know which end
2953 * of the link the bridge is which is a problem.
2954 */
2955 ata_for_each_dev(dev, &ap->link, ENABLED)
614fe29b
AC
2956 if (ata_id_is_sata(dev->id))
2957 ap->cbl = ATA_CBL_SATA;
614fe29b 2958
f31f0cc2
JG
2959 /* After the identify sequence we can now set up the devices. We do
2960 this in the normal order so that the user doesn't get confused */
2961
1eca4365 2962 ata_for_each_dev(dev, &ap->link, ENABLED) {
9af5c9c9 2963 ap->link.eh_context.i.flags |= ATA_EHI_PRINTINFO;
efdaedc4 2964 rc = ata_dev_configure(dev);
9af5c9c9 2965 ap->link.eh_context.i.flags &= ~ATA_EHI_PRINTINFO;
14d2bac1
TH
2966 if (rc)
2967 goto fail;
1da177e4
LT
2968 }
2969
e82cbdb9 2970 /* configure transfer mode */
0260731f 2971 rc = ata_set_mode(&ap->link, &dev);
4ae72a1e 2972 if (rc)
51713d35 2973 goto fail;
1da177e4 2974
1eca4365
TH
2975 ata_for_each_dev(dev, &ap->link, ENABLED)
2976 return 0;
1da177e4 2977
96072e69 2978 return -ENODEV;
14d2bac1
TH
2979
2980 fail:
4ae72a1e
TH
2981 tries[dev->devno]--;
2982
14d2bac1
TH
2983 switch (rc) {
2984 case -EINVAL:
4ae72a1e 2985 /* eeek, something went very wrong, give up */
14d2bac1
TH
2986 tries[dev->devno] = 0;
2987 break;
4ae72a1e
TH
2988
2989 case -ENODEV:
2990 /* give it just one more chance */
2991 tries[dev->devno] = min(tries[dev->devno], 1);
df561f66 2992 fallthrough;
14d2bac1 2993 case -EIO:
4ae72a1e
TH
2994 if (tries[dev->devno] == 1) {
2995 /* This is the last chance, better to slow
2996 * down than lose it.
2997 */
a07d499b 2998 sata_down_spd_limit(&ap->link, 0);
4ae72a1e
TH
2999 ata_down_xfermask_limit(dev, ATA_DNXFER_PIO);
3000 }
14d2bac1
TH
3001 }
3002
4ae72a1e 3003 if (!tries[dev->devno])
3373efd8 3004 ata_dev_disable(dev);
ec573755 3005
14d2bac1 3006 goto retry;
1da177e4
LT
3007}
3008
3be680b7
TH
3009/**
3010 * sata_print_link_status - Print SATA link status
936fd732 3011 * @link: SATA link to printk link status about
3be680b7
TH
3012 *
3013 * This function prints link speed and status of a SATA link.
3014 *
3015 * LOCKING:
3016 * None.
3017 */
6bdb4fc9 3018static void sata_print_link_status(struct ata_link *link)
3be680b7 3019{
6d5f9732 3020 u32 sstatus, scontrol, tmp;
3be680b7 3021
936fd732 3022 if (sata_scr_read(link, SCR_STATUS, &sstatus))
3be680b7 3023 return;
936fd732 3024 sata_scr_read(link, SCR_CONTROL, &scontrol);
3be680b7 3025
b1c72916 3026 if (ata_phys_link_online(link)) {
3be680b7 3027 tmp = (sstatus >> 4) & 0xf;
a9a79dfe
JP
3028 ata_link_info(link, "SATA link up %s (SStatus %X SControl %X)\n",
3029 sata_spd_string(tmp), sstatus, scontrol);
3be680b7 3030 } else {
a9a79dfe
JP
3031 ata_link_info(link, "SATA link down (SStatus %X SControl %X)\n",
3032 sstatus, scontrol);
3be680b7
TH
3033 }
3034}
3035
ebdfca6e
AC
3036/**
3037 * ata_dev_pair - return other device on cable
ebdfca6e
AC
3038 * @adev: device
3039 *
3040 * Obtain the other device on the same cable, or if none is
3041 * present NULL is returned
3042 */
2e9edbf8 3043
3373efd8 3044struct ata_device *ata_dev_pair(struct ata_device *adev)
ebdfca6e 3045{
9af5c9c9
TH
3046 struct ata_link *link = adev->link;
3047 struct ata_device *pair = &link->device[1 - adev->devno];
e1211e3f 3048 if (!ata_dev_enabled(pair))
ebdfca6e
AC
3049 return NULL;
3050 return pair;
3051}
a52fbcfc 3052EXPORT_SYMBOL_GPL(ata_dev_pair);
ebdfca6e 3053
1c3fae4d 3054/**
3c567b7d 3055 * sata_down_spd_limit - adjust SATA spd limit downward
936fd732 3056 * @link: Link to adjust SATA spd limit for
a07d499b 3057 * @spd_limit: Additional limit
1c3fae4d 3058 *
936fd732 3059 * Adjust SATA spd limit of @link downward. Note that this
1c3fae4d 3060 * function only adjusts the limit. The change must be applied
3c567b7d 3061 * using sata_set_spd().
1c3fae4d 3062 *
a07d499b
TH
3063 * If @spd_limit is non-zero, the speed is limited to equal to or
3064 * lower than @spd_limit if such speed is supported. If
3065 * @spd_limit is slower than any supported speed, only the lowest
3066 * supported speed is allowed.
3067 *
1c3fae4d
TH
3068 * LOCKING:
3069 * Inherited from caller.
3070 *
3071 * RETURNS:
3072 * 0 on success, negative errno on failure
3073 */
a07d499b 3074int sata_down_spd_limit(struct ata_link *link, u32 spd_limit)
1c3fae4d 3075{
81952c54 3076 u32 sstatus, spd, mask;
a07d499b 3077 int rc, bit;
1c3fae4d 3078
936fd732 3079 if (!sata_scr_valid(link))
008a7896
TH
3080 return -EOPNOTSUPP;
3081
3082 /* If SCR can be read, use it to determine the current SPD.
936fd732 3083 * If not, use cached value in link->sata_spd.
008a7896 3084 */
936fd732 3085 rc = sata_scr_read(link, SCR_STATUS, &sstatus);
9913ff8a 3086 if (rc == 0 && ata_sstatus_online(sstatus))
008a7896
TH
3087 spd = (sstatus >> 4) & 0xf;
3088 else
936fd732 3089 spd = link->sata_spd;
1c3fae4d 3090
936fd732 3091 mask = link->sata_spd_limit;
1c3fae4d
TH
3092 if (mask <= 1)
3093 return -EINVAL;
008a7896
TH
3094
3095 /* unconditionally mask off the highest bit */
a07d499b
TH
3096 bit = fls(mask) - 1;
3097 mask &= ~(1 << bit);
1c3fae4d 3098
2dc0b46b
DM
3099 /*
3100 * Mask off all speeds higher than or equal to the current one. At
3101 * this point, if current SPD is not available and we previously
3102 * recorded the link speed from SStatus, the driver has already
3103 * masked off the highest bit so mask should already be 1 or 0.
3104 * Otherwise, we should not force 1.5Gbps on a link where we have
3105 * not previously recorded speed from SStatus. Just return in this
3106 * case.
008a7896
TH
3107 */
3108 if (spd > 1)
3109 mask &= (1 << (spd - 1)) - 1;
3110 else
2dc0b46b 3111 return -EINVAL;
008a7896
TH
3112
3113 /* were we already at the bottom? */
1c3fae4d
TH
3114 if (!mask)
3115 return -EINVAL;
3116
a07d499b
TH
3117 if (spd_limit) {
3118 if (mask & ((1 << spd_limit) - 1))
3119 mask &= (1 << spd_limit) - 1;
3120 else {
3121 bit = ffs(mask) - 1;
3122 mask = 1 << bit;
3123 }
3124 }
3125
936fd732 3126 link->sata_spd_limit = mask;
1c3fae4d 3127
a9a79dfe
JP
3128 ata_link_warn(link, "limiting SATA link speed to %s\n",
3129 sata_spd_string(fls(mask)));
1c3fae4d
TH
3130
3131 return 0;
3132}
3133
a9b2c120 3134#ifdef CONFIG_ATA_ACPI
a0f79b92
TH
3135/**
3136 * ata_timing_cycle2mode - find xfer mode for the specified cycle duration
3137 * @xfer_shift: ATA_SHIFT_* value for transfer type to examine.
3138 * @cycle: cycle duration in ns
3139 *
3140 * Return matching xfer mode for @cycle. The returned mode is of
3141 * the transfer type specified by @xfer_shift. If @cycle is too
3142 * slow for @xfer_shift, 0xff is returned. If @cycle is faster
3143 * than the fastest known mode, the fasted mode is returned.
3144 *
3145 * LOCKING:
3146 * None.
3147 *
3148 * RETURNS:
3149 * Matching xfer_mode, 0xff if no match found.
3150 */
3151u8 ata_timing_cycle2mode(unsigned int xfer_shift, int cycle)
3152{
3153 u8 base_mode = 0xff, last_mode = 0xff;
3154 const struct ata_xfer_ent *ent;
3155 const struct ata_timing *t;
3156
3157 for (ent = ata_xfer_tbl; ent->shift >= 0; ent++)
3158 if (ent->shift == xfer_shift)
3159 base_mode = ent->base;
3160
3161 for (t = ata_timing_find_mode(base_mode);
3162 t && ata_xfer_mode2shift(t->mode) == xfer_shift; t++) {
3163 unsigned short this_cycle;
3164
3165 switch (xfer_shift) {
3166 case ATA_SHIFT_PIO:
3167 case ATA_SHIFT_MWDMA:
3168 this_cycle = t->cycle;
3169 break;
3170 case ATA_SHIFT_UDMA:
3171 this_cycle = t->udma;
3172 break;
3173 default:
3174 return 0xff;
3175 }
3176
3177 if (cycle > this_cycle)
3178 break;
3179
3180 last_mode = t->mode;
3181 }
3182
3183 return last_mode;
3184}
a9b2c120 3185#endif
a0f79b92 3186
cf176e1a
TH
3187/**
3188 * ata_down_xfermask_limit - adjust dev xfer masks downward
cf176e1a 3189 * @dev: Device to adjust xfer masks
458337db 3190 * @sel: ATA_DNXFER_* selector
cf176e1a
TH
3191 *
3192 * Adjust xfer masks of @dev downward. Note that this function
3193 * does not apply the change. Invoking ata_set_mode() afterwards
3194 * will apply the limit.
3195 *
3196 * LOCKING:
3197 * Inherited from caller.
3198 *
3199 * RETURNS:
3200 * 0 on success, negative errno on failure
3201 */
458337db 3202int ata_down_xfermask_limit(struct ata_device *dev, unsigned int sel)
cf176e1a 3203{
458337db 3204 char buf[32];
f0a6d77b
SS
3205 unsigned int orig_mask, xfer_mask;
3206 unsigned int pio_mask, mwdma_mask, udma_mask;
458337db 3207 int quiet, highbit;
cf176e1a 3208
458337db
TH
3209 quiet = !!(sel & ATA_DNXFER_QUIET);
3210 sel &= ~ATA_DNXFER_QUIET;
cf176e1a 3211
458337db
TH
3212 xfer_mask = orig_mask = ata_pack_xfermask(dev->pio_mask,
3213 dev->mwdma_mask,
3214 dev->udma_mask);
3215 ata_unpack_xfermask(xfer_mask, &pio_mask, &mwdma_mask, &udma_mask);
cf176e1a 3216
458337db
TH
3217 switch (sel) {
3218 case ATA_DNXFER_PIO:
3219 highbit = fls(pio_mask) - 1;
3220 pio_mask &= ~(1 << highbit);
3221 break;
3222
3223 case ATA_DNXFER_DMA:
3224 if (udma_mask) {
3225 highbit = fls(udma_mask) - 1;
3226 udma_mask &= ~(1 << highbit);
3227 if (!udma_mask)
3228 return -ENOENT;
3229 } else if (mwdma_mask) {
3230 highbit = fls(mwdma_mask) - 1;
3231 mwdma_mask &= ~(1 << highbit);
3232 if (!mwdma_mask)
3233 return -ENOENT;
3234 }
3235 break;
3236
3237 case ATA_DNXFER_40C:
3238 udma_mask &= ATA_UDMA_MASK_40C;
3239 break;
3240
3241 case ATA_DNXFER_FORCE_PIO0:
3242 pio_mask &= 1;
df561f66 3243 fallthrough;
458337db
TH
3244 case ATA_DNXFER_FORCE_PIO:
3245 mwdma_mask = 0;
3246 udma_mask = 0;
3247 break;
3248
458337db
TH
3249 default:
3250 BUG();
3251 }
3252
3253 xfer_mask &= ata_pack_xfermask(pio_mask, mwdma_mask, udma_mask);
3254
3255 if (!(xfer_mask & ATA_MASK_PIO) || xfer_mask == orig_mask)
3256 return -ENOENT;
3257
3258 if (!quiet) {
3259 if (xfer_mask & (ATA_MASK_MWDMA | ATA_MASK_UDMA))
3260 snprintf(buf, sizeof(buf), "%s:%s",
3261 ata_mode_string(xfer_mask),
3262 ata_mode_string(xfer_mask & ATA_MASK_PIO));
3263 else
3264 snprintf(buf, sizeof(buf), "%s",
3265 ata_mode_string(xfer_mask));
3266
a9a79dfe 3267 ata_dev_warn(dev, "limiting speed to %s\n", buf);
458337db 3268 }
cf176e1a
TH
3269
3270 ata_unpack_xfermask(xfer_mask, &dev->pio_mask, &dev->mwdma_mask,
3271 &dev->udma_mask);
3272
cf176e1a 3273 return 0;
cf176e1a
TH
3274}
3275
3373efd8 3276static int ata_dev_set_mode(struct ata_device *dev)
1da177e4 3277{
d0cb43b3 3278 struct ata_port *ap = dev->link->ap;
9af5c9c9 3279 struct ata_eh_context *ehc = &dev->link->eh_context;
d0cb43b3 3280 const bool nosetxfer = dev->horkage & ATA_HORKAGE_NOSETXFER;
4055dee7
TH
3281 const char *dev_err_whine = "";
3282 int ign_dev_err = 0;
d0cb43b3 3283 unsigned int err_mask = 0;
83206a29 3284 int rc;
1da177e4 3285
e8384607 3286 dev->flags &= ~ATA_DFLAG_PIO;
1da177e4
LT
3287 if (dev->xfer_shift == ATA_SHIFT_PIO)
3288 dev->flags |= ATA_DFLAG_PIO;
3289
d0cb43b3
TH
3290 if (nosetxfer && ap->flags & ATA_FLAG_SATA && ata_id_is_sata(dev->id))
3291 dev_err_whine = " (SET_XFERMODE skipped)";
3292 else {
3293 if (nosetxfer)
a9a79dfe
JP
3294 ata_dev_warn(dev,
3295 "NOSETXFER but PATA detected - can't "
3296 "skip SETXFER, might malfunction\n");
d0cb43b3
TH
3297 err_mask = ata_dev_set_xfermode(dev);
3298 }
2dcb407e 3299
4055dee7
TH
3300 if (err_mask & ~AC_ERR_DEV)
3301 goto fail;
3302
3303 /* revalidate */
3304 ehc->i.flags |= ATA_EHI_POST_SETMODE;
3305 rc = ata_dev_revalidate(dev, ATA_DEV_UNKNOWN, 0);
3306 ehc->i.flags &= ~ATA_EHI_POST_SETMODE;
3307 if (rc)
3308 return rc;
3309
b93fda12
AC
3310 if (dev->xfer_shift == ATA_SHIFT_PIO) {
3311 /* Old CFA may refuse this command, which is just fine */
3312 if (ata_id_is_cfa(dev->id))
3313 ign_dev_err = 1;
3314 /* Catch several broken garbage emulations plus some pre
3315 ATA devices */
3316 if (ata_id_major_version(dev->id) == 0 &&
3317 dev->pio_mode <= XFER_PIO_2)
3318 ign_dev_err = 1;
3319 /* Some very old devices and some bad newer ones fail
3320 any kind of SET_XFERMODE request but support PIO0-2
3321 timings and no IORDY */
3322 if (!ata_id_has_iordy(dev->id) && dev->pio_mode <= XFER_PIO_2)
3323 ign_dev_err = 1;
3324 }
3acaf94b
AC
3325 /* Early MWDMA devices do DMA but don't allow DMA mode setting.
3326 Don't fail an MWDMA0 set IFF the device indicates it is in MWDMA0 */
c5038fc0 3327 if (dev->xfer_shift == ATA_SHIFT_MWDMA &&
3acaf94b
AC
3328 dev->dma_mode == XFER_MW_DMA_0 &&
3329 (dev->id[63] >> 8) & 1)
4055dee7 3330 ign_dev_err = 1;
3acaf94b 3331
4055dee7
TH
3332 /* if the device is actually configured correctly, ignore dev err */
3333 if (dev->xfer_mode == ata_xfer_mask2mode(ata_id_xfermask(dev->id)))
3334 ign_dev_err = 1;
1da177e4 3335
4055dee7
TH
3336 if (err_mask & AC_ERR_DEV) {
3337 if (!ign_dev_err)
3338 goto fail;
3339 else
3340 dev_err_whine = " (device error ignored)";
3341 }
48a8a14f 3342
4633778b
HR
3343 ata_dev_dbg(dev, "xfer_shift=%u, xfer_mode=0x%x\n",
3344 dev->xfer_shift, (int)dev->xfer_mode);
1da177e4 3345
07b9b6d6
DLM
3346 if (!(ehc->i.flags & ATA_EHI_QUIET) ||
3347 ehc->i.flags & ATA_EHI_DID_HARDRESET)
3348 ata_dev_info(dev, "configured for %s%s\n",
3349 ata_mode_string(ata_xfer_mode2mask(dev->xfer_mode)),
3350 dev_err_whine);
4055dee7 3351
83206a29 3352 return 0;
4055dee7
TH
3353
3354 fail:
a9a79dfe 3355 ata_dev_err(dev, "failed to set xfermode (err_mask=0x%x)\n", err_mask);
4055dee7 3356 return -EIO;
1da177e4
LT
3357}
3358
1da177e4 3359/**
04351821 3360 * ata_do_set_mode - Program timings and issue SET FEATURES - XFER
0260731f 3361 * @link: link on which timings will be programmed
1967b7ff 3362 * @r_failed_dev: out parameter for failed device
1da177e4 3363 *
04351821
AC
3364 * Standard implementation of the function used to tune and set
3365 * ATA device disk transfer mode (PIO3, UDMA6, etc.). If
3366 * ata_dev_set_mode() fails, pointer to the failing device is
e82cbdb9 3367 * returned in @r_failed_dev.
780a87f7 3368 *
1da177e4 3369 * LOCKING:
0cba632b 3370 * PCI/etc. bus probe sem.
e82cbdb9
TH
3371 *
3372 * RETURNS:
3373 * 0 on success, negative errno otherwise
1da177e4 3374 */
04351821 3375
0260731f 3376int ata_do_set_mode(struct ata_link *link, struct ata_device **r_failed_dev)
1da177e4 3377{
0260731f 3378 struct ata_port *ap = link->ap;
e8e0619f 3379 struct ata_device *dev;
f58229f8 3380 int rc = 0, used_dma = 0, found = 0;
3adcebb2 3381
a6d5a51c 3382 /* step 1: calculate xfer_mask */
1eca4365 3383 ata_for_each_dev(dev, link, ENABLED) {
f0a6d77b 3384 unsigned int pio_mask, dma_mask;
b3a70601 3385 unsigned int mode_mask;
a6d5a51c 3386
b3a70601
AC
3387 mode_mask = ATA_DMA_MASK_ATA;
3388 if (dev->class == ATA_DEV_ATAPI)
3389 mode_mask = ATA_DMA_MASK_ATAPI;
3390 else if (ata_id_is_cfa(dev->id))
3391 mode_mask = ATA_DMA_MASK_CFA;
3392
3373efd8 3393 ata_dev_xfermask(dev);
33267325 3394 ata_force_xfermask(dev);
1da177e4 3395
acf356b1 3396 pio_mask = ata_pack_xfermask(dev->pio_mask, 0, 0);
b3a70601
AC
3397
3398 if (libata_dma_mask & mode_mask)
80a9c430
SS
3399 dma_mask = ata_pack_xfermask(0, dev->mwdma_mask,
3400 dev->udma_mask);
b3a70601
AC
3401 else
3402 dma_mask = 0;
3403
acf356b1
TH
3404 dev->pio_mode = ata_xfer_mask2mode(pio_mask);
3405 dev->dma_mode = ata_xfer_mask2mode(dma_mask);
5444a6f4 3406
4f65977d 3407 found = 1;
b15b3eba 3408 if (ata_dma_enabled(dev))
5444a6f4 3409 used_dma = 1;
a6d5a51c 3410 }
4f65977d 3411 if (!found)
e82cbdb9 3412 goto out;
a6d5a51c
TH
3413
3414 /* step 2: always set host PIO timings */
1eca4365 3415 ata_for_each_dev(dev, link, ENABLED) {
70cd071e 3416 if (dev->pio_mode == 0xff) {
a9a79dfe 3417 ata_dev_warn(dev, "no PIO support\n");
e8e0619f 3418 rc = -EINVAL;
e82cbdb9 3419 goto out;
e8e0619f
TH
3420 }
3421
3422 dev->xfer_mode = dev->pio_mode;
3423 dev->xfer_shift = ATA_SHIFT_PIO;
3424 if (ap->ops->set_piomode)
3425 ap->ops->set_piomode(ap, dev);
3426 }
1da177e4 3427
a6d5a51c 3428 /* step 3: set host DMA timings */
1eca4365
TH
3429 ata_for_each_dev(dev, link, ENABLED) {
3430 if (!ata_dma_enabled(dev))
e8e0619f
TH
3431 continue;
3432
3433 dev->xfer_mode = dev->dma_mode;
3434 dev->xfer_shift = ata_xfer_mode2shift(dev->dma_mode);
3435 if (ap->ops->set_dmamode)
3436 ap->ops->set_dmamode(ap, dev);
3437 }
1da177e4
LT
3438
3439 /* step 4: update devices' xfer mode */
1eca4365 3440 ata_for_each_dev(dev, link, ENABLED) {
3373efd8 3441 rc = ata_dev_set_mode(dev);
5bbc53f4 3442 if (rc)
e82cbdb9 3443 goto out;
83206a29 3444 }
1da177e4 3445
e8e0619f
TH
3446 /* Record simplex status. If we selected DMA then the other
3447 * host channels are not permitted to do so.
5444a6f4 3448 */
cca3974e 3449 if (used_dma && (ap->host->flags & ATA_HOST_SIMPLEX))
032af1ce 3450 ap->host->simplex_claimed = ap;
5444a6f4 3451
e82cbdb9
TH
3452 out:
3453 if (rc)
3454 *r_failed_dev = dev;
3455 return rc;
1da177e4 3456}
a52fbcfc 3457EXPORT_SYMBOL_GPL(ata_do_set_mode);
1da177e4 3458
aa2731ad
TH
3459/**
3460 * ata_wait_ready - wait for link to become ready
3461 * @link: link to be waited on
3462 * @deadline: deadline jiffies for the operation
3463 * @check_ready: callback to check link readiness
3464 *
3465 * Wait for @link to become ready. @check_ready should return
3466 * positive number if @link is ready, 0 if it isn't, -ENODEV if
3467 * link doesn't seem to be occupied, other errno for other error
3468 * conditions.
3469 *
3470 * Transient -ENODEV conditions are allowed for
3471 * ATA_TMOUT_FF_WAIT.
3472 *
3473 * LOCKING:
3474 * EH context.
3475 *
3476 * RETURNS:
c9b5560a 3477 * 0 if @link is ready before @deadline; otherwise, -errno.
aa2731ad
TH
3478 */
3479int ata_wait_ready(struct ata_link *link, unsigned long deadline,
3480 int (*check_ready)(struct ata_link *link))
3481{
3482 unsigned long start = jiffies;
b48d58f5 3483 unsigned long nodev_deadline;
aa2731ad
TH
3484 int warned = 0;
3485
b48d58f5
TH
3486 /* choose which 0xff timeout to use, read comment in libata.h */
3487 if (link->ap->host->flags & ATA_HOST_PARALLEL_SCAN)
3488 nodev_deadline = ata_deadline(start, ATA_TMOUT_FF_WAIT_LONG);
3489 else
3490 nodev_deadline = ata_deadline(start, ATA_TMOUT_FF_WAIT);
3491
b1c72916
TH
3492 /* Slave readiness can't be tested separately from master. On
3493 * M/S emulation configuration, this function should be called
3494 * only on the master and it will handle both master and slave.
3495 */
3496 WARN_ON(link == link->ap->slave_link);
3497
aa2731ad
TH
3498 if (time_after(nodev_deadline, deadline))
3499 nodev_deadline = deadline;
3500
3501 while (1) {
3502 unsigned long now = jiffies;
3503 int ready, tmp;
3504
3505 ready = tmp = check_ready(link);
3506 if (ready > 0)
3507 return 0;
3508
b48d58f5
TH
3509 /*
3510 * -ENODEV could be transient. Ignore -ENODEV if link
aa2731ad 3511 * is online. Also, some SATA devices take a long
b48d58f5
TH
3512 * time to clear 0xff after reset. Wait for
3513 * ATA_TMOUT_FF_WAIT[_LONG] on -ENODEV if link isn't
3514 * offline.
aa2731ad
TH
3515 *
3516 * Note that some PATA controllers (pata_ali) explode
3517 * if status register is read more than once when
3518 * there's no device attached.
3519 */
3520 if (ready == -ENODEV) {
3521 if (ata_link_online(link))
3522 ready = 0;
3523 else if ((link->ap->flags & ATA_FLAG_SATA) &&
3524 !ata_link_offline(link) &&
3525 time_before(now, nodev_deadline))
3526 ready = 0;
3527 }
3528
3529 if (ready)
3530 return ready;
3531 if (time_after(now, deadline))
3532 return -EBUSY;
3533
3534 if (!warned && time_after(now, start + 5 * HZ) &&
3535 (deadline - now > 3 * HZ)) {
a9a79dfe 3536 ata_link_warn(link,
aa2731ad
TH
3537 "link is slow to respond, please be patient "
3538 "(ready=%d)\n", tmp);
3539 warned = 1;
3540 }
3541
97750ceb 3542 ata_msleep(link->ap, 50);
aa2731ad
TH
3543 }
3544}
3545
3546/**
3547 * ata_wait_after_reset - wait for link to become ready after reset
3548 * @link: link to be waited on
3549 * @deadline: deadline jiffies for the operation
3550 * @check_ready: callback to check link readiness
3551 *
3552 * Wait for @link to become ready after reset.
3553 *
3554 * LOCKING:
3555 * EH context.
3556 *
3557 * RETURNS:
c9b5560a 3558 * 0 if @link is ready before @deadline; otherwise, -errno.
aa2731ad 3559 */
2b4221bb 3560int ata_wait_after_reset(struct ata_link *link, unsigned long deadline,
aa2731ad
TH
3561 int (*check_ready)(struct ata_link *link))
3562{
97750ceb 3563 ata_msleep(link->ap, ATA_WAIT_AFTER_RESET);
aa2731ad
TH
3564
3565 return ata_wait_ready(link, deadline, check_ready);
3566}
a52fbcfc 3567EXPORT_SYMBOL_GPL(ata_wait_after_reset);
aa2731ad 3568
f5914a46 3569/**
0aa1113d 3570 * ata_std_prereset - prepare for reset
cc0680a5 3571 * @link: ATA link to be reset
d4b2bab4 3572 * @deadline: deadline jiffies for the operation
f5914a46 3573 *
cc0680a5 3574 * @link is about to be reset. Initialize it. Failure from
b8cffc6a
TH
3575 * prereset makes libata abort whole reset sequence and give up
3576 * that port, so prereset should be best-effort. It does its
3577 * best to prepare for reset sequence but if things go wrong, it
3578 * should just whine, not fail.
f5914a46
TH
3579 *
3580 * LOCKING:
3581 * Kernel thread context (may sleep)
3582 *
3583 * RETURNS:
ac1eb665 3584 * Always 0.
f5914a46 3585 */
0aa1113d 3586int ata_std_prereset(struct ata_link *link, unsigned long deadline)
f5914a46 3587{
cc0680a5 3588 struct ata_port *ap = link->ap;
936fd732 3589 struct ata_eh_context *ehc = &link->eh_context;
e9c83914 3590 const unsigned long *timing = sata_ehc_deb_timing(ehc);
f5914a46
TH
3591 int rc;
3592
f5914a46
TH
3593 /* if we're about to do hardreset, nothing more to do */
3594 if (ehc->i.action & ATA_EH_HARDRESET)
3595 return 0;
3596
936fd732 3597 /* if SATA, resume link */
a16abc0b 3598 if (ap->flags & ATA_FLAG_SATA) {
936fd732 3599 rc = sata_link_resume(link, timing, deadline);
b8cffc6a
TH
3600 /* whine about phy resume failure but proceed */
3601 if (rc && rc != -EOPNOTSUPP)
a9a79dfe
JP
3602 ata_link_warn(link,
3603 "failed to resume link for reset (errno=%d)\n",
3604 rc);
f5914a46
TH
3605 }
3606
45db2f6c 3607 /* no point in trying softreset on offline link */
b1c72916 3608 if (ata_phys_link_offline(link))
45db2f6c
TH
3609 ehc->i.action &= ~ATA_EH_SOFTRESET;
3610
f5914a46
TH
3611 return 0;
3612}
a52fbcfc 3613EXPORT_SYMBOL_GPL(ata_std_prereset);
f5914a46 3614
57c9efdf
TH
3615/**
3616 * sata_std_hardreset - COMRESET w/o waiting or classification
3617 * @link: link to reset
3618 * @class: resulting class of attached device
3619 * @deadline: deadline jiffies for the operation
3620 *
3621 * Standard SATA COMRESET w/o waiting or classification.
3622 *
3623 * LOCKING:
3624 * Kernel thread context (may sleep)
3625 *
3626 * RETURNS:
3627 * 0 if link offline, -EAGAIN if link online, -errno on errors.
3628 */
3629int sata_std_hardreset(struct ata_link *link, unsigned int *class,
3630 unsigned long deadline)
3631{
3632 const unsigned long *timing = sata_ehc_deb_timing(&link->eh_context);
3633 bool online;
3634 int rc;
3635
3636 /* do hardreset */
3637 rc = sata_link_hardreset(link, timing, deadline, &online, NULL);
57c9efdf
TH
3638 return online ? -EAGAIN : rc;
3639}
a52fbcfc 3640EXPORT_SYMBOL_GPL(sata_std_hardreset);
57c9efdf 3641
c2bd5804 3642/**
203c75b8 3643 * ata_std_postreset - standard postreset callback
cc0680a5 3644 * @link: the target ata_link
c2bd5804
TH
3645 * @classes: classes of attached devices
3646 *
3647 * This function is invoked after a successful reset. Note that
3648 * the device might have been reset more than once using
3649 * different reset methods before postreset is invoked.
c2bd5804 3650 *
c2bd5804
TH
3651 * LOCKING:
3652 * Kernel thread context (may sleep)
3653 */
203c75b8 3654void ata_std_postreset(struct ata_link *link, unsigned int *classes)
c2bd5804 3655{
f046519f
TH
3656 u32 serror;
3657
f046519f
TH
3658 /* reset complete, clear SError */
3659 if (!sata_scr_read(link, SCR_ERROR, &serror))
3660 sata_scr_write(link, SCR_ERROR, serror);
3661
c2bd5804 3662 /* print link status */
936fd732 3663 sata_print_link_status(link);
c2bd5804 3664}
a52fbcfc 3665EXPORT_SYMBOL_GPL(ata_std_postreset);
c2bd5804 3666
623a3128
TH
3667/**
3668 * ata_dev_same_device - Determine whether new ID matches configured device
623a3128
TH
3669 * @dev: device to compare against
3670 * @new_class: class of the new device
3671 * @new_id: IDENTIFY page of the new device
3672 *
3673 * Compare @new_class and @new_id against @dev and determine
3674 * whether @dev is the device indicated by @new_class and
3675 * @new_id.
3676 *
3677 * LOCKING:
3678 * None.
3679 *
3680 * RETURNS:
3681 * 1 if @dev matches @new_class and @new_id, 0 otherwise.
3682 */
3373efd8
TH
3683static int ata_dev_same_device(struct ata_device *dev, unsigned int new_class,
3684 const u16 *new_id)
623a3128
TH
3685{
3686 const u16 *old_id = dev->id;
a0cf733b
TH
3687 unsigned char model[2][ATA_ID_PROD_LEN + 1];
3688 unsigned char serial[2][ATA_ID_SERNO_LEN + 1];
623a3128
TH
3689
3690 if (dev->class != new_class) {
a9a79dfe
JP
3691 ata_dev_info(dev, "class mismatch %d != %d\n",
3692 dev->class, new_class);
623a3128
TH
3693 return 0;
3694 }
3695
a0cf733b
TH
3696 ata_id_c_string(old_id, model[0], ATA_ID_PROD, sizeof(model[0]));
3697 ata_id_c_string(new_id, model[1], ATA_ID_PROD, sizeof(model[1]));
3698 ata_id_c_string(old_id, serial[0], ATA_ID_SERNO, sizeof(serial[0]));
3699 ata_id_c_string(new_id, serial[1], ATA_ID_SERNO, sizeof(serial[1]));
623a3128
TH
3700
3701 if (strcmp(model[0], model[1])) {
a9a79dfe
JP
3702 ata_dev_info(dev, "model number mismatch '%s' != '%s'\n",
3703 model[0], model[1]);
623a3128
TH
3704 return 0;
3705 }
3706
3707 if (strcmp(serial[0], serial[1])) {
a9a79dfe
JP
3708 ata_dev_info(dev, "serial number mismatch '%s' != '%s'\n",
3709 serial[0], serial[1]);
623a3128
TH
3710 return 0;
3711 }
3712
623a3128
TH
3713 return 1;
3714}
3715
3716/**
fe30911b 3717 * ata_dev_reread_id - Re-read IDENTIFY data
3fae450c 3718 * @dev: target ATA device
bff04647 3719 * @readid_flags: read ID flags
623a3128
TH
3720 *
3721 * Re-read IDENTIFY page and make sure @dev is still attached to
3722 * the port.
3723 *
3724 * LOCKING:
3725 * Kernel thread context (may sleep)
3726 *
3727 * RETURNS:
3728 * 0 on success, negative errno otherwise
3729 */
fe30911b 3730int ata_dev_reread_id(struct ata_device *dev, unsigned int readid_flags)
623a3128 3731{
5eb45c02 3732 unsigned int class = dev->class;
9af5c9c9 3733 u16 *id = (void *)dev->link->ap->sector_buf;
623a3128
TH
3734 int rc;
3735
fe635c7e 3736 /* read ID data */
bff04647 3737 rc = ata_dev_read_id(dev, &class, readid_flags, id);
623a3128 3738 if (rc)
fe30911b 3739 return rc;
623a3128
TH
3740
3741 /* is the device still there? */
fe30911b
TH
3742 if (!ata_dev_same_device(dev, class, id))
3743 return -ENODEV;
623a3128 3744
fe635c7e 3745 memcpy(dev->id, id, sizeof(id[0]) * ATA_ID_WORDS);
fe30911b
TH
3746 return 0;
3747}
3748
3749/**
3750 * ata_dev_revalidate - Revalidate ATA device
3751 * @dev: device to revalidate
422c9daa 3752 * @new_class: new class code
fe30911b
TH
3753 * @readid_flags: read ID flags
3754 *
3755 * Re-read IDENTIFY page, make sure @dev is still attached to the
3756 * port and reconfigure it according to the new IDENTIFY page.
3757 *
3758 * LOCKING:
3759 * Kernel thread context (may sleep)
3760 *
3761 * RETURNS:
3762 * 0 on success, negative errno otherwise
3763 */
422c9daa
TH
3764int ata_dev_revalidate(struct ata_device *dev, unsigned int new_class,
3765 unsigned int readid_flags)
fe30911b 3766{
6ddcd3b0 3767 u64 n_sectors = dev->n_sectors;
5920dadf 3768 u64 n_native_sectors = dev->n_native_sectors;
fe30911b
TH
3769 int rc;
3770
3771 if (!ata_dev_enabled(dev))
3772 return -ENODEV;
3773
422c9daa
TH
3774 /* fail early if !ATA && !ATAPI to avoid issuing [P]IDENTIFY to PMP */
3775 if (ata_class_enabled(new_class) &&
f0d0613d
BP
3776 new_class != ATA_DEV_ATA &&
3777 new_class != ATA_DEV_ATAPI &&
9162c657 3778 new_class != ATA_DEV_ZAC &&
f0d0613d 3779 new_class != ATA_DEV_SEMB) {
a9a79dfe
JP
3780 ata_dev_info(dev, "class mismatch %u != %u\n",
3781 dev->class, new_class);
422c9daa
TH
3782 rc = -ENODEV;
3783 goto fail;
3784 }
3785
fe30911b
TH
3786 /* re-read ID */
3787 rc = ata_dev_reread_id(dev, readid_flags);
3788 if (rc)
3789 goto fail;
623a3128
TH
3790
3791 /* configure device according to the new ID */
efdaedc4 3792 rc = ata_dev_configure(dev);
6ddcd3b0
TH
3793 if (rc)
3794 goto fail;
3795
3796 /* verify n_sectors hasn't changed */
445d211b
TH
3797 if (dev->class != ATA_DEV_ATA || !n_sectors ||
3798 dev->n_sectors == n_sectors)
3799 return 0;
3800
3801 /* n_sectors has changed */
a9a79dfe
JP
3802 ata_dev_warn(dev, "n_sectors mismatch %llu != %llu\n",
3803 (unsigned long long)n_sectors,
3804 (unsigned long long)dev->n_sectors);
445d211b
TH
3805
3806 /*
3807 * Something could have caused HPA to be unlocked
3808 * involuntarily. If n_native_sectors hasn't changed and the
3809 * new size matches it, keep the device.
3810 */
3811 if (dev->n_native_sectors == n_native_sectors &&
3812 dev->n_sectors > n_sectors && dev->n_sectors == n_native_sectors) {
a9a79dfe
JP
3813 ata_dev_warn(dev,
3814 "new n_sectors matches native, probably "
3815 "late HPA unlock, n_sectors updated\n");
68939ce5 3816 /* use the larger n_sectors */
445d211b 3817 return 0;
6ddcd3b0
TH
3818 }
3819
445d211b
TH
3820 /*
3821 * Some BIOSes boot w/o HPA but resume w/ HPA locked. Try
3822 * unlocking HPA in those cases.
3823 *
3824 * https://bugzilla.kernel.org/show_bug.cgi?id=15396
3825 */
3826 if (dev->n_native_sectors == n_native_sectors &&
3827 dev->n_sectors < n_sectors && n_sectors == n_native_sectors &&
3828 !(dev->horkage & ATA_HORKAGE_BROKEN_HPA)) {
a9a79dfe
JP
3829 ata_dev_warn(dev,
3830 "old n_sectors matches native, probably "
3831 "late HPA lock, will try to unlock HPA\n");
445d211b
TH
3832 /* try unlocking HPA */
3833 dev->flags |= ATA_DFLAG_UNLOCK_HPA;
3834 rc = -EIO;
3835 } else
3836 rc = -ENODEV;
623a3128 3837
445d211b
TH
3838 /* restore original n_[native_]sectors and fail */
3839 dev->n_native_sectors = n_native_sectors;
3840 dev->n_sectors = n_sectors;
623a3128 3841 fail:
a9a79dfe 3842 ata_dev_err(dev, "revalidation failed (errno=%d)\n", rc);
623a3128
TH
3843 return rc;
3844}
3845
6919a0a6
AC
3846struct ata_blacklist_entry {
3847 const char *model_num;
3848 const char *model_rev;
3849 unsigned long horkage;
3850};
3851
3852static const struct ata_blacklist_entry ata_device_blacklist [] = {
3853 /* Devices with DMA related problems under Linux */
3854 { "WDC AC11000H", NULL, ATA_HORKAGE_NODMA },
3855 { "WDC AC22100H", NULL, ATA_HORKAGE_NODMA },
3856 { "WDC AC32500H", NULL, ATA_HORKAGE_NODMA },
3857 { "WDC AC33100H", NULL, ATA_HORKAGE_NODMA },
3858 { "WDC AC31600H", NULL, ATA_HORKAGE_NODMA },
3859 { "WDC AC32100H", "24.09P07", ATA_HORKAGE_NODMA },
3860 { "WDC AC23200L", "21.10N21", ATA_HORKAGE_NODMA },
3861 { "Compaq CRD-8241B", NULL, ATA_HORKAGE_NODMA },
3862 { "CRD-8400B", NULL, ATA_HORKAGE_NODMA },
7da4c935 3863 { "CRD-848[02]B", NULL, ATA_HORKAGE_NODMA },
6919a0a6
AC
3864 { "CRD-84", NULL, ATA_HORKAGE_NODMA },
3865 { "SanDisk SDP3B", NULL, ATA_HORKAGE_NODMA },
3866 { "SanDisk SDP3B-64", NULL, ATA_HORKAGE_NODMA },
3867 { "SANYO CD-ROM CRD", NULL, ATA_HORKAGE_NODMA },
3868 { "HITACHI CDR-8", NULL, ATA_HORKAGE_NODMA },
7da4c935 3869 { "HITACHI CDR-8[34]35",NULL, ATA_HORKAGE_NODMA },
6919a0a6
AC
3870 { "Toshiba CD-ROM XM-6202B", NULL, ATA_HORKAGE_NODMA },
3871 { "TOSHIBA CD-ROM XM-1702BC", NULL, ATA_HORKAGE_NODMA },
3872 { "CD-532E-A", NULL, ATA_HORKAGE_NODMA },
3873 { "E-IDE CD-ROM CR-840",NULL, ATA_HORKAGE_NODMA },
3874 { "CD-ROM Drive/F5A", NULL, ATA_HORKAGE_NODMA },
3875 { "WPI CDD-820", NULL, ATA_HORKAGE_NODMA },
3876 { "SAMSUNG CD-ROM SC-148C", NULL, ATA_HORKAGE_NODMA },
3877 { "SAMSUNG CD-ROM SC", NULL, ATA_HORKAGE_NODMA },
6919a0a6
AC
3878 { "ATAPI CD-ROM DRIVE 40X MAXIMUM",NULL,ATA_HORKAGE_NODMA },
3879 { "_NEC DV5800A", NULL, ATA_HORKAGE_NODMA },
2dcb407e 3880 { "SAMSUNG CD-ROM SN-124", "N001", ATA_HORKAGE_NODMA },
39f19886 3881 { "Seagate STT20000A", NULL, ATA_HORKAGE_NODMA },
d17d794c 3882 { " 2GB ATA Flash Disk", "ADMA428M", ATA_HORKAGE_NODMA },
b00622fc 3883 { "VRFDFC22048UCHC-TE*", NULL, ATA_HORKAGE_NODMA },
3af9a77a 3884 /* Odd clown on sil3726/4726 PMPs */
50af2fa1 3885 { "Config Disk", NULL, ATA_HORKAGE_DISABLE },
a66307d4
HR
3886 /* Similar story with ASMedia 1092 */
3887 { "ASMT109x- Config", NULL, ATA_HORKAGE_DISABLE },
6919a0a6 3888
18d6e9d5 3889 /* Weird ATAPI devices */
40a1d531 3890 { "TORiSAN DVD-ROM DRD-N216", NULL, ATA_HORKAGE_MAX_SEC_128 },
6a87e42e 3891 { "QUANTUM DAT DAT72-000", NULL, ATA_HORKAGE_ATAPI_MOD16_DMA },
a32450e1 3892 { "Slimtype DVD A DS8A8SH", NULL, ATA_HORKAGE_MAX_SEC_LBA48 },
0523f037 3893 { "Slimtype DVD A DS8A9SH", NULL, ATA_HORKAGE_MAX_SEC_LBA48 },
18d6e9d5 3894
af34d637
DM
3895 /*
3896 * Causes silent data corruption with higher max sects.
3897 * http://lkml.kernel.org/g/x49wpy40ysk.fsf@segfault.boston.devel.redhat.com
3898 */
3899 { "ST380013AS", "3.20", ATA_HORKAGE_MAX_SEC_1024 },
1488a1e3
TH
3900
3901 /*
e0edc8c5 3902 * These devices time out with higher max sects.
1488a1e3
TH
3903 * https://bugzilla.kernel.org/show_bug.cgi?id=121671
3904 */
e0edc8c5 3905 { "LITEON CX1-JB*-HP", NULL, ATA_HORKAGE_MAX_SEC_1024 },
db5ff909 3906 { "LITEON EP1-*", NULL, ATA_HORKAGE_MAX_SEC_1024 },
af34d637 3907
6919a0a6
AC
3908 /* Devices we expect to fail diagnostics */
3909
3910 /* Devices where NCQ should be avoided */
3911 /* NCQ is slow */
2dcb407e 3912 { "WDC WD740ADFD-00", NULL, ATA_HORKAGE_NONCQ },
ef1429c0 3913 { "WDC WD740ADFD-00NLR1", NULL, ATA_HORKAGE_NONCQ },
09125ea6
TH
3914 /* http://thread.gmane.org/gmane.linux.ide/14907 */
3915 { "FUJITSU MHT2060BH", NULL, ATA_HORKAGE_NONCQ },
7acfaf30 3916 /* NCQ is broken */
539cc7c7 3917 { "Maxtor *", "BANC*", ATA_HORKAGE_NONCQ },
0e3dbc01 3918 { "Maxtor 7V300F0", "VA111630", ATA_HORKAGE_NONCQ },
da6f0ec2 3919 { "ST380817AS", "3.42", ATA_HORKAGE_NONCQ },
e41bd3e8 3920 { "ST3160023AS", "3.42", ATA_HORKAGE_NONCQ },
5ccfca97 3921 { "OCZ CORE_SSD", "02.10104", ATA_HORKAGE_NONCQ },
539cc7c7 3922
ac70a964 3923 /* Seagate NCQ + FLUSH CACHE firmware bug */
4d1f9082 3924 { "ST31500341AS", "SD1[5-9]", ATA_HORKAGE_NONCQ |
ac70a964 3925 ATA_HORKAGE_FIRMWARE_WARN },
d10d491f 3926
4d1f9082 3927 { "ST31000333AS", "SD1[5-9]", ATA_HORKAGE_NONCQ |
d10d491f
TH
3928 ATA_HORKAGE_FIRMWARE_WARN },
3929
4d1f9082 3930 { "ST3640[36]23AS", "SD1[5-9]", ATA_HORKAGE_NONCQ |
d10d491f
TH
3931 ATA_HORKAGE_FIRMWARE_WARN },
3932
4d1f9082 3933 { "ST3320[68]13AS", "SD1[5-9]", ATA_HORKAGE_NONCQ |
ac70a964
TH
3934 ATA_HORKAGE_FIRMWARE_WARN },
3935
31f6264e
HG
3936 /* drives which fail FPDMA_AA activation (some may freeze afterwards)
3937 the ST disks also have LPM issues */
8756a25b 3938 { "ST1000LM024 HN-M101MBB", NULL, ATA_HORKAGE_BROKEN_FPDMA_AA |
ef1429c0 3939 ATA_HORKAGE_NOLPM },
08c85d2a 3940 { "VB0250EAVER", "HPG7", ATA_HORKAGE_BROKEN_FPDMA_AA },
87809942 3941
36e337d0
RH
3942 /* Blacklist entries taken from Silicon Image 3124/3132
3943 Windows driver .inf file - also several Linux problem reports */
ef1429c0
DLM
3944 { "HTS541060G9SA00", "MB3OC60D", ATA_HORKAGE_NONCQ },
3945 { "HTS541080G9SA00", "MB4OC60D", ATA_HORKAGE_NONCQ },
3946 { "HTS541010G9SA00", "MBZOC60D", ATA_HORKAGE_NONCQ },
6919a0a6 3947
68b0ddb2 3948 /* https://bugzilla.kernel.org/show_bug.cgi?id=15573 */
ef1429c0 3949 { "C300-CTFDDAC128MAG", "0001", ATA_HORKAGE_NONCQ },
68b0ddb2 3950
3b545563 3951 /* Sandisk SD7/8/9s lock up hard on large trims */
ef1429c0 3952 { "SanDisk SD[789]*", NULL, ATA_HORKAGE_MAX_TRIM_128M },
322579dc 3953
16c55b03 3954 /* devices which puke on READ_NATIVE_MAX */
ef1429c0 3955 { "HDS724040KLSA80", "KFAOA20N", ATA_HORKAGE_BROKEN_HPA },
16c55b03
TH
3956 { "WDC WD3200JD-00KLB0", "WD-WCAMR1130137", ATA_HORKAGE_BROKEN_HPA },
3957 { "WDC WD2500JD-00HBB0", "WD-WMAL71490727", ATA_HORKAGE_BROKEN_HPA },
3958 { "MAXTOR 6L080L4", "A93.0500", ATA_HORKAGE_BROKEN_HPA },
6919a0a6 3959
7831387b
TH
3960 /* this one allows HPA unlocking but fails IOs on the area */
3961 { "OCZ-VERTEX", "1.30", ATA_HORKAGE_BROKEN_HPA },
3962
93328e11 3963 /* Devices which report 1 sector over size HPA */
ef1429c0
DLM
3964 { "ST340823A", NULL, ATA_HORKAGE_HPA_SIZE },
3965 { "ST320413A", NULL, ATA_HORKAGE_HPA_SIZE },
3966 { "ST310211A", NULL, ATA_HORKAGE_HPA_SIZE },
93328e11 3967
6bbfd53d 3968 /* Devices which get the IVB wrong */
ef1429c0 3969 { "QUANTUM FIREBALLlct10 05", "A03.0900", ATA_HORKAGE_IVB },
a79067e5 3970 /* Maybe we should just blacklist TSSTcorp... */
ef1429c0 3971 { "TSSTcorp CDDVDW SH-S202[HJN]", "SB0[01]", ATA_HORKAGE_IVB },
6bbfd53d 3972
9ce8e307 3973 /* Devices that do not need bridging limits applied */
ef1429c0
DLM
3974 { "MTRON MSP-SATA*", NULL, ATA_HORKAGE_BRIDGE_OK },
3975 { "BUFFALO HD-QSU2/R5", NULL, ATA_HORKAGE_BRIDGE_OK },
9ce8e307 3976
9062712f 3977 /* Devices which aren't very happy with higher link speeds */
ef1429c0
DLM
3978 { "WD My Book", NULL, ATA_HORKAGE_1_5_GBPS },
3979 { "Seagate FreeAgent GoFlex", NULL, ATA_HORKAGE_1_5_GBPS },
9062712f 3980
d0cb43b3
TH
3981 /*
3982 * Devices which choke on SETXFER. Applies only if both the
3983 * device and controller are SATA.
3984 */
cd691876 3985 { "PIONEER DVD-RW DVRTD08", NULL, ATA_HORKAGE_NOSETXFER },
3a25179e
VL
3986 { "PIONEER DVD-RW DVRTD08A", NULL, ATA_HORKAGE_NOSETXFER },
3987 { "PIONEER DVD-RW DVR-215", NULL, ATA_HORKAGE_NOSETXFER },
cd691876
TH
3988 { "PIONEER DVD-RW DVR-212D", NULL, ATA_HORKAGE_NOSETXFER },
3989 { "PIONEER DVD-RW DVR-216D", NULL, ATA_HORKAGE_NOSETXFER },
d0cb43b3 3990
b17e5729 3991 /* Crucial BX100 SSD 500GB has broken LPM support */
3bf7b5d6 3992 { "CT500BX100SSD1", NULL, ATA_HORKAGE_NOLPM },
b17e5729 3993
d418ff56
HG
3994 /* 512GB MX100 with MU01 firmware has both queued TRIM and LPM issues */
3995 { "Crucial_CT512MX100*", "MU01", ATA_HORKAGE_NO_NCQ_TRIM |
9c7be59f 3996 ATA_HORKAGE_ZERO_AFTER_TRIM |
ef1429c0 3997 ATA_HORKAGE_NOLPM },
d418ff56
HG
3998 /* 512GB MX100 with newer firmware has only LPM issues */
3999 { "Crucial_CT512MX100*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM |
ef1429c0 4000 ATA_HORKAGE_NOLPM },
9c7be59f 4001
62ac3f73
HG
4002 /* 480GB+ M500 SSDs have both queued TRIM and LPM issues */
4003 { "Crucial_CT480M500*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
4004 ATA_HORKAGE_ZERO_AFTER_TRIM |
ef1429c0 4005 ATA_HORKAGE_NOLPM },
62ac3f73
HG
4006 { "Crucial_CT960M500*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
4007 ATA_HORKAGE_ZERO_AFTER_TRIM |
ef1429c0 4008 ATA_HORKAGE_NOLPM },
62ac3f73 4009
76936e9a 4010 /* These specific Samsung models/firmware-revs do not handle LPM well */
ef1429c0
DLM
4011 { "SAMSUNG MZMPC128HBFU-000MV", "CXM14M1Q", ATA_HORKAGE_NOLPM },
4012 { "SAMSUNG SSD PM830 mSATA *", "CXM13D1Q", ATA_HORKAGE_NOLPM },
4013 { "SAMSUNG MZ7TD256HAFV-000L9", NULL, ATA_HORKAGE_NOLPM },
4014 { "SAMSUNG MZ7TE512HMHP-000L1", "EXT06L0Q", ATA_HORKAGE_NOLPM },
b5b4d3a5 4015
f78dea06 4016 /* devices that don't properly handle queued TRIM commands */
136d769e 4017 { "Micron_M500IT_*", "MU01", ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4018 ATA_HORKAGE_ZERO_AFTER_TRIM },
243918be 4019 { "Micron_M500_*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4020 ATA_HORKAGE_ZERO_AFTER_TRIM },
ff7f53fb 4021 { "Crucial_CT*M500*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4022 ATA_HORKAGE_ZERO_AFTER_TRIM },
9051bd39 4023 { "Micron_M5[15]0_*", "MU01", ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4024 ATA_HORKAGE_ZERO_AFTER_TRIM },
ff7f53fb 4025 { "Crucial_CT*M550*", "MU01", ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4026 ATA_HORKAGE_ZERO_AFTER_TRIM },
ff7f53fb 4027 { "Crucial_CT*MX100*", "MU01", ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4028 ATA_HORKAGE_ZERO_AFTER_TRIM },
53997522
CL
4029 { "Samsung SSD 840 EVO*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
4030 ATA_HORKAGE_NO_DMA_LOG |
ef1429c0 4031 ATA_HORKAGE_ZERO_AFTER_TRIM },
ca6bfcb2 4032 { "Samsung SSD 840*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4033 ATA_HORKAGE_ZERO_AFTER_TRIM },
ca6bfcb2 4034 { "Samsung SSD 850*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4035 ATA_HORKAGE_ZERO_AFTER_TRIM },
8a6430ab 4036 { "Samsung SSD 860*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
7a8526a5 4037 ATA_HORKAGE_ZERO_AFTER_TRIM |
ef1429c0 4038 ATA_HORKAGE_NO_NCQ_ON_ATI },
8a6430ab 4039 { "Samsung SSD 870*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
7a8526a5 4040 ATA_HORKAGE_ZERO_AFTER_TRIM |
ef1429c0 4041 ATA_HORKAGE_NO_NCQ_ON_ATI },
7a7184b0 4042 { "FCCT*M500*", NULL, ATA_HORKAGE_NO_NCQ_TRIM |
ef1429c0 4043 ATA_HORKAGE_ZERO_AFTER_TRIM },
e61f7d1c 4044
cda57b1b 4045 /* devices that don't properly handle TRIM commands */
ef1429c0
DLM
4046 { "SuperSSpeed S238*", NULL, ATA_HORKAGE_NOTRIM },
4047 { "M88V29*", NULL, ATA_HORKAGE_NOTRIM },
cda57b1b 4048
e61f7d1c
MP
4049 /*
4050 * As defined, the DRAT (Deterministic Read After Trim) and RZAT
4051 * (Return Zero After Trim) flags in the ATA Command Set are
4052 * unreliable in the sense that they only define what happens if
4053 * the device successfully executed the DSM TRIM command. TRIM
4054 * is only advisory, however, and the device is free to silently
4055 * ignore all or parts of the request.
4056 *
4057 * Whitelist drives that are known to reliably return zeroes
4058 * after TRIM.
4059 */
4060
4061 /*
4062 * The intel 510 drive has buggy DRAT/RZAT. Explicitly exclude
4063 * that model before whitelisting all other intel SSDs.
4064 */
ef1429c0
DLM
4065 { "INTEL*SSDSC2MH*", NULL, 0 },
4066
4067 { "Micron*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
4068 { "Crucial*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
4069 { "INTEL*SSD*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
4070 { "SSD*INTEL*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
4071 { "Samsung*SSD*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
4072 { "SAMSUNG*SSD*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
4073 { "SAMSUNG*MZ7KM*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
4074 { "ST[1248][0248]0[FH]*", NULL, ATA_HORKAGE_ZERO_AFTER_TRIM },
f78dea06 4075
ecd75ad5
TH
4076 /*
4077 * Some WD SATA-I drives spin up and down erratically when the link
4078 * is put into the slumber mode. We don't have full list of the
4079 * affected devices. Disable LPM if the device matches one of the
4080 * known prefixes and is SATA-1. As a side effect LPM partial is
4081 * lost too.
4082 *
4083 * https://bugzilla.kernel.org/show_bug.cgi?id=57211
4084 */
4085 { "WDC WD800JD-*", NULL, ATA_HORKAGE_WD_BROKEN_LPM },
4086 { "WDC WD1200JD-*", NULL, ATA_HORKAGE_WD_BROKEN_LPM },
4087 { "WDC WD1600JD-*", NULL, ATA_HORKAGE_WD_BROKEN_LPM },
4088 { "WDC WD2000JD-*", NULL, ATA_HORKAGE_WD_BROKEN_LPM },
4089 { "WDC WD2500JD-*", NULL, ATA_HORKAGE_WD_BROKEN_LPM },
4090 { "WDC WD3000JD-*", NULL, ATA_HORKAGE_WD_BROKEN_LPM },
4091 { "WDC WD3200JD-*", NULL, ATA_HORKAGE_WD_BROKEN_LPM },
4092
ac9f0c81
AL
4093 /*
4094 * This sata dom device goes on a walkabout when the ATA_LOG_DIRECTORY
4095 * log page is accessed. Ensure we never ask for this log page with
4096 * these devices.
4097 */
4098 { "SATADOM-ML 3ME", NULL, ATA_HORKAGE_NO_LOG_DIR },
4099
6919a0a6
AC
4100 /* End Marker */
4101 { }
1da177e4 4102};
2e9edbf8 4103
75683fe7 4104static unsigned long ata_dev_blacklisted(const struct ata_device *dev)
1da177e4 4105{
8bfa79fc
TH
4106 unsigned char model_num[ATA_ID_PROD_LEN + 1];
4107 unsigned char model_rev[ATA_ID_FW_REV_LEN + 1];
6919a0a6 4108 const struct ata_blacklist_entry *ad = ata_device_blacklist;
3a778275 4109
8bfa79fc
TH
4110 ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
4111 ata_id_c_string(dev->id, model_rev, ATA_ID_FW_REV, sizeof(model_rev));
1da177e4 4112
6919a0a6 4113 while (ad->model_num) {
1c402799 4114 if (glob_match(ad->model_num, model_num)) {
6919a0a6
AC
4115 if (ad->model_rev == NULL)
4116 return ad->horkage;
1c402799 4117 if (glob_match(ad->model_rev, model_rev))
6919a0a6 4118 return ad->horkage;
f4b15fef 4119 }
6919a0a6 4120 ad++;
f4b15fef 4121 }
1da177e4
LT
4122 return 0;
4123}
4124
6919a0a6
AC
4125static int ata_dma_blacklisted(const struct ata_device *dev)
4126{
4127 /* We don't support polling DMA.
4128 * DMA blacklist those ATAPI devices with CDB-intr (and use PIO)
4129 * if the LLDD handles only interrupts in the HSM_ST_LAST state.
4130 */
9af5c9c9 4131 if ((dev->link->ap->flags & ATA_FLAG_PIO_POLLING) &&
6919a0a6
AC
4132 (dev->flags & ATA_DFLAG_CDB_INTR))
4133 return 1;
75683fe7 4134 return (dev->horkage & ATA_HORKAGE_NODMA) ? 1 : 0;
6919a0a6
AC
4135}
4136
6bbfd53d
AC
4137/**
4138 * ata_is_40wire - check drive side detection
4139 * @dev: device
4140 *
4141 * Perform drive side detection decoding, allowing for device vendors
4142 * who can't follow the documentation.
4143 */
4144
4145static int ata_is_40wire(struct ata_device *dev)
4146{
4147 if (dev->horkage & ATA_HORKAGE_IVB)
4148 return ata_drive_40wire_relaxed(dev->id);
4149 return ata_drive_40wire(dev->id);
4150}
4151
15a5551c
AC
4152/**
4153 * cable_is_40wire - 40/80/SATA decider
4154 * @ap: port to consider
4155 *
4156 * This function encapsulates the policy for speed management
4157 * in one place. At the moment we don't cache the result but
4158 * there is a good case for setting ap->cbl to the result when
4159 * we are called with unknown cables (and figuring out if it
4160 * impacts hotplug at all).
4161 *
4162 * Return 1 if the cable appears to be 40 wire.
4163 */
4164
4165static int cable_is_40wire(struct ata_port *ap)
4166{
4167 struct ata_link *link;
4168 struct ata_device *dev;
4169
4a9c7b33 4170 /* If the controller thinks we are 40 wire, we are. */
15a5551c
AC
4171 if (ap->cbl == ATA_CBL_PATA40)
4172 return 1;
4a9c7b33
TH
4173
4174 /* If the controller thinks we are 80 wire, we are. */
15a5551c
AC
4175 if (ap->cbl == ATA_CBL_PATA80 || ap->cbl == ATA_CBL_SATA)
4176 return 0;
4a9c7b33
TH
4177
4178 /* If the system is known to be 40 wire short cable (eg
4179 * laptop), then we allow 80 wire modes even if the drive
4180 * isn't sure.
4181 */
f792068e
AC
4182 if (ap->cbl == ATA_CBL_PATA40_SHORT)
4183 return 0;
4a9c7b33
TH
4184
4185 /* If the controller doesn't know, we scan.
4186 *
4187 * Note: We look for all 40 wire detects at this point. Any
4188 * 80 wire detect is taken to be 80 wire cable because
4189 * - in many setups only the one drive (slave if present) will
4190 * give a valid detect
4191 * - if you have a non detect capable drive you don't want it
4192 * to colour the choice
4193 */
1eca4365
TH
4194 ata_for_each_link(link, ap, EDGE) {
4195 ata_for_each_dev(dev, link, ENABLED) {
4196 if (!ata_is_40wire(dev))
15a5551c
AC
4197 return 0;
4198 }
4199 }
4200 return 1;
4201}
4202
a6d5a51c
TH
4203/**
4204 * ata_dev_xfermask - Compute supported xfermask of the given device
a6d5a51c
TH
4205 * @dev: Device to compute xfermask for
4206 *
acf356b1
TH
4207 * Compute supported xfermask of @dev and store it in
4208 * dev->*_mask. This function is responsible for applying all
4209 * known limits including host controller limits, device
4210 * blacklist, etc...
a6d5a51c
TH
4211 *
4212 * LOCKING:
4213 * None.
a6d5a51c 4214 */
3373efd8 4215static void ata_dev_xfermask(struct ata_device *dev)
1da177e4 4216{
9af5c9c9
TH
4217 struct ata_link *link = dev->link;
4218 struct ata_port *ap = link->ap;
cca3974e 4219 struct ata_host *host = ap->host;
f0a6d77b 4220 unsigned int xfer_mask;
1da177e4 4221
37deecb5 4222 /* controller modes available */
565083e1
TH
4223 xfer_mask = ata_pack_xfermask(ap->pio_mask,
4224 ap->mwdma_mask, ap->udma_mask);
4225
8343f889 4226 /* drive modes available */
37deecb5
TH
4227 xfer_mask &= ata_pack_xfermask(dev->pio_mask,
4228 dev->mwdma_mask, dev->udma_mask);
4229 xfer_mask &= ata_id_xfermask(dev->id);
565083e1 4230
b352e57d
AC
4231 /*
4232 * CFA Advanced TrueIDE timings are not allowed on a shared
4233 * cable
4234 */
4235 if (ata_dev_pair(dev)) {
4236 /* No PIO5 or PIO6 */
4237 xfer_mask &= ~(0x03 << (ATA_SHIFT_PIO + 5));
4238 /* No MWDMA3 or MWDMA 4 */
4239 xfer_mask &= ~(0x03 << (ATA_SHIFT_MWDMA + 3));
4240 }
4241
37deecb5
TH
4242 if (ata_dma_blacklisted(dev)) {
4243 xfer_mask &= ~(ATA_MASK_MWDMA | ATA_MASK_UDMA);
a9a79dfe
JP
4244 ata_dev_warn(dev,
4245 "device is on DMA blacklist, disabling DMA\n");
37deecb5 4246 }
a6d5a51c 4247
14d66ab7 4248 if ((host->flags & ATA_HOST_SIMPLEX) &&
2dcb407e 4249 host->simplex_claimed && host->simplex_claimed != ap) {
37deecb5 4250 xfer_mask &= ~(ATA_MASK_MWDMA | ATA_MASK_UDMA);
a9a79dfe
JP
4251 ata_dev_warn(dev,
4252 "simplex DMA is claimed by other device, disabling DMA\n");
5444a6f4 4253 }
565083e1 4254
e424675f
JG
4255 if (ap->flags & ATA_FLAG_NO_IORDY)
4256 xfer_mask &= ata_pio_mask_no_iordy(dev);
4257
5444a6f4 4258 if (ap->ops->mode_filter)
a76b62ca 4259 xfer_mask = ap->ops->mode_filter(dev, xfer_mask);
5444a6f4 4260
8343f889
RH
4261 /* Apply cable rule here. Don't apply it early because when
4262 * we handle hot plug the cable type can itself change.
4263 * Check this last so that we know if the transfer rate was
4264 * solely limited by the cable.
4265 * Unknown or 80 wire cables reported host side are checked
4266 * drive side as well. Cases where we know a 40wire cable
4267 * is used safely for 80 are not checked here.
4268 */
4269 if (xfer_mask & (0xF8 << ATA_SHIFT_UDMA))
4270 /* UDMA/44 or higher would be available */
15a5551c 4271 if (cable_is_40wire(ap)) {
a9a79dfe
JP
4272 ata_dev_warn(dev,
4273 "limited to UDMA/33 due to 40-wire cable\n");
8343f889
RH
4274 xfer_mask &= ~(0xF8 << ATA_SHIFT_UDMA);
4275 }
4276
565083e1
TH
4277 ata_unpack_xfermask(xfer_mask, &dev->pio_mask,
4278 &dev->mwdma_mask, &dev->udma_mask);
1da177e4
LT
4279}
4280
1da177e4
LT
4281/**
4282 * ata_dev_set_xfermode - Issue SET FEATURES - XFER MODE command
1da177e4
LT
4283 * @dev: Device to which command will be sent
4284 *
780a87f7
JG
4285 * Issue SET FEATURES - XFER MODE command to device @dev
4286 * on port @ap.
4287 *
1da177e4 4288 * LOCKING:
0cba632b 4289 * PCI/etc. bus probe sem.
83206a29
TH
4290 *
4291 * RETURNS:
4292 * 0 on success, AC_ERR_* mask otherwise.
1da177e4
LT
4293 */
4294
3373efd8 4295static unsigned int ata_dev_set_xfermode(struct ata_device *dev)
1da177e4 4296{
a0123703 4297 struct ata_taskfile tf;
83206a29 4298 unsigned int err_mask;
1da177e4
LT
4299
4300 /* set up set-features taskfile */
4633778b 4301 ata_dev_dbg(dev, "set features - xfer mode\n");
1da177e4 4302
464cf177
TH
4303 /* Some controllers and ATAPI devices show flaky interrupt
4304 * behavior after setting xfer mode. Use polling instead.
4305 */
3373efd8 4306 ata_tf_init(dev, &tf);
a0123703
TH
4307 tf.command = ATA_CMD_SET_FEATURES;
4308 tf.feature = SETFEATURES_XFER;
464cf177 4309 tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE | ATA_TFLAG_POLLING;
a0123703 4310 tf.protocol = ATA_PROT_NODATA;
b9f8ab2d 4311 /* If we are using IORDY we must send the mode setting command */
11b7becc
JG
4312 if (ata_pio_need_iordy(dev))
4313 tf.nsect = dev->xfer_mode;
b9f8ab2d
AC
4314 /* If the device has IORDY and the controller does not - turn it off */
4315 else if (ata_id_has_iordy(dev->id))
11b7becc 4316 tf.nsect = 0x01;
b9f8ab2d
AC
4317 else /* In the ancient relic department - skip all of this */
4318 return 0;
1da177e4 4319
d531be2c
MP
4320 /* On some disks, this command causes spin-up, so we need longer timeout */
4321 err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 15000);
9f45cbd3 4322
9f45cbd3
KCA
4323 return err_mask;
4324}
1152b261 4325
9f45cbd3 4326/**
218f3d30 4327 * ata_dev_set_feature - Issue SET FEATURES - SATA FEATURES
9f45cbd3
KCA
4328 * @dev: Device to which command will be sent
4329 * @enable: Whether to enable or disable the feature
218f3d30 4330 * @feature: The sector count represents the feature to set
9f45cbd3
KCA
4331 *
4332 * Issue SET FEATURES - SATA FEATURES command to device @dev
218f3d30 4333 * on port @ap with sector count
9f45cbd3
KCA
4334 *
4335 * LOCKING:
4336 * PCI/etc. bus probe sem.
4337 *
4338 * RETURNS:
4339 * 0 on success, AC_ERR_* mask otherwise.
4340 */
1152b261 4341unsigned int ata_dev_set_feature(struct ata_device *dev, u8 enable, u8 feature)
9f45cbd3
KCA
4342{
4343 struct ata_taskfile tf;
4344 unsigned int err_mask;
61176eed 4345 unsigned int timeout = 0;
9f45cbd3
KCA
4346
4347 /* set up set-features taskfile */
4633778b 4348 ata_dev_dbg(dev, "set features - SATA features\n");
9f45cbd3
KCA
4349
4350 ata_tf_init(dev, &tf);
4351 tf.command = ATA_CMD_SET_FEATURES;
4352 tf.feature = enable;
4353 tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
4354 tf.protocol = ATA_PROT_NODATA;
218f3d30 4355 tf.nsect = feature;
9f45cbd3 4356
974e0a45
DLM
4357 if (enable == SETFEATURES_SPINUP)
4358 timeout = ata_probe_timeout ?
4359 ata_probe_timeout * 1000 : SETFEATURES_SPINUP_TIMEOUT;
4360 err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, timeout);
1da177e4 4361
83206a29 4362 return err_mask;
1da177e4 4363}
633de4cc 4364EXPORT_SYMBOL_GPL(ata_dev_set_feature);
1da177e4 4365
8bf62ece
AL
4366/**
4367 * ata_dev_init_params - Issue INIT DEV PARAMS command
8bf62ece 4368 * @dev: Device to which command will be sent
e2a7f77a
RD
4369 * @heads: Number of heads (taskfile parameter)
4370 * @sectors: Number of sectors (taskfile parameter)
8bf62ece
AL
4371 *
4372 * LOCKING:
6aff8f1f
TH
4373 * Kernel thread context (may sleep)
4374 *
4375 * RETURNS:
4376 * 0 on success, AC_ERR_* mask otherwise.
8bf62ece 4377 */
3373efd8
TH
4378static unsigned int ata_dev_init_params(struct ata_device *dev,
4379 u16 heads, u16 sectors)
8bf62ece 4380{
a0123703 4381 struct ata_taskfile tf;
6aff8f1f 4382 unsigned int err_mask;
8bf62ece
AL
4383
4384 /* Number of sectors per track 1-255. Number of heads 1-16 */
4385 if (sectors < 1 || sectors > 255 || heads < 1 || heads > 16)
00b6f5e9 4386 return AC_ERR_INVALID;
8bf62ece
AL
4387
4388 /* set up init dev params taskfile */
4633778b 4389 ata_dev_dbg(dev, "init dev params \n");
8bf62ece 4390
3373efd8 4391 ata_tf_init(dev, &tf);
a0123703
TH
4392 tf.command = ATA_CMD_INIT_DEV_PARAMS;
4393 tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
4394 tf.protocol = ATA_PROT_NODATA;
4395 tf.nsect = sectors;
4396 tf.device |= (heads - 1) & 0x0f; /* max head = num. of heads - 1 */
8bf62ece 4397
2b789108 4398 err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
18b2466c
AC
4399 /* A clean abort indicates an original or just out of spec drive
4400 and we should continue as we issue the setup based on the
4401 drive reported working geometry */
efcef265 4402 if (err_mask == AC_ERR_DEV && (tf.error & ATA_ABORTED))
18b2466c 4403 err_mask = 0;
8bf62ece 4404
6aff8f1f 4405 return err_mask;
8bf62ece
AL
4406}
4407
1da177e4 4408/**
5895ef9a 4409 * atapi_check_dma - Check whether ATAPI DMA can be supported
1da177e4
LT
4410 * @qc: Metadata associated with taskfile to check
4411 *
780a87f7
JG
4412 * Allow low-level driver to filter ATA PACKET commands, returning
4413 * a status indicating whether or not it is OK to use DMA for the
4414 * supplied PACKET command.
4415 *
1da177e4 4416 * LOCKING:
624d5c51
TH
4417 * spin_lock_irqsave(host lock)
4418 *
4419 * RETURNS: 0 when ATAPI DMA can be used
4420 * nonzero otherwise
4421 */
5895ef9a 4422int atapi_check_dma(struct ata_queued_cmd *qc)
624d5c51
TH
4423{
4424 struct ata_port *ap = qc->ap;
71601958 4425
624d5c51
TH
4426 /* Don't allow DMA if it isn't multiple of 16 bytes. Quite a
4427 * few ATAPI devices choke on such DMA requests.
4428 */
6a87e42e
TH
4429 if (!(qc->dev->horkage & ATA_HORKAGE_ATAPI_MOD16_DMA) &&
4430 unlikely(qc->nbytes & 15))
624d5c51 4431 return 1;
e2cec771 4432
624d5c51
TH
4433 if (ap->ops->check_atapi_dma)
4434 return ap->ops->check_atapi_dma(qc);
e2cec771 4435
624d5c51
TH
4436 return 0;
4437}
1da177e4 4438
624d5c51
TH
4439/**
4440 * ata_std_qc_defer - Check whether a qc needs to be deferred
4441 * @qc: ATA command in question
4442 *
4443 * Non-NCQ commands cannot run with any other command, NCQ or
4444 * not. As upper layer only knows the queue depth, we are
4445 * responsible for maintaining exclusion. This function checks
4446 * whether a new command @qc can be issued.
4447 *
4448 * LOCKING:
4449 * spin_lock_irqsave(host lock)
4450 *
4451 * RETURNS:
4452 * ATA_DEFER_* if deferring is needed, 0 otherwise.
4453 */
4454int ata_std_qc_defer(struct ata_queued_cmd *qc)
4455{
4456 struct ata_link *link = qc->dev->link;
e2cec771 4457
179b310a 4458 if (ata_is_ncq(qc->tf.protocol)) {
624d5c51
TH
4459 if (!ata_tag_valid(link->active_tag))
4460 return 0;
4461 } else {
4462 if (!ata_tag_valid(link->active_tag) && !link->sactive)
4463 return 0;
4464 }
e2cec771 4465
624d5c51
TH
4466 return ATA_DEFER_LINK;
4467}
a52fbcfc 4468EXPORT_SYMBOL_GPL(ata_std_qc_defer);
6912ccd5 4469
95364f36
JS
4470enum ata_completion_errors ata_noop_qc_prep(struct ata_queued_cmd *qc)
4471{
4472 return AC_ERR_OK;
4473}
a52fbcfc 4474EXPORT_SYMBOL_GPL(ata_noop_qc_prep);
1da177e4 4475
624d5c51
TH
4476/**
4477 * ata_sg_init - Associate command with scatter-gather table.
4478 * @qc: Command to be associated
4479 * @sg: Scatter-gather table.
4480 * @n_elem: Number of elements in s/g table.
4481 *
4482 * Initialize the data-related elements of queued_cmd @qc
4483 * to point to a scatter-gather table @sg, containing @n_elem
4484 * elements.
4485 *
4486 * LOCKING:
4487 * spin_lock_irqsave(host lock)
4488 */
4489void ata_sg_init(struct ata_queued_cmd *qc, struct scatterlist *sg,
4490 unsigned int n_elem)
4491{
4492 qc->sg = sg;
4493 qc->n_elem = n_elem;
4494 qc->cursg = qc->sg;
4495}
bb5cb290 4496
2874d5ee
GU
4497#ifdef CONFIG_HAS_DMA
4498
4499/**
4500 * ata_sg_clean - Unmap DMA memory associated with command
4501 * @qc: Command containing DMA memory to be released
4502 *
4503 * Unmap all mapped DMA memory associated with this command.
4504 *
4505 * LOCKING:
4506 * spin_lock_irqsave(host lock)
4507 */
af27e01c 4508static void ata_sg_clean(struct ata_queued_cmd *qc)
2874d5ee
GU
4509{
4510 struct ata_port *ap = qc->ap;
4511 struct scatterlist *sg = qc->sg;
4512 int dir = qc->dma_dir;
4513
4514 WARN_ON_ONCE(sg == NULL);
4515
2874d5ee
GU
4516 if (qc->n_elem)
4517 dma_unmap_sg(ap->dev, sg, qc->orig_n_elem, dir);
4518
4519 qc->flags &= ~ATA_QCFLAG_DMAMAP;
4520 qc->sg = NULL;
4521}
4522
624d5c51
TH
4523/**
4524 * ata_sg_setup - DMA-map the scatter-gather table associated with a command.
4525 * @qc: Command with scatter-gather table to be mapped.
4526 *
4527 * DMA-map the scatter-gather table associated with queued_cmd @qc.
4528 *
4529 * LOCKING:
4530 * spin_lock_irqsave(host lock)
4531 *
4532 * RETURNS:
4533 * Zero on success, negative on error.
4534 *
4535 */
4536static int ata_sg_setup(struct ata_queued_cmd *qc)
4537{
4538 struct ata_port *ap = qc->ap;
4539 unsigned int n_elem;
1da177e4 4540
624d5c51
TH
4541 n_elem = dma_map_sg(ap->dev, qc->sg, qc->n_elem, qc->dma_dir);
4542 if (n_elem < 1)
4543 return -1;
bb5cb290 4544
5825627c 4545 qc->orig_n_elem = qc->n_elem;
624d5c51
TH
4546 qc->n_elem = n_elem;
4547 qc->flags |= ATA_QCFLAG_DMAMAP;
1da177e4 4548
624d5c51 4549 return 0;
1da177e4
LT
4550}
4551
2874d5ee
GU
4552#else /* !CONFIG_HAS_DMA */
4553
4554static inline void ata_sg_clean(struct ata_queued_cmd *qc) {}
4555static inline int ata_sg_setup(struct ata_queued_cmd *qc) { return -1; }
4556
4557#endif /* !CONFIG_HAS_DMA */
4558
624d5c51
TH
4559/**
4560 * swap_buf_le16 - swap halves of 16-bit words in place
4561 * @buf: Buffer to swap
4562 * @buf_words: Number of 16-bit words in buffer.
4563 *
4564 * Swap halves of 16-bit words if needed to convert from
4565 * little-endian byte order to native cpu byte order, or
4566 * vice-versa.
4567 *
4568 * LOCKING:
4569 * Inherited from caller.
4570 */
4571void swap_buf_le16(u16 *buf, unsigned int buf_words)
8061f5f0 4572{
624d5c51
TH
4573#ifdef __BIG_ENDIAN
4574 unsigned int i;
8061f5f0 4575
624d5c51
TH
4576 for (i = 0; i < buf_words; i++)
4577 buf[i] = le16_to_cpu(buf[i]);
4578#endif /* __BIG_ENDIAN */
8061f5f0
TH
4579}
4580
8a8bc223
TH
4581/**
4582 * ata_qc_free - free unused ata_queued_cmd
4583 * @qc: Command to complete
4584 *
4585 * Designed to free unused ata_queued_cmd object
4586 * in case something prevents using it.
4587 *
4588 * LOCKING:
4589 * spin_lock_irqsave(host lock)
4590 */
4591void ata_qc_free(struct ata_queued_cmd *qc)
4592{
8a8bc223 4593 qc->flags = 0;
4f1a22ee 4594 if (ata_tag_valid(qc->tag))
8a8bc223 4595 qc->tag = ATA_TAG_POISON;
8a8bc223
TH
4596}
4597
76014427 4598void __ata_qc_complete(struct ata_queued_cmd *qc)
1da177e4 4599{
a1104016
JL
4600 struct ata_port *ap;
4601 struct ata_link *link;
dedaf2b0 4602
efcb3cf7
TH
4603 WARN_ON_ONCE(qc == NULL); /* ata_qc_from_tag _might_ return NULL */
4604 WARN_ON_ONCE(!(qc->flags & ATA_QCFLAG_ACTIVE));
a1104016
JL
4605 ap = qc->ap;
4606 link = qc->dev->link;
1da177e4
LT
4607
4608 if (likely(qc->flags & ATA_QCFLAG_DMAMAP))
4609 ata_sg_clean(qc);
4610
7401abf2 4611 /* command should be marked inactive atomically with qc completion */
179b310a 4612 if (ata_is_ncq(qc->tf.protocol)) {
4e5b6260 4613 link->sactive &= ~(1 << qc->hw_tag);
da917d69
TH
4614 if (!link->sactive)
4615 ap->nr_active_links--;
4616 } else {
9af5c9c9 4617 link->active_tag = ATA_TAG_POISON;
da917d69
TH
4618 ap->nr_active_links--;
4619 }
4620
4621 /* clear exclusive status */
4622 if (unlikely(qc->flags & ATA_QCFLAG_CLEAR_EXCL &&
4623 ap->excl_link == link))
4624 ap->excl_link = NULL;
7401abf2 4625
3f3791d3
AL
4626 /* atapi: mark qc as inactive to prevent the interrupt handler
4627 * from completing the command twice later, before the error handler
4628 * is called. (when rc != 0 and atapi request sense is needed)
4629 */
4630 qc->flags &= ~ATA_QCFLAG_ACTIVE;
e3ed8939 4631 ap->qc_active &= ~(1ULL << qc->tag);
3f3791d3 4632
1da177e4 4633 /* call completion callback */
77853bf2 4634 qc->complete_fn(qc);
1da177e4
LT
4635}
4636
39599a53
TH
4637static void fill_result_tf(struct ata_queued_cmd *qc)
4638{
4639 struct ata_port *ap = qc->ap;
4640
39599a53 4641 qc->result_tf.flags = qc->tf.flags;
22183bf5 4642 ap->ops->qc_fill_rtf(qc);
39599a53
TH
4643}
4644
00115e0f
TH
4645static void ata_verify_xfer(struct ata_queued_cmd *qc)
4646{
4647 struct ata_device *dev = qc->dev;
4648
eb0effdf 4649 if (!ata_is_data(qc->tf.protocol))
00115e0f
TH
4650 return;
4651
4652 if ((dev->mwdma_mask || dev->udma_mask) && ata_is_pio(qc->tf.protocol))
4653 return;
4654
4655 dev->flags &= ~ATA_DFLAG_DUBIOUS_XFER;
4656}
4657
f686bcb8
TH
4658/**
4659 * ata_qc_complete - Complete an active ATA command
4660 * @qc: Command to complete
f686bcb8 4661 *
1aadf5c3
TH
4662 * Indicate to the mid and upper layers that an ATA command has
4663 * completed, with either an ok or not-ok status.
4664 *
4665 * Refrain from calling this function multiple times when
4666 * successfully completing multiple NCQ commands.
4667 * ata_qc_complete_multiple() should be used instead, which will
4668 * properly update IRQ expect state.
f686bcb8
TH
4669 *
4670 * LOCKING:
cca3974e 4671 * spin_lock_irqsave(host lock)
f686bcb8
TH
4672 */
4673void ata_qc_complete(struct ata_queued_cmd *qc)
4674{
4675 struct ata_port *ap = qc->ap;
4676
eb25cb99 4677 /* Trigger the LED (if available) */
d1ed7c55 4678 ledtrig_disk_activity(!!(qc->tf.flags & ATA_TFLAG_WRITE));
eb25cb99 4679
f686bcb8
TH
4680 /* XXX: New EH and old EH use different mechanisms to
4681 * synchronize EH with regular execution path.
4682 *
4683 * In new EH, a failed qc is marked with ATA_QCFLAG_FAILED.
4684 * Normal execution path is responsible for not accessing a
4685 * failed qc. libata core enforces the rule by returning NULL
4686 * from ata_qc_from_tag() for failed qcs.
4687 *
4688 * Old EH depends on ata_qc_complete() nullifying completion
4689 * requests if ATA_QCFLAG_EH_SCHEDULED is set. Old EH does
4690 * not synchronize with interrupt handler. Only PIO task is
4691 * taken care of.
4692 */
4693 if (ap->ops->error_handler) {
4dbfa39b
TH
4694 struct ata_device *dev = qc->dev;
4695 struct ata_eh_info *ehi = &dev->link->eh_info;
4696
f686bcb8
TH
4697 if (unlikely(qc->err_mask))
4698 qc->flags |= ATA_QCFLAG_FAILED;
4699
f08dc1ac
TH
4700 /*
4701 * Finish internal commands without any further processing
4702 * and always with the result TF filled.
4703 */
4704 if (unlikely(ata_tag_internal(qc->tag))) {
f4b31db9 4705 fill_result_tf(qc);
255c03d1 4706 trace_ata_qc_complete_internal(qc);
f08dc1ac
TH
4707 __ata_qc_complete(qc);
4708 return;
4709 }
f4b31db9 4710
f08dc1ac
TH
4711 /*
4712 * Non-internal qc has failed. Fill the result TF and
4713 * summon EH.
4714 */
4715 if (unlikely(qc->flags & ATA_QCFLAG_FAILED)) {
4716 fill_result_tf(qc);
255c03d1 4717 trace_ata_qc_complete_failed(qc);
f08dc1ac 4718 ata_qc_schedule_eh(qc);
f4b31db9 4719 return;
f686bcb8
TH
4720 }
4721
4dc738ed
TH
4722 WARN_ON_ONCE(ap->pflags & ATA_PFLAG_FROZEN);
4723
f686bcb8
TH
4724 /* read result TF if requested */
4725 if (qc->flags & ATA_QCFLAG_RESULT_TF)
39599a53 4726 fill_result_tf(qc);
f686bcb8 4727
255c03d1 4728 trace_ata_qc_complete_done(qc);
4dbfa39b
TH
4729 /* Some commands need post-processing after successful
4730 * completion.
4731 */
4732 switch (qc->tf.command) {
4733 case ATA_CMD_SET_FEATURES:
4734 if (qc->tf.feature != SETFEATURES_WC_ON &&
0c12735e
TY
4735 qc->tf.feature != SETFEATURES_WC_OFF &&
4736 qc->tf.feature != SETFEATURES_RA_ON &&
4737 qc->tf.feature != SETFEATURES_RA_OFF)
4dbfa39b 4738 break;
df561f66 4739 fallthrough;
4dbfa39b
TH
4740 case ATA_CMD_INIT_DEV_PARAMS: /* CHS translation changed */
4741 case ATA_CMD_SET_MULTI: /* multi_count changed */
4742 /* revalidate device */
4743 ehi->dev_action[dev->devno] |= ATA_EH_REVALIDATE;
4744 ata_port_schedule_eh(ap);
4745 break;
054a5fba
TH
4746
4747 case ATA_CMD_SLEEP:
4748 dev->flags |= ATA_DFLAG_SLEEPING;
4749 break;
4dbfa39b
TH
4750 }
4751
00115e0f
TH
4752 if (unlikely(dev->flags & ATA_DFLAG_DUBIOUS_XFER))
4753 ata_verify_xfer(qc);
4754
f686bcb8
TH
4755 __ata_qc_complete(qc);
4756 } else {
4757 if (qc->flags & ATA_QCFLAG_EH_SCHEDULED)
4758 return;
4759
4760 /* read result TF if failed or requested */
4761 if (qc->err_mask || qc->flags & ATA_QCFLAG_RESULT_TF)
39599a53 4762 fill_result_tf(qc);
f686bcb8
TH
4763
4764 __ata_qc_complete(qc);
4765 }
4766}
a52fbcfc 4767EXPORT_SYMBOL_GPL(ata_qc_complete);
f686bcb8 4768
8385d756
SH
4769/**
4770 * ata_qc_get_active - get bitmask of active qcs
4771 * @ap: port in question
4772 *
4773 * LOCKING:
4774 * spin_lock_irqsave(host lock)
4775 *
4776 * RETURNS:
4777 * Bitmask of active qcs
4778 */
4779u64 ata_qc_get_active(struct ata_port *ap)
4780{
4781 u64 qc_active = ap->qc_active;
4782
4783 /* ATA_TAG_INTERNAL is sent to hw as tag 0 */
4784 if (qc_active & (1ULL << ATA_TAG_INTERNAL)) {
4785 qc_active |= (1 << 0);
4786 qc_active &= ~(1ULL << ATA_TAG_INTERNAL);
4787 }
4788
4789 return qc_active;
4790}
4791EXPORT_SYMBOL_GPL(ata_qc_get_active);
4792
1da177e4
LT
4793/**
4794 * ata_qc_issue - issue taskfile to device
4795 * @qc: command to issue to device
4796 *
4797 * Prepare an ATA command to submission to device.
4798 * This includes mapping the data into a DMA-able
4799 * area, filling in the S/G table, and finally
4800 * writing the taskfile to hardware, starting the command.
4801 *
4802 * LOCKING:
cca3974e 4803 * spin_lock_irqsave(host lock)
1da177e4 4804 */
8e0e694a 4805void ata_qc_issue(struct ata_queued_cmd *qc)
1da177e4
LT
4806{
4807 struct ata_port *ap = qc->ap;
9af5c9c9 4808 struct ata_link *link = qc->dev->link;
405e66b3 4809 u8 prot = qc->tf.protocol;
1da177e4 4810
dedaf2b0
TH
4811 /* Make sure only one non-NCQ command is outstanding. The
4812 * check is skipped for old EH because it reuses active qc to
4813 * request ATAPI sense.
4814 */
efcb3cf7 4815 WARN_ON_ONCE(ap->ops->error_handler && ata_tag_valid(link->active_tag));
dedaf2b0 4816
1973a023 4817 if (ata_is_ncq(prot)) {
4e5b6260 4818 WARN_ON_ONCE(link->sactive & (1 << qc->hw_tag));
da917d69
TH
4819
4820 if (!link->sactive)
4821 ap->nr_active_links++;
4e5b6260 4822 link->sactive |= 1 << qc->hw_tag;
dedaf2b0 4823 } else {
efcb3cf7 4824 WARN_ON_ONCE(link->sactive);
da917d69
TH
4825
4826 ap->nr_active_links++;
9af5c9c9 4827 link->active_tag = qc->tag;
dedaf2b0
TH
4828 }
4829
e4a70e76 4830 qc->flags |= ATA_QCFLAG_ACTIVE;
e3ed8939 4831 ap->qc_active |= 1ULL << qc->tag;
e4a70e76 4832
60f5d6ef
TH
4833 /*
4834 * We guarantee to LLDs that they will have at least one
f92a2636
TH
4835 * non-zero sg if the command is a data command.
4836 */
9173e5e8 4837 if (ata_is_data(prot) && (!qc->sg || !qc->n_elem || !qc->nbytes))
60f5d6ef 4838 goto sys_err;
f92a2636 4839
405e66b3 4840 if (ata_is_dma(prot) || (ata_is_pio(prot) &&
f92a2636 4841 (ap->flags & ATA_FLAG_PIO_DMA)))
001102d7 4842 if (ata_sg_setup(qc))
60f5d6ef 4843 goto sys_err;
1da177e4 4844
cf480626 4845 /* if device is sleeping, schedule reset and abort the link */
054a5fba 4846 if (unlikely(qc->dev->flags & ATA_DFLAG_SLEEPING)) {
cf480626 4847 link->eh_info.action |= ATA_EH_RESET;
054a5fba
TH
4848 ata_ehi_push_desc(&link->eh_info, "waking up from sleep");
4849 ata_link_abort(link);
4850 return;
4851 }
4852
fc914faa 4853 trace_ata_qc_prep(qc);
95364f36
JS
4854 qc->err_mask |= ap->ops->qc_prep(qc);
4855 if (unlikely(qc->err_mask))
4856 goto err;
255c03d1 4857 trace_ata_qc_issue(qc);
8e0e694a
TH
4858 qc->err_mask |= ap->ops->qc_issue(qc);
4859 if (unlikely(qc->err_mask))
4860 goto err;
4861 return;
1da177e4 4862
60f5d6ef 4863sys_err:
8e0e694a
TH
4864 qc->err_mask |= AC_ERR_SYSTEM;
4865err:
4866 ata_qc_complete(qc);
1da177e4
LT
4867}
4868
34bf2170 4869/**
b1c72916 4870 * ata_phys_link_online - test whether the given link is online
936fd732 4871 * @link: ATA link to test
34bf2170 4872 *
936fd732
TH
4873 * Test whether @link is online. Note that this function returns
4874 * 0 if online status of @link cannot be obtained, so
4875 * ata_link_online(link) != !ata_link_offline(link).
34bf2170
TH
4876 *
4877 * LOCKING:
4878 * None.
4879 *
4880 * RETURNS:
b5b3fa38 4881 * True if the port online status is available and online.
34bf2170 4882 */
b1c72916 4883bool ata_phys_link_online(struct ata_link *link)
34bf2170
TH
4884{
4885 u32 sstatus;
4886
936fd732 4887 if (sata_scr_read(link, SCR_STATUS, &sstatus) == 0 &&
9913ff8a 4888 ata_sstatus_online(sstatus))
b5b3fa38
TH
4889 return true;
4890 return false;
34bf2170
TH
4891}
4892
4893/**
b1c72916 4894 * ata_phys_link_offline - test whether the given link is offline
936fd732 4895 * @link: ATA link to test
34bf2170 4896 *
936fd732
TH
4897 * Test whether @link is offline. Note that this function
4898 * returns 0 if offline status of @link cannot be obtained, so
4899 * ata_link_online(link) != !ata_link_offline(link).
34bf2170
TH
4900 *
4901 * LOCKING:
4902 * None.
4903 *
4904 * RETURNS:
b5b3fa38 4905 * True if the port offline status is available and offline.
34bf2170 4906 */
b1c72916 4907bool ata_phys_link_offline(struct ata_link *link)
34bf2170
TH
4908{
4909 u32 sstatus;
4910
936fd732 4911 if (sata_scr_read(link, SCR_STATUS, &sstatus) == 0 &&
9913ff8a 4912 !ata_sstatus_online(sstatus))
b5b3fa38
TH
4913 return true;
4914 return false;
34bf2170 4915}
0baab86b 4916
b1c72916
TH
4917/**
4918 * ata_link_online - test whether the given link is online
4919 * @link: ATA link to test
4920 *
4921 * Test whether @link is online. This is identical to
4922 * ata_phys_link_online() when there's no slave link. When
4923 * there's a slave link, this function should only be called on
4924 * the master link and will return true if any of M/S links is
4925 * online.
4926 *
4927 * LOCKING:
4928 * None.
4929 *
4930 * RETURNS:
4931 * True if the port online status is available and online.
4932 */
4933bool ata_link_online(struct ata_link *link)
4934{
4935 struct ata_link *slave = link->ap->slave_link;
4936
4937 WARN_ON(link == slave); /* shouldn't be called on slave link */
4938
4939 return ata_phys_link_online(link) ||
4940 (slave && ata_phys_link_online(slave));
4941}
a52fbcfc 4942EXPORT_SYMBOL_GPL(ata_link_online);
b1c72916
TH
4943
4944/**
4945 * ata_link_offline - test whether the given link is offline
4946 * @link: ATA link to test
4947 *
4948 * Test whether @link is offline. This is identical to
4949 * ata_phys_link_offline() when there's no slave link. When
4950 * there's a slave link, this function should only be called on
4951 * the master link and will return true if both M/S links are
4952 * offline.
4953 *
4954 * LOCKING:
4955 * None.
4956 *
4957 * RETURNS:
4958 * True if the port offline status is available and offline.
4959 */
4960bool ata_link_offline(struct ata_link *link)
4961{
4962 struct ata_link *slave = link->ap->slave_link;
4963
4964 WARN_ON(link == slave); /* shouldn't be called on slave link */
4965
4966 return ata_phys_link_offline(link) &&
4967 (!slave || ata_phys_link_offline(slave));
4968}
a52fbcfc 4969EXPORT_SYMBOL_GPL(ata_link_offline);
b1c72916 4970
6ffa01d8 4971#ifdef CONFIG_PM
bc6e7c4b
DW
4972static void ata_port_request_pm(struct ata_port *ap, pm_message_t mesg,
4973 unsigned int action, unsigned int ehi_flags,
4974 bool async)
500530f6 4975{
5ef41082 4976 struct ata_link *link;
500530f6 4977 unsigned long flags;
500530f6 4978
5ef41082
LM
4979 /* Previous resume operation might still be in
4980 * progress. Wait for PM_PENDING to clear.
4981 */
4982 if (ap->pflags & ATA_PFLAG_PM_PENDING) {
4983 ata_port_wait_eh(ap);
4984 WARN_ON(ap->pflags & ATA_PFLAG_PM_PENDING);
4985 }
500530f6 4986
5ef41082
LM
4987 /* request PM ops to EH */
4988 spin_lock_irqsave(ap->lock, flags);
500530f6 4989
5ef41082 4990 ap->pm_mesg = mesg;
5ef41082
LM
4991 ap->pflags |= ATA_PFLAG_PM_PENDING;
4992 ata_for_each_link(link, ap, HOST_FIRST) {
4993 link->eh_info.action |= action;
4994 link->eh_info.flags |= ehi_flags;
4995 }
500530f6 4996
5ef41082 4997 ata_port_schedule_eh(ap);
500530f6 4998
5ef41082 4999 spin_unlock_irqrestore(ap->lock, flags);
500530f6 5000
2fcbdcb4 5001 if (!async) {
5ef41082
LM
5002 ata_port_wait_eh(ap);
5003 WARN_ON(ap->pflags & ATA_PFLAG_PM_PENDING);
500530f6 5004 }
500530f6
TH
5005}
5006
bc6e7c4b
DW
5007/*
5008 * On some hardware, device fails to respond after spun down for suspend. As
5009 * the device won't be used before being resumed, we don't need to touch the
5010 * device. Ask EH to skip the usual stuff and proceed directly to suspend.
5011 *
5012 * http://thread.gmane.org/gmane.linux.ide/46764
5013 */
5014static const unsigned int ata_port_suspend_ehi = ATA_EHI_QUIET
5015 | ATA_EHI_NO_AUTOPSY
5016 | ATA_EHI_NO_RECOVERY;
5017
5018static void ata_port_suspend(struct ata_port *ap, pm_message_t mesg)
5ef41082 5019{
bc6e7c4b 5020 ata_port_request_pm(ap, mesg, 0, ata_port_suspend_ehi, false);
5ef41082
LM
5021}
5022
bc6e7c4b 5023static void ata_port_suspend_async(struct ata_port *ap, pm_message_t mesg)
2fcbdcb4 5024{
bc6e7c4b 5025 ata_port_request_pm(ap, mesg, 0, ata_port_suspend_ehi, true);
2fcbdcb4
DW
5026}
5027
bc6e7c4b 5028static int ata_port_pm_suspend(struct device *dev)
5ef41082 5029{
bc6e7c4b
DW
5030 struct ata_port *ap = to_ata_port(dev);
5031
5ef41082
LM
5032 if (pm_runtime_suspended(dev))
5033 return 0;
5034
bc6e7c4b
DW
5035 ata_port_suspend(ap, PMSG_SUSPEND);
5036 return 0;
33574d68
LM
5037}
5038
bc6e7c4b 5039static int ata_port_pm_freeze(struct device *dev)
33574d68 5040{
bc6e7c4b
DW
5041 struct ata_port *ap = to_ata_port(dev);
5042
33574d68 5043 if (pm_runtime_suspended(dev))
f5e6d0d0 5044 return 0;
33574d68 5045
bc6e7c4b
DW
5046 ata_port_suspend(ap, PMSG_FREEZE);
5047 return 0;
33574d68
LM
5048}
5049
bc6e7c4b 5050static int ata_port_pm_poweroff(struct device *dev)
33574d68 5051{
bc6e7c4b
DW
5052 ata_port_suspend(to_ata_port(dev), PMSG_HIBERNATE);
5053 return 0;
5ef41082
LM
5054}
5055
bc6e7c4b
DW
5056static const unsigned int ata_port_resume_ehi = ATA_EHI_NO_AUTOPSY
5057 | ATA_EHI_QUIET;
5ef41082 5058
bc6e7c4b
DW
5059static void ata_port_resume(struct ata_port *ap, pm_message_t mesg)
5060{
5061 ata_port_request_pm(ap, mesg, ATA_EH_RESET, ata_port_resume_ehi, false);
5ef41082
LM
5062}
5063
bc6e7c4b 5064static void ata_port_resume_async(struct ata_port *ap, pm_message_t mesg)
2fcbdcb4 5065{
bc6e7c4b 5066 ata_port_request_pm(ap, mesg, ATA_EH_RESET, ata_port_resume_ehi, true);
2fcbdcb4
DW
5067}
5068
bc6e7c4b 5069static int ata_port_pm_resume(struct device *dev)
e90b1e5a 5070{
200421a8 5071 ata_port_resume_async(to_ata_port(dev), PMSG_RESUME);
bc6e7c4b
DW
5072 pm_runtime_disable(dev);
5073 pm_runtime_set_active(dev);
5074 pm_runtime_enable(dev);
5075 return 0;
e90b1e5a
LM
5076}
5077
7e15e9be
AL
5078/*
5079 * For ODDs, the upper layer will poll for media change every few seconds,
5080 * which will make it enter and leave suspend state every few seconds. And
5081 * as each suspend will cause a hard/soft reset, the gain of runtime suspend
5082 * is very little and the ODD may malfunction after constantly being reset.
5083 * So the idle callback here will not proceed to suspend if a non-ZPODD capable
5084 * ODD is attached to the port.
5085 */
9ee4f393
LM
5086static int ata_port_runtime_idle(struct device *dev)
5087{
7e15e9be
AL
5088 struct ata_port *ap = to_ata_port(dev);
5089 struct ata_link *link;
5090 struct ata_device *adev;
5091
5092 ata_for_each_link(link, ap, HOST_FIRST) {
5093 ata_for_each_dev(adev, link, ENABLED)
5094 if (adev->class == ATA_DEV_ATAPI &&
5095 !zpodd_dev_enabled(adev))
5096 return -EBUSY;
5097 }
5098
45f0a85c 5099 return 0;
9ee4f393
LM
5100}
5101
a7ff60db
AL
5102static int ata_port_runtime_suspend(struct device *dev)
5103{
bc6e7c4b
DW
5104 ata_port_suspend(to_ata_port(dev), PMSG_AUTO_SUSPEND);
5105 return 0;
a7ff60db
AL
5106}
5107
5108static int ata_port_runtime_resume(struct device *dev)
5109{
bc6e7c4b
DW
5110 ata_port_resume(to_ata_port(dev), PMSG_AUTO_RESUME);
5111 return 0;
a7ff60db
AL
5112}
5113
5ef41082 5114static const struct dev_pm_ops ata_port_pm_ops = {
bc6e7c4b
DW
5115 .suspend = ata_port_pm_suspend,
5116 .resume = ata_port_pm_resume,
5117 .freeze = ata_port_pm_freeze,
5118 .thaw = ata_port_pm_resume,
5119 .poweroff = ata_port_pm_poweroff,
5120 .restore = ata_port_pm_resume,
9ee4f393 5121
a7ff60db
AL
5122 .runtime_suspend = ata_port_runtime_suspend,
5123 .runtime_resume = ata_port_runtime_resume,
9ee4f393 5124 .runtime_idle = ata_port_runtime_idle,
5ef41082
LM
5125};
5126
2fcbdcb4
DW
5127/* sas ports don't participate in pm runtime management of ata_ports,
5128 * and need to resume ata devices at the domain level, not the per-port
5129 * level. sas suspend/resume is async to allow parallel port recovery
5130 * since sas has multiple ata_port instances per Scsi_Host.
5131 */
bc6e7c4b 5132void ata_sas_port_suspend(struct ata_port *ap)
2fcbdcb4 5133{
bc6e7c4b 5134 ata_port_suspend_async(ap, PMSG_SUSPEND);
2fcbdcb4 5135}
bc6e7c4b 5136EXPORT_SYMBOL_GPL(ata_sas_port_suspend);
2fcbdcb4 5137
bc6e7c4b 5138void ata_sas_port_resume(struct ata_port *ap)
2fcbdcb4 5139{
bc6e7c4b 5140 ata_port_resume_async(ap, PMSG_RESUME);
2fcbdcb4 5141}
bc6e7c4b 5142EXPORT_SYMBOL_GPL(ata_sas_port_resume);
2fcbdcb4 5143
500530f6 5144/**
cca3974e
JG
5145 * ata_host_suspend - suspend host
5146 * @host: host to suspend
500530f6
TH
5147 * @mesg: PM message
5148 *
5ef41082 5149 * Suspend @host. Actual operation is performed by port suspend.
500530f6 5150 */
ec87cf37 5151void ata_host_suspend(struct ata_host *host, pm_message_t mesg)
500530f6 5152{
5ef41082 5153 host->dev->power.power_state = mesg;
500530f6 5154}
a52fbcfc 5155EXPORT_SYMBOL_GPL(ata_host_suspend);
500530f6
TH
5156
5157/**
cca3974e
JG
5158 * ata_host_resume - resume host
5159 * @host: host to resume
500530f6 5160 *
5ef41082 5161 * Resume @host. Actual operation is performed by port resume.
500530f6 5162 */
cca3974e 5163void ata_host_resume(struct ata_host *host)
500530f6 5164{
72ad6ec4 5165 host->dev->power.power_state = PMSG_ON;
500530f6 5166}
a52fbcfc 5167EXPORT_SYMBOL_GPL(ata_host_resume);
6ffa01d8 5168#endif
500530f6 5169
8df82c13 5170const struct device_type ata_port_type = {
5ef41082
LM
5171 .name = "ata_port",
5172#ifdef CONFIG_PM
5173 .pm = &ata_port_pm_ops,
5174#endif
5175};
5176
3ef3b43d
TH
5177/**
5178 * ata_dev_init - Initialize an ata_device structure
5179 * @dev: Device structure to initialize
5180 *
5181 * Initialize @dev in preparation for probing.
5182 *
5183 * LOCKING:
5184 * Inherited from caller.
5185 */
5186void ata_dev_init(struct ata_device *dev)
5187{
b1c72916 5188 struct ata_link *link = ata_dev_phys_link(dev);
9af5c9c9 5189 struct ata_port *ap = link->ap;
72fa4b74
TH
5190 unsigned long flags;
5191
b1c72916 5192 /* SATA spd limit is bound to the attached device, reset together */
9af5c9c9
TH
5193 link->sata_spd_limit = link->hw_sata_spd_limit;
5194 link->sata_spd = 0;
5a04bf4b 5195
72fa4b74
TH
5196 /* High bits of dev->flags are used to record warm plug
5197 * requests which occur asynchronously. Synchronize using
cca3974e 5198 * host lock.
72fa4b74 5199 */
ba6a1308 5200 spin_lock_irqsave(ap->lock, flags);
72fa4b74 5201 dev->flags &= ~ATA_DFLAG_INIT_MASK;
3dcc323f 5202 dev->horkage = 0;
ba6a1308 5203 spin_unlock_irqrestore(ap->lock, flags);
3ef3b43d 5204
99cf610a
TH
5205 memset((void *)dev + ATA_DEVICE_CLEAR_BEGIN, 0,
5206 ATA_DEVICE_CLEAR_END - ATA_DEVICE_CLEAR_BEGIN);
3ef3b43d
TH
5207 dev->pio_mask = UINT_MAX;
5208 dev->mwdma_mask = UINT_MAX;
5209 dev->udma_mask = UINT_MAX;
5210}
5211
4fb37a25
TH
5212/**
5213 * ata_link_init - Initialize an ata_link structure
5214 * @ap: ATA port link is attached to
5215 * @link: Link structure to initialize
8989805d 5216 * @pmp: Port multiplier port number
4fb37a25
TH
5217 *
5218 * Initialize @link.
5219 *
5220 * LOCKING:
5221 * Kernel thread context (may sleep)
5222 */
fb7fd614 5223void ata_link_init(struct ata_port *ap, struct ata_link *link, int pmp)
4fb37a25
TH
5224{
5225 int i;
5226
5227 /* clear everything except for devices */
d9027470
GG
5228 memset((void *)link + ATA_LINK_CLEAR_BEGIN, 0,
5229 ATA_LINK_CLEAR_END - ATA_LINK_CLEAR_BEGIN);
4fb37a25
TH
5230
5231 link->ap = ap;
8989805d 5232 link->pmp = pmp;
4fb37a25
TH
5233 link->active_tag = ATA_TAG_POISON;
5234 link->hw_sata_spd_limit = UINT_MAX;
5235
5236 /* can't use iterator, ap isn't initialized yet */
5237 for (i = 0; i < ATA_MAX_DEVICES; i++) {
5238 struct ata_device *dev = &link->device[i];
5239
5240 dev->link = link;
5241 dev->devno = dev - link->device;
110f66d2
TH
5242#ifdef CONFIG_ATA_ACPI
5243 dev->gtf_filter = ata_acpi_gtf_filter;
5244#endif
4fb37a25
TH
5245 ata_dev_init(dev);
5246 }
5247}
5248
5249/**
5250 * sata_link_init_spd - Initialize link->sata_spd_limit
5251 * @link: Link to configure sata_spd_limit for
5252 *
a31a6997 5253 * Initialize ``link->[hw_]sata_spd_limit`` to the currently
4fb37a25
TH
5254 * configured value.
5255 *
5256 * LOCKING:
5257 * Kernel thread context (may sleep).
5258 *
5259 * RETURNS:
5260 * 0 on success, -errno on failure.
5261 */
fb7fd614 5262int sata_link_init_spd(struct ata_link *link)
4fb37a25 5263{
33267325 5264 u8 spd;
4fb37a25
TH
5265 int rc;
5266
d127ea7b 5267 rc = sata_scr_read(link, SCR_CONTROL, &link->saved_scontrol);
4fb37a25
TH
5268 if (rc)
5269 return rc;
5270
d127ea7b 5271 spd = (link->saved_scontrol >> 4) & 0xf;
4fb37a25
TH
5272 if (spd)
5273 link->hw_sata_spd_limit &= (1 << spd) - 1;
5274
05944bdf 5275 ata_force_link_limits(link);
33267325 5276
4fb37a25
TH
5277 link->sata_spd_limit = link->hw_sata_spd_limit;
5278
5279 return 0;
5280}
5281
1da177e4 5282/**
f3187195
TH
5283 * ata_port_alloc - allocate and initialize basic ATA port resources
5284 * @host: ATA host this allocated port belongs to
1da177e4 5285 *
f3187195
TH
5286 * Allocate and initialize basic ATA port resources.
5287 *
5288 * RETURNS:
5289 * Allocate ATA port on success, NULL on failure.
0cba632b 5290 *
1da177e4 5291 * LOCKING:
f3187195 5292 * Inherited from calling layer (may sleep).
1da177e4 5293 */
f3187195 5294struct ata_port *ata_port_alloc(struct ata_host *host)
1da177e4 5295{
f3187195 5296 struct ata_port *ap;
1da177e4 5297
f3187195
TH
5298 ap = kzalloc(sizeof(*ap), GFP_KERNEL);
5299 if (!ap)
5300 return NULL;
4fca377f 5301
7b3a24c5 5302 ap->pflags |= ATA_PFLAG_INITIALIZING | ATA_PFLAG_FROZEN;
cca3974e 5303 ap->lock = &host->lock;
f3187195 5304 ap->print_id = -1;
e628dc99 5305 ap->local_port_no = -1;
cca3974e 5306 ap->host = host;
f3187195 5307 ap->dev = host->dev;
bd5d825c 5308
ad72cf98 5309 mutex_init(&ap->scsi_scan_mutex);
65f27f38
DH
5310 INIT_DELAYED_WORK(&ap->hotplug_task, ata_scsi_hotplug);
5311 INIT_WORK(&ap->scsi_rescan_task, ata_scsi_dev_rescan);
a72ec4ce 5312 INIT_LIST_HEAD(&ap->eh_done_q);
c6cf9e99 5313 init_waitqueue_head(&ap->eh_wait_q);
45fabbb7 5314 init_completion(&ap->park_req_pending);
b93ab338
KC
5315 timer_setup(&ap->fastdrain_timer, ata_eh_fastdrain_timerfn,
5316 TIMER_DEFERRABLE);
1da177e4 5317
838df628 5318 ap->cbl = ATA_CBL_NONE;
838df628 5319
8989805d 5320 ata_link_init(ap, &ap->link, 0);
1da177e4
LT
5321
5322#ifdef ATA_IRQ_TRAP
5323 ap->stats.unhandled_irq = 1;
5324 ap->stats.idle_irq = 1;
5325#endif
270390e1
TH
5326 ata_sff_port_init(ap);
5327
1da177e4 5328 return ap;
1da177e4
LT
5329}
5330
2623c7a5 5331static void ata_devres_release(struct device *gendev, void *res)
f0d36efd
TH
5332{
5333 struct ata_host *host = dev_get_drvdata(gendev);
5334 int i;
5335
1aa506e4
TH
5336 for (i = 0; i < host->n_ports; i++) {
5337 struct ata_port *ap = host->ports[i];
5338
4911487a
TH
5339 if (!ap)
5340 continue;
5341
5342 if (ap->scsi_host)
1aa506e4
TH
5343 scsi_host_put(ap->scsi_host);
5344
2623c7a5
TK
5345 }
5346
5347 dev_set_drvdata(gendev, NULL);
5348 ata_host_put(host);
5349}
5350
5351static void ata_host_release(struct kref *kref)
5352{
5353 struct ata_host *host = container_of(kref, struct ata_host, kref);
5354 int i;
5355
5356 for (i = 0; i < host->n_ports; i++) {
5357 struct ata_port *ap = host->ports[i];
5358
633273a3 5359 kfree(ap->pmp_link);
b1c72916 5360 kfree(ap->slave_link);
4911487a 5361 kfree(ap);
1aa506e4
TH
5362 host->ports[i] = NULL;
5363 }
2623c7a5
TK
5364 kfree(host);
5365}
1aa506e4 5366
2623c7a5
TK
5367void ata_host_get(struct ata_host *host)
5368{
5369 kref_get(&host->kref);
5370}
5371
5372void ata_host_put(struct ata_host *host)
5373{
5374 kref_put(&host->kref, ata_host_release);
f0d36efd 5375}
a52fbcfc 5376EXPORT_SYMBOL_GPL(ata_host_put);
f0d36efd 5377
f3187195
TH
5378/**
5379 * ata_host_alloc - allocate and init basic ATA host resources
5380 * @dev: generic device this host is associated with
5381 * @max_ports: maximum number of ATA ports associated with this host
5382 *
5383 * Allocate and initialize basic ATA host resources. LLD calls
5384 * this function to allocate a host, initializes it fully and
5385 * attaches it using ata_host_register().
5386 *
5387 * @max_ports ports are allocated and host->n_ports is
5388 * initialized to @max_ports. The caller is allowed to decrease
5389 * host->n_ports before calling ata_host_register(). The unused
5390 * ports will be automatically freed on registration.
5391 *
5392 * RETURNS:
5393 * Allocate ATA host on success, NULL on failure.
5394 *
5395 * LOCKING:
5396 * Inherited from calling layer (may sleep).
5397 */
5398struct ata_host *ata_host_alloc(struct device *dev, int max_ports)
5399{
5400 struct ata_host *host;
5401 size_t sz;
5402 int i;
2623c7a5 5403 void *dr;
f3187195 5404
f3187195
TH
5405 /* alloc a container for our list of ATA ports (buses) */
5406 sz = sizeof(struct ata_host) + (max_ports + 1) * sizeof(void *);
2623c7a5 5407 host = kzalloc(sz, GFP_KERNEL);
f3187195 5408 if (!host)
2623c7a5
TK
5409 return NULL;
5410
5411 if (!devres_open_group(dev, NULL, GFP_KERNEL))
dafd6c49 5412 goto err_free;
2623c7a5
TK
5413
5414 dr = devres_alloc(ata_devres_release, 0, GFP_KERNEL);
5415 if (!dr)
f3187195
TH
5416 goto err_out;
5417
2623c7a5 5418 devres_add(dev, dr);
f3187195
TH
5419 dev_set_drvdata(dev, host);
5420
5421 spin_lock_init(&host->lock);
c0c362b6 5422 mutex_init(&host->eh_mutex);
f3187195
TH
5423 host->dev = dev;
5424 host->n_ports = max_ports;
2623c7a5 5425 kref_init(&host->kref);
f3187195
TH
5426
5427 /* allocate ports bound to this host */
5428 for (i = 0; i < max_ports; i++) {
5429 struct ata_port *ap;
5430
5431 ap = ata_port_alloc(host);
5432 if (!ap)
5433 goto err_out;
5434
5435 ap->port_no = i;
5436 host->ports[i] = ap;
5437 }
5438
5439 devres_remove_group(dev, NULL);
5440 return host;
5441
5442 err_out:
5443 devres_release_group(dev, NULL);
dafd6c49
CIK
5444 err_free:
5445 kfree(host);
f3187195
TH
5446 return NULL;
5447}
a52fbcfc 5448EXPORT_SYMBOL_GPL(ata_host_alloc);
f3187195 5449
f5cda257
TH
5450/**
5451 * ata_host_alloc_pinfo - alloc host and init with port_info array
5452 * @dev: generic device this host is associated with
5453 * @ppi: array of ATA port_info to initialize host with
5454 * @n_ports: number of ATA ports attached to this host
5455 *
5456 * Allocate ATA host and initialize with info from @ppi. If NULL
5457 * terminated, @ppi may contain fewer entries than @n_ports. The
5458 * last entry will be used for the remaining ports.
5459 *
5460 * RETURNS:
5461 * Allocate ATA host on success, NULL on failure.
5462 *
5463 * LOCKING:
5464 * Inherited from calling layer (may sleep).
5465 */
5466struct ata_host *ata_host_alloc_pinfo(struct device *dev,
5467 const struct ata_port_info * const * ppi,
5468 int n_ports)
5469{
bf476fe2 5470 const struct ata_port_info *pi = &ata_dummy_port_info;
f5cda257
TH
5471 struct ata_host *host;
5472 int i, j;
5473
5474 host = ata_host_alloc(dev, n_ports);
5475 if (!host)
5476 return NULL;
5477
bf476fe2 5478 for (i = 0, j = 0; i < host->n_ports; i++) {
f5cda257
TH
5479 struct ata_port *ap = host->ports[i];
5480
5481 if (ppi[j])
5482 pi = ppi[j++];
5483
5484 ap->pio_mask = pi->pio_mask;
5485 ap->mwdma_mask = pi->mwdma_mask;
5486 ap->udma_mask = pi->udma_mask;
5487 ap->flags |= pi->flags;
0c88758b 5488 ap->link.flags |= pi->link_flags;
f5cda257
TH
5489 ap->ops = pi->port_ops;
5490
5491 if (!host->ops && (pi->port_ops != &ata_dummy_port_ops))
5492 host->ops = pi->port_ops;
f5cda257
TH
5493 }
5494
5495 return host;
5496}
a52fbcfc 5497EXPORT_SYMBOL_GPL(ata_host_alloc_pinfo);
f5cda257 5498
32ebbc0c
TH
5499static void ata_host_stop(struct device *gendev, void *res)
5500{
5501 struct ata_host *host = dev_get_drvdata(gendev);
5502 int i;
5503
5504 WARN_ON(!(host->flags & ATA_HOST_STARTED));
5505
5506 for (i = 0; i < host->n_ports; i++) {
5507 struct ata_port *ap = host->ports[i];
5508
5509 if (ap->ops->port_stop)
5510 ap->ops->port_stop(ap);
5511 }
5512
5513 if (host->ops->host_stop)
5514 host->ops->host_stop(host);
5515}
5516
029cfd6b
TH
5517/**
5518 * ata_finalize_port_ops - finalize ata_port_operations
5519 * @ops: ata_port_operations to finalize
5520 *
5521 * An ata_port_operations can inherit from another ops and that
5522 * ops can again inherit from another. This can go on as many
5523 * times as necessary as long as there is no loop in the
5524 * inheritance chain.
5525 *
5526 * Ops tables are finalized when the host is started. NULL or
5527 * unspecified entries are inherited from the closet ancestor
5528 * which has the method and the entry is populated with it.
5529 * After finalization, the ops table directly points to all the
5530 * methods and ->inherits is no longer necessary and cleared.
5531 *
5532 * Using ATA_OP_NULL, inheriting ops can force a method to NULL.
5533 *
5534 * LOCKING:
5535 * None.
5536 */
5537static void ata_finalize_port_ops(struct ata_port_operations *ops)
5538{
2da67659 5539 static DEFINE_SPINLOCK(lock);
029cfd6b
TH
5540 const struct ata_port_operations *cur;
5541 void **begin = (void **)ops;
5542 void **end = (void **)&ops->inherits;
5543 void **pp;
5544
5545 if (!ops || !ops->inherits)
5546 return;
5547
5548 spin_lock(&lock);
5549
5550 for (cur = ops->inherits; cur; cur = cur->inherits) {
5551 void **inherit = (void **)cur;
5552
5553 for (pp = begin; pp < end; pp++, inherit++)
5554 if (!*pp)
5555 *pp = *inherit;
5556 }
5557
5558 for (pp = begin; pp < end; pp++)
5559 if (IS_ERR(*pp))
5560 *pp = NULL;
5561
5562 ops->inherits = NULL;
5563
5564 spin_unlock(&lock);
5565}
5566
ecef7253
TH
5567/**
5568 * ata_host_start - start and freeze ports of an ATA host
5569 * @host: ATA host to start ports for
5570 *
5571 * Start and then freeze ports of @host. Started status is
5572 * recorded in host->flags, so this function can be called
5573 * multiple times. Ports are guaranteed to get started only
e0af10ac 5574 * once. If host->ops is not initialized yet, it is set to the
f3187195 5575 * first non-dummy port ops.
ecef7253
TH
5576 *
5577 * LOCKING:
5578 * Inherited from calling layer (may sleep).
5579 *
5580 * RETURNS:
5581 * 0 if all ports are started successfully, -errno otherwise.
5582 */
5583int ata_host_start(struct ata_host *host)
5584{
32ebbc0c
TH
5585 int have_stop = 0;
5586 void *start_dr = NULL;
ecef7253
TH
5587 int i, rc;
5588
5589 if (host->flags & ATA_HOST_STARTED)
5590 return 0;
5591
029cfd6b
TH
5592 ata_finalize_port_ops(host->ops);
5593
ecef7253
TH
5594 for (i = 0; i < host->n_ports; i++) {
5595 struct ata_port *ap = host->ports[i];
5596
029cfd6b
TH
5597 ata_finalize_port_ops(ap->ops);
5598
f3187195
TH
5599 if (!host->ops && !ata_port_is_dummy(ap))
5600 host->ops = ap->ops;
5601
32ebbc0c
TH
5602 if (ap->ops->port_stop)
5603 have_stop = 1;
5604 }
5605
355a8031 5606 if (host->ops && host->ops->host_stop)
32ebbc0c
TH
5607 have_stop = 1;
5608
5609 if (have_stop) {
5610 start_dr = devres_alloc(ata_host_stop, 0, GFP_KERNEL);
5611 if (!start_dr)
5612 return -ENOMEM;
5613 }
5614
5615 for (i = 0; i < host->n_ports; i++) {
5616 struct ata_port *ap = host->ports[i];
5617
ecef7253
TH
5618 if (ap->ops->port_start) {
5619 rc = ap->ops->port_start(ap);
5620 if (rc) {
0f9fe9b7 5621 if (rc != -ENODEV)
a44fec1f
JP
5622 dev_err(host->dev,
5623 "failed to start port %d (errno=%d)\n",
5624 i, rc);
ecef7253
TH
5625 goto err_out;
5626 }
5627 }
ecef7253
TH
5628 ata_eh_freeze_port(ap);
5629 }
5630
32ebbc0c
TH
5631 if (start_dr)
5632 devres_add(host->dev, start_dr);
ecef7253
TH
5633 host->flags |= ATA_HOST_STARTED;
5634 return 0;
5635
5636 err_out:
5637 while (--i >= 0) {
5638 struct ata_port *ap = host->ports[i];
5639
5640 if (ap->ops->port_stop)
5641 ap->ops->port_stop(ap);
5642 }
32ebbc0c 5643 devres_free(start_dr);
ecef7253
TH
5644 return rc;
5645}
a52fbcfc 5646EXPORT_SYMBOL_GPL(ata_host_start);
ecef7253 5647
b03732f0 5648/**
94bd5719 5649 * ata_host_init - Initialize a host struct for sas (ipr, libsas)
cca3974e
JG
5650 * @host: host to initialize
5651 * @dev: device host is attached to
cca3974e 5652 * @ops: port_ops
b03732f0 5653 *
b03732f0 5654 */
cca3974e 5655void ata_host_init(struct ata_host *host, struct device *dev,
8d8e7d13 5656 struct ata_port_operations *ops)
b03732f0 5657{
cca3974e 5658 spin_lock_init(&host->lock);
c0c362b6 5659 mutex_init(&host->eh_mutex);
69278f79 5660 host->n_tags = ATA_MAX_QUEUE;
cca3974e 5661 host->dev = dev;
cca3974e 5662 host->ops = ops;
2fa4a326 5663 kref_init(&host->kref);
b03732f0 5664}
a52fbcfc 5665EXPORT_SYMBOL_GPL(ata_host_init);
b03732f0 5666
9508a66f 5667void __ata_port_probe(struct ata_port *ap)
79318057 5668{
9508a66f
DW
5669 struct ata_eh_info *ehi = &ap->link.eh_info;
5670 unsigned long flags;
886ad09f 5671
9508a66f
DW
5672 /* kick EH for boot probing */
5673 spin_lock_irqsave(ap->lock, flags);
79318057 5674
9508a66f
DW
5675 ehi->probe_mask |= ATA_ALL_DEVICES;
5676 ehi->action |= ATA_EH_RESET;
5677 ehi->flags |= ATA_EHI_NO_AUTOPSY | ATA_EHI_QUIET;
79318057 5678
9508a66f
DW
5679 ap->pflags &= ~ATA_PFLAG_INITIALIZING;
5680 ap->pflags |= ATA_PFLAG_LOADING;
5681 ata_port_schedule_eh(ap);
79318057 5682
9508a66f
DW
5683 spin_unlock_irqrestore(ap->lock, flags);
5684}
79318057 5685
9508a66f
DW
5686int ata_port_probe(struct ata_port *ap)
5687{
5688 int rc = 0;
79318057 5689
9508a66f
DW
5690 if (ap->ops->error_handler) {
5691 __ata_port_probe(ap);
79318057
AV
5692 ata_port_wait_eh(ap);
5693 } else {
79318057 5694 rc = ata_bus_probe(ap);
79318057 5695 }
238c9cf9
JB
5696 return rc;
5697}
5698
5699
5700static void async_port_probe(void *data, async_cookie_t cookie)
5701{
5702 struct ata_port *ap = data;
4fca377f 5703
238c9cf9
JB
5704 /*
5705 * If we're not allowed to scan this host in parallel,
5706 * we need to wait until all previous scans have completed
5707 * before going further.
5708 * Jeff Garzik says this is only within a controller, so we
5709 * don't need to wait for port 0, only for later ports.
5710 */
5711 if (!(ap->host->flags & ATA_HOST_PARALLEL_SCAN) && ap->port_no != 0)
5712 async_synchronize_cookie(cookie);
5713
5714 (void)ata_port_probe(ap);
f29d3b23
AV
5715
5716 /* in order to keep device order, we need to synchronize at this point */
5717 async_synchronize_cookie(cookie);
5718
5719 ata_scsi_scan_host(ap, 1);
79318057 5720}
238c9cf9 5721
f3187195
TH
5722/**
5723 * ata_host_register - register initialized ATA host
5724 * @host: ATA host to register
5725 * @sht: template for SCSI host
5726 *
5727 * Register initialized ATA host. @host is allocated using
5728 * ata_host_alloc() and fully initialized by LLD. This function
5729 * starts ports, registers @host with ATA and SCSI layers and
5730 * probe registered devices.
5731 *
5732 * LOCKING:
5733 * Inherited from calling layer (may sleep).
5734 *
5735 * RETURNS:
5736 * 0 on success, -errno otherwise.
5737 */
5738int ata_host_register(struct ata_host *host, struct scsi_host_template *sht)
5739{
5740 int i, rc;
5741
69278f79 5742 host->n_tags = clamp(sht->can_queue, 1, ATA_MAX_QUEUE);
1871ee13 5743
f3187195
TH
5744 /* host must have been started */
5745 if (!(host->flags & ATA_HOST_STARTED)) {
a44fec1f 5746 dev_err(host->dev, "BUG: trying to register unstarted host\n");
f3187195
TH
5747 WARN_ON(1);
5748 return -EINVAL;
5749 }
5750
5751 /* Blow away unused ports. This happens when LLD can't
5752 * determine the exact number of ports to allocate at
5753 * allocation time.
5754 */
5755 for (i = host->n_ports; host->ports[i]; i++)
5756 kfree(host->ports[i]);
5757
5758 /* give ports names and add SCSI hosts */
e628dc99 5759 for (i = 0; i < host->n_ports; i++) {
85d6725b 5760 host->ports[i]->print_id = atomic_inc_return(&ata_print_id);
e628dc99
DM
5761 host->ports[i]->local_port_no = i + 1;
5762 }
4fca377f 5763
d9027470
GG
5764 /* Create associated sysfs transport objects */
5765 for (i = 0; i < host->n_ports; i++) {
5766 rc = ata_tport_add(host->dev,host->ports[i]);
5767 if (rc) {
5768 goto err_tadd;
5769 }
5770 }
5771
f3187195
TH
5772 rc = ata_scsi_add_hosts(host, sht);
5773 if (rc)
d9027470 5774 goto err_tadd;
f3187195
TH
5775
5776 /* set cable, sata_spd_limit and report */
5777 for (i = 0; i < host->n_ports; i++) {
5778 struct ata_port *ap = host->ports[i];
f0a6d77b 5779 unsigned int xfer_mask;
f3187195
TH
5780
5781 /* set SATA cable type if still unset */
5782 if (ap->cbl == ATA_CBL_NONE && (ap->flags & ATA_FLAG_SATA))
5783 ap->cbl = ATA_CBL_SATA;
5784
5785 /* init sata_spd_limit to the current value */
4fb37a25 5786 sata_link_init_spd(&ap->link);
b1c72916
TH
5787 if (ap->slave_link)
5788 sata_link_init_spd(ap->slave_link);
f3187195 5789
cbcdd875 5790 /* print per-port info to dmesg */
f3187195
TH
5791 xfer_mask = ata_pack_xfermask(ap->pio_mask, ap->mwdma_mask,
5792 ap->udma_mask);
5793
abf6e8ed 5794 if (!ata_port_is_dummy(ap)) {
a9a79dfe
JP
5795 ata_port_info(ap, "%cATA max %s %s\n",
5796 (ap->flags & ATA_FLAG_SATA) ? 'S' : 'P',
5797 ata_mode_string(xfer_mask),
5798 ap->link.eh_info.desc);
abf6e8ed
TH
5799 ata_ehi_clear_desc(&ap->link.eh_info);
5800 } else
a9a79dfe 5801 ata_port_info(ap, "DUMMY\n");
f3187195
TH
5802 }
5803
f6005354 5804 /* perform each probe asynchronously */
f3187195
TH
5805 for (i = 0; i < host->n_ports; i++) {
5806 struct ata_port *ap = host->ports[i];
b5292111 5807 ap->cookie = async_schedule(async_port_probe, ap);
f3187195 5808 }
f3187195
TH
5809
5810 return 0;
d9027470
GG
5811
5812 err_tadd:
5813 while (--i >= 0) {
5814 ata_tport_delete(host->ports[i]);
5815 }
5816 return rc;
5817
f3187195 5818}
a52fbcfc 5819EXPORT_SYMBOL_GPL(ata_host_register);
f3187195 5820
f5cda257
TH
5821/**
5822 * ata_host_activate - start host, request IRQ and register it
5823 * @host: target ATA host
5824 * @irq: IRQ to request
5825 * @irq_handler: irq_handler used when requesting IRQ
5826 * @irq_flags: irq_flags used when requesting IRQ
5827 * @sht: scsi_host_template to use when registering the host
5828 *
5829 * After allocating an ATA host and initializing it, most libata
5830 * LLDs perform three steps to activate the host - start host,
c9b5560a 5831 * request IRQ and register it. This helper takes necessary
f5cda257
TH
5832 * arguments and performs the three steps in one go.
5833 *
3d46b2e2
PM
5834 * An invalid IRQ skips the IRQ registration and expects the host to
5835 * have set polling mode on the port. In this case, @irq_handler
5836 * should be NULL.
5837 *
f5cda257
TH
5838 * LOCKING:
5839 * Inherited from calling layer (may sleep).
5840 *
5841 * RETURNS:
5842 * 0 on success, -errno otherwise.
5843 */
5844int ata_host_activate(struct ata_host *host, int irq,
5845 irq_handler_t irq_handler, unsigned long irq_flags,
5846 struct scsi_host_template *sht)
5847{
cbcdd875 5848 int i, rc;
7e22c002 5849 char *irq_desc;
f5cda257
TH
5850
5851 rc = ata_host_start(host);
5852 if (rc)
5853 return rc;
5854
3d46b2e2
PM
5855 /* Special case for polling mode */
5856 if (!irq) {
5857 WARN_ON(irq_handler);
5858 return ata_host_register(host, sht);
5859 }
5860
7e22c002
HK
5861 irq_desc = devm_kasprintf(host->dev, GFP_KERNEL, "%s[%s]",
5862 dev_driver_string(host->dev),
5863 dev_name(host->dev));
5864 if (!irq_desc)
5865 return -ENOMEM;
5866
f5cda257 5867 rc = devm_request_irq(host->dev, irq, irq_handler, irq_flags,
7e22c002 5868 irq_desc, host);
f5cda257
TH
5869 if (rc)
5870 return rc;
5871
cbcdd875
TH
5872 for (i = 0; i < host->n_ports; i++)
5873 ata_port_desc(host->ports[i], "irq %d", irq);
4031826b 5874
f5cda257
TH
5875 rc = ata_host_register(host, sht);
5876 /* if failed, just free the IRQ and leave ports alone */
5877 if (rc)
5878 devm_free_irq(host->dev, irq, host);
5879
5880 return rc;
5881}
a52fbcfc 5882EXPORT_SYMBOL_GPL(ata_host_activate);
f5cda257 5883
720ba126 5884/**
c9b5560a 5885 * ata_port_detach - Detach ATA port in preparation of device removal
720ba126
TH
5886 * @ap: ATA port to be detached
5887 *
5888 * Detach all ATA devices and the associated SCSI devices of @ap;
5889 * then, remove the associated SCSI host. @ap is guaranteed to
5890 * be quiescent on return from this function.
5891 *
5892 * LOCKING:
5893 * Kernel thread context (may sleep).
5894 */
741b7763 5895static void ata_port_detach(struct ata_port *ap)
720ba126
TH
5896{
5897 unsigned long flags;
a6f9bf4d
LK
5898 struct ata_link *link;
5899 struct ata_device *dev;
720ba126
TH
5900
5901 if (!ap->ops->error_handler)
c3cf30a9 5902 goto skip_eh;
720ba126
TH
5903
5904 /* tell EH we're leaving & flush EH */
ba6a1308 5905 spin_lock_irqsave(ap->lock, flags);
b51e9e5d 5906 ap->pflags |= ATA_PFLAG_UNLOADING;
ece180d1 5907 ata_port_schedule_eh(ap);
ba6a1308 5908 spin_unlock_irqrestore(ap->lock, flags);
720ba126 5909
ece180d1 5910 /* wait till EH commits suicide */
720ba126
TH
5911 ata_port_wait_eh(ap);
5912
ece180d1
TH
5913 /* it better be dead now */
5914 WARN_ON(!(ap->pflags & ATA_PFLAG_UNLOADED));
720ba126 5915
afe2c511 5916 cancel_delayed_work_sync(&ap->hotplug_task);
720ba126 5917
c3cf30a9 5918 skip_eh:
a6f9bf4d
LK
5919 /* clean up zpodd on port removal */
5920 ata_for_each_link(link, ap, HOST_FIRST) {
5921 ata_for_each_dev(dev, link, ALL) {
5922 if (zpodd_dev_enabled(dev))
5923 zpodd_exit(dev);
5924 }
5925 }
d9027470
GG
5926 if (ap->pmp_link) {
5927 int i;
5928 for (i = 0; i < SATA_PMP_MAX_PORTS; i++)
5929 ata_tlink_delete(&ap->pmp_link[i]);
5930 }
720ba126 5931 /* remove the associated SCSI host */
cca3974e 5932 scsi_remove_host(ap->scsi_host);
c5700766 5933 ata_tport_delete(ap);
720ba126
TH
5934}
5935
0529c159
TH
5936/**
5937 * ata_host_detach - Detach all ports of an ATA host
5938 * @host: Host to detach
5939 *
5940 * Detach all ports of @host.
5941 *
5942 * LOCKING:
5943 * Kernel thread context (may sleep).
5944 */
5945void ata_host_detach(struct ata_host *host)
5946{
5947 int i;
5948
b5292111
KHF
5949 for (i = 0; i < host->n_ports; i++) {
5950 /* Ensure ata_port probe has completed */
5951 async_synchronize_cookie(host->ports[i]->cookie + 1);
0529c159 5952 ata_port_detach(host->ports[i]);
b5292111 5953 }
562f0c2d
TH
5954
5955 /* the host is dead now, dissociate ACPI */
5956 ata_acpi_dissociate(host);
0529c159 5957}
a52fbcfc 5958EXPORT_SYMBOL_GPL(ata_host_detach);
0529c159 5959
374b1873
JG
5960#ifdef CONFIG_PCI
5961
1da177e4
LT
5962/**
5963 * ata_pci_remove_one - PCI layer callback for device removal
5964 * @pdev: PCI device that was removed
5965 *
b878ca5d
TH
5966 * PCI layer indicates to libata via this hook that hot-unplug or
5967 * module unload event has occurred. Detach all ports. Resource
5968 * release is handled via devres.
1da177e4
LT
5969 *
5970 * LOCKING:
5971 * Inherited from PCI layer (may sleep).
5972 */
f0d36efd 5973void ata_pci_remove_one(struct pci_dev *pdev)
1da177e4 5974{
04a3f5b7 5975 struct ata_host *host = pci_get_drvdata(pdev);
1da177e4 5976
b878ca5d 5977 ata_host_detach(host);
1da177e4 5978}
a52fbcfc 5979EXPORT_SYMBOL_GPL(ata_pci_remove_one);
1da177e4 5980
10a663a1
PK
5981void ata_pci_shutdown_one(struct pci_dev *pdev)
5982{
5983 struct ata_host *host = pci_get_drvdata(pdev);
5984 int i;
5985
5986 for (i = 0; i < host->n_ports; i++) {
5987 struct ata_port *ap = host->ports[i];
5988
5989 ap->pflags |= ATA_PFLAG_FROZEN;
5990
5991 /* Disable port interrupts */
5992 if (ap->ops->freeze)
5993 ap->ops->freeze(ap);
5994
5995 /* Stop the port DMA engines */
5996 if (ap->ops->port_stop)
5997 ap->ops->port_stop(ap);
5998 }
5999}
a52fbcfc 6000EXPORT_SYMBOL_GPL(ata_pci_shutdown_one);
10a663a1 6001
1da177e4 6002/* move to PCI subsystem */
057ace5e 6003int pci_test_config_bits(struct pci_dev *pdev, const struct pci_bits *bits)
1da177e4
LT
6004{
6005 unsigned long tmp = 0;
6006
6007 switch (bits->width) {
6008 case 1: {
6009 u8 tmp8 = 0;
6010 pci_read_config_byte(pdev, bits->reg, &tmp8);
6011 tmp = tmp8;
6012 break;
6013 }
6014 case 2: {
6015 u16 tmp16 = 0;
6016 pci_read_config_word(pdev, bits->reg, &tmp16);
6017 tmp = tmp16;
6018 break;
6019 }
6020 case 4: {
6021 u32 tmp32 = 0;
6022 pci_read_config_dword(pdev, bits->reg, &tmp32);
6023 tmp = tmp32;
6024 break;
6025 }
6026
6027 default:
6028 return -EINVAL;
6029 }
6030
6031 tmp &= bits->mask;
6032
6033 return (tmp == bits->val) ? 1 : 0;
6034}
a52fbcfc 6035EXPORT_SYMBOL_GPL(pci_test_config_bits);
9b847548 6036
6ffa01d8 6037#ifdef CONFIG_PM
3c5100c1 6038void ata_pci_device_do_suspend(struct pci_dev *pdev, pm_message_t mesg)
9b847548
JA
6039{
6040 pci_save_state(pdev);
4c90d971 6041 pci_disable_device(pdev);
500530f6 6042
3a2d5b70 6043 if (mesg.event & PM_EVENT_SLEEP)
500530f6 6044 pci_set_power_state(pdev, PCI_D3hot);
9b847548 6045}
a52fbcfc 6046EXPORT_SYMBOL_GPL(ata_pci_device_do_suspend);
9b847548 6047
553c4aa6 6048int ata_pci_device_do_resume(struct pci_dev *pdev)
9b847548 6049{
553c4aa6
TH
6050 int rc;
6051
9b847548
JA
6052 pci_set_power_state(pdev, PCI_D0);
6053 pci_restore_state(pdev);
553c4aa6 6054
b878ca5d 6055 rc = pcim_enable_device(pdev);
553c4aa6 6056 if (rc) {
a44fec1f
JP
6057 dev_err(&pdev->dev,
6058 "failed to enable device after resume (%d)\n", rc);
553c4aa6
TH
6059 return rc;
6060 }
6061
9b847548 6062 pci_set_master(pdev);
553c4aa6 6063 return 0;
500530f6 6064}
a52fbcfc 6065EXPORT_SYMBOL_GPL(ata_pci_device_do_resume);
500530f6 6066
3c5100c1 6067int ata_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg)
500530f6 6068{
04a3f5b7 6069 struct ata_host *host = pci_get_drvdata(pdev);
500530f6 6070
ec87cf37 6071 ata_host_suspend(host, mesg);
500530f6 6072
3c5100c1 6073 ata_pci_device_do_suspend(pdev, mesg);
500530f6
TH
6074
6075 return 0;
6076}
a52fbcfc 6077EXPORT_SYMBOL_GPL(ata_pci_device_suspend);
500530f6
TH
6078
6079int ata_pci_device_resume(struct pci_dev *pdev)
6080{
04a3f5b7 6081 struct ata_host *host = pci_get_drvdata(pdev);
553c4aa6 6082 int rc;
500530f6 6083
553c4aa6
TH
6084 rc = ata_pci_device_do_resume(pdev);
6085 if (rc == 0)
6086 ata_host_resume(host);
6087 return rc;
9b847548 6088}
a52fbcfc 6089EXPORT_SYMBOL_GPL(ata_pci_device_resume);
6ffa01d8 6090#endif /* CONFIG_PM */
1da177e4
LT
6091#endif /* CONFIG_PCI */
6092
b7db04d9
BN
6093/**
6094 * ata_platform_remove_one - Platform layer callback for device removal
6095 * @pdev: Platform device that was removed
6096 *
6097 * Platform layer indicates to libata via this hook that hot-unplug or
6098 * module unload event has occurred. Detach all ports. Resource
6099 * release is handled via devres.
6100 *
6101 * LOCKING:
6102 * Inherited from platform layer (may sleep).
6103 */
6104int ata_platform_remove_one(struct platform_device *pdev)
6105{
6106 struct ata_host *host = platform_get_drvdata(pdev);
6107
6108 ata_host_detach(host);
6109
6110 return 0;
6111}
a52fbcfc 6112EXPORT_SYMBOL_GPL(ata_platform_remove_one);
b7db04d9 6113
bf89b0bf 6114#ifdef CONFIG_ATA_FORCE
168af4af
DLM
6115
6116#define force_cbl(name, flag) \
6117 { #name, .cbl = (flag) }
6118
6119#define force_spd_limit(spd, val) \
6120 { #spd, .spd_limit = (val) }
6121
6122#define force_xfer(mode, shift) \
6123 { #mode, .xfer_mask = (1UL << (shift)) }
6124
3af9ca4d
DLM
6125#define force_lflag_on(name, flags) \
6126 { #name, .lflags_on = (flags) }
6127
6128#define force_lflag_onoff(name, flags) \
6129 { "no" #name, .lflags_on = (flags) }, \
6130 { #name, .lflags_off = (flags) }
168af4af
DLM
6131
6132#define force_horkage_on(name, flag) \
6133 { #name, .horkage_on = (flag) }
6134
6135#define force_horkage_onoff(name, flag) \
6136 { "no" #name, .horkage_on = (flag) }, \
6137 { #name, .horkage_off = (flag) }
6138
6139static const struct ata_force_param force_tbl[] __initconst = {
6140 force_cbl(40c, ATA_CBL_PATA40),
6141 force_cbl(80c, ATA_CBL_PATA80),
6142 force_cbl(short40c, ATA_CBL_PATA40_SHORT),
6143 force_cbl(unk, ATA_CBL_PATA_UNK),
6144 force_cbl(ign, ATA_CBL_PATA_IGN),
6145 force_cbl(sata, ATA_CBL_SATA),
6146
6147 force_spd_limit(1.5Gbps, 1),
6148 force_spd_limit(3.0Gbps, 2),
6149
6150 force_xfer(pio0, ATA_SHIFT_PIO + 0),
6151 force_xfer(pio1, ATA_SHIFT_PIO + 1),
6152 force_xfer(pio2, ATA_SHIFT_PIO + 2),
6153 force_xfer(pio3, ATA_SHIFT_PIO + 3),
6154 force_xfer(pio4, ATA_SHIFT_PIO + 4),
6155 force_xfer(pio5, ATA_SHIFT_PIO + 5),
6156 force_xfer(pio6, ATA_SHIFT_PIO + 6),
6157 force_xfer(mwdma0, ATA_SHIFT_MWDMA + 0),
6158 force_xfer(mwdma1, ATA_SHIFT_MWDMA + 1),
6159 force_xfer(mwdma2, ATA_SHIFT_MWDMA + 2),
6160 force_xfer(mwdma3, ATA_SHIFT_MWDMA + 3),
6161 force_xfer(mwdma4, ATA_SHIFT_MWDMA + 4),
6162 force_xfer(udma0, ATA_SHIFT_UDMA + 0),
6163 force_xfer(udma16, ATA_SHIFT_UDMA + 0),
6164 force_xfer(udma/16, ATA_SHIFT_UDMA + 0),
6165 force_xfer(udma1, ATA_SHIFT_UDMA + 1),
6166 force_xfer(udma25, ATA_SHIFT_UDMA + 1),
6167 force_xfer(udma/25, ATA_SHIFT_UDMA + 1),
6168 force_xfer(udma2, ATA_SHIFT_UDMA + 2),
6169 force_xfer(udma33, ATA_SHIFT_UDMA + 2),
6170 force_xfer(udma/33, ATA_SHIFT_UDMA + 2),
6171 force_xfer(udma3, ATA_SHIFT_UDMA + 3),
6172 force_xfer(udma44, ATA_SHIFT_UDMA + 3),
6173 force_xfer(udma/44, ATA_SHIFT_UDMA + 3),
6174 force_xfer(udma4, ATA_SHIFT_UDMA + 4),
6175 force_xfer(udma66, ATA_SHIFT_UDMA + 4),
6176 force_xfer(udma/66, ATA_SHIFT_UDMA + 4),
6177 force_xfer(udma5, ATA_SHIFT_UDMA + 5),
6178 force_xfer(udma100, ATA_SHIFT_UDMA + 5),
6179 force_xfer(udma/100, ATA_SHIFT_UDMA + 5),
6180 force_xfer(udma6, ATA_SHIFT_UDMA + 6),
6181 force_xfer(udma133, ATA_SHIFT_UDMA + 6),
6182 force_xfer(udma/133, ATA_SHIFT_UDMA + 6),
6183 force_xfer(udma7, ATA_SHIFT_UDMA + 7),
6184
3af9ca4d
DLM
6185 force_lflag_on(nohrst, ATA_LFLAG_NO_HRST),
6186 force_lflag_on(nosrst, ATA_LFLAG_NO_SRST),
6187 force_lflag_on(norst, ATA_LFLAG_NO_HRST | ATA_LFLAG_NO_SRST),
6188 force_lflag_on(rstonce, ATA_LFLAG_RST_ONCE),
6189 force_lflag_onoff(dbdelay, ATA_LFLAG_NO_DEBOUNCE_DELAY),
168af4af
DLM
6190
6191 force_horkage_onoff(ncq, ATA_HORKAGE_NONCQ),
6192 force_horkage_onoff(ncqtrim, ATA_HORKAGE_NO_NCQ_TRIM),
6193 force_horkage_onoff(ncqati, ATA_HORKAGE_NO_NCQ_ON_ATI),
6194
2c33bbda
DLM
6195 force_horkage_onoff(trim, ATA_HORKAGE_NOTRIM),
6196 force_horkage_on(trim_zero, ATA_HORKAGE_ZERO_AFTER_TRIM),
6197 force_horkage_on(max_trim_128m, ATA_HORKAGE_MAX_TRIM_128M),
6198
6199 force_horkage_onoff(dma, ATA_HORKAGE_NODMA),
168af4af 6200 force_horkage_on(atapi_dmadir, ATA_HORKAGE_ATAPI_DMADIR),
2c33bbda
DLM
6201 force_horkage_on(atapi_mod16_dma, ATA_HORKAGE_ATAPI_MOD16_DMA),
6202
6203 force_horkage_onoff(dmalog, ATA_HORKAGE_NO_DMA_LOG),
6204 force_horkage_onoff(iddevlog, ATA_HORKAGE_NO_ID_DEV_LOG),
6205 force_horkage_onoff(logdir, ATA_HORKAGE_NO_LOG_DIR),
6206
6207 force_horkage_on(max_sec_128, ATA_HORKAGE_MAX_SEC_128),
6208 force_horkage_on(max_sec_1024, ATA_HORKAGE_MAX_SEC_1024),
6209 force_horkage_on(max_sec_lba48, ATA_HORKAGE_MAX_SEC_LBA48),
6210
6211 force_horkage_onoff(lpm, ATA_HORKAGE_NOLPM),
6212 force_horkage_onoff(setxfer, ATA_HORKAGE_NOSETXFER),
6213 force_horkage_on(dump_id, ATA_HORKAGE_DUMP_ID),
6214
6215 force_horkage_on(disable, ATA_HORKAGE_DISABLE),
168af4af
DLM
6216};
6217
33267325
TH
6218static int __init ata_parse_force_one(char **cur,
6219 struct ata_force_ent *force_ent,
6220 const char **reason)
6221{
33267325
TH
6222 char *start = *cur, *p = *cur;
6223 char *id, *val, *endp;
6224 const struct ata_force_param *match_fp = NULL;
6225 int nr_matches = 0, i;
6226
6227 /* find where this param ends and update *cur */
6228 while (*p != '\0' && *p != ',')
6229 p++;
6230
6231 if (*p == '\0')
6232 *cur = p;
6233 else
6234 *cur = p + 1;
6235
6236 *p = '\0';
6237
6238 /* parse */
6239 p = strchr(start, ':');
6240 if (!p) {
6241 val = strstrip(start);
6242 goto parse_val;
6243 }
6244 *p = '\0';
6245
6246 id = strstrip(start);
6247 val = strstrip(p + 1);
6248
6249 /* parse id */
6250 p = strchr(id, '.');
6251 if (p) {
6252 *p++ = '\0';
6253 force_ent->device = simple_strtoul(p, &endp, 10);
6254 if (p == endp || *endp != '\0') {
6255 *reason = "invalid device";
6256 return -EINVAL;
6257 }
6258 }
6259
6260 force_ent->port = simple_strtoul(id, &endp, 10);
f7cf69ae 6261 if (id == endp || *endp != '\0') {
33267325
TH
6262 *reason = "invalid port/link";
6263 return -EINVAL;
6264 }
6265
6266 parse_val:
6267 /* parse val, allow shortcuts so that both 1.5 and 1.5Gbps work */
6268 for (i = 0; i < ARRAY_SIZE(force_tbl); i++) {
6269 const struct ata_force_param *fp = &force_tbl[i];
6270
6271 if (strncasecmp(val, fp->name, strlen(val)))
6272 continue;
6273
6274 nr_matches++;
6275 match_fp = fp;
6276
6277 if (strcasecmp(val, fp->name) == 0) {
6278 nr_matches = 1;
6279 break;
6280 }
6281 }
6282
6283 if (!nr_matches) {
6284 *reason = "unknown value";
6285 return -EINVAL;
6286 }
6287 if (nr_matches > 1) {
9de55351 6288 *reason = "ambiguous value";
33267325
TH
6289 return -EINVAL;
6290 }
6291
6292 force_ent->param = *match_fp;
6293
6294 return 0;
6295}
6296
6297static void __init ata_parse_force_param(void)
6298{
6299 int idx = 0, size = 1;
6300 int last_port = -1, last_device = -1;
6301 char *p, *cur, *next;
6302
168af4af 6303 /* Calculate maximum number of params and allocate ata_force_tbl */
33267325
TH
6304 for (p = ata_force_param_buf; *p; p++)
6305 if (*p == ',')
6306 size++;
6307
6396bb22 6308 ata_force_tbl = kcalloc(size, sizeof(ata_force_tbl[0]), GFP_KERNEL);
33267325
TH
6309 if (!ata_force_tbl) {
6310 printk(KERN_WARNING "ata: failed to extend force table, "
6311 "libata.force ignored\n");
6312 return;
6313 }
6314
6315 /* parse and populate the table */
6316 for (cur = ata_force_param_buf; *cur != '\0'; cur = next) {
6317 const char *reason = "";
6318 struct ata_force_ent te = { .port = -1, .device = -1 };
6319
6320 next = cur;
6321 if (ata_parse_force_one(&next, &te, &reason)) {
6322 printk(KERN_WARNING "ata: failed to parse force "
6323 "parameter \"%s\" (%s)\n",
6324 cur, reason);
6325 continue;
6326 }
6327
6328 if (te.port == -1) {
6329 te.port = last_port;
6330 te.device = last_device;
6331 }
6332
6333 ata_force_tbl[idx++] = te;
6334
6335 last_port = te.port;
6336 last_device = te.device;
6337 }
6338
6339 ata_force_tbl_size = idx;
6340}
1da177e4 6341
bf89b0bf
BZ
6342static void ata_free_force_param(void)
6343{
6344 kfree(ata_force_tbl);
6345}
6346#else
6347static inline void ata_parse_force_param(void) { }
6348static inline void ata_free_force_param(void) { }
6349#endif
6350
1da177e4
LT
6351static int __init ata_init(void)
6352{
d9027470 6353 int rc;
270390e1 6354
33267325
TH
6355 ata_parse_force_param();
6356
270390e1 6357 rc = ata_sff_init();
ad72cf98 6358 if (rc) {
bf89b0bf 6359 ata_free_force_param();
ad72cf98
TH
6360 return rc;
6361 }
453b07ac 6362
d9027470
GG
6363 libata_transport_init();
6364 ata_scsi_transport_template = ata_attach_transport();
6365 if (!ata_scsi_transport_template) {
6366 ata_sff_exit();
6367 rc = -ENOMEM;
6368 goto err_out;
4fca377f 6369 }
d9027470 6370
1da177e4
LT
6371 printk(KERN_DEBUG "libata version " DRV_VERSION " loaded.\n");
6372 return 0;
d9027470
GG
6373
6374err_out:
6375 return rc;
1da177e4
LT
6376}
6377
6378static void __exit ata_exit(void)
6379{
d9027470
GG
6380 ata_release_transport(ata_scsi_transport_template);
6381 libata_transport_exit();
270390e1 6382 ata_sff_exit();
bf89b0bf 6383 ata_free_force_param();
1da177e4
LT
6384}
6385
a4625085 6386subsys_initcall(ata_init);
1da177e4
LT
6387module_exit(ata_exit);
6388
9990b6f3 6389static DEFINE_RATELIMIT_STATE(ratelimit, HZ / 5, 1);
67846b30
JG
6390
6391int ata_ratelimit(void)
6392{
9990b6f3 6393 return __ratelimit(&ratelimit);
67846b30 6394}
a52fbcfc 6395EXPORT_SYMBOL_GPL(ata_ratelimit);
67846b30 6396
c0c362b6
TH
6397/**
6398 * ata_msleep - ATA EH owner aware msleep
6399 * @ap: ATA port to attribute the sleep to
6400 * @msecs: duration to sleep in milliseconds
6401 *
6402 * Sleeps @msecs. If the current task is owner of @ap's EH, the
6403 * ownership is released before going to sleep and reacquired
6404 * after the sleep is complete. IOW, other ports sharing the
6405 * @ap->host will be allowed to own the EH while this task is
6406 * sleeping.
6407 *
6408 * LOCKING:
6409 * Might sleep.
6410 */
97750ceb
TH
6411void ata_msleep(struct ata_port *ap, unsigned int msecs)
6412{
c0c362b6
TH
6413 bool owns_eh = ap && ap->host->eh_owner == current;
6414
6415 if (owns_eh)
6416 ata_eh_release(ap);
6417
848c3920
AVM
6418 if (msecs < 20) {
6419 unsigned long usecs = msecs * USEC_PER_MSEC;
6420 usleep_range(usecs, usecs + 50);
6421 } else {
6422 msleep(msecs);
6423 }
c0c362b6
TH
6424
6425 if (owns_eh)
6426 ata_eh_acquire(ap);
97750ceb 6427}
a52fbcfc 6428EXPORT_SYMBOL_GPL(ata_msleep);
97750ceb 6429
c22daff4
TH
6430/**
6431 * ata_wait_register - wait until register value changes
97750ceb 6432 * @ap: ATA port to wait register for, can be NULL
c22daff4
TH
6433 * @reg: IO-mapped register
6434 * @mask: Mask to apply to read register value
6435 * @val: Wait condition
341c2c95
TH
6436 * @interval: polling interval in milliseconds
6437 * @timeout: timeout in milliseconds
c22daff4
TH
6438 *
6439 * Waiting for some bits of register to change is a common
6440 * operation for ATA controllers. This function reads 32bit LE
6441 * IO-mapped register @reg and tests for the following condition.
6442 *
6443 * (*@reg & mask) != val
6444 *
6445 * If the condition is met, it returns; otherwise, the process is
6446 * repeated after @interval_msec until timeout.
6447 *
6448 * LOCKING:
6449 * Kernel thread context (may sleep)
6450 *
6451 * RETURNS:
6452 * The final register value.
6453 */
97750ceb 6454u32 ata_wait_register(struct ata_port *ap, void __iomem *reg, u32 mask, u32 val,
341c2c95 6455 unsigned long interval, unsigned long timeout)
c22daff4 6456{
341c2c95 6457 unsigned long deadline;
c22daff4
TH
6458 u32 tmp;
6459
6460 tmp = ioread32(reg);
6461
6462 /* Calculate timeout _after_ the first read to make sure
6463 * preceding writes reach the controller before starting to
6464 * eat away the timeout.
6465 */
341c2c95 6466 deadline = ata_deadline(jiffies, timeout);
c22daff4 6467
341c2c95 6468 while ((tmp & mask) == val && time_before(jiffies, deadline)) {
97750ceb 6469 ata_msleep(ap, interval);
c22daff4
TH
6470 tmp = ioread32(reg);
6471 }
6472
6473 return tmp;
6474}
a52fbcfc 6475EXPORT_SYMBOL_GPL(ata_wait_register);
c22daff4 6476
dd5b06c4
TH
6477/*
6478 * Dummy port_ops
6479 */
182d7bba 6480static unsigned int ata_dummy_qc_issue(struct ata_queued_cmd *qc)
dd5b06c4 6481{
182d7bba 6482 return AC_ERR_SYSTEM;
dd5b06c4
TH
6483}
6484
182d7bba 6485static void ata_dummy_error_handler(struct ata_port *ap)
dd5b06c4 6486{
182d7bba 6487 /* truly dummy */
dd5b06c4
TH
6488}
6489
029cfd6b 6490struct ata_port_operations ata_dummy_port_ops = {
dd5b06c4
TH
6491 .qc_prep = ata_noop_qc_prep,
6492 .qc_issue = ata_dummy_qc_issue,
182d7bba 6493 .error_handler = ata_dummy_error_handler,
e4a9c373
DW
6494 .sched_eh = ata_std_sched_eh,
6495 .end_eh = ata_std_end_eh,
dd5b06c4 6496};
a52fbcfc 6497EXPORT_SYMBOL_GPL(ata_dummy_port_ops);
dd5b06c4 6498
21b0ad4f
TH
6499const struct ata_port_info ata_dummy_port_info = {
6500 .port_ops = &ata_dummy_port_ops,
6501};
a52fbcfc 6502EXPORT_SYMBOL_GPL(ata_dummy_port_info);
21b0ad4f 6503
06296a1e
JP
6504void ata_print_version(const struct device *dev, const char *version)
6505{
6506 dev_printk(KERN_DEBUG, dev, "version %s\n", version);
6507}
6508EXPORT_SYMBOL(ata_print_version);
c206a389
HR
6509
6510EXPORT_TRACEPOINT_SYMBOL_GPL(ata_tf_load);
6511EXPORT_TRACEPOINT_SYMBOL_GPL(ata_exec_command);
6512EXPORT_TRACEPOINT_SYMBOL_GPL(ata_bmdma_setup);
6513EXPORT_TRACEPOINT_SYMBOL_GPL(ata_bmdma_start);
6514EXPORT_TRACEPOINT_SYMBOL_GPL(ata_bmdma_status);