2 * Serial Attached SCSI (SAS) class SCSI Host glue.
4 * Copyright (C) 2005 Adaptec, Inc. All rights reserved.
5 * Copyright (C) 2005 Luben Tuikov <luben_tuikov@adaptec.com>
7 * This file is licensed under GPLv2.
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.
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.
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
26 #include <linux/kthread.h>
28 #include "sas_internal.h"
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_internal.h"
38 #include "../scsi_transport_api.h"
39 #include "../scsi_priv.h"
41 #include <linux/err.h>
42 #include <linux/blkdev.h>
43 #include <linux/freezer.h>
44 #include <linux/scatterlist.h>
45 #include <linux/libata.h>
47 /* ---------- SCSI Host glue ---------- */
49 #define TO_SAS_TASK(_scsi_cmd) ((void *)(_scsi_cmd)->host_scribble)
50 #define ASSIGN_SAS_TASK(_sc, _t) do { (_sc)->host_scribble = (void *) _t; } while (0)
52 static void sas_scsi_task_done(struct sas_task
*task
)
54 struct task_status_struct
*ts
= &task
->task_status
;
55 struct scsi_cmnd
*sc
= task
->uldd_task
;
56 struct sas_ha_struct
*sas_ha
= SHOST_TO_SAS_HA(sc
->device
->host
);
57 unsigned ts_flags
= task
->task_state_flags
;
61 SAS_DPRINTK("task_done called with non existing SCSI cmnd!\n");
62 list_del_init(&task
->list
);
67 if (ts
->resp
== SAS_TASK_UNDELIVERED
) {
70 } else { /* ts->resp == SAS_TASK_COMPLETE */
71 /* task delivered, what happened afterwards? */
73 case SAS_DEV_NO_RESPONSE
:
80 case SAS_DATA_UNDERRUN
:
81 scsi_set_resid(sc
, ts
->residual
);
82 if (scsi_bufflen(sc
) - scsi_get_resid(sc
) < sc
->underflow
)
85 case SAS_DATA_OVERRUN
:
89 hs
= DID_SOFT_ERROR
; /* retry */
91 case SAS_DEVICE_UNKNOWN
:
98 if (ts
->open_rej_reason
== SAS_OREJ_RSVD_RETRY
)
99 hs
= DID_SOFT_ERROR
; /* retry */
103 case SAS_PROTO_RESPONSE
:
104 SAS_DPRINTK("LLDD:%s sent SAS_PROTO_RESP for an SSP "
105 "task; please report this\n",
106 task
->dev
->port
->ha
->sas_ha_name
);
108 case SAS_ABORTED_TASK
:
112 memcpy(sc
->sense_buffer
, ts
->buf
,
113 max(SCSI_SENSE_BUFFERSIZE
, ts
->buf_valid_size
));
114 stat
= SAM_CHECK_COND
;
121 ASSIGN_SAS_TASK(sc
, NULL
);
122 sc
->result
= (hs
<< 16) | stat
;
123 list_del_init(&task
->list
);
125 /* This is very ugly but this is how SCSI Core works. */
126 if (ts_flags
& SAS_TASK_STATE_ABORTED
)
127 scsi_eh_finish_cmd(sc
, &sas_ha
->eh_done_q
);
132 static enum task_attribute
sas_scsi_get_task_attr(struct scsi_cmnd
*cmd
)
134 enum task_attribute ta
= TASK_ATTR_SIMPLE
;
135 if (cmd
->request
&& blk_rq_tagged(cmd
->request
)) {
136 if (cmd
->device
->ordered_tags
&&
137 (cmd
->request
->cmd_flags
& REQ_HARDBARRIER
))
138 ta
= TASK_ATTR_ORDERED
;
143 static struct sas_task
*sas_create_task(struct scsi_cmnd
*cmd
,
144 struct domain_device
*dev
,
147 struct sas_task
*task
= sas_alloc_task(gfp_flags
);
153 *(u32
*)cmd
->sense_buffer
= 0;
154 task
->uldd_task
= cmd
;
155 ASSIGN_SAS_TASK(cmd
, task
);
158 task
->task_proto
= task
->dev
->tproto
; /* BUG_ON(!SSP) */
160 task
->ssp_task
.retry_count
= 1;
161 int_to_scsilun(cmd
->device
->lun
, &lun
);
162 memcpy(task
->ssp_task
.LUN
, &lun
.scsi_lun
, 8);
163 task
->ssp_task
.task_attr
= sas_scsi_get_task_attr(cmd
);
164 memcpy(task
->ssp_task
.cdb
, cmd
->cmnd
, 16);
166 task
->scatter
= scsi_sglist(cmd
);
167 task
->num_scatter
= scsi_sg_count(cmd
);
168 task
->total_xfer_len
= scsi_bufflen(cmd
);
169 task
->data_dir
= cmd
->sc_data_direction
;
171 task
->task_done
= sas_scsi_task_done
;
176 static int sas_queue_up(struct sas_task
*task
)
178 struct sas_ha_struct
*sas_ha
= task
->dev
->port
->ha
;
179 struct scsi_core
*core
= &sas_ha
->core
;
183 spin_lock_irqsave(&core
->task_queue_lock
, flags
);
184 if (sas_ha
->lldd_queue_size
< core
->task_queue_size
+ 1) {
185 spin_unlock_irqrestore(&core
->task_queue_lock
, flags
);
186 return -SAS_QUEUE_FULL
;
188 list_add_tail(&task
->list
, &core
->task_queue
);
189 core
->task_queue_size
+= 1;
190 spin_unlock_irqrestore(&core
->task_queue_lock
, flags
);
191 wake_up_process(core
->queue_thread
);
196 static inline int dev_is_sata(struct domain_device
*dev
)
198 return (dev
->rphy
->identify
.target_port_protocols
& SAS_PROTOCOL_SATA
);
202 * sas_queuecommand -- Enqueue a command for processing
203 * @parameters: See SCSI Core documentation
205 * Note: XXX: Remove the host unlock/lock pair when SCSI Core can
206 * call us without holding an IRQ spinlock...
208 int sas_queuecommand(struct scsi_cmnd
*cmd
,
209 void (*scsi_done
)(struct scsi_cmnd
*))
212 struct domain_device
*dev
= cmd_to_domain_dev(cmd
);
213 struct Scsi_Host
*host
= cmd
->device
->host
;
214 struct sas_internal
*i
= to_sas_internal(host
->transportt
);
216 spin_unlock_irq(host
->host_lock
);
219 struct sas_ha_struct
*sas_ha
= dev
->port
->ha
;
220 struct sas_task
*task
;
222 if (dev_is_sata(dev
)) {
223 res
= ata_sas_queuecmd(cmd
, scsi_done
,
229 task
= sas_create_task(cmd
, dev
, GFP_ATOMIC
);
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
);
238 res
= sas_queue_up(task
);
242 SAS_DPRINTK("lldd_execute_task returned: %d\n", res
);
243 ASSIGN_SAS_TASK(cmd
, NULL
);
245 if (res
== -SAS_QUEUE_FULL
) {
246 cmd
->result
= DID_SOFT_ERROR
<< 16; /* retry */
254 spin_lock_irq(host
->host_lock
);
258 static void sas_scsi_clear_queue_lu(struct list_head
*error_q
, struct scsi_cmnd
*my_cmd
)
260 struct scsi_cmnd
*cmd
, *n
;
262 list_for_each_entry_safe(cmd
, n
, error_q
, eh_entry
) {
264 list_del_init(&cmd
->eh_entry
);
268 static void sas_scsi_clear_queue_I_T(struct list_head
*error_q
,
269 struct domain_device
*dev
)
271 struct scsi_cmnd
*cmd
, *n
;
273 list_for_each_entry_safe(cmd
, n
, error_q
, eh_entry
) {
274 struct domain_device
*x
= cmd_to_domain_dev(cmd
);
277 list_del_init(&cmd
->eh_entry
);
281 static void sas_scsi_clear_queue_port(struct list_head
*error_q
,
282 struct asd_sas_port
*port
)
284 struct scsi_cmnd
*cmd
, *n
;
286 list_for_each_entry_safe(cmd
, n
, error_q
, eh_entry
) {
287 struct domain_device
*dev
= cmd_to_domain_dev(cmd
);
288 struct asd_sas_port
*x
= dev
->port
;
291 list_del_init(&cmd
->eh_entry
);
295 enum task_disposition
{
303 static enum task_disposition
sas_scsi_find_task(struct sas_task
*task
)
305 struct sas_ha_struct
*ha
= task
->dev
->port
->ha
;
308 struct sas_internal
*si
=
309 to_sas_internal(task
->dev
->port
->ha
->core
.shost
->transportt
);
311 if (ha
->lldd_max_execute_num
> 1) {
312 struct scsi_core
*core
= &ha
->core
;
313 struct sas_task
*t
, *n
;
315 spin_lock_irqsave(&core
->task_queue_lock
, flags
);
316 list_for_each_entry_safe(t
, n
, &core
->task_queue
, list
) {
318 list_del_init(&t
->list
);
319 spin_unlock_irqrestore(&core
->task_queue_lock
,
321 SAS_DPRINTK("%s: task 0x%p aborted from "
324 return TASK_IS_ABORTED
;
327 spin_unlock_irqrestore(&core
->task_queue_lock
, flags
);
330 for (i
= 0; i
< 5; i
++) {
331 SAS_DPRINTK("%s: aborting task 0x%p\n", __FUNCTION__
, task
);
332 res
= si
->dft
->lldd_abort_task(task
);
334 spin_lock_irqsave(&task
->task_state_lock
, flags
);
335 if (task
->task_state_flags
& SAS_TASK_STATE_DONE
) {
336 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
337 SAS_DPRINTK("%s: task 0x%p is done\n", __FUNCTION__
,
341 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
343 if (res
== TMF_RESP_FUNC_COMPLETE
) {
344 SAS_DPRINTK("%s: task 0x%p is aborted\n",
346 return TASK_IS_ABORTED
;
347 } else if (si
->dft
->lldd_query_task
) {
348 SAS_DPRINTK("%s: querying task 0x%p\n",
350 res
= si
->dft
->lldd_query_task(task
);
352 case TMF_RESP_FUNC_SUCC
:
353 SAS_DPRINTK("%s: task 0x%p at LU\n",
355 return TASK_IS_AT_LU
;
356 case TMF_RESP_FUNC_COMPLETE
:
357 SAS_DPRINTK("%s: task 0x%p not at LU\n",
359 return TASK_IS_NOT_AT_LU
;
360 case TMF_RESP_FUNC_FAILED
:
361 SAS_DPRINTK("%s: task 0x%p failed to abort\n",
363 return TASK_ABORT_FAILED
;
371 static int sas_recover_lu(struct domain_device
*dev
, struct scsi_cmnd
*cmd
)
373 int res
= TMF_RESP_FUNC_FAILED
;
375 struct sas_internal
*i
=
376 to_sas_internal(dev
->port
->ha
->core
.shost
->transportt
);
378 int_to_scsilun(cmd
->device
->lun
, &lun
);
380 SAS_DPRINTK("eh: device %llx LUN %x has the task\n",
381 SAS_ADDR(dev
->sas_addr
),
384 if (i
->dft
->lldd_abort_task_set
)
385 res
= i
->dft
->lldd_abort_task_set(dev
, lun
.scsi_lun
);
387 if (res
== TMF_RESP_FUNC_FAILED
) {
388 if (i
->dft
->lldd_clear_task_set
)
389 res
= i
->dft
->lldd_clear_task_set(dev
, lun
.scsi_lun
);
392 if (res
== TMF_RESP_FUNC_FAILED
) {
393 if (i
->dft
->lldd_lu_reset
)
394 res
= i
->dft
->lldd_lu_reset(dev
, lun
.scsi_lun
);
400 static int sas_recover_I_T(struct domain_device
*dev
)
402 int res
= TMF_RESP_FUNC_FAILED
;
403 struct sas_internal
*i
=
404 to_sas_internal(dev
->port
->ha
->core
.shost
->transportt
);
406 SAS_DPRINTK("I_T nexus reset for dev %016llx\n",
407 SAS_ADDR(dev
->sas_addr
));
409 if (i
->dft
->lldd_I_T_nexus_reset
)
410 res
= i
->dft
->lldd_I_T_nexus_reset(dev
);
415 /* Find the sas_phy that's attached to this device */
416 struct sas_phy
*find_local_sas_phy(struct domain_device
*dev
)
418 struct domain_device
*pdev
= dev
->parent
;
419 struct ex_phy
*exphy
= NULL
;
422 /* Directly attached device */
424 return dev
->port
->phy
;
426 /* Otherwise look in the expander */
427 for (i
= 0; i
< pdev
->ex_dev
.num_phys
; i
++)
428 if (!memcmp(dev
->sas_addr
,
429 pdev
->ex_dev
.ex_phy
[i
].attached_sas_addr
,
431 exphy
= &pdev
->ex_dev
.ex_phy
[i
];
439 /* Attempt to send a LUN reset message to a device */
440 int sas_eh_device_reset_handler(struct scsi_cmnd
*cmd
)
442 struct domain_device
*dev
= cmd_to_domain_dev(cmd
);
443 struct sas_internal
*i
=
444 to_sas_internal(dev
->port
->ha
->core
.shost
->transportt
);
448 int_to_scsilun(cmd
->device
->lun
, &lun
);
450 if (!i
->dft
->lldd_lu_reset
)
453 res
= i
->dft
->lldd_lu_reset(dev
, lun
.scsi_lun
);
454 if (res
== TMF_RESP_FUNC_SUCC
|| res
== TMF_RESP_FUNC_COMPLETE
)
460 /* Attempt to send a phy (bus) reset */
461 int sas_eh_bus_reset_handler(struct scsi_cmnd
*cmd
)
463 struct domain_device
*dev
= cmd_to_domain_dev(cmd
);
464 struct sas_phy
*phy
= find_local_sas_phy(dev
);
467 res
= sas_phy_reset(phy
, 1);
469 SAS_DPRINTK("Bus reset of %s failed 0x%x\n",
470 phy
->dev
.kobj
.k_name
,
472 if (res
== TMF_RESP_FUNC_SUCC
|| res
== TMF_RESP_FUNC_COMPLETE
)
478 /* Try to reset a device */
479 static int try_to_reset_cmd_device(struct Scsi_Host
*shost
,
480 struct scsi_cmnd
*cmd
)
484 if (!shost
->hostt
->eh_device_reset_handler
)
487 res
= shost
->hostt
->eh_device_reset_handler(cmd
);
492 if (shost
->hostt
->eh_bus_reset_handler
)
493 return shost
->hostt
->eh_bus_reset_handler(cmd
);
498 static int sas_eh_handle_sas_errors(struct Scsi_Host
*shost
,
499 struct list_head
*work_q
,
500 struct list_head
*done_q
)
502 struct scsi_cmnd
*cmd
, *n
;
503 enum task_disposition res
= TASK_IS_DONE
;
504 int tmf_resp
, need_reset
;
505 struct sas_internal
*i
= to_sas_internal(shost
->transportt
);
507 struct sas_ha_struct
*ha
= SHOST_TO_SAS_HA(shost
);
510 list_for_each_entry_safe(cmd
, n
, work_q
, eh_entry
) {
511 struct sas_task
*task
= TO_SAS_TASK(cmd
);
516 list_del_init(&cmd
->eh_entry
);
518 spin_lock_irqsave(&task
->task_state_lock
, flags
);
519 need_reset
= task
->task_state_flags
& SAS_TASK_NEED_DEV_RESET
;
520 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
522 SAS_DPRINTK("trying to find task 0x%p\n", task
);
523 res
= sas_scsi_find_task(task
);
529 SAS_DPRINTK("%s: task 0x%p is done\n", __FUNCTION__
,
531 task
->task_done(task
);
533 try_to_reset_cmd_device(shost
, cmd
);
535 case TASK_IS_ABORTED
:
536 SAS_DPRINTK("%s: task 0x%p is aborted\n",
538 task
->task_done(task
);
540 try_to_reset_cmd_device(shost
, cmd
);
543 SAS_DPRINTK("task 0x%p is at LU: lu recover\n", task
);
544 tmf_resp
= sas_recover_lu(task
->dev
, cmd
);
545 if (tmf_resp
== TMF_RESP_FUNC_COMPLETE
) {
546 SAS_DPRINTK("dev %016llx LU %x is "
550 task
->task_done(task
);
552 try_to_reset_cmd_device(shost
, cmd
);
553 sas_scsi_clear_queue_lu(work_q
, cmd
);
557 case TASK_IS_NOT_AT_LU
:
558 case TASK_ABORT_FAILED
:
559 SAS_DPRINTK("task 0x%p is not at LU: I_T recover\n",
561 tmf_resp
= sas_recover_I_T(task
->dev
);
562 if (tmf_resp
== TMF_RESP_FUNC_COMPLETE
) {
563 SAS_DPRINTK("I_T %016llx recovered\n",
564 SAS_ADDR(task
->dev
->sas_addr
));
565 task
->task_done(task
);
567 try_to_reset_cmd_device(shost
, cmd
);
568 sas_scsi_clear_queue_I_T(work_q
, task
->dev
);
571 /* Hammer time :-) */
572 if (i
->dft
->lldd_clear_nexus_port
) {
573 struct asd_sas_port
*port
= task
->dev
->port
;
574 SAS_DPRINTK("clearing nexus for port:%d\n",
576 res
= i
->dft
->lldd_clear_nexus_port(port
);
577 if (res
== TMF_RESP_FUNC_COMPLETE
) {
578 SAS_DPRINTK("clear nexus port:%d "
579 "succeeded\n", port
->id
);
580 task
->task_done(task
);
582 try_to_reset_cmd_device(shost
, cmd
);
583 sas_scsi_clear_queue_port(work_q
,
588 if (i
->dft
->lldd_clear_nexus_ha
) {
589 SAS_DPRINTK("clear nexus ha\n");
590 res
= i
->dft
->lldd_clear_nexus_ha(ha
);
591 if (res
== TMF_RESP_FUNC_COMPLETE
) {
592 SAS_DPRINTK("clear nexus ha "
594 task
->task_done(task
);
596 try_to_reset_cmd_device(shost
, cmd
);
600 /* If we are here -- this means that no amount
601 * of effort could recover from errors. Quite
602 * possibly the HA just disappeared.
604 SAS_DPRINTK("error from device %llx, LUN %x "
605 "couldn't be recovered in any way\n",
606 SAS_ADDR(task
->dev
->sas_addr
),
609 task
->task_done(task
);
611 try_to_reset_cmd_device(shost
, cmd
);
616 return list_empty(work_q
);
618 SAS_DPRINTK("--- Exit %s -- clear_q\n", __FUNCTION__
);
619 list_for_each_entry_safe(cmd
, n
, work_q
, eh_entry
) {
620 struct sas_task
*task
= TO_SAS_TASK(cmd
);
621 list_del_init(&cmd
->eh_entry
);
622 task
->task_done(task
);
624 return list_empty(work_q
);
627 void sas_scsi_recover_host(struct Scsi_Host
*shost
)
629 struct sas_ha_struct
*ha
= SHOST_TO_SAS_HA(shost
);
631 LIST_HEAD(eh_work_q
);
633 spin_lock_irqsave(shost
->host_lock
, flags
);
634 list_splice_init(&shost
->eh_cmd_q
, &eh_work_q
);
635 spin_unlock_irqrestore(shost
->host_lock
, flags
);
637 SAS_DPRINTK("Enter %s\n", __FUNCTION__
);
639 * Deal with commands that still have SAS tasks (i.e. they didn't
640 * complete via the normal sas_task completion mechanism)
642 if (sas_eh_handle_sas_errors(shost
, &eh_work_q
, &ha
->eh_done_q
))
646 * Now deal with SCSI commands that completed ok but have a an error
647 * code (and hopefully sense data) attached. This is roughly what
648 * scsi_unjam_host does, but we skip scsi_eh_abort_cmds because any
649 * command we see here has no sas_task and is thus unknown to the HA.
651 if (!scsi_eh_get_sense(&eh_work_q
, &ha
->eh_done_q
))
652 scsi_eh_ready_devs(shost
, &eh_work_q
, &ha
->eh_done_q
);
655 scsi_eh_flush_done_q(&ha
->eh_done_q
);
656 SAS_DPRINTK("--- Exit %s\n", __FUNCTION__
);
660 enum scsi_eh_timer_return
sas_scsi_timed_out(struct scsi_cmnd
*cmd
)
662 struct sas_task
*task
= TO_SAS_TASK(cmd
);
666 cmd
->timeout_per_command
/= 2;
667 SAS_DPRINTK("command 0x%p, task 0x%p, gone: %s\n",
668 cmd
, task
, (cmd
->timeout_per_command
?
669 "EH_RESET_TIMER" : "EH_NOT_HANDLED"));
670 if (!cmd
->timeout_per_command
)
671 return EH_NOT_HANDLED
;
672 return EH_RESET_TIMER
;
675 spin_lock_irqsave(&task
->task_state_lock
, flags
);
676 BUG_ON(task
->task_state_flags
& SAS_TASK_STATE_ABORTED
);
677 if (task
->task_state_flags
& SAS_TASK_STATE_DONE
) {
678 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
679 SAS_DPRINTK("command 0x%p, task 0x%p, timed out: EH_HANDLED\n",
683 if (!(task
->task_state_flags
& SAS_TASK_AT_INITIATOR
)) {
684 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
685 SAS_DPRINTK("command 0x%p, task 0x%p, not at initiator: "
688 return EH_RESET_TIMER
;
690 task
->task_state_flags
|= SAS_TASK_STATE_ABORTED
;
691 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
693 SAS_DPRINTK("command 0x%p, task 0x%p, timed out: EH_NOT_HANDLED\n",
696 return EH_NOT_HANDLED
;
700 static enum ata_completion_errors
sas_to_ata_err(struct task_status_struct
*ts
)
702 /* Cheesy attempt to translate SAS errors into ATA. Hah! */
704 /* transport error */
705 if (ts
->resp
== SAS_TASK_UNDELIVERED
)
706 return AC_ERR_ATA_BUS
;
708 /* ts->resp == SAS_TASK_COMPLETE */
709 /* task delivered, what happened afterwards? */
711 case SAS_DEV_NO_RESPONSE
:
712 return AC_ERR_TIMEOUT
;
714 case SAS_INTERRUPTED
:
717 return AC_ERR_ATA_BUS
;
720 case SAS_DATA_UNDERRUN
:
722 * Some programs that use the taskfile interface
723 * (smartctl in particular) can cause underrun
724 * problems. Ignore these errors, perhaps at our
729 case SAS_DATA_OVERRUN
:
731 case SAS_DEVICE_UNKNOWN
:
733 return AC_ERR_INVALID
;
737 case SAS_OPEN_REJECT
:
738 case SAS_PROTO_RESPONSE
:
739 SAS_DPRINTK("%s: Saw error %d. What to do?\n",
740 __FUNCTION__
, ts
->stat
);
743 case SAS_ABORTED_TASK
:
751 static void sas_ata_task_done(struct sas_task
*task
)
753 struct ata_queued_cmd
*qc
= task
->uldd_task
;
754 struct domain_device
*dev
= qc
->ap
->private_data
;
755 struct task_status_struct
*stat
= &task
->task_status
;
756 struct ata_task_resp
*resp
= (struct ata_task_resp
*)stat
->buf
;
757 enum ata_completion_errors ac
;
759 ac
= sas_to_ata_err(stat
);
761 SAS_DPRINTK("%s: SAS error %x\n", __FUNCTION__
, stat
->stat
);
762 /* We saw a SAS error. Send a vague error. */
764 dev
->sata_dev
.tf
.feature
= 0x04; /* status err */
765 dev
->sata_dev
.tf
.command
= ATA_ERR
;
769 ata_tf_from_fis(resp
->ending_fis
, &dev
->sata_dev
.tf
);
770 qc
->err_mask
|= ac_err_mask(dev
->sata_dev
.tf
.command
);
771 dev
->sata_dev
.sstatus
= resp
->sstatus
;
772 dev
->sata_dev
.serror
= resp
->serror
;
773 dev
->sata_dev
.scontrol
= resp
->scontrol
;
774 dev
->sata_dev
.ap
->sactive
= resp
->sactive
;
777 list_del_init(&task
->list
);
781 int sas_ioctl(struct scsi_device
*sdev
, int cmd
, void __user
*arg
)
783 struct domain_device
*dev
= sdev_to_domain_dev(sdev
);
785 if (dev_is_sata(dev
))
786 return ata_scsi_ioctl(sdev
, cmd
, arg
);
791 static unsigned int sas_ata_qc_issue(struct ata_queued_cmd
*qc
)
794 struct sas_task
*task
;
795 struct domain_device
*dev
= qc
->ap
->private_data
;
796 struct sas_ha_struct
*sas_ha
= dev
->port
->ha
;
797 struct Scsi_Host
*host
= sas_ha
->core
.shost
;
798 struct sas_internal
*i
= to_sas_internal(host
->transportt
);
799 struct scatterlist
*sg
;
800 unsigned int num
= 0;
801 unsigned int xfer
= 0;
803 task
= sas_alloc_task(GFP_ATOMIC
);
807 task
->task_proto
= SAS_PROTOCOL_STP
;
808 task
->task_done
= sas_ata_task_done
;
810 ata_tf_to_fis(&qc
->tf
, (u8
*)&task
->ata_task
.fis
, 0);
811 task
->uldd_task
= qc
;
812 if (is_atapi_taskfile(&qc
->tf
)) {
813 memcpy(task
->ata_task
.atapi_packet
, qc
->cdb
, ATAPI_CDB_LEN
);
814 task
->total_xfer_len
= qc
->nbytes
+ qc
->pad_len
;
815 task
->num_scatter
= qc
->pad_len
? qc
->n_elem
+ 1 : qc
->n_elem
;
817 ata_for_each_sg(sg
, qc
) {
822 task
->total_xfer_len
= xfer
;
823 task
->num_scatter
= num
;
826 task
->data_dir
= qc
->dma_dir
;
827 task
->scatter
= qc
->__sg
;
828 task
->ata_task
.retry_count
= 1;
829 task
->task_state_flags
= SAS_TASK_STATE_PENDING
;
831 if (qc
->tf
.protocol
== ATA_PROT_DMA
)
832 task
->ata_task
.dma_xfer
= 1;
834 if (sas_ha
->lldd_max_execute_num
< 2)
835 res
= i
->dft
->lldd_execute_task(task
, 1, GFP_ATOMIC
);
837 res
= sas_queue_up(task
);
841 SAS_DPRINTK("lldd_execute_task returned: %d\n", res
);
844 if (res
== -SAS_QUEUE_FULL
)
852 static u8
sas_ata_check_status(struct ata_port
*ap
)
854 struct domain_device
*dev
= ap
->private_data
;
855 return dev
->sata_dev
.tf
.command
;
858 static void sas_ata_phy_reset(struct ata_port
*ap
)
860 struct domain_device
*dev
= ap
->private_data
;
861 struct sas_internal
*i
=
862 to_sas_internal(dev
->port
->ha
->core
.shost
->transportt
);
865 if (i
->dft
->lldd_I_T_nexus_reset
)
866 res
= i
->dft
->lldd_I_T_nexus_reset(dev
);
869 SAS_DPRINTK("%s: Unable to reset I T nexus?\n", __FUNCTION__
);
871 switch (dev
->sata_dev
.command_set
) {
872 case ATA_COMMAND_SET
:
873 SAS_DPRINTK("%s: Found ATA device.\n", __FUNCTION__
);
874 ap
->device
[0].class = ATA_DEV_ATA
;
876 case ATAPI_COMMAND_SET
:
877 SAS_DPRINTK("%s: Found ATAPI device.\n", __FUNCTION__
);
878 ap
->device
[0].class = ATA_DEV_ATAPI
;
881 SAS_DPRINTK("%s: Unknown SATA command set: %d.\n",
883 dev
->sata_dev
.command_set
);
884 ap
->device
[0].class = ATA_DEV_ATA
;
888 ap
->cbl
= ATA_CBL_SATA
;
891 static void sas_ata_post_internal(struct ata_queued_cmd
*qc
)
893 if (qc
->flags
& ATA_QCFLAG_FAILED
)
894 qc
->err_mask
|= AC_ERR_OTHER
;
897 SAS_DPRINTK("%s: Failure; reset phy!\n", __FUNCTION__
);
900 static void sas_ata_tf_read(struct ata_port
*ap
, struct ata_taskfile
*tf
)
902 struct domain_device
*dev
= ap
->private_data
;
903 memcpy(tf
, &dev
->sata_dev
.tf
, sizeof (*tf
));
906 static void sas_ata_scr_write(struct ata_port
*ap
, unsigned int sc_reg_in
,
909 struct domain_device
*dev
= ap
->private_data
;
911 SAS_DPRINTK("STUB %s\n", __FUNCTION__
);
914 dev
->sata_dev
.sstatus
= val
;
917 dev
->sata_dev
.scontrol
= val
;
920 dev
->sata_dev
.serror
= val
;
923 dev
->sata_dev
.ap
->sactive
= val
;
928 static u32
sas_ata_scr_read(struct ata_port
*ap
, unsigned int sc_reg_in
)
930 struct domain_device
*dev
= ap
->private_data
;
932 SAS_DPRINTK("STUB %s\n", __FUNCTION__
);
935 return dev
->sata_dev
.sstatus
;
937 return dev
->sata_dev
.scontrol
;
939 return dev
->sata_dev
.serror
;
941 return dev
->sata_dev
.ap
->sactive
;
947 static struct ata_port_operations sas_sata_ops
= {
948 .port_disable
= ata_port_disable
,
949 .check_status
= sas_ata_check_status
,
950 .check_altstatus
= sas_ata_check_status
,
951 .dev_select
= ata_noop_dev_select
,
952 .phy_reset
= sas_ata_phy_reset
,
953 .post_internal_cmd
= sas_ata_post_internal
,
954 .tf_read
= sas_ata_tf_read
,
955 .qc_prep
= ata_noop_qc_prep
,
956 .qc_issue
= sas_ata_qc_issue
,
957 .port_start
= ata_sas_port_start
,
958 .port_stop
= ata_sas_port_stop
,
959 .scr_read
= sas_ata_scr_read
,
960 .scr_write
= sas_ata_scr_write
963 static struct ata_port_info sata_port_info
= {
964 .flags
= ATA_FLAG_SATA
| ATA_FLAG_NO_LEGACY
| ATA_FLAG_SATA_RESET
|
965 ATA_FLAG_MMIO
| ATA_FLAG_PIO_DMA
,
966 .pio_mask
= 0x1f, /* PIO0-4 */
967 .mwdma_mask
= 0x07, /* MWDMA0-2 */
968 .udma_mask
= ATA_UDMA6
,
969 .port_ops
= &sas_sata_ops
972 struct domain_device
*sas_find_dev_by_rphy(struct sas_rphy
*rphy
)
974 struct Scsi_Host
*shost
= dev_to_shost(rphy
->dev
.parent
);
975 struct sas_ha_struct
*ha
= SHOST_TO_SAS_HA(shost
);
976 struct domain_device
*found_dev
= NULL
;
980 spin_lock_irqsave(&ha
->phy_port_lock
, flags
);
981 for (i
= 0; i
< ha
->num_phys
; i
++) {
982 struct asd_sas_port
*port
= ha
->sas_port
[i
];
983 struct domain_device
*dev
;
985 spin_lock(&port
->dev_list_lock
);
986 list_for_each_entry(dev
, &port
->dev_list
, dev_list_node
) {
987 if (rphy
== dev
->rphy
) {
989 spin_unlock(&port
->dev_list_lock
);
993 spin_unlock(&port
->dev_list_lock
);
996 spin_unlock_irqrestore(&ha
->phy_port_lock
, flags
);
1001 static inline struct domain_device
*sas_find_target(struct scsi_target
*starget
)
1003 struct sas_rphy
*rphy
= dev_to_rphy(starget
->dev
.parent
);
1005 return sas_find_dev_by_rphy(rphy
);
1008 int sas_target_alloc(struct scsi_target
*starget
)
1010 struct Scsi_Host
*shost
= dev_to_shost(&starget
->dev
);
1011 struct sas_ha_struct
*ha
= SHOST_TO_SAS_HA(shost
);
1012 struct domain_device
*found_dev
= sas_find_target(starget
);
1017 if (dev_is_sata(found_dev
)) {
1018 struct ata_port
*ap
;
1020 ata_host_init(&found_dev
->sata_dev
.ata_host
,
1022 sata_port_info
.flags
,
1024 ap
= ata_sas_port_alloc(&found_dev
->sata_dev
.ata_host
,
1028 SAS_DPRINTK("ata_sas_port_alloc failed.\n");
1032 ap
->private_data
= found_dev
;
1033 ap
->cbl
= ATA_CBL_SATA
;
1034 found_dev
->sata_dev
.ap
= ap
;
1037 starget
->hostdata
= found_dev
;
1041 #define SAS_DEF_QD 32
1042 #define SAS_MAX_QD 64
1044 int sas_slave_configure(struct scsi_device
*scsi_dev
)
1046 struct domain_device
*dev
= sdev_to_domain_dev(scsi_dev
);
1047 struct sas_ha_struct
*sas_ha
;
1049 BUG_ON(dev
->rphy
->identify
.device_type
!= SAS_END_DEVICE
);
1051 if (dev_is_sata(dev
)) {
1052 ata_sas_slave_configure(scsi_dev
, dev
->sata_dev
.ap
);
1056 sas_ha
= dev
->port
->ha
;
1058 sas_read_port_mode_page(scsi_dev
);
1060 if (scsi_dev
->tagged_supported
) {
1061 scsi_set_tag_type(scsi_dev
, MSG_SIMPLE_TAG
);
1062 scsi_activate_tcq(scsi_dev
, SAS_DEF_QD
);
1064 SAS_DPRINTK("device %llx, LUN %x doesn't support "
1065 "TCQ\n", SAS_ADDR(dev
->sas_addr
),
1067 scsi_dev
->tagged_supported
= 0;
1068 scsi_set_tag_type(scsi_dev
, 0);
1069 scsi_deactivate_tcq(scsi_dev
, 1);
1072 scsi_dev
->allow_restart
= 1;
1077 void sas_slave_destroy(struct scsi_device
*scsi_dev
)
1079 struct domain_device
*dev
= sdev_to_domain_dev(scsi_dev
);
1081 if (dev_is_sata(dev
))
1082 ata_port_disable(dev
->sata_dev
.ap
);
1085 int sas_change_queue_depth(struct scsi_device
*scsi_dev
, int new_depth
)
1087 int res
= min(new_depth
, SAS_MAX_QD
);
1089 if (scsi_dev
->tagged_supported
)
1090 scsi_adjust_queue_depth(scsi_dev
, scsi_get_tag_type(scsi_dev
),
1093 struct domain_device
*dev
= sdev_to_domain_dev(scsi_dev
);
1094 sas_printk("device %llx LUN %x queue depth changed to 1\n",
1095 SAS_ADDR(dev
->sas_addr
),
1097 scsi_adjust_queue_depth(scsi_dev
, 0, 1);
1104 int sas_change_queue_type(struct scsi_device
*scsi_dev
, int qt
)
1106 if (!scsi_dev
->tagged_supported
)
1109 scsi_deactivate_tcq(scsi_dev
, 1);
1111 scsi_set_tag_type(scsi_dev
, qt
);
1112 scsi_activate_tcq(scsi_dev
, scsi_dev
->queue_depth
);
1117 int sas_bios_param(struct scsi_device
*scsi_dev
,
1118 struct block_device
*bdev
,
1119 sector_t capacity
, int *hsc
)
1123 sector_div(capacity
, 255*63);
1129 /* ---------- Task Collector Thread implementation ---------- */
1131 static void sas_queue(struct sas_ha_struct
*sas_ha
)
1133 struct scsi_core
*core
= &sas_ha
->core
;
1134 unsigned long flags
;
1138 struct sas_internal
*i
= to_sas_internal(core
->shost
->transportt
);
1140 spin_lock_irqsave(&core
->task_queue_lock
, flags
);
1141 while (!kthread_should_stop() &&
1142 !list_empty(&core
->task_queue
)) {
1144 can_queue
= sas_ha
->lldd_queue_size
- core
->task_queue_size
;
1145 if (can_queue
>= 0) {
1146 can_queue
= core
->task_queue_size
;
1147 list_splice_init(&core
->task_queue
, &q
);
1149 struct list_head
*a
, *n
;
1151 can_queue
= sas_ha
->lldd_queue_size
;
1152 list_for_each_safe(a
, n
, &core
->task_queue
) {
1153 list_move_tail(a
, &q
);
1154 if (--can_queue
== 0)
1157 can_queue
= sas_ha
->lldd_queue_size
;
1159 core
->task_queue_size
-= can_queue
;
1160 spin_unlock_irqrestore(&core
->task_queue_lock
, flags
);
1162 struct sas_task
*task
= list_entry(q
.next
,
1166 res
= i
->dft
->lldd_execute_task(task
, can_queue
,
1169 __list_add(&q
, task
->list
.prev
, &task
->list
);
1171 spin_lock_irqsave(&core
->task_queue_lock
, flags
);
1173 list_splice_init(&q
, &core
->task_queue
); /*at head*/
1174 core
->task_queue_size
+= can_queue
;
1177 spin_unlock_irqrestore(&core
->task_queue_lock
, flags
);
1181 * sas_queue_thread -- The Task Collector thread
1182 * @_sas_ha: pointer to struct sas_ha
1184 static int sas_queue_thread(void *_sas_ha
)
1186 struct sas_ha_struct
*sas_ha
= _sas_ha
;
1189 set_current_state(TASK_INTERRUPTIBLE
);
1192 if (kthread_should_stop())
1199 int sas_init_queue(struct sas_ha_struct
*sas_ha
)
1201 struct scsi_core
*core
= &sas_ha
->core
;
1203 spin_lock_init(&core
->task_queue_lock
);
1204 core
->task_queue_size
= 0;
1205 INIT_LIST_HEAD(&core
->task_queue
);
1207 core
->queue_thread
= kthread_run(sas_queue_thread
, sas_ha
,
1208 "sas_queue_%d", core
->shost
->host_no
);
1209 if (IS_ERR(core
->queue_thread
))
1210 return PTR_ERR(core
->queue_thread
);
1214 void sas_shutdown_queue(struct sas_ha_struct
*sas_ha
)
1216 unsigned long flags
;
1217 struct scsi_core
*core
= &sas_ha
->core
;
1218 struct sas_task
*task
, *n
;
1220 kthread_stop(core
->queue_thread
);
1222 if (!list_empty(&core
->task_queue
))
1223 SAS_DPRINTK("HA: %llx: scsi core task queue is NOT empty!?\n",
1224 SAS_ADDR(sas_ha
->sas_addr
));
1226 spin_lock_irqsave(&core
->task_queue_lock
, flags
);
1227 list_for_each_entry_safe(task
, n
, &core
->task_queue
, list
) {
1228 struct scsi_cmnd
*cmd
= task
->uldd_task
;
1230 list_del_init(&task
->list
);
1232 ASSIGN_SAS_TASK(cmd
, NULL
);
1233 sas_free_task(task
);
1234 cmd
->result
= DID_ABORT
<< 16;
1235 cmd
->scsi_done(cmd
);
1237 spin_unlock_irqrestore(&core
->task_queue_lock
, flags
);
1241 * Call the LLDD task abort routine directly. This function is intended for
1242 * use by upper layers that need to tell the LLDD to abort a task.
1244 int __sas_task_abort(struct sas_task
*task
)
1246 struct sas_internal
*si
=
1247 to_sas_internal(task
->dev
->port
->ha
->core
.shost
->transportt
);
1248 unsigned long flags
;
1251 spin_lock_irqsave(&task
->task_state_lock
, flags
);
1252 if (task
->task_state_flags
& SAS_TASK_STATE_ABORTED
||
1253 task
->task_state_flags
& SAS_TASK_STATE_DONE
) {
1254 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
1255 SAS_DPRINTK("%s: Task %p already finished.\n", __FUNCTION__
,
1259 task
->task_state_flags
|= SAS_TASK_STATE_ABORTED
;
1260 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
1262 if (!si
->dft
->lldd_abort_task
)
1265 res
= si
->dft
->lldd_abort_task(task
);
1267 spin_lock_irqsave(&task
->task_state_lock
, flags
);
1268 if ((task
->task_state_flags
& SAS_TASK_STATE_DONE
) ||
1269 (res
== TMF_RESP_FUNC_COMPLETE
))
1271 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
1272 task
->task_done(task
);
1276 if (!(task
->task_state_flags
& SAS_TASK_STATE_DONE
))
1277 task
->task_state_flags
&= ~SAS_TASK_STATE_ABORTED
;
1278 spin_unlock_irqrestore(&task
->task_state_lock
, flags
);
1284 * Tell an upper layer that it needs to initiate an abort for a given task.
1285 * This should only ever be called by an LLDD.
1287 void sas_task_abort(struct sas_task
*task
)
1289 struct scsi_cmnd
*sc
= task
->uldd_task
;
1291 /* Escape for libsas internal commands */
1293 if (!del_timer(&task
->timer
))
1295 task
->timer
.function(task
->timer
.data
);
1299 scsi_req_abort_cmd(sc
);
1300 scsi_schedule_eh(sc
->device
->host
);
1303 int sas_slave_alloc(struct scsi_device
*scsi_dev
)
1305 struct domain_device
*dev
= sdev_to_domain_dev(scsi_dev
);
1307 if (dev_is_sata(dev
))
1308 return ata_sas_port_init(dev
->sata_dev
.ap
);
1313 void sas_target_destroy(struct scsi_target
*starget
)
1315 struct domain_device
*found_dev
= sas_find_target(starget
);
1320 if (dev_is_sata(found_dev
))
1321 ata_sas_port_destroy(found_dev
->sata_dev
.ap
);
1326 EXPORT_SYMBOL_GPL(sas_queuecommand
);
1327 EXPORT_SYMBOL_GPL(sas_target_alloc
);
1328 EXPORT_SYMBOL_GPL(sas_slave_configure
);
1329 EXPORT_SYMBOL_GPL(sas_slave_destroy
);
1330 EXPORT_SYMBOL_GPL(sas_change_queue_depth
);
1331 EXPORT_SYMBOL_GPL(sas_change_queue_type
);
1332 EXPORT_SYMBOL_GPL(sas_bios_param
);
1333 EXPORT_SYMBOL_GPL(__sas_task_abort
);
1334 EXPORT_SYMBOL_GPL(sas_task_abort
);
1335 EXPORT_SYMBOL_GPL(sas_phy_reset
);
1336 EXPORT_SYMBOL_GPL(sas_phy_enable
);
1337 EXPORT_SYMBOL_GPL(sas_eh_device_reset_handler
);
1338 EXPORT_SYMBOL_GPL(sas_eh_bus_reset_handler
);
1339 EXPORT_SYMBOL_GPL(sas_slave_alloc
);
1340 EXPORT_SYMBOL_GPL(sas_target_destroy
);
1341 EXPORT_SYMBOL_GPL(sas_ioctl
);