sas_scsi_host.c revision b27dcfb0670ea7352a67137f4ff7947c2a9f6892
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#include <linux/firmware.h> 28#include <linux/ctype.h> 29 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> 36#include <scsi/scsi_eh.h> 37#include <scsi/scsi_transport.h> 38#include <scsi/scsi_transport_sas.h> 39#include <scsi/sas_ata.h> 40#include "../scsi_sas_internal.h" 41#include "../scsi_transport_api.h" 42#include "../scsi_priv.h" 43 44#include <linux/err.h> 45#include <linux/blkdev.h> 46#include <linux/freezer.h> 47#include <linux/gfp.h> 48#include <linux/scatterlist.h> 49#include <linux/libata.h> 50 51/* ---------- SCSI Host glue ---------- */ 52 53static 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; 57 int hs = 0, stat = 0; 58 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 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: 86 scsi_set_resid(sc, ts->residual); 87 if (scsi_bufflen(sc) - scsi_get_resid(sc) < sc->underflow) 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; 116 case SAM_STAT_CHECK_CONDITION: 117 memcpy(sc->sense_buffer, ts->buf, 118 min(SCSI_SENSE_BUFFERSIZE, ts->buf_valid_size)); 119 stat = SAM_STAT_CHECK_CONDITION; 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); 130 sc->scsi_done(sc); 131} 132 133static struct sas_task *sas_create_task(struct scsi_cmnd *cmd, 134 struct domain_device *dev, 135 gfp_t gfp_flags) 136{ 137 struct sas_task *task = sas_alloc_task(gfp_flags); 138 struct scsi_lun lun; 139 140 if (!task) 141 return NULL; 142 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); 152 task->ssp_task.task_attr = TASK_ATTR_SIMPLE; 153 memcpy(task->ssp_task.cdb, cmd->cmnd, 16); 154 155 task->scatter = scsi_sglist(cmd); 156 task->num_scatter = scsi_sg_count(cmd); 157 task->total_xfer_len = scsi_bufflen(cmd); 158 task->data_dir = cmd->sc_data_direction; 159 160 task->task_done = sas_scsi_task_done; 161 162 return task; 163} 164 165int sas_queue_up(struct sas_task *task) 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); 180 wake_up_process(core->queue_thread); 181 182 return 0; 183} 184 185/** 186 * sas_queuecommand -- Enqueue a command for processing 187 * @parameters: See SCSI Core documentation 188 * 189 * Note: XXX: Remove the host unlock/lock pair when SCSI Core can 190 * call us without holding an IRQ spinlock... 191 */ 192static int sas_queuecommand_lck(struct scsi_cmnd *cmd, 193 void (*scsi_done)(struct scsi_cmnd *)) 194 __releases(host->host_lock) 195 __acquires(dev->sata_dev.ap->lock) 196 __releases(dev->sata_dev.ap->lock) 197 __acquires(host->host_lock) 198{ 199 int res = 0; 200 struct domain_device *dev = cmd_to_domain_dev(cmd); 201 struct Scsi_Host *host = cmd->device->host; 202 struct sas_internal *i = to_sas_internal(host->transportt); 203 204 spin_unlock_irq(host->host_lock); 205 206 { 207 struct sas_ha_struct *sas_ha = dev->port->ha; 208 struct sas_task *task; 209 210 if (dev_is_sata(dev)) { 211 unsigned long flags; 212 213 spin_lock_irqsave(dev->sata_dev.ap->lock, flags); 214 res = ata_sas_queuecmd(cmd, dev->sata_dev.ap); 215 spin_unlock_irqrestore(dev->sata_dev.ap->lock, flags); 216 goto out; 217 } 218 219 /* If the device fell off, no sense in issuing commands */ 220 if (dev->gone) { 221 cmd->result = DID_BAD_TARGET << 16; 222 scsi_done(cmd); 223 goto out; 224 } 225 226 res = -ENOMEM; 227 task = sas_create_task(cmd, dev, GFP_ATOMIC); 228 if (!task) 229 goto out; 230 231 cmd->scsi_done = scsi_done; 232 /* Queue up, Direct Mode or Task Collector Mode. */ 233 if (sas_ha->lldd_max_execute_num < 2) 234 res = i->dft->lldd_execute_task(task, 1, GFP_ATOMIC); 235 else 236 res = sas_queue_up(task); 237 238 /* Examine */ 239 if (res) { 240 SAS_DPRINTK("lldd_execute_task returned: %d\n", res); 241 ASSIGN_SAS_TASK(cmd, NULL); 242 sas_free_task(task); 243 if (res == -SAS_QUEUE_FULL) { 244 cmd->result = DID_SOFT_ERROR << 16; /* retry */ 245 res = 0; 246 scsi_done(cmd); 247 } 248 goto out; 249 } 250 } 251out: 252 spin_lock_irq(host->host_lock); 253 return res; 254} 255 256DEF_SCSI_QCMD(sas_queuecommand) 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 __func__, 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", __func__, 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", __func__, 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 __func__, task); 367 return TASK_IS_ABORTED; 368 } else if (si->dft->lldd_query_task) { 369 SAS_DPRINTK("%s: querying task 0x%p\n", 370 __func__, 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 __func__, 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 __func__, 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 __func__, 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_cmnd *cmd) 502{ 503 int res; 504 struct Scsi_Host *shost = cmd->device->host; 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 if (need_reset) { 545 SAS_DPRINTK("%s: task 0x%p requests reset\n", 546 __func__, task); 547 goto reset; 548 } 549 550 SAS_DPRINTK("trying to find task 0x%p\n", task); 551 res = sas_scsi_find_task(task); 552 553 cmd->eh_eflags = 0; 554 555 switch (res) { 556 case TASK_IS_DONE: 557 SAS_DPRINTK("%s: task 0x%p is done\n", __func__, 558 task); 559 sas_eh_finish_cmd(cmd); 560 continue; 561 case TASK_IS_ABORTED: 562 SAS_DPRINTK("%s: task 0x%p is aborted\n", 563 __func__, task); 564 sas_eh_finish_cmd(cmd); 565 continue; 566 case TASK_IS_AT_LU: 567 SAS_DPRINTK("task 0x%p is at LU: lu recover\n", task); 568 reset: 569 tmf_resp = sas_recover_lu(task->dev, cmd); 570 if (tmf_resp == TMF_RESP_FUNC_COMPLETE) { 571 SAS_DPRINTK("dev %016llx LU %x is " 572 "recovered\n", 573 SAS_ADDR(task->dev), 574 cmd->device->lun); 575 sas_eh_finish_cmd(cmd); 576 sas_scsi_clear_queue_lu(work_q, cmd); 577 goto Again; 578 } 579 /* fallthrough */ 580 case TASK_IS_NOT_AT_LU: 581 case TASK_ABORT_FAILED: 582 SAS_DPRINTK("task 0x%p is not at LU: I_T recover\n", 583 task); 584 tmf_resp = sas_recover_I_T(task->dev); 585 if (tmf_resp == TMF_RESP_FUNC_COMPLETE) { 586 struct domain_device *dev = task->dev; 587 SAS_DPRINTK("I_T %016llx recovered\n", 588 SAS_ADDR(task->dev->sas_addr)); 589 sas_eh_finish_cmd(cmd); 590 sas_scsi_clear_queue_I_T(work_q, dev); 591 goto Again; 592 } 593 /* Hammer time :-) */ 594 try_to_reset_cmd_device(cmd); 595 if (i->dft->lldd_clear_nexus_port) { 596 struct asd_sas_port *port = task->dev->port; 597 SAS_DPRINTK("clearing nexus for port:%d\n", 598 port->id); 599 res = i->dft->lldd_clear_nexus_port(port); 600 if (res == TMF_RESP_FUNC_COMPLETE) { 601 SAS_DPRINTK("clear nexus port:%d " 602 "succeeded\n", port->id); 603 sas_eh_finish_cmd(cmd); 604 sas_scsi_clear_queue_port(work_q, 605 port); 606 goto Again; 607 } 608 } 609 if (i->dft->lldd_clear_nexus_ha) { 610 SAS_DPRINTK("clear nexus ha\n"); 611 res = i->dft->lldd_clear_nexus_ha(ha); 612 if (res == TMF_RESP_FUNC_COMPLETE) { 613 SAS_DPRINTK("clear nexus ha " 614 "succeeded\n"); 615 sas_eh_finish_cmd(cmd); 616 goto clear_q; 617 } 618 } 619 /* If we are here -- this means that no amount 620 * of effort could recover from errors. Quite 621 * possibly the HA just disappeared. 622 */ 623 SAS_DPRINTK("error from device %llx, LUN %x " 624 "couldn't be recovered in any way\n", 625 SAS_ADDR(task->dev->sas_addr), 626 cmd->device->lun); 627 628 sas_eh_finish_cmd(cmd); 629 goto clear_q; 630 } 631 } 632 return list_empty(work_q); 633clear_q: 634 SAS_DPRINTK("--- Exit %s -- clear_q\n", __func__); 635 list_for_each_entry_safe(cmd, n, work_q, eh_entry) 636 sas_eh_finish_cmd(cmd); 637 638 return list_empty(work_q); 639} 640 641void sas_scsi_recover_host(struct Scsi_Host *shost) 642{ 643 struct sas_ha_struct *ha = SHOST_TO_SAS_HA(shost); 644 unsigned long flags; 645 LIST_HEAD(eh_work_q); 646 647 spin_lock_irqsave(shost->host_lock, flags); 648 list_splice_init(&shost->eh_cmd_q, &eh_work_q); 649 spin_unlock_irqrestore(shost->host_lock, flags); 650 651 SAS_DPRINTK("Enter %s\n", __func__); 652 /* 653 * Deal with commands that still have SAS tasks (i.e. they didn't 654 * complete via the normal sas_task completion mechanism) 655 */ 656 if (sas_eh_handle_sas_errors(shost, &eh_work_q, &ha->eh_done_q)) 657 goto out; 658 659 /* 660 * Now deal with SCSI commands that completed ok but have a an error 661 * code (and hopefully sense data) attached. This is roughly what 662 * scsi_unjam_host does, but we skip scsi_eh_abort_cmds because any 663 * command we see here has no sas_task and is thus unknown to the HA. 664 */ 665 if (!scsi_eh_get_sense(&eh_work_q, &ha->eh_done_q)) 666 scsi_eh_ready_devs(shost, &eh_work_q, &ha->eh_done_q); 667 668out: 669 scsi_eh_flush_done_q(&ha->eh_done_q); 670 SAS_DPRINTK("--- Exit %s\n", __func__); 671 return; 672} 673 674enum blk_eh_timer_return sas_scsi_timed_out(struct scsi_cmnd *cmd) 675{ 676 struct sas_task *task = TO_SAS_TASK(cmd); 677 unsigned long flags; 678 679 if (!task) { 680 cmd->request->timeout /= 2; 681 SAS_DPRINTK("command 0x%p, task 0x%p, gone: %s\n", 682 cmd, task, (cmd->request->timeout ? 683 "BLK_EH_RESET_TIMER" : "BLK_EH_NOT_HANDLED")); 684 if (!cmd->request->timeout) 685 return BLK_EH_NOT_HANDLED; 686 return BLK_EH_RESET_TIMER; 687 } 688 689 spin_lock_irqsave(&task->task_state_lock, flags); 690 BUG_ON(task->task_state_flags & SAS_TASK_STATE_ABORTED); 691 if (task->task_state_flags & SAS_TASK_STATE_DONE) { 692 spin_unlock_irqrestore(&task->task_state_lock, flags); 693 SAS_DPRINTK("command 0x%p, task 0x%p, timed out: " 694 "BLK_EH_HANDLED\n", cmd, task); 695 return BLK_EH_HANDLED; 696 } 697 if (!(task->task_state_flags & SAS_TASK_AT_INITIATOR)) { 698 spin_unlock_irqrestore(&task->task_state_lock, flags); 699 SAS_DPRINTK("command 0x%p, task 0x%p, not at initiator: " 700 "BLK_EH_RESET_TIMER\n", 701 cmd, task); 702 return BLK_EH_RESET_TIMER; 703 } 704 task->task_state_flags |= SAS_TASK_STATE_ABORTED; 705 spin_unlock_irqrestore(&task->task_state_lock, flags); 706 707 SAS_DPRINTK("command 0x%p, task 0x%p, timed out: BLK_EH_NOT_HANDLED\n", 708 cmd, task); 709 710 return BLK_EH_NOT_HANDLED; 711} 712 713int sas_ioctl(struct scsi_device *sdev, int cmd, void __user *arg) 714{ 715 struct domain_device *dev = sdev_to_domain_dev(sdev); 716 717 if (dev_is_sata(dev)) 718 return ata_sas_scsi_ioctl(dev->sata_dev.ap, sdev, cmd, arg); 719 720 return -EINVAL; 721} 722 723struct domain_device *sas_find_dev_by_rphy(struct sas_rphy *rphy) 724{ 725 struct Scsi_Host *shost = dev_to_shost(rphy->dev.parent); 726 struct sas_ha_struct *ha = SHOST_TO_SAS_HA(shost); 727 struct domain_device *found_dev = NULL; 728 int i; 729 unsigned long flags; 730 731 spin_lock_irqsave(&ha->phy_port_lock, flags); 732 for (i = 0; i < ha->num_phys; i++) { 733 struct asd_sas_port *port = ha->sas_port[i]; 734 struct domain_device *dev; 735 736 spin_lock(&port->dev_list_lock); 737 list_for_each_entry(dev, &port->dev_list, dev_list_node) { 738 if (rphy == dev->rphy) { 739 found_dev = dev; 740 spin_unlock(&port->dev_list_lock); 741 goto found; 742 } 743 } 744 spin_unlock(&port->dev_list_lock); 745 } 746 found: 747 spin_unlock_irqrestore(&ha->phy_port_lock, flags); 748 749 return found_dev; 750} 751 752static inline struct domain_device *sas_find_target(struct scsi_target *starget) 753{ 754 struct sas_rphy *rphy = dev_to_rphy(starget->dev.parent); 755 756 return sas_find_dev_by_rphy(rphy); 757} 758 759int sas_target_alloc(struct scsi_target *starget) 760{ 761 struct domain_device *found_dev = sas_find_target(starget); 762 int res; 763 764 if (!found_dev) 765 return -ENODEV; 766 767 if (dev_is_sata(found_dev)) { 768 res = sas_ata_init_host_and_port(found_dev, starget); 769 if (res) 770 return res; 771 } 772 773 starget->hostdata = found_dev; 774 return 0; 775} 776 777#define SAS_DEF_QD 32 778#define SAS_MAX_QD 64 779 780int sas_slave_configure(struct scsi_device *scsi_dev) 781{ 782 struct domain_device *dev = sdev_to_domain_dev(scsi_dev); 783 struct sas_ha_struct *sas_ha; 784 785 BUG_ON(dev->rphy->identify.device_type != SAS_END_DEVICE); 786 787 if (dev_is_sata(dev)) { 788 ata_sas_slave_configure(scsi_dev, dev->sata_dev.ap); 789 return 0; 790 } 791 792 sas_ha = dev->port->ha; 793 794 sas_read_port_mode_page(scsi_dev); 795 796 if (scsi_dev->tagged_supported) { 797 scsi_set_tag_type(scsi_dev, MSG_SIMPLE_TAG); 798 scsi_activate_tcq(scsi_dev, SAS_DEF_QD); 799 } else { 800 SAS_DPRINTK("device %llx, LUN %x doesn't support " 801 "TCQ\n", SAS_ADDR(dev->sas_addr), 802 scsi_dev->lun); 803 scsi_dev->tagged_supported = 0; 804 scsi_set_tag_type(scsi_dev, 0); 805 scsi_deactivate_tcq(scsi_dev, 1); 806 } 807 808 scsi_dev->allow_restart = 1; 809 810 return 0; 811} 812 813void sas_slave_destroy(struct scsi_device *scsi_dev) 814{ 815 struct domain_device *dev = sdev_to_domain_dev(scsi_dev); 816 817 if (dev_is_sata(dev)) 818 dev->sata_dev.ap->link.device[0].class = ATA_DEV_NONE; 819} 820 821int sas_change_queue_depth(struct scsi_device *scsi_dev, int new_depth, 822 int reason) 823{ 824 int res = min(new_depth, SAS_MAX_QD); 825 826 if (reason != SCSI_QDEPTH_DEFAULT) 827 return -EOPNOTSUPP; 828 829 if (scsi_dev->tagged_supported) 830 scsi_adjust_queue_depth(scsi_dev, scsi_get_tag_type(scsi_dev), 831 res); 832 else { 833 struct domain_device *dev = sdev_to_domain_dev(scsi_dev); 834 sas_printk("device %llx LUN %x queue depth changed to 1\n", 835 SAS_ADDR(dev->sas_addr), 836 scsi_dev->lun); 837 scsi_adjust_queue_depth(scsi_dev, 0, 1); 838 res = 1; 839 } 840 841 return res; 842} 843 844int sas_change_queue_type(struct scsi_device *scsi_dev, int qt) 845{ 846 if (!scsi_dev->tagged_supported) 847 return 0; 848 849 scsi_deactivate_tcq(scsi_dev, 1); 850 851 scsi_set_tag_type(scsi_dev, qt); 852 scsi_activate_tcq(scsi_dev, scsi_dev->queue_depth); 853 854 return qt; 855} 856 857int sas_bios_param(struct scsi_device *scsi_dev, 858 struct block_device *bdev, 859 sector_t capacity, int *hsc) 860{ 861 hsc[0] = 255; 862 hsc[1] = 63; 863 sector_div(capacity, 255*63); 864 hsc[2] = capacity; 865 866 return 0; 867} 868 869/* ---------- Task Collector Thread implementation ---------- */ 870 871static void sas_queue(struct sas_ha_struct *sas_ha) 872{ 873 struct scsi_core *core = &sas_ha->core; 874 unsigned long flags; 875 LIST_HEAD(q); 876 int can_queue; 877 int res; 878 struct sas_internal *i = to_sas_internal(core->shost->transportt); 879 880 spin_lock_irqsave(&core->task_queue_lock, flags); 881 while (!kthread_should_stop() && 882 !list_empty(&core->task_queue)) { 883 884 can_queue = sas_ha->lldd_queue_size - core->task_queue_size; 885 if (can_queue >= 0) { 886 can_queue = core->task_queue_size; 887 list_splice_init(&core->task_queue, &q); 888 } else { 889 struct list_head *a, *n; 890 891 can_queue = sas_ha->lldd_queue_size; 892 list_for_each_safe(a, n, &core->task_queue) { 893 list_move_tail(a, &q); 894 if (--can_queue == 0) 895 break; 896 } 897 can_queue = sas_ha->lldd_queue_size; 898 } 899 core->task_queue_size -= can_queue; 900 spin_unlock_irqrestore(&core->task_queue_lock, flags); 901 { 902 struct sas_task *task = list_entry(q.next, 903 struct sas_task, 904 list); 905 list_del_init(&q); 906 res = i->dft->lldd_execute_task(task, can_queue, 907 GFP_KERNEL); 908 if (unlikely(res)) 909 __list_add(&q, task->list.prev, &task->list); 910 } 911 spin_lock_irqsave(&core->task_queue_lock, flags); 912 if (res) { 913 list_splice_init(&q, &core->task_queue); /*at head*/ 914 core->task_queue_size += can_queue; 915 } 916 } 917 spin_unlock_irqrestore(&core->task_queue_lock, flags); 918} 919 920/** 921 * sas_queue_thread -- The Task Collector thread 922 * @_sas_ha: pointer to struct sas_ha 923 */ 924static int sas_queue_thread(void *_sas_ha) 925{ 926 struct sas_ha_struct *sas_ha = _sas_ha; 927 928 while (1) { 929 set_current_state(TASK_INTERRUPTIBLE); 930 schedule(); 931 sas_queue(sas_ha); 932 if (kthread_should_stop()) 933 break; 934 } 935 936 return 0; 937} 938 939int sas_init_queue(struct sas_ha_struct *sas_ha) 940{ 941 struct scsi_core *core = &sas_ha->core; 942 943 spin_lock_init(&core->task_queue_lock); 944 core->task_queue_size = 0; 945 INIT_LIST_HEAD(&core->task_queue); 946 947 core->queue_thread = kthread_run(sas_queue_thread, sas_ha, 948 "sas_queue_%d", core->shost->host_no); 949 if (IS_ERR(core->queue_thread)) 950 return PTR_ERR(core->queue_thread); 951 return 0; 952} 953 954void sas_shutdown_queue(struct sas_ha_struct *sas_ha) 955{ 956 unsigned long flags; 957 struct scsi_core *core = &sas_ha->core; 958 struct sas_task *task, *n; 959 960 kthread_stop(core->queue_thread); 961 962 if (!list_empty(&core->task_queue)) 963 SAS_DPRINTK("HA: %llx: scsi core task queue is NOT empty!?\n", 964 SAS_ADDR(sas_ha->sas_addr)); 965 966 spin_lock_irqsave(&core->task_queue_lock, flags); 967 list_for_each_entry_safe(task, n, &core->task_queue, list) { 968 struct scsi_cmnd *cmd = task->uldd_task; 969 970 list_del_init(&task->list); 971 972 ASSIGN_SAS_TASK(cmd, NULL); 973 sas_free_task(task); 974 cmd->result = DID_ABORT << 16; 975 cmd->scsi_done(cmd); 976 } 977 spin_unlock_irqrestore(&core->task_queue_lock, flags); 978} 979 980/* 981 * Call the LLDD task abort routine directly. This function is intended for 982 * use by upper layers that need to tell the LLDD to abort a task. 983 */ 984int __sas_task_abort(struct sas_task *task) 985{ 986 struct sas_internal *si = 987 to_sas_internal(task->dev->port->ha->core.shost->transportt); 988 unsigned long flags; 989 int res; 990 991 spin_lock_irqsave(&task->task_state_lock, flags); 992 if (task->task_state_flags & SAS_TASK_STATE_ABORTED || 993 task->task_state_flags & SAS_TASK_STATE_DONE) { 994 spin_unlock_irqrestore(&task->task_state_lock, flags); 995 SAS_DPRINTK("%s: Task %p already finished.\n", __func__, 996 task); 997 return 0; 998 } 999 task->task_state_flags |= SAS_TASK_STATE_ABORTED; 1000 spin_unlock_irqrestore(&task->task_state_lock, flags); 1001 1002 if (!si->dft->lldd_abort_task) 1003 return -ENODEV; 1004 1005 res = si->dft->lldd_abort_task(task); 1006 1007 spin_lock_irqsave(&task->task_state_lock, flags); 1008 if ((task->task_state_flags & SAS_TASK_STATE_DONE) || 1009 (res == TMF_RESP_FUNC_COMPLETE)) 1010 { 1011 spin_unlock_irqrestore(&task->task_state_lock, flags); 1012 task->task_done(task); 1013 return 0; 1014 } 1015 1016 if (!(task->task_state_flags & SAS_TASK_STATE_DONE)) 1017 task->task_state_flags &= ~SAS_TASK_STATE_ABORTED; 1018 spin_unlock_irqrestore(&task->task_state_lock, flags); 1019 1020 return -EAGAIN; 1021} 1022 1023/* 1024 * Tell an upper layer that it needs to initiate an abort for a given task. 1025 * This should only ever be called by an LLDD. 1026 */ 1027void sas_task_abort(struct sas_task *task) 1028{ 1029 struct scsi_cmnd *sc = task->uldd_task; 1030 1031 /* Escape for libsas internal commands */ 1032 if (!sc) { 1033 if (!del_timer(&task->timer)) 1034 return; 1035 task->timer.function(task->timer.data); 1036 return; 1037 } 1038 1039 if (dev_is_sata(task->dev)) { 1040 sas_ata_task_abort(task); 1041 } else { 1042 struct request_queue *q = sc->device->request_queue; 1043 unsigned long flags; 1044 1045 spin_lock_irqsave(q->queue_lock, flags); 1046 blk_abort_request(sc->request); 1047 spin_unlock_irqrestore(q->queue_lock, flags); 1048 scsi_schedule_eh(sc->device->host); 1049 } 1050} 1051 1052int sas_slave_alloc(struct scsi_device *scsi_dev) 1053{ 1054 struct domain_device *dev = sdev_to_domain_dev(scsi_dev); 1055 1056 if (dev_is_sata(dev)) 1057 return ata_sas_port_init(dev->sata_dev.ap); 1058 1059 return 0; 1060} 1061 1062void sas_target_destroy(struct scsi_target *starget) 1063{ 1064 struct domain_device *found_dev = sas_find_target(starget); 1065 1066 if (!found_dev) 1067 return; 1068 1069 if (dev_is_sata(found_dev)) 1070 ata_sas_port_destroy(found_dev->sata_dev.ap); 1071 1072 return; 1073} 1074 1075static void sas_parse_addr(u8 *sas_addr, const char *p) 1076{ 1077 int i; 1078 for (i = 0; i < SAS_ADDR_SIZE; i++) { 1079 u8 h, l; 1080 if (!*p) 1081 break; 1082 h = isdigit(*p) ? *p-'0' : toupper(*p)-'A'+10; 1083 p++; 1084 l = isdigit(*p) ? *p-'0' : toupper(*p)-'A'+10; 1085 p++; 1086 sas_addr[i] = (h<<4) | l; 1087 } 1088} 1089 1090#define SAS_STRING_ADDR_SIZE 16 1091 1092int sas_request_addr(struct Scsi_Host *shost, u8 *addr) 1093{ 1094 int res; 1095 const struct firmware *fw; 1096 1097 res = request_firmware(&fw, "sas_addr", &shost->shost_gendev); 1098 if (res) 1099 return res; 1100 1101 if (fw->size < SAS_STRING_ADDR_SIZE) { 1102 res = -ENODEV; 1103 goto out; 1104 } 1105 1106 sas_parse_addr(addr, fw->data); 1107 1108out: 1109 release_firmware(fw); 1110 return res; 1111} 1112EXPORT_SYMBOL_GPL(sas_request_addr); 1113 1114EXPORT_SYMBOL_GPL(sas_queuecommand); 1115EXPORT_SYMBOL_GPL(sas_target_alloc); 1116EXPORT_SYMBOL_GPL(sas_slave_configure); 1117EXPORT_SYMBOL_GPL(sas_slave_destroy); 1118EXPORT_SYMBOL_GPL(sas_change_queue_depth); 1119EXPORT_SYMBOL_GPL(sas_change_queue_type); 1120EXPORT_SYMBOL_GPL(sas_bios_param); 1121EXPORT_SYMBOL_GPL(__sas_task_abort); 1122EXPORT_SYMBOL_GPL(sas_task_abort); 1123EXPORT_SYMBOL_GPL(sas_phy_reset); 1124EXPORT_SYMBOL_GPL(sas_phy_enable); 1125EXPORT_SYMBOL_GPL(sas_eh_device_reset_handler); 1126EXPORT_SYMBOL_GPL(sas_eh_bus_reset_handler); 1127EXPORT_SYMBOL_GPL(sas_slave_alloc); 1128EXPORT_SYMBOL_GPL(sas_target_destroy); 1129EXPORT_SYMBOL_GPL(sas_ioctl); 1130