Linux Audio

Check our new training course

Loading...
v4.10.11
  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
 41static 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
 95static 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.class == ATA_DEV_ATAPI))) {
142		memcpy(dev->sata_dev.fis, resp->ending_fis, ATA_RESP_FIS_SIZE);
143
144		if (!link->sactive) {
145			qc->err_mask |= ac_err_mask(dev->sata_dev.fis[2]);
146		} else {
147			link->eh_info.err_mask |= ac_err_mask(dev->sata_dev.fis[2]);
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.fis[3] = 0x04; /* status err */
165			dev->sata_dev.fis[2] = ATA_ERR;
166		}
167	}
168
169	qc->lldd_task = NULL;
170	ata_qc_complete(qc);
171	spin_unlock_irqrestore(ap->lock, flags);
172
173qc_already_gone:
174	sas_free_task(task);
175}
176
177static unsigned int sas_ata_qc_issue(struct ata_queued_cmd *qc)
178{
179	unsigned long flags;
180	struct sas_task *task;
181	struct scatterlist *sg;
182	int ret = AC_ERR_SYSTEM;
183	unsigned int si, xfer = 0;
184	struct ata_port *ap = qc->ap;
185	struct domain_device *dev = ap->private_data;
186	struct sas_ha_struct *sas_ha = dev->port->ha;
187	struct Scsi_Host *host = sas_ha->core.shost;
188	struct sas_internal *i = to_sas_internal(host->transportt);
189
190	/* TODO: audit callers to ensure they are ready for qc_issue to
191	 * unconditionally re-enable interrupts
192	 */
193	local_irq_save(flags);
194	spin_unlock(ap->lock);
195
196	/* If the device fell off, no sense in issuing commands */
197	if (test_bit(SAS_DEV_GONE, &dev->state))
198		goto out;
199
200	task = sas_alloc_task(GFP_ATOMIC);
201	if (!task)
202		goto out;
203	task->dev = dev;
204	task->task_proto = SAS_PROTOCOL_STP;
205	task->task_done = sas_ata_task_done;
206
207	if (qc->tf.command == ATA_CMD_FPDMA_WRITE ||
208	    qc->tf.command == ATA_CMD_FPDMA_READ ||
209	    qc->tf.command == ATA_CMD_FPDMA_RECV ||
210	    qc->tf.command == ATA_CMD_FPDMA_SEND ||
211	    qc->tf.command == ATA_CMD_NCQ_NON_DATA) {
212		/* Need to zero out the tag libata assigned us */
213		qc->tf.nsect = 0;
214	}
215
216	ata_tf_to_fis(&qc->tf, qc->dev->link->pmp, 1, (u8 *)&task->ata_task.fis);
217	task->uldd_task = qc;
218	if (ata_is_atapi(qc->tf.protocol)) {
219		memcpy(task->ata_task.atapi_packet, qc->cdb, qc->dev->cdb_len);
220		task->total_xfer_len = qc->nbytes;
221		task->num_scatter = qc->n_elem;
222	} else {
223		for_each_sg(qc->sg, sg, qc->n_elem, si)
224			xfer += sg_dma_len(sg);
225
226		task->total_xfer_len = xfer;
227		task->num_scatter = si;
228	}
229
230	task->data_dir = qc->dma_dir;
231	task->scatter = qc->sg;
232	task->ata_task.retry_count = 1;
233	task->task_state_flags = SAS_TASK_STATE_PENDING;
234	qc->lldd_task = task;
235
236	task->ata_task.use_ncq = ata_is_ncq(qc->tf.protocol);
237	task->ata_task.dma_xfer = ata_is_dma(qc->tf.protocol);
238
239	if (qc->scsicmd)
240		ASSIGN_SAS_TASK(qc->scsicmd, task);
241
242	ret = i->dft->lldd_execute_task(task, GFP_ATOMIC);
243	if (ret) {
244		SAS_DPRINTK("lldd_execute_task returned: %d\n", ret);
245
246		if (qc->scsicmd)
247			ASSIGN_SAS_TASK(qc->scsicmd, NULL);
248		sas_free_task(task);
249		qc->lldd_task = NULL;
250		ret = AC_ERR_SYSTEM;
251	}
252
253 out:
254	spin_lock(ap->lock);
255	local_irq_restore(flags);
256	return ret;
257}
258
259static bool sas_ata_qc_fill_rtf(struct ata_queued_cmd *qc)
260{
261	struct domain_device *dev = qc->ap->private_data;
262
263	ata_tf_from_fis(dev->sata_dev.fis, &qc->result_tf);
264	return true;
265}
266
267static struct sas_internal *dev_to_sas_internal(struct domain_device *dev)
268{
269	return to_sas_internal(dev->port->ha->core.shost->transportt);
270}
271
272static int sas_get_ata_command_set(struct domain_device *dev);
273
274int sas_get_ata_info(struct domain_device *dev, struct ex_phy *phy)
275{
276	if (phy->attached_tproto & SAS_PROTOCOL_STP)
277		dev->tproto = phy->attached_tproto;
278	if (phy->attached_sata_dev)
279		dev->tproto |= SAS_SATA_DEV;
280
281	if (phy->attached_dev_type == SAS_SATA_PENDING)
282		dev->dev_type = SAS_SATA_PENDING;
283	else {
284		int res;
285
286		dev->dev_type = SAS_SATA_DEV;
287		res = sas_get_report_phy_sata(dev->parent, phy->phy_id,
288					      &dev->sata_dev.rps_resp);
289		if (res) {
290			SAS_DPRINTK("report phy sata to %016llx:0x%x returned "
291				    "0x%x\n", SAS_ADDR(dev->parent->sas_addr),
292				    phy->phy_id, res);
293			return res;
294		}
295		memcpy(dev->frame_rcvd, &dev->sata_dev.rps_resp.rps.fis,
296		       sizeof(struct dev_to_host_fis));
297		dev->sata_dev.class = sas_get_ata_command_set(dev);
298	}
299	return 0;
300}
301
302static int sas_ata_clear_pending(struct domain_device *dev, struct ex_phy *phy)
303{
304	int res;
305
306	/* we weren't pending, so successfully end the reset sequence now */
307	if (dev->dev_type != SAS_SATA_PENDING)
308		return 1;
309
310	/* hmmm, if this succeeds do we need to repost the domain_device to the
311	 * lldd so it can pick up new parameters?
312	 */
313	res = sas_get_ata_info(dev, phy);
314	if (res)
315		return 0; /* retry */
316	else
317		return 1;
318}
319
320static int smp_ata_check_ready(struct ata_link *link)
321{
322	int res;
323	struct ata_port *ap = link->ap;
324	struct domain_device *dev = ap->private_data;
325	struct domain_device *ex_dev = dev->parent;
326	struct sas_phy *phy = sas_get_local_phy(dev);
327	struct ex_phy *ex_phy = &ex_dev->ex_dev.ex_phy[phy->number];
328
329	res = sas_ex_phy_discover(ex_dev, phy->number);
330	sas_put_local_phy(phy);
331
332	/* break the wait early if the expander is unreachable,
333	 * otherwise keep polling
334	 */
335	if (res == -ECOMM)
336		return res;
337	if (res != SMP_RESP_FUNC_ACC)
338		return 0;
339
340	switch (ex_phy->attached_dev_type) {
341	case SAS_SATA_PENDING:
342		return 0;
343	case SAS_END_DEVICE:
344		if (ex_phy->attached_sata_dev)
345			return sas_ata_clear_pending(dev, ex_phy);
 
346	default:
347		return -ENODEV;
348	}
349}
350
351static int local_ata_check_ready(struct ata_link *link)
352{
353	struct ata_port *ap = link->ap;
354	struct domain_device *dev = ap->private_data;
355	struct sas_internal *i = dev_to_sas_internal(dev);
356
357	if (i->dft->lldd_ata_check_ready)
358		return i->dft->lldd_ata_check_ready(dev);
359	else {
360		/* lldd's that don't implement 'ready' checking get the
361		 * old default behavior of not coordinating reset
362		 * recovery with libata
363		 */
364		return 1;
365	}
366}
367
368static int sas_ata_printk(const char *level, const struct domain_device *ddev,
369			  const char *fmt, ...)
370{
371	struct ata_port *ap = ddev->sata_dev.ap;
372	struct device *dev = &ddev->rphy->dev;
373	struct va_format vaf;
374	va_list args;
375	int r;
376
377	va_start(args, fmt);
378
379	vaf.fmt = fmt;
380	vaf.va = &args;
381
382	r = printk("%ssas: ata%u: %s: %pV",
383		   level, ap->print_id, dev_name(dev), &vaf);
384
385	va_end(args);
386
387	return r;
388}
389
390static int sas_ata_hard_reset(struct ata_link *link, unsigned int *class,
391			      unsigned long deadline)
392{
393	int ret = 0, res;
394	struct sas_phy *phy;
395	struct ata_port *ap = link->ap;
396	int (*check_ready)(struct ata_link *link);
397	struct domain_device *dev = ap->private_data;
398	struct sas_internal *i = dev_to_sas_internal(dev);
399
400	res = i->dft->lldd_I_T_nexus_reset(dev);
401	if (res == -ENODEV)
402		return res;
403
404	if (res != TMF_RESP_FUNC_COMPLETE)
405		sas_ata_printk(KERN_DEBUG, dev, "Unable to reset ata device?\n");
406
407	phy = sas_get_local_phy(dev);
408	if (scsi_is_sas_phy_local(phy))
409		check_ready = local_ata_check_ready;
410	else
411		check_ready = smp_ata_check_ready;
412	sas_put_local_phy(phy);
413
414	ret = ata_wait_after_reset(link, deadline, check_ready);
415	if (ret && ret != -EAGAIN)
416		sas_ata_printk(KERN_ERR, dev, "reset failed (errno=%d)\n", ret);
417
418	*class = dev->sata_dev.class;
419
420	ap->cbl = ATA_CBL_SATA;
421	return ret;
422}
423
424/*
425 * notify the lldd to forget the sas_task for this internal ata command
426 * that bypasses scsi-eh
427 */
428static void sas_ata_internal_abort(struct sas_task *task)
429{
430	struct sas_internal *si = dev_to_sas_internal(task->dev);
431	unsigned long flags;
432	int res;
433
434	spin_lock_irqsave(&task->task_state_lock, flags);
435	if (task->task_state_flags & SAS_TASK_STATE_ABORTED ||
436	    task->task_state_flags & SAS_TASK_STATE_DONE) {
437		spin_unlock_irqrestore(&task->task_state_lock, flags);
438		SAS_DPRINTK("%s: Task %p already finished.\n", __func__,
439			    task);
440		goto out;
441	}
442	task->task_state_flags |= SAS_TASK_STATE_ABORTED;
443	spin_unlock_irqrestore(&task->task_state_lock, flags);
444
445	res = si->dft->lldd_abort_task(task);
446
447	spin_lock_irqsave(&task->task_state_lock, flags);
448	if (task->task_state_flags & SAS_TASK_STATE_DONE ||
449	    res == TMF_RESP_FUNC_COMPLETE) {
450		spin_unlock_irqrestore(&task->task_state_lock, flags);
451		goto out;
452	}
453
454	/* XXX we are not prepared to deal with ->lldd_abort_task()
455	 * failures.  TODO: lldds need to unconditionally forget about
456	 * aborted ata tasks, otherwise we (likely) leak the sas task
457	 * here
458	 */
459	SAS_DPRINTK("%s: Task %p leaked.\n", __func__, task);
460
461	if (!(task->task_state_flags & SAS_TASK_STATE_DONE))
462		task->task_state_flags &= ~SAS_TASK_STATE_ABORTED;
463	spin_unlock_irqrestore(&task->task_state_lock, flags);
464
465	return;
466 out:
467	sas_free_task(task);
468}
469
470static void sas_ata_post_internal(struct ata_queued_cmd *qc)
471{
472	if (qc->flags & ATA_QCFLAG_FAILED)
473		qc->err_mask |= AC_ERR_OTHER;
474
475	if (qc->err_mask) {
476		/*
477		 * Find the sas_task and kill it.  By this point, libata
478		 * has decided to kill the qc and has frozen the port.
479		 * In this state sas_ata_task_done() will no longer free
480		 * the sas_task, so we need to notify the lldd (via
481		 * ->lldd_abort_task) that the task is dead and free it
482		 *  ourselves.
483		 */
484		struct sas_task *task = qc->lldd_task;
485
486		qc->lldd_task = NULL;
487		if (!task)
488			return;
489		task->uldd_task = NULL;
490		sas_ata_internal_abort(task);
491	}
492}
493
494
495static void sas_ata_set_dmamode(struct ata_port *ap, struct ata_device *ata_dev)
496{
497	struct domain_device *dev = ap->private_data;
498	struct sas_internal *i = dev_to_sas_internal(dev);
499
500	if (i->dft->lldd_ata_set_dmamode)
501		i->dft->lldd_ata_set_dmamode(dev);
502}
503
504static void sas_ata_sched_eh(struct ata_port *ap)
505{
506	struct domain_device *dev = ap->private_data;
507	struct sas_ha_struct *ha = dev->port->ha;
508	unsigned long flags;
509
510	spin_lock_irqsave(&ha->lock, flags);
511	if (!test_and_set_bit(SAS_DEV_EH_PENDING, &dev->state))
512		ha->eh_active++;
513	ata_std_sched_eh(ap);
514	spin_unlock_irqrestore(&ha->lock, flags);
515}
516
517void sas_ata_end_eh(struct ata_port *ap)
518{
519	struct domain_device *dev = ap->private_data;
520	struct sas_ha_struct *ha = dev->port->ha;
521	unsigned long flags;
522
523	spin_lock_irqsave(&ha->lock, flags);
524	if (test_and_clear_bit(SAS_DEV_EH_PENDING, &dev->state))
525		ha->eh_active--;
526	spin_unlock_irqrestore(&ha->lock, flags);
527}
528
529static struct ata_port_operations sas_sata_ops = {
530	.prereset		= ata_std_prereset,
531	.hardreset		= sas_ata_hard_reset,
532	.postreset		= ata_std_postreset,
533	.error_handler		= ata_std_error_handler,
534	.post_internal_cmd	= sas_ata_post_internal,
535	.qc_defer               = ata_std_qc_defer,
536	.qc_prep		= ata_noop_qc_prep,
537	.qc_issue		= sas_ata_qc_issue,
538	.qc_fill_rtf		= sas_ata_qc_fill_rtf,
539	.port_start		= ata_sas_port_start,
540	.port_stop		= ata_sas_port_stop,
541	.set_dmamode		= sas_ata_set_dmamode,
542	.sched_eh		= sas_ata_sched_eh,
543	.end_eh			= sas_ata_end_eh,
544};
545
546static struct ata_port_info sata_port_info = {
547	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ |
548		 ATA_FLAG_SAS_HOST | ATA_FLAG_FPDMA_AUX,
549	.pio_mask = ATA_PIO4,
550	.mwdma_mask = ATA_MWDMA2,
551	.udma_mask = ATA_UDMA6,
552	.port_ops = &sas_sata_ops
553};
554
555int sas_ata_init(struct domain_device *found_dev)
556{
557	struct sas_ha_struct *ha = found_dev->port->ha;
558	struct Scsi_Host *shost = ha->core.shost;
559	struct ata_port *ap;
560	int rc;
561
562	ata_host_init(&found_dev->sata_dev.ata_host, ha->dev, &sas_sata_ops);
563	ap = ata_sas_port_alloc(&found_dev->sata_dev.ata_host,
564				&sata_port_info,
565				shost);
566	if (!ap) {
567		SAS_DPRINTK("ata_sas_port_alloc failed.\n");
568		return -ENODEV;
569	}
570
571	ap->private_data = found_dev;
572	ap->cbl = ATA_CBL_SATA;
573	ap->scsi_host = shost;
574	rc = ata_sas_port_init(ap);
575	if (rc) {
576		ata_sas_port_destroy(ap);
577		return rc;
578	}
579	found_dev->sata_dev.ap = ap;
580
581	return 0;
582}
583
584void sas_ata_task_abort(struct sas_task *task)
585{
586	struct ata_queued_cmd *qc = task->uldd_task;
587	struct completion *waiting;
588
589	/* Bounce SCSI-initiated commands to the SCSI EH */
590	if (qc->scsicmd) {
591		struct request_queue *q = qc->scsicmd->device->request_queue;
592		unsigned long flags;
593
594		spin_lock_irqsave(q->queue_lock, flags);
595		blk_abort_request(qc->scsicmd->request);
596		spin_unlock_irqrestore(q->queue_lock, flags);
597		return;
598	}
599
600	/* Internal command, fake a timeout and complete. */
601	qc->flags &= ~ATA_QCFLAG_ACTIVE;
602	qc->flags |= ATA_QCFLAG_FAILED;
603	qc->err_mask |= AC_ERR_TIMEOUT;
604	waiting = qc->private_data;
605	complete(waiting);
606}
607
608static int sas_get_ata_command_set(struct domain_device *dev)
609{
610	struct dev_to_host_fis *fis =
611		(struct dev_to_host_fis *) dev->frame_rcvd;
612	struct ata_taskfile tf;
613
614	if (dev->dev_type == SAS_SATA_PENDING)
615		return ATA_DEV_UNKNOWN;
616
617	ata_tf_from_fis((const u8 *)fis, &tf);
618
619	return ata_dev_classify(&tf);
620}
621
622void sas_probe_sata(struct asd_sas_port *port)
623{
624	struct domain_device *dev, *n;
625
626	mutex_lock(&port->ha->disco_mutex);
627	list_for_each_entry(dev, &port->disco_list, disco_list_node) {
628		if (!dev_is_sata(dev))
629			continue;
630
631		ata_sas_async_probe(dev->sata_dev.ap);
632	}
633	mutex_unlock(&port->ha->disco_mutex);
634
635	list_for_each_entry_safe(dev, n, &port->disco_list, disco_list_node) {
636		if (!dev_is_sata(dev))
637			continue;
638
639		sas_ata_wait_eh(dev);
640
641		/* if libata could not bring the link up, don't surface
642		 * the device
643		 */
644		if (ata_dev_disabled(sas_to_ata_dev(dev)))
645			sas_fail_probe(dev, __func__, -ENODEV);
646	}
647
648}
649
650static void sas_ata_flush_pm_eh(struct asd_sas_port *port, const char *func)
651{
652	struct domain_device *dev, *n;
653
654	list_for_each_entry_safe(dev, n, &port->dev_list, dev_list_node) {
655		if (!dev_is_sata(dev))
656			continue;
657
658		sas_ata_wait_eh(dev);
659
660		/* if libata failed to power manage the device, tear it down */
661		if (ata_dev_disabled(sas_to_ata_dev(dev)))
662			sas_fail_probe(dev, func, -ENODEV);
663	}
664}
665
666void sas_suspend_sata(struct asd_sas_port *port)
667{
668	struct domain_device *dev;
669
670	mutex_lock(&port->ha->disco_mutex);
671	list_for_each_entry(dev, &port->dev_list, dev_list_node) {
672		struct sata_device *sata;
673
674		if (!dev_is_sata(dev))
675			continue;
676
677		sata = &dev->sata_dev;
678		if (sata->ap->pm_mesg.event == PM_EVENT_SUSPEND)
679			continue;
680
681		ata_sas_port_suspend(sata->ap);
682	}
683	mutex_unlock(&port->ha->disco_mutex);
684
685	sas_ata_flush_pm_eh(port, __func__);
686}
687
688void sas_resume_sata(struct asd_sas_port *port)
689{
690	struct domain_device *dev;
691
692	mutex_lock(&port->ha->disco_mutex);
693	list_for_each_entry(dev, &port->dev_list, dev_list_node) {
694		struct sata_device *sata;
695
696		if (!dev_is_sata(dev))
697			continue;
698
699		sata = &dev->sata_dev;
700		if (sata->ap->pm_mesg.event == PM_EVENT_ON)
701			continue;
702
703		ata_sas_port_resume(sata->ap);
704	}
705	mutex_unlock(&port->ha->disco_mutex);
706
707	sas_ata_flush_pm_eh(port, __func__);
708}
709
710/**
711 * sas_discover_sata -- discover an STP/SATA domain device
712 * @dev: pointer to struct domain_device of interest
713 *
714 * Devices directly attached to a HA port, have no parents.  All other
715 * devices do, and should have their "parent" pointer set appropriately
716 * before calling this function.
717 */
718int sas_discover_sata(struct domain_device *dev)
719{
720	int res;
721
722	if (dev->dev_type == SAS_SATA_PM)
723		return -ENODEV;
724
725	dev->sata_dev.class = sas_get_ata_command_set(dev);
726	sas_fill_in_rphy(dev, dev->rphy);
727
728	res = sas_notify_lldd_dev_found(dev);
729	if (res)
730		return res;
731
732	sas_discover_event(dev->port, DISCE_PROBE);
733	return 0;
734}
735
736static void async_sas_ata_eh(void *data, async_cookie_t cookie)
737{
738	struct domain_device *dev = data;
739	struct ata_port *ap = dev->sata_dev.ap;
740	struct sas_ha_struct *ha = dev->port->ha;
741
742	sas_ata_printk(KERN_DEBUG, dev, "dev error handler\n");
743	ata_scsi_port_error_handler(ha->core.shost, ap);
744	sas_put_device(dev);
745}
746
747void sas_ata_strategy_handler(struct Scsi_Host *shost)
748{
749	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
750	ASYNC_DOMAIN_EXCLUSIVE(async);
751	int i;
752
753	/* it's ok to defer revalidation events during ata eh, these
754	 * disks are in one of three states:
755	 * 1/ present for initial domain discovery, and these
756	 *    resets will cause bcn flutters
757	 * 2/ hot removed, we'll discover that after eh fails
758	 * 3/ hot added after initial discovery, lost the race, and need
759	 *    to catch the next train.
760	 */
761	sas_disable_revalidation(sas_ha);
762
763	spin_lock_irq(&sas_ha->phy_port_lock);
764	for (i = 0; i < sas_ha->num_phys; i++) {
765		struct asd_sas_port *port = sas_ha->sas_port[i];
766		struct domain_device *dev;
767
768		spin_lock(&port->dev_list_lock);
769		list_for_each_entry(dev, &port->dev_list, dev_list_node) {
770			if (!dev_is_sata(dev))
771				continue;
772
773			/* hold a reference over eh since we may be
774			 * racing with final remove once all commands
775			 * are completed
776			 */
777			kref_get(&dev->kref);
778
779			async_schedule_domain(async_sas_ata_eh, dev, &async);
780		}
781		spin_unlock(&port->dev_list_lock);
782	}
783	spin_unlock_irq(&sas_ha->phy_port_lock);
784
785	async_synchronize_full_domain(&async);
786
787	sas_enable_revalidation(sas_ha);
788}
789
790void sas_ata_eh(struct Scsi_Host *shost, struct list_head *work_q,
791		struct list_head *done_q)
792{
793	struct scsi_cmnd *cmd, *n;
794	struct domain_device *eh_dev;
795
796	do {
797		LIST_HEAD(sata_q);
798		eh_dev = NULL;
799
800		list_for_each_entry_safe(cmd, n, work_q, eh_entry) {
801			struct domain_device *ddev = cmd_to_domain_dev(cmd);
802
803			if (!dev_is_sata(ddev) || TO_SAS_TASK(cmd))
804				continue;
805			if (eh_dev && eh_dev != ddev)
806				continue;
807			eh_dev = ddev;
808			list_move(&cmd->eh_entry, &sata_q);
809		}
810
811		if (!list_empty(&sata_q)) {
812			struct ata_port *ap = eh_dev->sata_dev.ap;
813
814			sas_ata_printk(KERN_DEBUG, eh_dev, "cmd error handler\n");
815			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
816			/*
817			 * ata's error handler may leave the cmd on the list
818			 * so make sure they don't remain on a stack list
819			 * about to go out of scope.
820			 *
821			 * This looks strange, since the commands are
822			 * now part of no list, but the next error
823			 * action will be ata_port_error_handler()
824			 * which takes no list and sweeps them up
825			 * anyway from the ata tag array.
826			 */
827			while (!list_empty(&sata_q))
828				list_del_init(sata_q.next);
829		}
830	} while (eh_dev);
831}
832
833void sas_ata_schedule_reset(struct domain_device *dev)
834{
835	struct ata_eh_info *ehi;
836	struct ata_port *ap;
837	unsigned long flags;
838
839	if (!dev_is_sata(dev))
840		return;
841
842	ap = dev->sata_dev.ap;
843	ehi = &ap->link.eh_info;
844
845	spin_lock_irqsave(ap->lock, flags);
846	ehi->err_mask |= AC_ERR_TIMEOUT;
847	ehi->action |= ATA_EH_RESET;
848	ata_port_schedule_eh(ap);
849	spin_unlock_irqrestore(ap->lock, flags);
850}
851EXPORT_SYMBOL_GPL(sas_ata_schedule_reset);
852
853void sas_ata_wait_eh(struct domain_device *dev)
854{
855	struct ata_port *ap;
856
857	if (!dev_is_sata(dev))
858		return;
859
860	ap = dev->sata_dev.ap;
861	ata_port_wait_eh(ap);
862}
v4.17
  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
 41static 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
 95static 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.class == ATA_DEV_ATAPI))) {
142		memcpy(dev->sata_dev.fis, resp->ending_fis, ATA_RESP_FIS_SIZE);
143
144		if (!link->sactive) {
145			qc->err_mask |= ac_err_mask(dev->sata_dev.fis[2]);
146		} else {
147			link->eh_info.err_mask |= ac_err_mask(dev->sata_dev.fis[2]);
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.fis[3] = 0x04; /* status err */
165			dev->sata_dev.fis[2] = ATA_ERR;
166		}
167	}
168
169	qc->lldd_task = NULL;
170	ata_qc_complete(qc);
171	spin_unlock_irqrestore(ap->lock, flags);
172
173qc_already_gone:
174	sas_free_task(task);
175}
176
177static unsigned int sas_ata_qc_issue(struct ata_queued_cmd *qc)
178{
179	unsigned long flags;
180	struct sas_task *task;
181	struct scatterlist *sg;
182	int ret = AC_ERR_SYSTEM;
183	unsigned int si, xfer = 0;
184	struct ata_port *ap = qc->ap;
185	struct domain_device *dev = ap->private_data;
186	struct sas_ha_struct *sas_ha = dev->port->ha;
187	struct Scsi_Host *host = sas_ha->core.shost;
188	struct sas_internal *i = to_sas_internal(host->transportt);
189
190	/* TODO: audit callers to ensure they are ready for qc_issue to
191	 * unconditionally re-enable interrupts
192	 */
193	local_irq_save(flags);
194	spin_unlock(ap->lock);
195
196	/* If the device fell off, no sense in issuing commands */
197	if (test_bit(SAS_DEV_GONE, &dev->state))
198		goto out;
199
200	task = sas_alloc_task(GFP_ATOMIC);
201	if (!task)
202		goto out;
203	task->dev = dev;
204	task->task_proto = SAS_PROTOCOL_STP;
205	task->task_done = sas_ata_task_done;
206
207	if (qc->tf.command == ATA_CMD_FPDMA_WRITE ||
208	    qc->tf.command == ATA_CMD_FPDMA_READ ||
209	    qc->tf.command == ATA_CMD_FPDMA_RECV ||
210	    qc->tf.command == ATA_CMD_FPDMA_SEND ||
211	    qc->tf.command == ATA_CMD_NCQ_NON_DATA) {
212		/* Need to zero out the tag libata assigned us */
213		qc->tf.nsect = 0;
214	}
215
216	ata_tf_to_fis(&qc->tf, qc->dev->link->pmp, 1, (u8 *)&task->ata_task.fis);
217	task->uldd_task = qc;
218	if (ata_is_atapi(qc->tf.protocol)) {
219		memcpy(task->ata_task.atapi_packet, qc->cdb, qc->dev->cdb_len);
220		task->total_xfer_len = qc->nbytes;
221		task->num_scatter = qc->n_elem;
222	} else {
223		for_each_sg(qc->sg, sg, qc->n_elem, si)
224			xfer += sg_dma_len(sg);
225
226		task->total_xfer_len = xfer;
227		task->num_scatter = si;
228	}
229
230	task->data_dir = qc->dma_dir;
231	task->scatter = qc->sg;
232	task->ata_task.retry_count = 1;
233	task->task_state_flags = SAS_TASK_STATE_PENDING;
234	qc->lldd_task = task;
235
236	task->ata_task.use_ncq = ata_is_ncq(qc->tf.protocol);
237	task->ata_task.dma_xfer = ata_is_dma(qc->tf.protocol);
238
239	if (qc->scsicmd)
240		ASSIGN_SAS_TASK(qc->scsicmd, task);
241
242	ret = i->dft->lldd_execute_task(task, GFP_ATOMIC);
243	if (ret) {
244		SAS_DPRINTK("lldd_execute_task returned: %d\n", ret);
245
246		if (qc->scsicmd)
247			ASSIGN_SAS_TASK(qc->scsicmd, NULL);
248		sas_free_task(task);
249		qc->lldd_task = NULL;
250		ret = AC_ERR_SYSTEM;
251	}
252
253 out:
254	spin_lock(ap->lock);
255	local_irq_restore(flags);
256	return ret;
257}
258
259static bool sas_ata_qc_fill_rtf(struct ata_queued_cmd *qc)
260{
261	struct domain_device *dev = qc->ap->private_data;
262
263	ata_tf_from_fis(dev->sata_dev.fis, &qc->result_tf);
264	return true;
265}
266
267static struct sas_internal *dev_to_sas_internal(struct domain_device *dev)
268{
269	return to_sas_internal(dev->port->ha->core.shost->transportt);
270}
271
272static int sas_get_ata_command_set(struct domain_device *dev);
273
274int sas_get_ata_info(struct domain_device *dev, struct ex_phy *phy)
275{
276	if (phy->attached_tproto & SAS_PROTOCOL_STP)
277		dev->tproto = phy->attached_tproto;
278	if (phy->attached_sata_dev)
279		dev->tproto |= SAS_SATA_DEV;
280
281	if (phy->attached_dev_type == SAS_SATA_PENDING)
282		dev->dev_type = SAS_SATA_PENDING;
283	else {
284		int res;
285
286		dev->dev_type = SAS_SATA_DEV;
287		res = sas_get_report_phy_sata(dev->parent, phy->phy_id,
288					      &dev->sata_dev.rps_resp);
289		if (res) {
290			SAS_DPRINTK("report phy sata to %016llx:0x%x returned "
291				    "0x%x\n", SAS_ADDR(dev->parent->sas_addr),
292				    phy->phy_id, res);
293			return res;
294		}
295		memcpy(dev->frame_rcvd, &dev->sata_dev.rps_resp.rps.fis,
296		       sizeof(struct dev_to_host_fis));
297		dev->sata_dev.class = sas_get_ata_command_set(dev);
298	}
299	return 0;
300}
301
302static int sas_ata_clear_pending(struct domain_device *dev, struct ex_phy *phy)
303{
304	int res;
305
306	/* we weren't pending, so successfully end the reset sequence now */
307	if (dev->dev_type != SAS_SATA_PENDING)
308		return 1;
309
310	/* hmmm, if this succeeds do we need to repost the domain_device to the
311	 * lldd so it can pick up new parameters?
312	 */
313	res = sas_get_ata_info(dev, phy);
314	if (res)
315		return 0; /* retry */
316	else
317		return 1;
318}
319
320static int smp_ata_check_ready(struct ata_link *link)
321{
322	int res;
323	struct ata_port *ap = link->ap;
324	struct domain_device *dev = ap->private_data;
325	struct domain_device *ex_dev = dev->parent;
326	struct sas_phy *phy = sas_get_local_phy(dev);
327	struct ex_phy *ex_phy = &ex_dev->ex_dev.ex_phy[phy->number];
328
329	res = sas_ex_phy_discover(ex_dev, phy->number);
330	sas_put_local_phy(phy);
331
332	/* break the wait early if the expander is unreachable,
333	 * otherwise keep polling
334	 */
335	if (res == -ECOMM)
336		return res;
337	if (res != SMP_RESP_FUNC_ACC)
338		return 0;
339
340	switch (ex_phy->attached_dev_type) {
341	case SAS_SATA_PENDING:
342		return 0;
343	case SAS_END_DEVICE:
344		if (ex_phy->attached_sata_dev)
345			return sas_ata_clear_pending(dev, ex_phy);
346		/* fall through */
347	default:
348		return -ENODEV;
349	}
350}
351
352static int local_ata_check_ready(struct ata_link *link)
353{
354	struct ata_port *ap = link->ap;
355	struct domain_device *dev = ap->private_data;
356	struct sas_internal *i = dev_to_sas_internal(dev);
357
358	if (i->dft->lldd_ata_check_ready)
359		return i->dft->lldd_ata_check_ready(dev);
360	else {
361		/* lldd's that don't implement 'ready' checking get the
362		 * old default behavior of not coordinating reset
363		 * recovery with libata
364		 */
365		return 1;
366	}
367}
368
369static int sas_ata_printk(const char *level, const struct domain_device *ddev,
370			  const char *fmt, ...)
371{
372	struct ata_port *ap = ddev->sata_dev.ap;
373	struct device *dev = &ddev->rphy->dev;
374	struct va_format vaf;
375	va_list args;
376	int r;
377
378	va_start(args, fmt);
379
380	vaf.fmt = fmt;
381	vaf.va = &args;
382
383	r = printk("%ssas: ata%u: %s: %pV",
384		   level, ap->print_id, dev_name(dev), &vaf);
385
386	va_end(args);
387
388	return r;
389}
390
391static int sas_ata_hard_reset(struct ata_link *link, unsigned int *class,
392			      unsigned long deadline)
393{
394	int ret = 0, res;
395	struct sas_phy *phy;
396	struct ata_port *ap = link->ap;
397	int (*check_ready)(struct ata_link *link);
398	struct domain_device *dev = ap->private_data;
399	struct sas_internal *i = dev_to_sas_internal(dev);
400
401	res = i->dft->lldd_I_T_nexus_reset(dev);
402	if (res == -ENODEV)
403		return res;
404
405	if (res != TMF_RESP_FUNC_COMPLETE)
406		sas_ata_printk(KERN_DEBUG, dev, "Unable to reset ata device?\n");
407
408	phy = sas_get_local_phy(dev);
409	if (scsi_is_sas_phy_local(phy))
410		check_ready = local_ata_check_ready;
411	else
412		check_ready = smp_ata_check_ready;
413	sas_put_local_phy(phy);
414
415	ret = ata_wait_after_reset(link, deadline, check_ready);
416	if (ret && ret != -EAGAIN)
417		sas_ata_printk(KERN_ERR, dev, "reset failed (errno=%d)\n", ret);
418
419	*class = dev->sata_dev.class;
420
421	ap->cbl = ATA_CBL_SATA;
422	return ret;
423}
424
425/*
426 * notify the lldd to forget the sas_task for this internal ata command
427 * that bypasses scsi-eh
428 */
429static void sas_ata_internal_abort(struct sas_task *task)
430{
431	struct sas_internal *si = dev_to_sas_internal(task->dev);
432	unsigned long flags;
433	int res;
434
435	spin_lock_irqsave(&task->task_state_lock, flags);
436	if (task->task_state_flags & SAS_TASK_STATE_ABORTED ||
437	    task->task_state_flags & SAS_TASK_STATE_DONE) {
438		spin_unlock_irqrestore(&task->task_state_lock, flags);
439		SAS_DPRINTK("%s: Task %p already finished.\n", __func__,
440			    task);
441		goto out;
442	}
443	task->task_state_flags |= SAS_TASK_STATE_ABORTED;
444	spin_unlock_irqrestore(&task->task_state_lock, flags);
445
446	res = si->dft->lldd_abort_task(task);
447
448	spin_lock_irqsave(&task->task_state_lock, flags);
449	if (task->task_state_flags & SAS_TASK_STATE_DONE ||
450	    res == TMF_RESP_FUNC_COMPLETE) {
451		spin_unlock_irqrestore(&task->task_state_lock, flags);
452		goto out;
453	}
454
455	/* XXX we are not prepared to deal with ->lldd_abort_task()
456	 * failures.  TODO: lldds need to unconditionally forget about
457	 * aborted ata tasks, otherwise we (likely) leak the sas task
458	 * here
459	 */
460	SAS_DPRINTK("%s: Task %p leaked.\n", __func__, task);
461
462	if (!(task->task_state_flags & SAS_TASK_STATE_DONE))
463		task->task_state_flags &= ~SAS_TASK_STATE_ABORTED;
464	spin_unlock_irqrestore(&task->task_state_lock, flags);
465
466	return;
467 out:
468	sas_free_task(task);
469}
470
471static void sas_ata_post_internal(struct ata_queued_cmd *qc)
472{
473	if (qc->flags & ATA_QCFLAG_FAILED)
474		qc->err_mask |= AC_ERR_OTHER;
475
476	if (qc->err_mask) {
477		/*
478		 * Find the sas_task and kill it.  By this point, libata
479		 * has decided to kill the qc and has frozen the port.
480		 * In this state sas_ata_task_done() will no longer free
481		 * the sas_task, so we need to notify the lldd (via
482		 * ->lldd_abort_task) that the task is dead and free it
483		 *  ourselves.
484		 */
485		struct sas_task *task = qc->lldd_task;
486
487		qc->lldd_task = NULL;
488		if (!task)
489			return;
490		task->uldd_task = NULL;
491		sas_ata_internal_abort(task);
492	}
493}
494
495
496static void sas_ata_set_dmamode(struct ata_port *ap, struct ata_device *ata_dev)
497{
498	struct domain_device *dev = ap->private_data;
499	struct sas_internal *i = dev_to_sas_internal(dev);
500
501	if (i->dft->lldd_ata_set_dmamode)
502		i->dft->lldd_ata_set_dmamode(dev);
503}
504
505static void sas_ata_sched_eh(struct ata_port *ap)
506{
507	struct domain_device *dev = ap->private_data;
508	struct sas_ha_struct *ha = dev->port->ha;
509	unsigned long flags;
510
511	spin_lock_irqsave(&ha->lock, flags);
512	if (!test_and_set_bit(SAS_DEV_EH_PENDING, &dev->state))
513		ha->eh_active++;
514	ata_std_sched_eh(ap);
515	spin_unlock_irqrestore(&ha->lock, flags);
516}
517
518void sas_ata_end_eh(struct ata_port *ap)
519{
520	struct domain_device *dev = ap->private_data;
521	struct sas_ha_struct *ha = dev->port->ha;
522	unsigned long flags;
523
524	spin_lock_irqsave(&ha->lock, flags);
525	if (test_and_clear_bit(SAS_DEV_EH_PENDING, &dev->state))
526		ha->eh_active--;
527	spin_unlock_irqrestore(&ha->lock, flags);
528}
529
530static struct ata_port_operations sas_sata_ops = {
531	.prereset		= ata_std_prereset,
532	.hardreset		= sas_ata_hard_reset,
533	.postreset		= ata_std_postreset,
534	.error_handler		= ata_std_error_handler,
535	.post_internal_cmd	= sas_ata_post_internal,
536	.qc_defer               = ata_std_qc_defer,
537	.qc_prep		= ata_noop_qc_prep,
538	.qc_issue		= sas_ata_qc_issue,
539	.qc_fill_rtf		= sas_ata_qc_fill_rtf,
540	.port_start		= ata_sas_port_start,
541	.port_stop		= ata_sas_port_stop,
542	.set_dmamode		= sas_ata_set_dmamode,
543	.sched_eh		= sas_ata_sched_eh,
544	.end_eh			= sas_ata_end_eh,
545};
546
547static struct ata_port_info sata_port_info = {
548	.flags = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA | ATA_FLAG_NCQ |
549		 ATA_FLAG_SAS_HOST | ATA_FLAG_FPDMA_AUX,
550	.pio_mask = ATA_PIO4,
551	.mwdma_mask = ATA_MWDMA2,
552	.udma_mask = ATA_UDMA6,
553	.port_ops = &sas_sata_ops
554};
555
556int sas_ata_init(struct domain_device *found_dev)
557{
558	struct sas_ha_struct *ha = found_dev->port->ha;
559	struct Scsi_Host *shost = ha->core.shost;
560	struct ata_port *ap;
561	int rc;
562
563	ata_host_init(&found_dev->sata_dev.ata_host, ha->dev, &sas_sata_ops);
564	ap = ata_sas_port_alloc(&found_dev->sata_dev.ata_host,
565				&sata_port_info,
566				shost);
567	if (!ap) {
568		SAS_DPRINTK("ata_sas_port_alloc failed.\n");
569		return -ENODEV;
570	}
571
572	ap->private_data = found_dev;
573	ap->cbl = ATA_CBL_SATA;
574	ap->scsi_host = shost;
575	rc = ata_sas_port_init(ap);
576	if (rc) {
577		ata_sas_port_destroy(ap);
578		return rc;
579	}
580	found_dev->sata_dev.ap = ap;
581
582	return 0;
583}
584
585void sas_ata_task_abort(struct sas_task *task)
586{
587	struct ata_queued_cmd *qc = task->uldd_task;
588	struct completion *waiting;
589
590	/* Bounce SCSI-initiated commands to the SCSI EH */
591	if (qc->scsicmd) {
592		struct request_queue *q = qc->scsicmd->device->request_queue;
593		unsigned long flags;
594
595		spin_lock_irqsave(q->queue_lock, flags);
596		blk_abort_request(qc->scsicmd->request);
597		spin_unlock_irqrestore(q->queue_lock, flags);
598		return;
599	}
600
601	/* Internal command, fake a timeout and complete. */
602	qc->flags &= ~ATA_QCFLAG_ACTIVE;
603	qc->flags |= ATA_QCFLAG_FAILED;
604	qc->err_mask |= AC_ERR_TIMEOUT;
605	waiting = qc->private_data;
606	complete(waiting);
607}
608
609static int sas_get_ata_command_set(struct domain_device *dev)
610{
611	struct dev_to_host_fis *fis =
612		(struct dev_to_host_fis *) dev->frame_rcvd;
613	struct ata_taskfile tf;
614
615	if (dev->dev_type == SAS_SATA_PENDING)
616		return ATA_DEV_UNKNOWN;
617
618	ata_tf_from_fis((const u8 *)fis, &tf);
619
620	return ata_dev_classify(&tf);
621}
622
623void sas_probe_sata(struct asd_sas_port *port)
624{
625	struct domain_device *dev, *n;
626
627	mutex_lock(&port->ha->disco_mutex);
628	list_for_each_entry(dev, &port->disco_list, disco_list_node) {
629		if (!dev_is_sata(dev))
630			continue;
631
632		ata_sas_async_probe(dev->sata_dev.ap);
633	}
634	mutex_unlock(&port->ha->disco_mutex);
635
636	list_for_each_entry_safe(dev, n, &port->disco_list, disco_list_node) {
637		if (!dev_is_sata(dev))
638			continue;
639
640		sas_ata_wait_eh(dev);
641
642		/* if libata could not bring the link up, don't surface
643		 * the device
644		 */
645		if (ata_dev_disabled(sas_to_ata_dev(dev)))
646			sas_fail_probe(dev, __func__, -ENODEV);
647	}
648
649}
650
651static void sas_ata_flush_pm_eh(struct asd_sas_port *port, const char *func)
652{
653	struct domain_device *dev, *n;
654
655	list_for_each_entry_safe(dev, n, &port->dev_list, dev_list_node) {
656		if (!dev_is_sata(dev))
657			continue;
658
659		sas_ata_wait_eh(dev);
660
661		/* if libata failed to power manage the device, tear it down */
662		if (ata_dev_disabled(sas_to_ata_dev(dev)))
663			sas_fail_probe(dev, func, -ENODEV);
664	}
665}
666
667void sas_suspend_sata(struct asd_sas_port *port)
668{
669	struct domain_device *dev;
670
671	mutex_lock(&port->ha->disco_mutex);
672	list_for_each_entry(dev, &port->dev_list, dev_list_node) {
673		struct sata_device *sata;
674
675		if (!dev_is_sata(dev))
676			continue;
677
678		sata = &dev->sata_dev;
679		if (sata->ap->pm_mesg.event == PM_EVENT_SUSPEND)
680			continue;
681
682		ata_sas_port_suspend(sata->ap);
683	}
684	mutex_unlock(&port->ha->disco_mutex);
685
686	sas_ata_flush_pm_eh(port, __func__);
687}
688
689void sas_resume_sata(struct asd_sas_port *port)
690{
691	struct domain_device *dev;
692
693	mutex_lock(&port->ha->disco_mutex);
694	list_for_each_entry(dev, &port->dev_list, dev_list_node) {
695		struct sata_device *sata;
696
697		if (!dev_is_sata(dev))
698			continue;
699
700		sata = &dev->sata_dev;
701		if (sata->ap->pm_mesg.event == PM_EVENT_ON)
702			continue;
703
704		ata_sas_port_resume(sata->ap);
705	}
706	mutex_unlock(&port->ha->disco_mutex);
707
708	sas_ata_flush_pm_eh(port, __func__);
709}
710
711/**
712 * sas_discover_sata - discover an STP/SATA domain device
713 * @dev: pointer to struct domain_device of interest
714 *
715 * Devices directly attached to a HA port, have no parents.  All other
716 * devices do, and should have their "parent" pointer set appropriately
717 * before calling this function.
718 */
719int sas_discover_sata(struct domain_device *dev)
720{
721	int res;
722
723	if (dev->dev_type == SAS_SATA_PM)
724		return -ENODEV;
725
726	dev->sata_dev.class = sas_get_ata_command_set(dev);
727	sas_fill_in_rphy(dev, dev->rphy);
728
729	res = sas_notify_lldd_dev_found(dev);
730	if (res)
731		return res;
732
 
733	return 0;
734}
735
736static void async_sas_ata_eh(void *data, async_cookie_t cookie)
737{
738	struct domain_device *dev = data;
739	struct ata_port *ap = dev->sata_dev.ap;
740	struct sas_ha_struct *ha = dev->port->ha;
741
742	sas_ata_printk(KERN_DEBUG, dev, "dev error handler\n");
743	ata_scsi_port_error_handler(ha->core.shost, ap);
744	sas_put_device(dev);
745}
746
747void sas_ata_strategy_handler(struct Scsi_Host *shost)
748{
749	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(shost);
750	ASYNC_DOMAIN_EXCLUSIVE(async);
751	int i;
752
753	/* it's ok to defer revalidation events during ata eh, these
754	 * disks are in one of three states:
755	 * 1/ present for initial domain discovery, and these
756	 *    resets will cause bcn flutters
757	 * 2/ hot removed, we'll discover that after eh fails
758	 * 3/ hot added after initial discovery, lost the race, and need
759	 *    to catch the next train.
760	 */
761	sas_disable_revalidation(sas_ha);
762
763	spin_lock_irq(&sas_ha->phy_port_lock);
764	for (i = 0; i < sas_ha->num_phys; i++) {
765		struct asd_sas_port *port = sas_ha->sas_port[i];
766		struct domain_device *dev;
767
768		spin_lock(&port->dev_list_lock);
769		list_for_each_entry(dev, &port->dev_list, dev_list_node) {
770			if (!dev_is_sata(dev))
771				continue;
772
773			/* hold a reference over eh since we may be
774			 * racing with final remove once all commands
775			 * are completed
776			 */
777			kref_get(&dev->kref);
778
779			async_schedule_domain(async_sas_ata_eh, dev, &async);
780		}
781		spin_unlock(&port->dev_list_lock);
782	}
783	spin_unlock_irq(&sas_ha->phy_port_lock);
784
785	async_synchronize_full_domain(&async);
786
787	sas_enable_revalidation(sas_ha);
788}
789
790void sas_ata_eh(struct Scsi_Host *shost, struct list_head *work_q,
791		struct list_head *done_q)
792{
793	struct scsi_cmnd *cmd, *n;
794	struct domain_device *eh_dev;
795
796	do {
797		LIST_HEAD(sata_q);
798		eh_dev = NULL;
799
800		list_for_each_entry_safe(cmd, n, work_q, eh_entry) {
801			struct domain_device *ddev = cmd_to_domain_dev(cmd);
802
803			if (!dev_is_sata(ddev) || TO_SAS_TASK(cmd))
804				continue;
805			if (eh_dev && eh_dev != ddev)
806				continue;
807			eh_dev = ddev;
808			list_move(&cmd->eh_entry, &sata_q);
809		}
810
811		if (!list_empty(&sata_q)) {
812			struct ata_port *ap = eh_dev->sata_dev.ap;
813
814			sas_ata_printk(KERN_DEBUG, eh_dev, "cmd error handler\n");
815			ata_scsi_cmd_error_handler(shost, ap, &sata_q);
816			/*
817			 * ata's error handler may leave the cmd on the list
818			 * so make sure they don't remain on a stack list
819			 * about to go out of scope.
820			 *
821			 * This looks strange, since the commands are
822			 * now part of no list, but the next error
823			 * action will be ata_port_error_handler()
824			 * which takes no list and sweeps them up
825			 * anyway from the ata tag array.
826			 */
827			while (!list_empty(&sata_q))
828				list_del_init(sata_q.next);
829		}
830	} while (eh_dev);
831}
832
833void sas_ata_schedule_reset(struct domain_device *dev)
834{
835	struct ata_eh_info *ehi;
836	struct ata_port *ap;
837	unsigned long flags;
838
839	if (!dev_is_sata(dev))
840		return;
841
842	ap = dev->sata_dev.ap;
843	ehi = &ap->link.eh_info;
844
845	spin_lock_irqsave(ap->lock, flags);
846	ehi->err_mask |= AC_ERR_TIMEOUT;
847	ehi->action |= ATA_EH_RESET;
848	ata_port_schedule_eh(ap);
849	spin_unlock_irqrestore(ap->lock, flags);
850}
851EXPORT_SYMBOL_GPL(sas_ata_schedule_reset);
852
853void sas_ata_wait_eh(struct domain_device *dev)
854{
855	struct ata_port *ap;
856
857	if (!dev_is_sata(dev))
858		return;
859
860	ap = dev->sata_dev.ap;
861	ata_port_wait_eh(ap);
862}