xref: /openbmc/linux/drivers/scsi/libsas/sas_ata.c (revision 63dc02bd)
1 /*
2  * Support for SATA devices on Serial Attached SCSI (SAS) controllers
3  *
4  * Copyright (C) 2006 IBM Corporation
5  *
6  * Written by: Darrick J. Wong <djwong@us.ibm.com>, IBM Corporation
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of the
11  * License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful, but
14  * WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  * General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
21  * USA
22  */
23 
24 #include <linux/scatterlist.h>
25 #include <linux/slab.h>
26 #include <linux/async.h>
27 #include <linux/export.h>
28 
29 #include <scsi/sas_ata.h>
30 #include "sas_internal.h"
31 #include <scsi/scsi_host.h>
32 #include <scsi/scsi_device.h>
33 #include <scsi/scsi_tcq.h>
34 #include <scsi/scsi.h>
35 #include <scsi/scsi_transport.h>
36 #include <scsi/scsi_transport_sas.h>
37 #include "../scsi_sas_internal.h"
38 #include "../scsi_transport_api.h"
39 #include <scsi/scsi_eh.h>
40 
41 static enum ata_completion_errors sas_to_ata_err(struct task_status_struct *ts)
42 {
43 	/* Cheesy attempt to translate SAS errors into ATA.  Hah! */
44 
45 	/* transport error */
46 	if (ts->resp == SAS_TASK_UNDELIVERED)
47 		return AC_ERR_ATA_BUS;
48 
49 	/* ts->resp == SAS_TASK_COMPLETE */
50 	/* task delivered, what happened afterwards? */
51 	switch (ts->stat) {
52 		case SAS_DEV_NO_RESPONSE:
53 			return AC_ERR_TIMEOUT;
54 
55 		case SAS_INTERRUPTED:
56 		case SAS_PHY_DOWN:
57 		case SAS_NAK_R_ERR:
58 			return AC_ERR_ATA_BUS;
59 
60 
61 		case SAS_DATA_UNDERRUN:
62 			/*
63 			 * Some programs that use the taskfile interface
64 			 * (smartctl in particular) can cause underrun
65 			 * problems.  Ignore these errors, perhaps at our
66 			 * peril.
67 			 */
68 			return 0;
69 
70 		case SAS_DATA_OVERRUN:
71 		case SAS_QUEUE_FULL:
72 		case SAS_DEVICE_UNKNOWN:
73 		case SAS_SG_ERR:
74 			return AC_ERR_INVALID;
75 
76 		case SAS_OPEN_TO:
77 		case SAS_OPEN_REJECT:
78 			SAS_DPRINTK("%s: Saw error %d.  What to do?\n",
79 				    __func__, ts->stat);
80 			return AC_ERR_OTHER;
81 
82 		case SAM_STAT_CHECK_CONDITION:
83 		case SAS_ABORTED_TASK:
84 			return AC_ERR_DEV;
85 
86 		case SAS_PROTO_RESPONSE:
87 			/* This means the ending_fis has the error
88 			 * value; return 0 here to collect it */
89 			return 0;
90 		default:
91 			return 0;
92 	}
93 }
94 
95 static void sas_ata_task_done(struct sas_task *task)
96 {
97 	struct ata_queued_cmd *qc = task->uldd_task;
98 	struct domain_device *dev = task->dev;
99 	struct task_status_struct *stat = &task->task_status;
100 	struct ata_task_resp *resp = (struct ata_task_resp *)stat->buf;
101 	struct sas_ha_struct *sas_ha = dev->port->ha;
102 	enum ata_completion_errors ac;
103 	unsigned long flags;
104 	struct ata_link *link;
105 	struct ata_port *ap;
106 
107 	spin_lock_irqsave(&dev->done_lock, flags);
108 	if (test_bit(SAS_HA_FROZEN, &sas_ha->state))
109 		task = NULL;
110 	else if (qc && qc->scsicmd)
111 		ASSIGN_SAS_TASK(qc->scsicmd, NULL);
112 	spin_unlock_irqrestore(&dev->done_lock, flags);
113 
114 	/* check if libsas-eh got to the task before us */
115 	if (unlikely(!task))
116 		return;
117 
118 	if (!qc)
119 		goto qc_already_gone;
120 
121 	ap = qc->ap;
122 	link = &ap->link;
123 
124 	spin_lock_irqsave(ap->lock, flags);
125 	/* check if we lost the race with libata/sas_ata_post_internal() */
126 	if (unlikely(ap->pflags & ATA_PFLAG_FROZEN)) {
127 		spin_unlock_irqrestore(ap->lock, flags);
128 		if (qc->scsicmd)
129 			goto qc_already_gone;
130 		else {
131 			/* if eh is not involved and the port is frozen then the
132 			 * ata internal abort process has taken responsibility
133 			 * for this sas_task
134 			 */
135 			return;
136 		}
137 	}
138 
139 	if (stat->stat == SAS_PROTO_RESPONSE || stat->stat == SAM_STAT_GOOD ||
140 	    ((stat->stat == SAM_STAT_CHECK_CONDITION &&
141 	      dev->sata_dev.command_set == ATAPI_COMMAND_SET))) {
142 		ata_tf_from_fis(resp->ending_fis, &dev->sata_dev.tf);
143 
144 		if (!link->sactive) {
145 			qc->err_mask |= ac_err_mask(dev->sata_dev.tf.command);
146 		} else {
147 			link->eh_info.err_mask |= ac_err_mask(dev->sata_dev.tf.command);
148 			if (unlikely(link->eh_info.err_mask))
149 				qc->flags |= ATA_QCFLAG_FAILED;
150 		}
151 	} else {
152 		ac = sas_to_ata_err(stat);
153 		if (ac) {
154 			SAS_DPRINTK("%s: SAS error %x\n", __func__,
155 				    stat->stat);
156 			/* We saw a SAS error. Send a vague error. */
157 			if (!link->sactive) {
158 				qc->err_mask = ac;
159 			} else {
160 				link->eh_info.err_mask |= AC_ERR_DEV;
161 				qc->flags |= ATA_QCFLAG_FAILED;
162 			}
163 
164 			dev->sata_dev.tf.feature = 0x04; /* status err */
165 			dev->sata_dev.tf.command = ATA_ERR;
166 		}
167 	}
168 
169 	qc->lldd_task = NULL;
170 	ata_qc_complete(qc);
171 	spin_unlock_irqrestore(ap->lock, flags);
172 
173 qc_already_gone:
174 	list_del_init(&task->list);
175 	sas_free_task(task);
176 }
177 
178 static unsigned int sas_ata_qc_issue(struct ata_queued_cmd *qc)
179 {
180 	unsigned long flags;
181 	struct sas_task *task;
182 	struct scatterlist *sg;
183 	int ret = AC_ERR_SYSTEM;
184 	unsigned int si, xfer = 0;
185 	struct ata_port *ap = qc->ap;
186 	struct domain_device *dev = ap->private_data;
187 	struct sas_ha_struct *sas_ha = dev->port->ha;
188 	struct Scsi_Host *host = sas_ha->core.shost;
189 	struct sas_internal *i = to_sas_internal(host->transportt);
190 
191 	/* TODO: audit callers to ensure they are ready for qc_issue to
192 	 * unconditionally re-enable interrupts
193 	 */
194 	local_irq_save(flags);
195 	spin_unlock(ap->lock);
196 
197 	/* If the device fell off, no sense in issuing commands */
198 	if (test_bit(SAS_DEV_GONE, &dev->state))
199 		goto out;
200 
201 	task = sas_alloc_task(GFP_ATOMIC);
202 	if (!task)
203 		goto out;
204 	task->dev = dev;
205 	task->task_proto = SAS_PROTOCOL_STP;
206 	task->task_done = sas_ata_task_done;
207 
208 	if (qc->tf.command == ATA_CMD_FPDMA_WRITE ||
209 	    qc->tf.command == ATA_CMD_FPDMA_READ) {
210 		/* Need to zero out the tag libata assigned us */
211 		qc->tf.nsect = 0;
212 	}
213 
214 	ata_tf_to_fis(&qc->tf, 1, 0, (u8*)&task->ata_task.fis);
215 	task->uldd_task = qc;
216 	if (ata_is_atapi(qc->tf.protocol)) {
217 		memcpy(task->ata_task.atapi_packet, qc->cdb, qc->dev->cdb_len);
218 		task->total_xfer_len = qc->nbytes;
219 		task->num_scatter = qc->n_elem;
220 	} else {
221 		for_each_sg(qc->sg, sg, qc->n_elem, si)
222 			xfer += sg->length;
223 
224 		task->total_xfer_len = xfer;
225 		task->num_scatter = si;
226 	}
227 
228 	task->data_dir = qc->dma_dir;
229 	task->scatter = qc->sg;
230 	task->ata_task.retry_count = 1;
231 	task->task_state_flags = SAS_TASK_STATE_PENDING;
232 	qc->lldd_task = task;
233 
234 	switch (qc->tf.protocol) {
235 	case ATA_PROT_NCQ:
236 		task->ata_task.use_ncq = 1;
237 		/* fall through */
238 	case ATAPI_PROT_DMA:
239 	case ATA_PROT_DMA:
240 		task->ata_task.dma_xfer = 1;
241 		break;
242 	}
243 
244 	if (qc->scsicmd)
245 		ASSIGN_SAS_TASK(qc->scsicmd, task);
246 
247 	if (sas_ha->lldd_max_execute_num < 2)
248 		ret = i->dft->lldd_execute_task(task, 1, GFP_ATOMIC);
249 	else
250 		ret = sas_queue_up(task);
251 
252 	/* Examine */
253 	if (ret) {
254 		SAS_DPRINTK("lldd_execute_task returned: %d\n", ret);
255 
256 		if (qc->scsicmd)
257 			ASSIGN_SAS_TASK(qc->scsicmd, NULL);
258 		sas_free_task(task);
259 		ret = AC_ERR_SYSTEM;
260 	}
261 
262  out:
263 	spin_lock(ap->lock);
264 	local_irq_restore(flags);
265 	return ret;
266 }
267 
268 static bool sas_ata_qc_fill_rtf(struct ata_queued_cmd *qc)
269 {
270 	struct domain_device *dev = qc->ap->private_data;
271 
272 	memcpy(&qc->result_tf, &dev->sata_dev.tf, sizeof(qc->result_tf));
273 	return true;
274 }
275 
276 static struct sas_internal *dev_to_sas_internal(struct domain_device *dev)
277 {
278 	return to_sas_internal(dev->port->ha->core.shost->transportt);
279 }
280 
281 static void sas_get_ata_command_set(struct domain_device *dev);
282 
283 int sas_get_ata_info(struct domain_device *dev, struct ex_phy *phy)
284 {
285 	if (phy->attached_tproto & SAS_PROTOCOL_STP)
286 		dev->tproto = phy->attached_tproto;
287 	if (phy->attached_sata_dev)
288 		dev->tproto |= SATA_DEV;
289 
290 	if (phy->attached_dev_type == SATA_PENDING)
291 		dev->dev_type = SATA_PENDING;
292 	else {
293 		int res;
294 
295 		dev->dev_type = SATA_DEV;
296 		res = sas_get_report_phy_sata(dev->parent, phy->phy_id,
297 					      &dev->sata_dev.rps_resp);
298 		if (res) {
299 			SAS_DPRINTK("report phy sata to %016llx:0x%x returned "
300 				    "0x%x\n", SAS_ADDR(dev->parent->sas_addr),
301 				    phy->phy_id, res);
302 			return res;
303 		}
304 		memcpy(dev->frame_rcvd, &dev->sata_dev.rps_resp.rps.fis,
305 		       sizeof(struct dev_to_host_fis));
306 		/* TODO switch to ata_dev_classify() */
307 		sas_get_ata_command_set(dev);
308 	}
309 	return 0;
310 }
311 
312 static int sas_ata_clear_pending(struct domain_device *dev, struct ex_phy *phy)
313 {
314 	int res;
315 
316 	/* we weren't pending, so successfully end the reset sequence now */
317 	if (dev->dev_type != SATA_PENDING)
318 		return 1;
319 
320 	/* hmmm, if this succeeds do we need to repost the domain_device to the
321 	 * lldd so it can pick up new parameters?
322 	 */
323 	res = sas_get_ata_info(dev, phy);
324 	if (res)
325 		return 0; /* retry */
326 	else
327 		return 1;
328 }
329 
330 static int smp_ata_check_ready(struct ata_link *link)
331 {
332 	int res;
333 	struct ata_port *ap = link->ap;
334 	struct domain_device *dev = ap->private_data;
335 	struct domain_device *ex_dev = dev->parent;
336 	struct sas_phy *phy = sas_get_local_phy(dev);
337 	struct ex_phy *ex_phy = &ex_dev->ex_dev.ex_phy[phy->number];
338 
339 	res = sas_ex_phy_discover(ex_dev, phy->number);
340 	sas_put_local_phy(phy);
341 
342 	/* break the wait early if the expander is unreachable,
343 	 * otherwise keep polling
344 	 */
345 	if (res == -ECOMM)
346 		return res;
347 	if (res != SMP_RESP_FUNC_ACC)
348 		return 0;
349 
350 	switch (ex_phy->attached_dev_type) {
351 	case SATA_PENDING:
352 		return 0;
353 	case SAS_END_DEV:
354 		if (ex_phy->attached_sata_dev)
355 			return sas_ata_clear_pending(dev, ex_phy);
356 	default:
357 		return -ENODEV;
358 	}
359 }
360 
361 static int local_ata_check_ready(struct ata_link *link)
362 {
363 	struct ata_port *ap = link->ap;
364 	struct domain_device *dev = ap->private_data;
365 	struct sas_internal *i = dev_to_sas_internal(dev);
366 
367 	if (i->dft->lldd_ata_check_ready)
368 		return i->dft->lldd_ata_check_ready(dev);
369 	else {
370 		/* lldd's that don't implement 'ready' checking get the
371 		 * old default behavior of not coordinating reset
372 		 * recovery with libata
373 		 */
374 		return 1;
375 	}
376 }
377 
378 static int sas_ata_printk(const char *level, const struct domain_device *ddev,
379 			  const char *fmt, ...)
380 {
381 	struct ata_port *ap = ddev->sata_dev.ap;
382 	struct device *dev = &ddev->rphy->dev;
383 	struct va_format vaf;
384 	va_list args;
385 	int r;
386 
387 	va_start(args, fmt);
388 
389 	vaf.fmt = fmt;
390 	vaf.va = &args;
391 
392 	r = printk("%ssas: ata%u: %s: %pV",
393 		   level, ap->print_id, dev_name(dev), &vaf);
394 
395 	va_end(args);
396 
397 	return r;
398 }
399 
400 static int sas_ata_hard_reset(struct ata_link *link, unsigned int *class,
401 			      unsigned long deadline)
402 {
403 	int ret = 0, res;
404 	struct sas_phy *phy;
405 	struct ata_port *ap = link->ap;
406 	int (*check_ready)(struct ata_link *link);
407 	struct domain_device *dev = ap->private_data;
408 	struct sas_internal *i = dev_to_sas_internal(dev);
409 
410 	res = i->dft->lldd_I_T_nexus_reset(dev);
411 	if (res == -ENODEV)
412 		return res;
413 
414 	if (res != TMF_RESP_FUNC_COMPLETE)
415 		sas_ata_printk(KERN_DEBUG, dev, "Unable to reset ata device?\n");
416 
417 	phy = sas_get_local_phy(dev);
418 	if (scsi_is_sas_phy_local(phy))
419 		check_ready = local_ata_check_ready;
420 	else
421 		check_ready = smp_ata_check_ready;
422 	sas_put_local_phy(phy);
423 
424 	ret = ata_wait_after_reset(link, deadline, check_ready);
425 	if (ret && ret != -EAGAIN)
426 		sas_ata_printk(KERN_ERR, dev, "reset failed (errno=%d)\n", ret);
427 
428 	/* XXX: if the class changes during the reset the upper layer
429 	 * should be informed, if the device has gone away we assume
430 	 * libsas will eventually delete it
431 	 */
432 	switch (dev->sata_dev.command_set) {
433 	case ATA_COMMAND_SET:
434 		*class = ATA_DEV_ATA;
435 		break;
436 	case ATAPI_COMMAND_SET:
437 		*class = ATA_DEV_ATAPI;
438 		break;
439 	}
440 
441 	ap->cbl = ATA_CBL_SATA;
442 	return ret;
443 }
444 
445 /*
446  * notify the lldd to forget the sas_task for this internal ata command
447  * that bypasses scsi-eh
448  */
449 static void sas_ata_internal_abort(struct sas_task *task)
450 {
451 	struct sas_internal *si = dev_to_sas_internal(task->dev);
452 	unsigned long flags;
453 	int res;
454 
455 	spin_lock_irqsave(&task->task_state_lock, flags);
456 	if (task->task_state_flags & SAS_TASK_STATE_ABORTED ||
457 	    task->task_state_flags & SAS_TASK_STATE_DONE) {
458 		spin_unlock_irqrestore(&task->task_state_lock, flags);
459 		SAS_DPRINTK("%s: Task %p already finished.\n", __func__,
460 			    task);
461 		goto out;
462 	}
463 	task->task_state_flags |= SAS_TASK_STATE_ABORTED;
464 	spin_unlock_irqrestore(&task->task_state_lock, flags);
465 
466 	res = si->dft->lldd_abort_task(task);
467 
468 	spin_lock_irqsave(&task->task_state_lock, flags);
469 	if (task->task_state_flags & SAS_TASK_STATE_DONE ||
470 	    res == TMF_RESP_FUNC_COMPLETE) {
471 		spin_unlock_irqrestore(&task->task_state_lock, flags);
472 		goto out;
473 	}
474 
475 	/* XXX we are not prepared to deal with ->lldd_abort_task()
476 	 * failures.  TODO: lldds need to unconditionally forget about
477 	 * aborted ata tasks, otherwise we (likely) leak the sas task
478 	 * here
479 	 */
480 	SAS_DPRINTK("%s: Task %p leaked.\n", __func__, task);
481 
482 	if (!(task->task_state_flags & SAS_TASK_STATE_DONE))
483 		task->task_state_flags &= ~SAS_TASK_STATE_ABORTED;
484 	spin_unlock_irqrestore(&task->task_state_lock, flags);
485 
486 	return;
487  out:
488 	list_del_init(&task->list);
489 	sas_free_task(task);
490 }
491 
492 static void sas_ata_post_internal(struct ata_queued_cmd *qc)
493 {
494 	if (qc->flags & ATA_QCFLAG_FAILED)
495 		qc->err_mask |= AC_ERR_OTHER;
496 
497 	if (qc->err_mask) {
498 		/*
499 		 * Find the sas_task and kill it.  By this point, libata
500 		 * has decided to kill the qc and has frozen the port.
501 		 * In this state sas_ata_task_done() will no longer free
502 		 * the sas_task, so we need to notify the lldd (via
503 		 * ->lldd_abort_task) that the task is dead and free it
504 		 *  ourselves.
505 		 */
506 		struct sas_task *task = qc->lldd_task;
507 
508 		qc->lldd_task = NULL;
509 		if (!task)
510 			return;
511 		task->uldd_task = NULL;
512 		sas_ata_internal_abort(task);
513 	}
514 }
515 
516 
517 static void sas_ata_set_dmamode(struct ata_port *ap, struct ata_device *ata_dev)
518 {
519 	struct domain_device *dev = ap->private_data;
520 	struct sas_internal *i = dev_to_sas_internal(dev);
521 
522 	if (i->dft->lldd_ata_set_dmamode)
523 		i->dft->lldd_ata_set_dmamode(dev);
524 }
525 
526 static struct ata_port_operations sas_sata_ops = {
527 	.prereset		= ata_std_prereset,
528 	.hardreset		= sas_ata_hard_reset,
529 	.postreset		= ata_std_postreset,
530 	.error_handler		= ata_std_error_handler,
531 	.post_internal_cmd	= sas_ata_post_internal,
532 	.qc_defer               = ata_std_qc_defer,
533 	.qc_prep		= ata_noop_qc_prep,
534 	.qc_issue		= sas_ata_qc_issue,
535 	.qc_fill_rtf		= sas_ata_qc_fill_rtf,
536 	.port_start		= ata_sas_port_start,
537 	.port_stop		= ata_sas_port_stop,
538 	.set_dmamode		= sas_ata_set_dmamode,
539 };
540 
541 static struct ata_port_info sata_port_info = {
542 	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ,
543 	.pio_mask = ATA_PIO4,
544 	.mwdma_mask = ATA_MWDMA2,
545 	.udma_mask = ATA_UDMA6,
546 	.port_ops = &sas_sata_ops
547 };
548 
549 int sas_ata_init(struct domain_device *found_dev)
550 {
551 	struct sas_ha_struct *ha = found_dev->port->ha;
552 	struct Scsi_Host *shost = ha->core.shost;
553 	struct ata_port *ap;
554 	int rc;
555 
556 	ata_host_init(&found_dev->sata_dev.ata_host,
557 		      ha->dev,
558 		      sata_port_info.flags,
559 		      &sas_sata_ops);
560 	ap = ata_sas_port_alloc(&found_dev->sata_dev.ata_host,
561 				&sata_port_info,
562 				shost);
563 	if (!ap) {
564 		SAS_DPRINTK("ata_sas_port_alloc failed.\n");
565 		return -ENODEV;
566 	}
567 
568 	ap->private_data = found_dev;
569 	ap->cbl = ATA_CBL_SATA;
570 	ap->scsi_host = shost;
571 	rc = ata_sas_port_init(ap);
572 	if (rc) {
573 		ata_sas_port_destroy(ap);
574 		return rc;
575 	}
576 	found_dev->sata_dev.ap = ap;
577 
578 	return 0;
579 }
580 
581 void sas_ata_task_abort(struct sas_task *task)
582 {
583 	struct ata_queued_cmd *qc = task->uldd_task;
584 	struct completion *waiting;
585 
586 	/* Bounce SCSI-initiated commands to the SCSI EH */
587 	if (qc->scsicmd) {
588 		struct request_queue *q = qc->scsicmd->device->request_queue;
589 		unsigned long flags;
590 
591 		spin_lock_irqsave(q->queue_lock, flags);
592 		blk_abort_request(qc->scsicmd->request);
593 		spin_unlock_irqrestore(q->queue_lock, flags);
594 		scsi_schedule_eh(qc->scsicmd->device->host);
595 		return;
596 	}
597 
598 	/* Internal command, fake a timeout and complete. */
599 	qc->flags &= ~ATA_QCFLAG_ACTIVE;
600 	qc->flags |= ATA_QCFLAG_FAILED;
601 	qc->err_mask |= AC_ERR_TIMEOUT;
602 	waiting = qc->private_data;
603 	complete(waiting);
604 }
605 
606 static void sas_get_ata_command_set(struct domain_device *dev)
607 {
608 	struct dev_to_host_fis *fis =
609 		(struct dev_to_host_fis *) dev->frame_rcvd;
610 
611 	if (dev->dev_type == SATA_PENDING)
612 		return;
613 
614 	if ((fis->sector_count == 1 && /* ATA */
615 	     fis->lbal         == 1 &&
616 	     fis->lbam         == 0 &&
617 	     fis->lbah         == 0 &&
618 	     fis->device       == 0)
619 	    ||
620 	    (fis->sector_count == 0 && /* CE-ATA (mATA) */
621 	     fis->lbal         == 0 &&
622 	     fis->lbam         == 0xCE &&
623 	     fis->lbah         == 0xAA &&
624 	     (fis->device & ~0x10) == 0))
625 
626 		dev->sata_dev.command_set = ATA_COMMAND_SET;
627 
628 	else if ((fis->interrupt_reason == 1 &&	/* ATAPI */
629 		  fis->lbal             == 1 &&
630 		  fis->byte_count_low   == 0x14 &&
631 		  fis->byte_count_high  == 0xEB &&
632 		  (fis->device & ~0x10) == 0))
633 
634 		dev->sata_dev.command_set = ATAPI_COMMAND_SET;
635 
636 	else if ((fis->sector_count == 1 && /* SEMB */
637 		  fis->lbal         == 1 &&
638 		  fis->lbam         == 0x3C &&
639 		  fis->lbah         == 0xC3 &&
640 		  fis->device       == 0)
641 		||
642 		 (fis->interrupt_reason == 1 &&	/* SATA PM */
643 		  fis->lbal             == 1 &&
644 		  fis->byte_count_low   == 0x69 &&
645 		  fis->byte_count_high  == 0x96 &&
646 		  (fis->device & ~0x10) == 0))
647 
648 		/* Treat it as a superset? */
649 		dev->sata_dev.command_set = ATAPI_COMMAND_SET;
650 }
651 
652 void sas_probe_sata(struct asd_sas_port *port)
653 {
654 	struct domain_device *dev, *n;
655 
656 	mutex_lock(&port->ha->disco_mutex);
657 	list_for_each_entry(dev, &port->disco_list, disco_list_node) {
658 		if (!dev_is_sata(dev))
659 			continue;
660 
661 		ata_sas_async_probe(dev->sata_dev.ap);
662 	}
663 	mutex_unlock(&port->ha->disco_mutex);
664 
665 	list_for_each_entry_safe(dev, n, &port->disco_list, disco_list_node) {
666 		if (!dev_is_sata(dev))
667 			continue;
668 
669 		sas_ata_wait_eh(dev);
670 
671 		/* if libata could not bring the link up, don't surface
672 		 * the device
673 		 */
674 		if (ata_dev_disabled(sas_to_ata_dev(dev)))
675 			sas_fail_probe(dev, __func__, -ENODEV);
676 	}
677 }
678 
679 /**
680  * sas_discover_sata -- discover an STP/SATA domain device
681  * @dev: pointer to struct domain_device of interest
682  *
683  * Devices directly attached to a HA port, have no parents.  All other
684  * devices do, and should have their "parent" pointer set appropriately
685  * before calling this function.
686  */
687 int sas_discover_sata(struct domain_device *dev)
688 {
689 	int res;
690 
691 	if (dev->dev_type == SATA_PM)
692 		return -ENODEV;
693 
694 	sas_get_ata_command_set(dev);
695 	sas_fill_in_rphy(dev, dev->rphy);
696 
697 	res = sas_notify_lldd_dev_found(dev);
698 	if (res)
699 		return res;
700 
701 	sas_discover_event(dev->port, DISCE_PROBE);
702 	return 0;
703 }
704 
705 static void async_sas_ata_eh(void *data, async_cookie_t cookie)
706 {
707 	struct domain_device *dev = data;
708 	struct ata_port *ap = dev->sata_dev.ap;
709 	struct sas_ha_struct *ha = dev->port->ha;
710 
711 	/* hold a reference over eh since we may be racing with final
712 	 * remove once all commands are completed
713 	 */
714 	kref_get(&dev->kref);
715 	sas_ata_printk(KERN_DEBUG, dev, "dev error handler\n");
716 	ata_scsi_port_error_handler(ha->core.shost, ap);
717 	sas_put_device(dev);
718 }
719 
720 void sas_ata_strategy_handler(struct Scsi_Host *shost)
721 {
722 	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
723 	LIST_HEAD(async);
724 	int i;
725 
726 	/* it's ok to defer revalidation events during ata eh, these
727 	 * disks are in one of three states:
728 	 * 1/ present for initial domain discovery, and these
729 	 *    resets will cause bcn flutters
730 	 * 2/ hot removed, we'll discover that after eh fails
731 	 * 3/ hot added after initial discovery, lost the race, and need
732 	 *    to catch the next train.
733 	 */
734 	sas_disable_revalidation(sas_ha);
735 
736 	spin_lock_irq(&sas_ha->phy_port_lock);
737 	for (i = 0; i < sas_ha->num_phys; i++) {
738 		struct asd_sas_port *port = sas_ha->sas_port[i];
739 		struct domain_device *dev;
740 
741 		spin_lock(&port->dev_list_lock);
742 		list_for_each_entry(dev, &port->dev_list, dev_list_node) {
743 			if (!dev_is_sata(dev))
744 				continue;
745 			async_schedule_domain(async_sas_ata_eh, dev, &async);
746 		}
747 		spin_unlock(&port->dev_list_lock);
748 	}
749 	spin_unlock_irq(&sas_ha->phy_port_lock);
750 
751 	async_synchronize_full_domain(&async);
752 
753 	sas_enable_revalidation(sas_ha);
754 }
755 
756 void sas_ata_eh(struct Scsi_Host *shost, struct list_head *work_q,
757 		struct list_head *done_q)
758 {
759 	struct scsi_cmnd *cmd, *n;
760 	struct domain_device *eh_dev;
761 
762 	do {
763 		LIST_HEAD(sata_q);
764 		eh_dev = NULL;
765 
766 		list_for_each_entry_safe(cmd, n, work_q, eh_entry) {
767 			struct domain_device *ddev = cmd_to_domain_dev(cmd);
768 
769 			if (!dev_is_sata(ddev) || TO_SAS_TASK(cmd))
770 				continue;
771 			if (eh_dev && eh_dev != ddev)
772 				continue;
773 			eh_dev = ddev;
774 			list_move(&cmd->eh_entry, &sata_q);
775 		}
776 
777 		if (!list_empty(&sata_q)) {
778 			struct ata_port *ap = eh_dev->sata_dev.ap;
779 
780 			sas_ata_printk(KERN_DEBUG, eh_dev, "cmd error handler\n");
781 			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
782 			/*
783 			 * ata's error handler may leave the cmd on the list
784 			 * so make sure they don't remain on a stack list
785 			 * about to go out of scope.
786 			 *
787 			 * This looks strange, since the commands are
788 			 * now part of no list, but the next error
789 			 * action will be ata_port_error_handler()
790 			 * which takes no list and sweeps them up
791 			 * anyway from the ata tag array.
792 			 */
793 			while (!list_empty(&sata_q))
794 				list_del_init(sata_q.next);
795 		}
796 	} while (eh_dev);
797 }
798 
799 void sas_ata_schedule_reset(struct domain_device *dev)
800 {
801 	struct ata_eh_info *ehi;
802 	struct ata_port *ap;
803 	unsigned long flags;
804 
805 	if (!dev_is_sata(dev))
806 		return;
807 
808 	ap = dev->sata_dev.ap;
809 	ehi = &ap->link.eh_info;
810 
811 	spin_lock_irqsave(ap->lock, flags);
812 	ehi->err_mask |= AC_ERR_TIMEOUT;
813 	ehi->action |= ATA_EH_RESET;
814 	ata_port_schedule_eh(ap);
815 	spin_unlock_irqrestore(ap->lock, flags);
816 }
817 EXPORT_SYMBOL_GPL(sas_ata_schedule_reset);
818 
819 void sas_ata_wait_eh(struct domain_device *dev)
820 {
821 	struct ata_port *ap;
822 
823 	if (!dev_is_sata(dev))
824 		return;
825 
826 	ap = dev->sata_dev.ap;
827 	ata_port_wait_eh(ap);
828 }
829