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