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