sas_scsi_host.c revision 5319578ca38a8b90b6d0270c194c65d1dd8f7725
1/*
2 * Serial Attached SCSI (SAS) class SCSI Host glue.
3 *
4 * Copyright (C) 2005 Adaptec, Inc.  All rights reserved.
5 * Copyright (C) 2005 Luben Tuikov <luben_tuikov@adaptec.com>
6 *
7 * This file is licensed under GPLv2.
8 *
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License as
11 * published by the Free Software Foundation; either version 2 of the
12 * License, or (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
22 * USA
23 *
24 */
25
26#include <linux/kthread.h>
27
28#include "sas_internal.h"
29
30#include <scsi/scsi_host.h>
31#include <scsi/scsi_device.h>
32#include <scsi/scsi_tcq.h>
33#include <scsi/scsi.h>
34#include <scsi/scsi_eh.h>
35#include <scsi/scsi_transport.h>
36#include <scsi/scsi_transport_sas.h>
37#include <scsi/sas_ata.h>
38#include "../scsi_sas_internal.h"
39#include "../scsi_transport_api.h"
40#include "../scsi_priv.h"
41
42#include <linux/err.h>
43#include <linux/blkdev.h>
44#include <linux/freezer.h>
45#include <linux/scatterlist.h>
46#include <linux/libata.h>
47
48/* ---------- SCSI Host glue ---------- */
49
50static void sas_scsi_task_done(struct sas_task *task)
51{
52	struct task_status_struct *ts = &task->task_status;
53	struct scsi_cmnd *sc = task->uldd_task;
54	int hs = 0, stat = 0;
55
56	if (unlikely(task->task_state_flags & SAS_TASK_STATE_ABORTED)) {
57		/* Aborted tasks will be completed by the error handler */
58		SAS_DPRINTK("task done but aborted\n");
59		return;
60	}
61
62	if (unlikely(!sc)) {
63		SAS_DPRINTK("task_done called with non existing SCSI cmnd!\n");
64		list_del_init(&task->list);
65		sas_free_task(task);
66		return;
67	}
68
69	if (ts->resp == SAS_TASK_UNDELIVERED) {
70		/* transport error */
71		hs = DID_NO_CONNECT;
72	} else { /* ts->resp == SAS_TASK_COMPLETE */
73		/* task delivered, what happened afterwards? */
74		switch (ts->stat) {
75		case SAS_DEV_NO_RESPONSE:
76		case SAS_INTERRUPTED:
77		case SAS_PHY_DOWN:
78		case SAS_NAK_R_ERR:
79		case SAS_OPEN_TO:
80			hs = DID_NO_CONNECT;
81			break;
82		case SAS_DATA_UNDERRUN:
83			scsi_set_resid(sc, ts->residual);
84			if (scsi_bufflen(sc) - scsi_get_resid(sc) < sc->underflow)
85				hs = DID_ERROR;
86			break;
87		case SAS_DATA_OVERRUN:
88			hs = DID_ERROR;
89			break;
90		case SAS_QUEUE_FULL:
91			hs = DID_SOFT_ERROR; /* retry */
92			break;
93		case SAS_DEVICE_UNKNOWN:
94			hs = DID_BAD_TARGET;
95			break;
96		case SAS_SG_ERR:
97			hs = DID_PARITY;
98			break;
99		case SAS_OPEN_REJECT:
100			if (ts->open_rej_reason == SAS_OREJ_RSVD_RETRY)
101				hs = DID_SOFT_ERROR; /* retry */
102			else
103				hs = DID_ERROR;
104			break;
105		case SAS_PROTO_RESPONSE:
106			SAS_DPRINTK("LLDD:%s sent SAS_PROTO_RESP for an SSP "
107				    "task; please report this\n",
108				    task->dev->port->ha->sas_ha_name);
109			break;
110		case SAS_ABORTED_TASK:
111			hs = DID_ABORT;
112			break;
113		case SAM_CHECK_COND:
114			memcpy(sc->sense_buffer, ts->buf,
115			       min(SCSI_SENSE_BUFFERSIZE, ts->buf_valid_size));
116			stat = SAM_CHECK_COND;
117			break;
118		default:
119			stat = ts->stat;
120			break;
121		}
122	}
123	ASSIGN_SAS_TASK(sc, NULL);
124	sc->result = (hs << 16) | stat;
125	list_del_init(&task->list);
126	sas_free_task(task);
127	sc->scsi_done(sc);
128}
129
130static enum task_attribute sas_scsi_get_task_attr(struct scsi_cmnd *cmd)
131{
132	enum task_attribute ta = TASK_ATTR_SIMPLE;
133	if (cmd->request && blk_rq_tagged(cmd->request)) {
134		if (cmd->device->ordered_tags &&
135		    (cmd->request->cmd_flags & REQ_HARDBARRIER))
136			ta = TASK_ATTR_ORDERED;
137	}
138	return ta;
139}
140
141static struct sas_task *sas_create_task(struct scsi_cmnd *cmd,
142					       struct domain_device *dev,
143					       gfp_t gfp_flags)
144{
145	struct sas_task *task = sas_alloc_task(gfp_flags);
146	struct scsi_lun lun;
147
148	if (!task)
149		return NULL;
150
151	task->uldd_task = cmd;
152	ASSIGN_SAS_TASK(cmd, task);
153
154	task->dev = dev;
155	task->task_proto = task->dev->tproto; /* BUG_ON(!SSP) */
156
157	task->ssp_task.retry_count = 1;
158	int_to_scsilun(cmd->device->lun, &lun);
159	memcpy(task->ssp_task.LUN, &lun.scsi_lun, 8);
160	task->ssp_task.task_attr = sas_scsi_get_task_attr(cmd);
161	memcpy(task->ssp_task.cdb, cmd->cmnd, 16);
162
163	task->scatter = scsi_sglist(cmd);
164	task->num_scatter = scsi_sg_count(cmd);
165	task->total_xfer_len = scsi_bufflen(cmd);
166	task->data_dir = cmd->sc_data_direction;
167
168	task->task_done = sas_scsi_task_done;
169
170	return task;
171}
172
173int sas_queue_up(struct sas_task *task)
174{
175	struct sas_ha_struct *sas_ha = task->dev->port->ha;
176	struct scsi_core *core = &sas_ha->core;
177	unsigned long flags;
178	LIST_HEAD(list);
179
180	spin_lock_irqsave(&core->task_queue_lock, flags);
181	if (sas_ha->lldd_queue_size < core->task_queue_size + 1) {
182		spin_unlock_irqrestore(&core->task_queue_lock, flags);
183		return -SAS_QUEUE_FULL;
184	}
185	list_add_tail(&task->list, &core->task_queue);
186	core->task_queue_size += 1;
187	spin_unlock_irqrestore(&core->task_queue_lock, flags);
188	wake_up_process(core->queue_thread);
189
190	return 0;
191}
192
193/**
194 * sas_queuecommand -- Enqueue a command for processing
195 * @parameters: See SCSI Core documentation
196 *
197 * Note: XXX: Remove the host unlock/lock pair when SCSI Core can
198 * call us without holding an IRQ spinlock...
199 */
200int sas_queuecommand(struct scsi_cmnd *cmd,
201		     void (*scsi_done)(struct scsi_cmnd *))
202	__releases(host->host_lock)
203	__acquires(dev->sata_dev.ap->lock)
204	__releases(dev->sata_dev.ap->lock)
205	__acquires(host->host_lock)
206{
207	int res = 0;
208	struct domain_device *dev = cmd_to_domain_dev(cmd);
209	struct Scsi_Host *host = cmd->device->host;
210	struct sas_internal *i = to_sas_internal(host->transportt);
211
212	spin_unlock_irq(host->host_lock);
213
214	{
215		struct sas_ha_struct *sas_ha = dev->port->ha;
216		struct sas_task *task;
217
218		if (dev_is_sata(dev)) {
219			unsigned long flags;
220
221			spin_lock_irqsave(dev->sata_dev.ap->lock, flags);
222			res = ata_sas_queuecmd(cmd, scsi_done,
223					       dev->sata_dev.ap);
224			spin_unlock_irqrestore(dev->sata_dev.ap->lock, flags);
225			goto out;
226		}
227
228		res = -ENOMEM;
229		task = sas_create_task(cmd, dev, GFP_ATOMIC);
230		if (!task)
231			goto out;
232
233		cmd->scsi_done = scsi_done;
234		/* Queue up, Direct Mode or Task Collector Mode. */
235		if (sas_ha->lldd_max_execute_num < 2)
236			res = i->dft->lldd_execute_task(task, 1, GFP_ATOMIC);
237		else
238			res = sas_queue_up(task);
239
240		/* Examine */
241		if (res) {
242			SAS_DPRINTK("lldd_execute_task returned: %d\n", res);
243			ASSIGN_SAS_TASK(cmd, NULL);
244			sas_free_task(task);
245			if (res == -SAS_QUEUE_FULL) {
246				cmd->result = DID_SOFT_ERROR << 16; /* retry */
247				res = 0;
248				scsi_done(cmd);
249			}
250			goto out;
251		}
252	}
253out:
254	spin_lock_irq(host->host_lock);
255	return res;
256}
257
258static void sas_eh_finish_cmd(struct scsi_cmnd *cmd)
259{
260	struct sas_task *task = TO_SAS_TASK(cmd);
261	struct sas_ha_struct *sas_ha = SHOST_TO_SAS_HA(cmd->device->host);
262
263	/* remove the aborted task flag to allow the task to be
264	 * completed now. At this point, we only get called following
265	 * an actual abort of the task, so we should be guaranteed not
266	 * to be racing with any completions from the LLD (hence we
267	 * don't need the task state lock to clear the flag) */
268	task->task_state_flags &= ~SAS_TASK_STATE_ABORTED;
269	/* Now call task_done.  However, task will be free'd after
270	 * this */
271	task->task_done(task);
272	/* now finish the command and move it on to the error
273	 * handler done list, this also takes it off the
274	 * error handler pending list */
275	scsi_eh_finish_cmd(cmd, &sas_ha->eh_done_q);
276}
277
278static void sas_scsi_clear_queue_lu(struct list_head *error_q, struct scsi_cmnd *my_cmd)
279{
280	struct scsi_cmnd *cmd, *n;
281
282	list_for_each_entry_safe(cmd, n, error_q, eh_entry) {
283		if (cmd->device->sdev_target == my_cmd->device->sdev_target &&
284		    cmd->device->lun == my_cmd->device->lun)
285			sas_eh_finish_cmd(cmd);
286	}
287}
288
289static void sas_scsi_clear_queue_I_T(struct list_head *error_q,
290				     struct domain_device *dev)
291{
292	struct scsi_cmnd *cmd, *n;
293
294	list_for_each_entry_safe(cmd, n, error_q, eh_entry) {
295		struct domain_device *x = cmd_to_domain_dev(cmd);
296
297		if (x == dev)
298			sas_eh_finish_cmd(cmd);
299	}
300}
301
302static void sas_scsi_clear_queue_port(struct list_head *error_q,
303				      struct asd_sas_port *port)
304{
305	struct scsi_cmnd *cmd, *n;
306
307	list_for_each_entry_safe(cmd, n, error_q, eh_entry) {
308		struct domain_device *dev = cmd_to_domain_dev(cmd);
309		struct asd_sas_port *x = dev->port;
310
311		if (x == port)
312			sas_eh_finish_cmd(cmd);
313	}
314}
315
316enum task_disposition {
317	TASK_IS_DONE,
318	TASK_IS_ABORTED,
319	TASK_IS_AT_LU,
320	TASK_IS_NOT_AT_LU,
321	TASK_ABORT_FAILED,
322};
323
324static enum task_disposition sas_scsi_find_task(struct sas_task *task)
325{
326	struct sas_ha_struct *ha = task->dev->port->ha;
327	unsigned long flags;
328	int i, res;
329	struct sas_internal *si =
330		to_sas_internal(task->dev->port->ha->core.shost->transportt);
331
332	if (ha->lldd_max_execute_num > 1) {
333		struct scsi_core *core = &ha->core;
334		struct sas_task *t, *n;
335
336		spin_lock_irqsave(&core->task_queue_lock, flags);
337		list_for_each_entry_safe(t, n, &core->task_queue, list) {
338			if (task == t) {
339				list_del_init(&t->list);
340				spin_unlock_irqrestore(&core->task_queue_lock,
341						       flags);
342				SAS_DPRINTK("%s: task 0x%p aborted from "
343					    "task_queue\n",
344					    __FUNCTION__, task);
345				return TASK_IS_ABORTED;
346			}
347		}
348		spin_unlock_irqrestore(&core->task_queue_lock, flags);
349	}
350
351	for (i = 0; i < 5; i++) {
352		SAS_DPRINTK("%s: aborting task 0x%p\n", __FUNCTION__, task);
353		res = si->dft->lldd_abort_task(task);
354
355		spin_lock_irqsave(&task->task_state_lock, flags);
356		if (task->task_state_flags & SAS_TASK_STATE_DONE) {
357			spin_unlock_irqrestore(&task->task_state_lock, flags);
358			SAS_DPRINTK("%s: task 0x%p is done\n", __FUNCTION__,
359				    task);
360			return TASK_IS_DONE;
361		}
362		spin_unlock_irqrestore(&task->task_state_lock, flags);
363
364		if (res == TMF_RESP_FUNC_COMPLETE) {
365			SAS_DPRINTK("%s: task 0x%p is aborted\n",
366				    __FUNCTION__, task);
367			return TASK_IS_ABORTED;
368		} else if (si->dft->lldd_query_task) {
369			SAS_DPRINTK("%s: querying task 0x%p\n",
370				    __FUNCTION__, task);
371			res = si->dft->lldd_query_task(task);
372			switch (res) {
373			case TMF_RESP_FUNC_SUCC:
374				SAS_DPRINTK("%s: task 0x%p at LU\n",
375					    __FUNCTION__, task);
376				return TASK_IS_AT_LU;
377			case TMF_RESP_FUNC_COMPLETE:
378				SAS_DPRINTK("%s: task 0x%p not at LU\n",
379					    __FUNCTION__, task);
380				return TASK_IS_NOT_AT_LU;
381			case TMF_RESP_FUNC_FAILED:
382                                SAS_DPRINTK("%s: task 0x%p failed to abort\n",
383                                                __FUNCTION__, task);
384                                return TASK_ABORT_FAILED;
385                        }
386
387		}
388	}
389	return res;
390}
391
392static int sas_recover_lu(struct domain_device *dev, struct scsi_cmnd *cmd)
393{
394	int res = TMF_RESP_FUNC_FAILED;
395	struct scsi_lun lun;
396	struct sas_internal *i =
397		to_sas_internal(dev->port->ha->core.shost->transportt);
398
399	int_to_scsilun(cmd->device->lun, &lun);
400
401	SAS_DPRINTK("eh: device %llx LUN %x has the task\n",
402		    SAS_ADDR(dev->sas_addr),
403		    cmd->device->lun);
404
405	if (i->dft->lldd_abort_task_set)
406		res = i->dft->lldd_abort_task_set(dev, lun.scsi_lun);
407
408	if (res == TMF_RESP_FUNC_FAILED) {
409		if (i->dft->lldd_clear_task_set)
410			res = i->dft->lldd_clear_task_set(dev, lun.scsi_lun);
411	}
412
413	if (res == TMF_RESP_FUNC_FAILED) {
414		if (i->dft->lldd_lu_reset)
415			res = i->dft->lldd_lu_reset(dev, lun.scsi_lun);
416	}
417
418	return res;
419}
420
421static int sas_recover_I_T(struct domain_device *dev)
422{
423	int res = TMF_RESP_FUNC_FAILED;
424	struct sas_internal *i =
425		to_sas_internal(dev->port->ha->core.shost->transportt);
426
427	SAS_DPRINTK("I_T nexus reset for dev %016llx\n",
428		    SAS_ADDR(dev->sas_addr));
429
430	if (i->dft->lldd_I_T_nexus_reset)
431		res = i->dft->lldd_I_T_nexus_reset(dev);
432
433	return res;
434}
435
436/* Find the sas_phy that's attached to this device */
437struct sas_phy *sas_find_local_phy(struct domain_device *dev)
438{
439	struct domain_device *pdev = dev->parent;
440	struct ex_phy *exphy = NULL;
441	int i;
442
443	/* Directly attached device */
444	if (!pdev)
445		return dev->port->phy;
446
447	/* Otherwise look in the expander */
448	for (i = 0; i < pdev->ex_dev.num_phys; i++)
449		if (!memcmp(dev->sas_addr,
450			    pdev->ex_dev.ex_phy[i].attached_sas_addr,
451			    SAS_ADDR_SIZE)) {
452			exphy = &pdev->ex_dev.ex_phy[i];
453			break;
454		}
455
456	BUG_ON(!exphy);
457	return exphy->phy;
458}
459EXPORT_SYMBOL_GPL(sas_find_local_phy);
460
461/* Attempt to send a LUN reset message to a device */
462int sas_eh_device_reset_handler(struct scsi_cmnd *cmd)
463{
464	struct domain_device *dev = cmd_to_domain_dev(cmd);
465	struct sas_internal *i =
466		to_sas_internal(dev->port->ha->core.shost->transportt);
467	struct scsi_lun lun;
468	int res;
469
470	int_to_scsilun(cmd->device->lun, &lun);
471
472	if (!i->dft->lldd_lu_reset)
473		return FAILED;
474
475	res = i->dft->lldd_lu_reset(dev, lun.scsi_lun);
476	if (res == TMF_RESP_FUNC_SUCC || res == TMF_RESP_FUNC_COMPLETE)
477		return SUCCESS;
478
479	return FAILED;
480}
481
482/* Attempt to send a phy (bus) reset */
483int sas_eh_bus_reset_handler(struct scsi_cmnd *cmd)
484{
485	struct domain_device *dev = cmd_to_domain_dev(cmd);
486	struct sas_phy *phy = sas_find_local_phy(dev);
487	int res;
488
489	res = sas_phy_reset(phy, 1);
490	if (res)
491		SAS_DPRINTK("Bus reset of %s failed 0x%x\n",
492			    kobject_name(&phy->dev.kobj),
493			    res);
494	if (res == TMF_RESP_FUNC_SUCC || res == TMF_RESP_FUNC_COMPLETE)
495		return SUCCESS;
496
497	return FAILED;
498}
499
500/* Try to reset a device */
501static int try_to_reset_cmd_device(struct Scsi_Host *shost,
502				   struct scsi_cmnd *cmd)
503{
504	int res;
505
506	if (!shost->hostt->eh_device_reset_handler)
507		goto try_bus_reset;
508
509	res = shost->hostt->eh_device_reset_handler(cmd);
510	if (res == SUCCESS)
511		return res;
512
513try_bus_reset:
514	if (shost->hostt->eh_bus_reset_handler)
515		return shost->hostt->eh_bus_reset_handler(cmd);
516
517	return FAILED;
518}
519
520static int sas_eh_handle_sas_errors(struct Scsi_Host *shost,
521				    struct list_head *work_q,
522				    struct list_head *done_q)
523{
524	struct scsi_cmnd *cmd, *n;
525	enum task_disposition res = TASK_IS_DONE;
526	int tmf_resp, need_reset;
527	struct sas_internal *i = to_sas_internal(shost->transportt);
528	unsigned long flags;
529	struct sas_ha_struct *ha = SHOST_TO_SAS_HA(shost);
530
531Again:
532	list_for_each_entry_safe(cmd, n, work_q, eh_entry) {
533		struct sas_task *task = TO_SAS_TASK(cmd);
534
535		if (!task)
536			continue;
537
538		list_del_init(&cmd->eh_entry);
539
540		spin_lock_irqsave(&task->task_state_lock, flags);
541		need_reset = task->task_state_flags & SAS_TASK_NEED_DEV_RESET;
542		spin_unlock_irqrestore(&task->task_state_lock, flags);
543
544		SAS_DPRINTK("trying to find task 0x%p\n", task);
545		res = sas_scsi_find_task(task);
546
547		cmd->eh_eflags = 0;
548
549		switch (res) {
550		case TASK_IS_DONE:
551			SAS_DPRINTK("%s: task 0x%p is done\n", __FUNCTION__,
552				    task);
553			sas_eh_finish_cmd(cmd);
554			if (need_reset)
555				try_to_reset_cmd_device(shost, cmd);
556			continue;
557		case TASK_IS_ABORTED:
558			SAS_DPRINTK("%s: task 0x%p is aborted\n",
559				    __FUNCTION__, task);
560			sas_eh_finish_cmd(cmd);
561			if (need_reset)
562				try_to_reset_cmd_device(shost, cmd);
563			continue;
564		case TASK_IS_AT_LU:
565			SAS_DPRINTK("task 0x%p is at LU: lu recover\n", task);
566			tmf_resp = sas_recover_lu(task->dev, cmd);
567			if (tmf_resp == TMF_RESP_FUNC_COMPLETE) {
568				SAS_DPRINTK("dev %016llx LU %x is "
569					    "recovered\n",
570					    SAS_ADDR(task->dev),
571					    cmd->device->lun);
572				sas_eh_finish_cmd(cmd);
573				if (need_reset)
574					try_to_reset_cmd_device(shost, cmd);
575				sas_scsi_clear_queue_lu(work_q, cmd);
576				goto Again;
577			}
578			/* fallthrough */
579		case TASK_IS_NOT_AT_LU:
580		case TASK_ABORT_FAILED:
581			SAS_DPRINTK("task 0x%p is not at LU: I_T recover\n",
582				    task);
583			tmf_resp = sas_recover_I_T(task->dev);
584			if (tmf_resp == TMF_RESP_FUNC_COMPLETE) {
585				SAS_DPRINTK("I_T %016llx recovered\n",
586					    SAS_ADDR(task->dev->sas_addr));
587				sas_eh_finish_cmd(cmd);
588				if (need_reset)
589					try_to_reset_cmd_device(shost, cmd);
590				sas_scsi_clear_queue_I_T(work_q, task->dev);
591				goto Again;
592			}
593			/* Hammer time :-) */
594			if (i->dft->lldd_clear_nexus_port) {
595				struct asd_sas_port *port = task->dev->port;
596				SAS_DPRINTK("clearing nexus for port:%d\n",
597					    port->id);
598				res = i->dft->lldd_clear_nexus_port(port);
599				if (res == TMF_RESP_FUNC_COMPLETE) {
600					SAS_DPRINTK("clear nexus port:%d "
601						    "succeeded\n", port->id);
602					sas_eh_finish_cmd(cmd);
603					if (need_reset)
604						try_to_reset_cmd_device(shost, cmd);
605					sas_scsi_clear_queue_port(work_q,
606								  port);
607					goto Again;
608				}
609			}
610			if (i->dft->lldd_clear_nexus_ha) {
611				SAS_DPRINTK("clear nexus ha\n");
612				res = i->dft->lldd_clear_nexus_ha(ha);
613				if (res == TMF_RESP_FUNC_COMPLETE) {
614					SAS_DPRINTK("clear nexus ha "
615						    "succeeded\n");
616					sas_eh_finish_cmd(cmd);
617					if (need_reset)
618						try_to_reset_cmd_device(shost, cmd);
619					goto clear_q;
620				}
621			}
622			/* If we are here -- this means that no amount
623			 * of effort could recover from errors.  Quite
624			 * possibly the HA just disappeared.
625			 */
626			SAS_DPRINTK("error from  device %llx, LUN %x "
627				    "couldn't be recovered in any way\n",
628				    SAS_ADDR(task->dev->sas_addr),
629				    cmd->device->lun);
630
631			sas_eh_finish_cmd(cmd);
632			if (need_reset)
633				try_to_reset_cmd_device(shost, cmd);
634			goto clear_q;
635		}
636	}
637	return list_empty(work_q);
638clear_q:
639	SAS_DPRINTK("--- Exit %s -- clear_q\n", __FUNCTION__);
640	list_for_each_entry_safe(cmd, n, work_q, eh_entry)
641		sas_eh_finish_cmd(cmd);
642
643	return list_empty(work_q);
644}
645
646void sas_scsi_recover_host(struct Scsi_Host *shost)
647{
648	struct sas_ha_struct *ha = SHOST_TO_SAS_HA(shost);
649	unsigned long flags;
650	LIST_HEAD(eh_work_q);
651
652	spin_lock_irqsave(shost->host_lock, flags);
653	list_splice_init(&shost->eh_cmd_q, &eh_work_q);
654	spin_unlock_irqrestore(shost->host_lock, flags);
655
656	SAS_DPRINTK("Enter %s\n", __FUNCTION__);
657	/*
658	 * Deal with commands that still have SAS tasks (i.e. they didn't
659	 * complete via the normal sas_task completion mechanism)
660	 */
661	if (sas_eh_handle_sas_errors(shost, &eh_work_q, &ha->eh_done_q))
662		goto out;
663
664	/*
665	 * Now deal with SCSI commands that completed ok but have a an error
666	 * code (and hopefully sense data) attached.  This is roughly what
667	 * scsi_unjam_host does, but we skip scsi_eh_abort_cmds because any
668	 * command we see here has no sas_task and is thus unknown to the HA.
669	 */
670	if (!scsi_eh_get_sense(&eh_work_q, &ha->eh_done_q))
671		scsi_eh_ready_devs(shost, &eh_work_q, &ha->eh_done_q);
672
673out:
674	scsi_eh_flush_done_q(&ha->eh_done_q);
675	SAS_DPRINTK("--- Exit %s\n", __FUNCTION__);
676	return;
677}
678
679enum scsi_eh_timer_return sas_scsi_timed_out(struct scsi_cmnd *cmd)
680{
681	struct sas_task *task = TO_SAS_TASK(cmd);
682	unsigned long flags;
683
684	if (!task) {
685		cmd->timeout_per_command /= 2;
686		SAS_DPRINTK("command 0x%p, task 0x%p, gone: %s\n",
687			    cmd, task, (cmd->timeout_per_command ?
688			    "EH_RESET_TIMER" : "EH_NOT_HANDLED"));
689		if (!cmd->timeout_per_command)
690			return EH_NOT_HANDLED;
691		return EH_RESET_TIMER;
692	}
693
694	spin_lock_irqsave(&task->task_state_lock, flags);
695	BUG_ON(task->task_state_flags & SAS_TASK_STATE_ABORTED);
696	if (task->task_state_flags & SAS_TASK_STATE_DONE) {
697		spin_unlock_irqrestore(&task->task_state_lock, flags);
698		SAS_DPRINTK("command 0x%p, task 0x%p, timed out: EH_HANDLED\n",
699			    cmd, task);
700		return EH_HANDLED;
701	}
702	if (!(task->task_state_flags & SAS_TASK_AT_INITIATOR)) {
703		spin_unlock_irqrestore(&task->task_state_lock, flags);
704		SAS_DPRINTK("command 0x%p, task 0x%p, not at initiator: "
705			    "EH_RESET_TIMER\n",
706			    cmd, task);
707		return EH_RESET_TIMER;
708	}
709	task->task_state_flags |= SAS_TASK_STATE_ABORTED;
710	spin_unlock_irqrestore(&task->task_state_lock, flags);
711
712	SAS_DPRINTK("command 0x%p, task 0x%p, timed out: EH_NOT_HANDLED\n",
713		    cmd, task);
714
715	return EH_NOT_HANDLED;
716}
717
718int sas_ioctl(struct scsi_device *sdev, int cmd, void __user *arg)
719{
720	struct domain_device *dev = sdev_to_domain_dev(sdev);
721
722	if (dev_is_sata(dev))
723		return ata_scsi_ioctl(sdev, cmd, arg);
724
725	return -EINVAL;
726}
727
728struct domain_device *sas_find_dev_by_rphy(struct sas_rphy *rphy)
729{
730	struct Scsi_Host *shost = dev_to_shost(rphy->dev.parent);
731	struct sas_ha_struct *ha = SHOST_TO_SAS_HA(shost);
732	struct domain_device *found_dev = NULL;
733	int i;
734	unsigned long flags;
735
736	spin_lock_irqsave(&ha->phy_port_lock, flags);
737	for (i = 0; i < ha->num_phys; i++) {
738		struct asd_sas_port *port = ha->sas_port[i];
739		struct domain_device *dev;
740
741		spin_lock(&port->dev_list_lock);
742		list_for_each_entry(dev, &port->dev_list, dev_list_node) {
743			if (rphy == dev->rphy) {
744				found_dev = dev;
745				spin_unlock(&port->dev_list_lock);
746				goto found;
747			}
748		}
749		spin_unlock(&port->dev_list_lock);
750	}
751 found:
752	spin_unlock_irqrestore(&ha->phy_port_lock, flags);
753
754	return found_dev;
755}
756
757static inline struct domain_device *sas_find_target(struct scsi_target *starget)
758{
759	struct sas_rphy *rphy = dev_to_rphy(starget->dev.parent);
760
761	return sas_find_dev_by_rphy(rphy);
762}
763
764int sas_target_alloc(struct scsi_target *starget)
765{
766	struct domain_device *found_dev = sas_find_target(starget);
767	int res;
768
769	if (!found_dev)
770		return -ENODEV;
771
772	if (dev_is_sata(found_dev)) {
773		res = sas_ata_init_host_and_port(found_dev, starget);
774		if (res)
775			return res;
776	}
777
778	starget->hostdata = found_dev;
779	return 0;
780}
781
782#define SAS_DEF_QD 32
783#define SAS_MAX_QD 64
784
785int sas_slave_configure(struct scsi_device *scsi_dev)
786{
787	struct domain_device *dev = sdev_to_domain_dev(scsi_dev);
788	struct sas_ha_struct *sas_ha;
789
790	BUG_ON(dev->rphy->identify.device_type != SAS_END_DEVICE);
791
792	if (dev_is_sata(dev)) {
793		ata_sas_slave_configure(scsi_dev, dev->sata_dev.ap);
794		return 0;
795	}
796
797	sas_ha = dev->port->ha;
798
799	sas_read_port_mode_page(scsi_dev);
800
801	if (scsi_dev->tagged_supported) {
802		scsi_set_tag_type(scsi_dev, MSG_SIMPLE_TAG);
803		scsi_activate_tcq(scsi_dev, SAS_DEF_QD);
804	} else {
805		SAS_DPRINTK("device %llx, LUN %x doesn't support "
806			    "TCQ\n", SAS_ADDR(dev->sas_addr),
807			    scsi_dev->lun);
808		scsi_dev->tagged_supported = 0;
809		scsi_set_tag_type(scsi_dev, 0);
810		scsi_deactivate_tcq(scsi_dev, 1);
811	}
812
813	scsi_dev->allow_restart = 1;
814
815	return 0;
816}
817
818void sas_slave_destroy(struct scsi_device *scsi_dev)
819{
820	struct domain_device *dev = sdev_to_domain_dev(scsi_dev);
821
822	if (dev_is_sata(dev))
823		ata_port_disable(dev->sata_dev.ap);
824}
825
826int sas_change_queue_depth(struct scsi_device *scsi_dev, int new_depth)
827{
828	int res = min(new_depth, SAS_MAX_QD);
829
830	if (scsi_dev->tagged_supported)
831		scsi_adjust_queue_depth(scsi_dev, scsi_get_tag_type(scsi_dev),
832					res);
833	else {
834		struct domain_device *dev = sdev_to_domain_dev(scsi_dev);
835		sas_printk("device %llx LUN %x queue depth changed to 1\n",
836			   SAS_ADDR(dev->sas_addr),
837			   scsi_dev->lun);
838		scsi_adjust_queue_depth(scsi_dev, 0, 1);
839		res = 1;
840	}
841
842	return res;
843}
844
845int sas_change_queue_type(struct scsi_device *scsi_dev, int qt)
846{
847	if (!scsi_dev->tagged_supported)
848		return 0;
849
850	scsi_deactivate_tcq(scsi_dev, 1);
851
852	scsi_set_tag_type(scsi_dev, qt);
853	scsi_activate_tcq(scsi_dev, scsi_dev->queue_depth);
854
855	return qt;
856}
857
858int sas_bios_param(struct scsi_device *scsi_dev,
859			  struct block_device *bdev,
860			  sector_t capacity, int *hsc)
861{
862	hsc[0] = 255;
863	hsc[1] = 63;
864	sector_div(capacity, 255*63);
865	hsc[2] = capacity;
866
867	return 0;
868}
869
870/* ---------- Task Collector Thread implementation ---------- */
871
872static void sas_queue(struct sas_ha_struct *sas_ha)
873{
874	struct scsi_core *core = &sas_ha->core;
875	unsigned long flags;
876	LIST_HEAD(q);
877	int can_queue;
878	int res;
879	struct sas_internal *i = to_sas_internal(core->shost->transportt);
880
881	spin_lock_irqsave(&core->task_queue_lock, flags);
882	while (!kthread_should_stop() &&
883	       !list_empty(&core->task_queue)) {
884
885		can_queue = sas_ha->lldd_queue_size - core->task_queue_size;
886		if (can_queue >= 0) {
887			can_queue = core->task_queue_size;
888			list_splice_init(&core->task_queue, &q);
889		} else {
890			struct list_head *a, *n;
891
892			can_queue = sas_ha->lldd_queue_size;
893			list_for_each_safe(a, n, &core->task_queue) {
894				list_move_tail(a, &q);
895				if (--can_queue == 0)
896					break;
897			}
898			can_queue = sas_ha->lldd_queue_size;
899		}
900		core->task_queue_size -= can_queue;
901		spin_unlock_irqrestore(&core->task_queue_lock, flags);
902		{
903			struct sas_task *task = list_entry(q.next,
904							   struct sas_task,
905							   list);
906			list_del_init(&q);
907			res = i->dft->lldd_execute_task(task, can_queue,
908							GFP_KERNEL);
909			if (unlikely(res))
910				__list_add(&q, task->list.prev, &task->list);
911		}
912		spin_lock_irqsave(&core->task_queue_lock, flags);
913		if (res) {
914			list_splice_init(&q, &core->task_queue); /*at head*/
915			core->task_queue_size += can_queue;
916		}
917	}
918	spin_unlock_irqrestore(&core->task_queue_lock, flags);
919}
920
921/**
922 * sas_queue_thread -- The Task Collector thread
923 * @_sas_ha: pointer to struct sas_ha
924 */
925static int sas_queue_thread(void *_sas_ha)
926{
927	struct sas_ha_struct *sas_ha = _sas_ha;
928
929	while (1) {
930		set_current_state(TASK_INTERRUPTIBLE);
931		schedule();
932		sas_queue(sas_ha);
933		if (kthread_should_stop())
934			break;
935	}
936
937	return 0;
938}
939
940int sas_init_queue(struct sas_ha_struct *sas_ha)
941{
942	struct scsi_core *core = &sas_ha->core;
943
944	spin_lock_init(&core->task_queue_lock);
945	core->task_queue_size = 0;
946	INIT_LIST_HEAD(&core->task_queue);
947
948	core->queue_thread = kthread_run(sas_queue_thread, sas_ha,
949					 "sas_queue_%d", core->shost->host_no);
950	if (IS_ERR(core->queue_thread))
951		return PTR_ERR(core->queue_thread);
952	return 0;
953}
954
955void sas_shutdown_queue(struct sas_ha_struct *sas_ha)
956{
957	unsigned long flags;
958	struct scsi_core *core = &sas_ha->core;
959	struct sas_task *task, *n;
960
961	kthread_stop(core->queue_thread);
962
963	if (!list_empty(&core->task_queue))
964		SAS_DPRINTK("HA: %llx: scsi core task queue is NOT empty!?\n",
965			    SAS_ADDR(sas_ha->sas_addr));
966
967	spin_lock_irqsave(&core->task_queue_lock, flags);
968	list_for_each_entry_safe(task, n, &core->task_queue, list) {
969		struct scsi_cmnd *cmd = task->uldd_task;
970
971		list_del_init(&task->list);
972
973		ASSIGN_SAS_TASK(cmd, NULL);
974		sas_free_task(task);
975		cmd->result = DID_ABORT << 16;
976		cmd->scsi_done(cmd);
977	}
978	spin_unlock_irqrestore(&core->task_queue_lock, flags);
979}
980
981/*
982 * Call the LLDD task abort routine directly.  This function is intended for
983 * use by upper layers that need to tell the LLDD to abort a task.
984 */
985int __sas_task_abort(struct sas_task *task)
986{
987	struct sas_internal *si =
988		to_sas_internal(task->dev->port->ha->core.shost->transportt);
989	unsigned long flags;
990	int res;
991
992	spin_lock_irqsave(&task->task_state_lock, flags);
993	if (task->task_state_flags & SAS_TASK_STATE_ABORTED ||
994	    task->task_state_flags & SAS_TASK_STATE_DONE) {
995		spin_unlock_irqrestore(&task->task_state_lock, flags);
996		SAS_DPRINTK("%s: Task %p already finished.\n", __FUNCTION__,
997			    task);
998		return 0;
999	}
1000	task->task_state_flags |= SAS_TASK_STATE_ABORTED;
1001	spin_unlock_irqrestore(&task->task_state_lock, flags);
1002
1003	if (!si->dft->lldd_abort_task)
1004		return -ENODEV;
1005
1006	res = si->dft->lldd_abort_task(task);
1007
1008	spin_lock_irqsave(&task->task_state_lock, flags);
1009	if ((task->task_state_flags & SAS_TASK_STATE_DONE) ||
1010	    (res == TMF_RESP_FUNC_COMPLETE))
1011	{
1012		spin_unlock_irqrestore(&task->task_state_lock, flags);
1013		task->task_done(task);
1014		return 0;
1015	}
1016
1017	if (!(task->task_state_flags & SAS_TASK_STATE_DONE))
1018		task->task_state_flags &= ~SAS_TASK_STATE_ABORTED;
1019	spin_unlock_irqrestore(&task->task_state_lock, flags);
1020
1021	return -EAGAIN;
1022}
1023
1024/*
1025 * Tell an upper layer that it needs to initiate an abort for a given task.
1026 * This should only ever be called by an LLDD.
1027 */
1028void sas_task_abort(struct sas_task *task)
1029{
1030	struct scsi_cmnd *sc = task->uldd_task;
1031
1032	/* Escape for libsas internal commands */
1033	if (!sc) {
1034		if (!del_timer(&task->timer))
1035			return;
1036		task->timer.function(task->timer.data);
1037		return;
1038	}
1039
1040	if (dev_is_sata(task->dev)) {
1041		sas_ata_task_abort(task);
1042		return;
1043	}
1044
1045	scsi_req_abort_cmd(sc);
1046	scsi_schedule_eh(sc->device->host);
1047}
1048
1049int sas_slave_alloc(struct scsi_device *scsi_dev)
1050{
1051	struct domain_device *dev = sdev_to_domain_dev(scsi_dev);
1052
1053	if (dev_is_sata(dev))
1054		return ata_sas_port_init(dev->sata_dev.ap);
1055
1056	return 0;
1057}
1058
1059void sas_target_destroy(struct scsi_target *starget)
1060{
1061	struct domain_device *found_dev = sas_find_target(starget);
1062
1063	if (!found_dev)
1064		return;
1065
1066	if (dev_is_sata(found_dev))
1067		ata_sas_port_destroy(found_dev->sata_dev.ap);
1068
1069	return;
1070}
1071
1072EXPORT_SYMBOL_GPL(sas_queuecommand);
1073EXPORT_SYMBOL_GPL(sas_target_alloc);
1074EXPORT_SYMBOL_GPL(sas_slave_configure);
1075EXPORT_SYMBOL_GPL(sas_slave_destroy);
1076EXPORT_SYMBOL_GPL(sas_change_queue_depth);
1077EXPORT_SYMBOL_GPL(sas_change_queue_type);
1078EXPORT_SYMBOL_GPL(sas_bios_param);
1079EXPORT_SYMBOL_GPL(__sas_task_abort);
1080EXPORT_SYMBOL_GPL(sas_task_abort);
1081EXPORT_SYMBOL_GPL(sas_phy_reset);
1082EXPORT_SYMBOL_GPL(sas_phy_enable);
1083EXPORT_SYMBOL_GPL(sas_eh_device_reset_handler);
1084EXPORT_SYMBOL_GPL(sas_eh_bus_reset_handler);
1085EXPORT_SYMBOL_GPL(sas_slave_alloc);
1086EXPORT_SYMBOL_GPL(sas_target_destroy);
1087EXPORT_SYMBOL_GPL(sas_ioctl);
1088