drivers/scsi/ibmvscsi/ibmvfc.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * ibmvfc.c -- driver for IBM Power Virtual Fibre Channel Adapter
   4  *
   5  * Written By: Brian King <brking@linux.vnet.ibm.com>, IBM Corporation
   6  *
   7  * Copyright (C) IBM Corporation, 2008
   8  */
   9
  10 #include <linux/module.h>
  11 #include <linux/moduleparam.h>
  12 #include <linux/dma-mapping.h>
  13 #include <linux/dmapool.h>
  14 #include <linux/delay.h>
  15 #include <linux/interrupt.h>
  16 #include <linux/kthread.h>
  17 #include <linux/slab.h>
  18 #include <linux/of.h>
  19 #include <linux/pm.h>
  20 #include <linux/stringify.h>
  21 #include <linux/bsg-lib.h>
  22 #include <asm/firmware.h>
  23 #include <asm/irq.h>
  24 #include <asm/vio.h>
  25 #include <scsi/scsi.h>
  26 #include <scsi/scsi_cmnd.h>
  27 #include <scsi/scsi_host.h>
  28 #include <scsi/scsi_device.h>
  29 #include <scsi/scsi_tcq.h>
  30 #include <scsi/scsi_transport_fc.h>
  31 #include <scsi/scsi_bsg_fc.h>
  32 #include "ibmvfc.h"
  33
  34 static unsigned int init_timeout = IBMVFC_INIT_TIMEOUT;
  35 static unsigned int default_timeout = IBMVFC_DEFAULT_TIMEOUT;
  36 static u64 max_lun = IBMVFC_MAX_LUN;
  37 static unsigned int max_targets = IBMVFC_MAX_TARGETS;
  38 static unsigned int max_requests = IBMVFC_MAX_REQUESTS_DEFAULT;
  39 static unsigned int disc_threads = IBMVFC_MAX_DISC_THREADS;
  40 static unsigned int ibmvfc_debug = IBMVFC_DEBUG;
  41 static unsigned int log_level = IBMVFC_DEFAULT_LOG_LEVEL;
  42 static unsigned int cls3_error = IBMVFC_CLS3_ERROR;
  43 static LIST_HEAD(ibmvfc_head);
  44 static DEFINE_SPINLOCK(ibmvfc_driver_lock);
  45 static struct scsi_transport_template *ibmvfc_transport_template;
  46
  47 MODULE_DESCRIPTION("IBM Virtual Fibre Channel Driver");
  48 MODULE_AUTHOR("Brian King <brking@linux.vnet.ibm.com>");
  49 MODULE_LICENSE("GPL");
  50 MODULE_VERSION(IBMVFC_DRIVER_VERSION);
  51
  52 module_param_named(init_timeout, init_timeout, uint, S_IRUGO | S_IWUSR);
  53 MODULE_PARM_DESC(init_timeout, "Initialization timeout in seconds. "
  54                  "[Default=" __stringify(IBMVFC_INIT_TIMEOUT) "]");
  55 module_param_named(default_timeout, default_timeout, uint, S_IRUGO | S_IWUSR);
  56 MODULE_PARM_DESC(default_timeout,
  57                  "Default timeout in seconds for initialization and EH commands. "
  58                  "[Default=" __stringify(IBMVFC_DEFAULT_TIMEOUT) "]");
  59 module_param_named(max_requests, max_requests, uint, S_IRUGO);
  60 MODULE_PARM_DESC(max_requests, "Maximum requests for this adapter. "
  61                  "[Default=" __stringify(IBMVFC_MAX_REQUESTS_DEFAULT) "]");
  62 module_param_named(max_lun, max_lun, ullong, S_IRUGO);
  63 MODULE_PARM_DESC(max_lun, "Maximum allowed LUN. "
  64                  "[Default=" __stringify(IBMVFC_MAX_LUN) "]");
  65 module_param_named(max_targets, max_targets, uint, S_IRUGO);
  66 MODULE_PARM_DESC(max_targets, "Maximum allowed targets. "
  67                  "[Default=" __stringify(IBMVFC_MAX_TARGETS) "]");
  68 module_param_named(disc_threads, disc_threads, uint, S_IRUGO);
  69 MODULE_PARM_DESC(disc_threads, "Number of device discovery threads to use. "
  70                  "[Default=" __stringify(IBMVFC_MAX_DISC_THREADS) "]");
  71 module_param_named(debug, ibmvfc_debug, uint, S_IRUGO | S_IWUSR);
  72 MODULE_PARM_DESC(debug, "Enable driver debug information. "
  73                  "[Default=" __stringify(IBMVFC_DEBUG) "]");
  74 module_param_named(log_level, log_level, uint, 0);
  75 MODULE_PARM_DESC(log_level, "Set to 0 - 4 for increasing verbosity of device driver. "
  76                  "[Default=" __stringify(IBMVFC_DEFAULT_LOG_LEVEL) "]");
  77 module_param_named(cls3_error, cls3_error, uint, 0);
  78 MODULE_PARM_DESC(cls3_error, "Enable FC Class 3 Error Recovery. "
  79                  "[Default=" __stringify(IBMVFC_CLS3_ERROR) "]");
  80
  81 static const struct {
  82         u16 status;
  83         u16 error;
  84         u8 result;
  85         u8 retry;
  86         int log;
  87         char *name;
  88 } cmd_status [] = {
  89         { IBMVFC_FABRIC_MAPPED, IBMVFC_UNABLE_TO_ESTABLISH, DID_ERROR, 1, 1, "unable to establish" },
  90         { IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_FAULT, DID_OK, 1, 0, "transport fault" },
  91         { IBMVFC_FABRIC_MAPPED, IBMVFC_CMD_TIMEOUT, DID_TIME_OUT, 1, 1, "command timeout" },
  92         { IBMVFC_FABRIC_MAPPED, IBMVFC_ENETDOWN, DID_TRANSPORT_DISRUPTED, 1, 1, "network down" },
  93         { IBMVFC_FABRIC_MAPPED, IBMVFC_HW_FAILURE, DID_ERROR, 1, 1, "hardware failure" },
  94         { IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_DOWN_ERR, DID_REQUEUE, 0, 0, "link down" },
  95         { IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_DEAD_ERR, DID_ERROR, 0, 0, "link dead" },
  96         { IBMVFC_FABRIC_MAPPED, IBMVFC_UNABLE_TO_REGISTER, DID_ERROR, 1, 1, "unable to register" },
  97         { IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_BUSY, DID_BUS_BUSY, 1, 0, "transport busy" },
  98         { IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_DEAD, DID_ERROR, 0, 1, "transport dead" },
  99         { IBMVFC_FABRIC_MAPPED, IBMVFC_CONFIG_ERROR, DID_ERROR, 1, 1, "configuration error" },
 100         { IBMVFC_FABRIC_MAPPED, IBMVFC_NAME_SERVER_FAIL, DID_ERROR, 1, 1, "name server failure" },
 101         { IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_HALTED, DID_REQUEUE, 1, 0, "link halted" },
 102         { IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_GENERAL, DID_OK, 1, 0, "general transport error" },
 103
 104         { IBMVFC_VIOS_FAILURE, IBMVFC_CRQ_FAILURE, DID_REQUEUE, 1, 1, "CRQ failure" },
 105         { IBMVFC_VIOS_FAILURE, IBMVFC_SW_FAILURE, DID_ERROR, 0, 1, "software failure" },
 106         { IBMVFC_VIOS_FAILURE, IBMVFC_INVALID_PARAMETER, DID_ERROR, 0, 1, "invalid parameter" },
 107         { IBMVFC_VIOS_FAILURE, IBMVFC_MISSING_PARAMETER, DID_ERROR, 0, 1, "missing parameter" },
 108         { IBMVFC_VIOS_FAILURE, IBMVFC_HOST_IO_BUS, DID_ERROR, 1, 1, "host I/O bus failure" },
 109         { IBMVFC_VIOS_FAILURE, IBMVFC_TRANS_CANCELLED, DID_ERROR, 0, 1, "transaction cancelled" },
 110         { IBMVFC_VIOS_FAILURE, IBMVFC_TRANS_CANCELLED_IMPLICIT, DID_ERROR, 0, 1, "transaction cancelled implicit" },
 111         { IBMVFC_VIOS_FAILURE, IBMVFC_INSUFFICIENT_RESOURCE, DID_REQUEUE, 1, 1, "insufficient resources" },
 112         { IBMVFC_VIOS_FAILURE, IBMVFC_PLOGI_REQUIRED, DID_ERROR, 0, 1, "port login required" },
 113         { IBMVFC_VIOS_FAILURE, IBMVFC_COMMAND_FAILED, DID_ERROR, 1, 1, "command failed" },
 114
 115         { IBMVFC_FC_FAILURE, IBMVFC_INVALID_ELS_CMD_CODE, DID_ERROR, 0, 1, "invalid ELS command code" },
 116         { IBMVFC_FC_FAILURE, IBMVFC_INVALID_VERSION, DID_ERROR, 0, 1, "invalid version level" },
 117         { IBMVFC_FC_FAILURE, IBMVFC_LOGICAL_ERROR, DID_ERROR, 1, 1, "logical error" },
 118         { IBMVFC_FC_FAILURE, IBMVFC_INVALID_CT_IU_SIZE, DID_ERROR, 0, 1, "invalid CT_IU size" },
 119         { IBMVFC_FC_FAILURE, IBMVFC_LOGICAL_BUSY, DID_REQUEUE, 1, 0, "logical busy" },
 120         { IBMVFC_FC_FAILURE, IBMVFC_PROTOCOL_ERROR, DID_ERROR, 1, 1, "protocol error" },
 121         { IBMVFC_FC_FAILURE, IBMVFC_UNABLE_TO_PERFORM_REQ, DID_ERROR, 1, 1, "unable to perform request" },
 122         { IBMVFC_FC_FAILURE, IBMVFC_CMD_NOT_SUPPORTED, DID_ERROR, 0, 0, "command not supported" },
 123         { IBMVFC_FC_FAILURE, IBMVFC_SERVER_NOT_AVAIL, DID_ERROR, 0, 1, "server not available" },
 124         { IBMVFC_FC_FAILURE, IBMVFC_CMD_IN_PROGRESS, DID_ERROR, 0, 1, "command already in progress" },
 125         { IBMVFC_FC_FAILURE, IBMVFC_VENDOR_SPECIFIC, DID_ERROR, 1, 1, "vendor specific" },
 126
 127         { IBMVFC_FC_SCSI_ERROR, 0, DID_OK, 1, 0, "SCSI error" },
 128         { IBMVFC_FC_SCSI_ERROR, IBMVFC_COMMAND_FAILED, DID_ERROR, 0, 1, "PRLI to device failed." },
 129 };
 130
 131 static void ibmvfc_npiv_login(struct ibmvfc_host *);
 132 static void ibmvfc_tgt_send_prli(struct ibmvfc_target *);
 133 static void ibmvfc_tgt_send_plogi(struct ibmvfc_target *);
 134 static void ibmvfc_tgt_query_target(struct ibmvfc_target *);
 135 static void ibmvfc_npiv_logout(struct ibmvfc_host *);
 136
 137 static const char *unknown_error = "unknown error";
 138
 139 #ifdef CONFIG_SCSI_IBMVFC_TRACE
 140 /**
 141  * ibmvfc_trc_start - Log a start trace entry
 142  * @evt:                ibmvfc event struct
 143  *
 144  **/
 145 static void ibmvfc_trc_start(struct ibmvfc_event *evt)
 146 {
 147         struct ibmvfc_host *vhost = evt->vhost;
 148         struct ibmvfc_cmd *vfc_cmd = &evt->iu.cmd;
 149         struct ibmvfc_mad_common *mad = &evt->iu.mad_common;
 150         struct ibmvfc_trace_entry *entry;
 151
 152         entry = &vhost->trace[vhost->trace_index++];
 153         entry->evt = evt;
 154         entry->time = jiffies;
 155         entry->fmt = evt->crq.format;
 156         entry->type = IBMVFC_TRC_START;
 157
 158         switch (entry->fmt) {
 159         case IBMVFC_CMD_FORMAT:
 160                 entry->op_code = vfc_cmd->iu.cdb[0];
 161                 entry->scsi_id = be64_to_cpu(vfc_cmd->tgt_scsi_id);
 162                 entry->lun = scsilun_to_int(&vfc_cmd->iu.lun);
 163                 entry->tmf_flags = vfc_cmd->iu.tmf_flags;
 164                 entry->u.start.xfer_len = be32_to_cpu(vfc_cmd->iu.xfer_len);
 165                 break;
 166         case IBMVFC_MAD_FORMAT:
 167                 entry->op_code = be32_to_cpu(mad->opcode);
 168                 break;
 169         default:
 170                 break;
 171         }
 172 }
 173
 174 /**
 175  * ibmvfc_trc_end - Log an end trace entry
 176  * @evt:                ibmvfc event struct
 177  *
 178  **/
 179 static void ibmvfc_trc_end(struct ibmvfc_event *evt)
 180 {
 181         struct ibmvfc_host *vhost = evt->vhost;
 182         struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
 183         struct ibmvfc_mad_common *mad = &evt->xfer_iu->mad_common;
 184         struct ibmvfc_trace_entry *entry = &vhost->trace[vhost->trace_index++];
 185
 186         entry->evt = evt;
 187         entry->time = jiffies;
 188         entry->fmt = evt->crq.format;
 189         entry->type = IBMVFC_TRC_END;
 190
 191         switch (entry->fmt) {
 192         case IBMVFC_CMD_FORMAT:
 193                 entry->op_code = vfc_cmd->iu.cdb[0];
 194                 entry->scsi_id = be64_to_cpu(vfc_cmd->tgt_scsi_id);
 195                 entry->lun = scsilun_to_int(&vfc_cmd->iu.lun);
 196                 entry->tmf_flags = vfc_cmd->iu.tmf_flags;
 197                 entry->u.end.status = be16_to_cpu(vfc_cmd->status);
 198                 entry->u.end.error = be16_to_cpu(vfc_cmd->error);
 199                 entry->u.end.fcp_rsp_flags = vfc_cmd->rsp.flags;
 200                 entry->u.end.rsp_code = vfc_cmd->rsp.data.info.rsp_code;
 201                 entry->u.end.scsi_status = vfc_cmd->rsp.scsi_status;
 202                 break;
 203         case IBMVFC_MAD_FORMAT:
 204                 entry->op_code = be32_to_cpu(mad->opcode);
 205                 entry->u.end.status = be16_to_cpu(mad->status);
 206                 break;
 207         default:
 208                 break;
 209
 210         }
 211 }
 212
 213 #else
 214 #define ibmvfc_trc_start(evt) do { } while (0)
 215 #define ibmvfc_trc_end(evt) do { } while (0)
 216 #endif
 217
 218 /**
 219  * ibmvfc_get_err_index - Find the index into cmd_status for the fcp response
 220  * @status:             status / error class
 221  * @error:              error
 222  *
 223  * Return value:
 224  *      index into cmd_status / -EINVAL on failure
 225  **/
 226 static int ibmvfc_get_err_index(u16 status, u16 error)
 227 {
 228         int i;
 229
 230         for (i = 0; i < ARRAY_SIZE(cmd_status); i++)
 231                 if ((cmd_status[i].status & status) == cmd_status[i].status &&
 232                     cmd_status[i].error == error)
 233                         return i;
 234
 235         return -EINVAL;
 236 }
 237
 238 /**
 239  * ibmvfc_get_cmd_error - Find the error description for the fcp response
 240  * @status:             status / error class
 241  * @error:              error
 242  *
 243  * Return value:
 244  *      error description string
 245  **/
 246 static const char *ibmvfc_get_cmd_error(u16 status, u16 error)
 247 {
 248         int rc = ibmvfc_get_err_index(status, error);
 249         if (rc >= 0)
 250                 return cmd_status[rc].name;
 251         return unknown_error;
 252 }
 253
 254 /**
 255  * ibmvfc_get_err_result - Find the scsi status to return for the fcp response
 256  * @vfc_cmd:    ibmvfc command struct
 257  *
 258  * Return value:
 259  *      SCSI result value to return for completed command
 260  **/
 261 static int ibmvfc_get_err_result(struct ibmvfc_cmd *vfc_cmd)
 262 {
 263         int err;
 264         struct ibmvfc_fcp_rsp *rsp = &vfc_cmd->rsp;
 265         int fc_rsp_len = be32_to_cpu(rsp->fcp_rsp_len);
 266
 267         if ((rsp->flags & FCP_RSP_LEN_VALID) &&
 268             ((fc_rsp_len && fc_rsp_len != 4 && fc_rsp_len != 8) ||
 269              rsp->data.info.rsp_code))
 270                 return DID_ERROR << 16;
 271
 272         err = ibmvfc_get_err_index(be16_to_cpu(vfc_cmd->status), be16_to_cpu(vfc_cmd->error));
 273         if (err >= 0)
 274                 return rsp->scsi_status | (cmd_status[err].result << 16);
 275         return rsp->scsi_status | (DID_ERROR << 16);
 276 }
 277
 278 /**
 279  * ibmvfc_retry_cmd - Determine if error status is retryable
 280  * @status:             status / error class
 281  * @error:              error
 282  *
 283  * Return value:
 284  *      1 if error should be retried / 0 if it should not
 285  **/
 286 static int ibmvfc_retry_cmd(u16 status, u16 error)
 287 {
 288         int rc = ibmvfc_get_err_index(status, error);
 289
 290         if (rc >= 0)
 291                 return cmd_status[rc].retry;
 292         return 1;
 293 }
 294
 295 static const char *unknown_fc_explain = "unknown fc explain";
 296
 297 static const struct {
 298         u16 fc_explain;
 299         char *name;
 300 } ls_explain [] = {
 301         { 0x00, "no additional explanation" },
 302         { 0x01, "service parameter error - options" },
 303         { 0x03, "service parameter error - initiator control" },
 304         { 0x05, "service parameter error - recipient control" },
 305         { 0x07, "service parameter error - received data field size" },
 306         { 0x09, "service parameter error - concurrent seq" },
 307         { 0x0B, "service parameter error - credit" },
 308         { 0x0D, "invalid N_Port/F_Port_Name" },
 309         { 0x0E, "invalid node/Fabric Name" },
 310         { 0x0F, "invalid common service parameters" },
 311         { 0x11, "invalid association header" },
 312         { 0x13, "association header required" },
 313         { 0x15, "invalid originator S_ID" },
 314         { 0x17, "invalid OX_ID-RX-ID combination" },
 315         { 0x19, "command (request) already in progress" },
 316         { 0x1E, "N_Port Login requested" },
 317         { 0x1F, "Invalid N_Port_ID" },
 318 };
 319
 320 static const struct {
 321         u16 fc_explain;
 322         char *name;
 323 } gs_explain [] = {
 324         { 0x00, "no additional explanation" },
 325         { 0x01, "port identifier not registered" },
 326         { 0x02, "port name not registered" },
 327         { 0x03, "node name not registered" },
 328         { 0x04, "class of service not registered" },
 329         { 0x06, "initial process associator not registered" },
 330         { 0x07, "FC-4 TYPEs not registered" },
 331         { 0x08, "symbolic port name not registered" },
 332         { 0x09, "symbolic node name not registered" },
 333         { 0x0A, "port type not registered" },
 334         { 0xF0, "authorization exception" },
 335         { 0xF1, "authentication exception" },
 336         { 0xF2, "data base full" },
 337         { 0xF3, "data base empty" },
 338         { 0xF4, "processing request" },
 339         { 0xF5, "unable to verify connection" },
 340         { 0xF6, "devices not in a common zone" },
 341 };
 342
 343 /**
 344  * ibmvfc_get_ls_explain - Return the FC Explain description text
 345  * @status:     FC Explain status
 346  *
 347  * Returns:
 348  *      error string
 349  **/
 350 static const char *ibmvfc_get_ls_explain(u16 status)
 351 {
 352         int i;
 353
 354         for (i = 0; i < ARRAY_SIZE(ls_explain); i++)
 355                 if (ls_explain[i].fc_explain == status)
 356                         return ls_explain[i].name;
 357
 358         return unknown_fc_explain;
 359 }
 360
 361 /**
 362  * ibmvfc_get_gs_explain - Return the FC Explain description text
 363  * @status:     FC Explain status
 364  *
 365  * Returns:
 366  *      error string
 367  **/
 368 static const char *ibmvfc_get_gs_explain(u16 status)
 369 {
 370         int i;
 371
 372         for (i = 0; i < ARRAY_SIZE(gs_explain); i++)
 373                 if (gs_explain[i].fc_explain == status)
 374                         return gs_explain[i].name;
 375
 376         return unknown_fc_explain;
 377 }
 378
 379 static const struct {
 380         enum ibmvfc_fc_type fc_type;
 381         char *name;
 382 } fc_type [] = {
 383         { IBMVFC_FABRIC_REJECT, "fabric reject" },
 384         { IBMVFC_PORT_REJECT, "port reject" },
 385         { IBMVFC_LS_REJECT, "ELS reject" },
 386         { IBMVFC_FABRIC_BUSY, "fabric busy" },
 387         { IBMVFC_PORT_BUSY, "port busy" },
 388         { IBMVFC_BASIC_REJECT, "basic reject" },
 389 };
 390
 391 static const char *unknown_fc_type = "unknown fc type";
 392
 393 /**
 394  * ibmvfc_get_fc_type - Return the FC Type description text
 395  * @status:     FC Type error status
 396  *
 397  * Returns:
 398  *      error string
 399  **/
 400 static const char *ibmvfc_get_fc_type(u16 status)
 401 {
 402         int i;
 403
 404         for (i = 0; i < ARRAY_SIZE(fc_type); i++)
 405                 if (fc_type[i].fc_type == status)
 406                         return fc_type[i].name;
 407
 408         return unknown_fc_type;
 409 }
 410
 411 /**
 412  * ibmvfc_set_tgt_action - Set the next init action for the target
 413  * @tgt:                ibmvfc target struct
 414  * @action:             action to perform
 415  *
 416  **/
 417 static void ibmvfc_set_tgt_action(struct ibmvfc_target *tgt,
 418                                   enum ibmvfc_target_action action)
 419 {
 420         switch (tgt->action) {
 421         case IBMVFC_TGT_ACTION_DEL_RPORT:
 422                 if (action == IBMVFC_TGT_ACTION_DELETED_RPORT)
 423                         tgt->action = action;
 424         case IBMVFC_TGT_ACTION_DELETED_RPORT:
 425                 break;
 426         default:
 427                 if (action == IBMVFC_TGT_ACTION_DEL_RPORT)
 428                         tgt->add_rport = 0;
 429                 tgt->action = action;
 430                 break;
 431         }
 432 }
 433
 434 /**
 435  * ibmvfc_set_host_state - Set the state for the host
 436  * @vhost:              ibmvfc host struct
 437  * @state:              state to set host to
 438  *
 439  * Returns:
 440  *      0 if state changed / non-zero if not changed
 441  **/
 442 static int ibmvfc_set_host_state(struct ibmvfc_host *vhost,
 443                                   enum ibmvfc_host_state state)
 444 {
 445         int rc = 0;
 446
 447         switch (vhost->state) {
 448         case IBMVFC_HOST_OFFLINE:
 449                 rc = -EINVAL;
 450                 break;
 451         default:
 452                 vhost->state = state;
 453                 break;
 454         }
 455
 456         return rc;
 457 }
 458
 459 /**
 460  * ibmvfc_set_host_action - Set the next init action for the host
 461  * @vhost:              ibmvfc host struct
 462  * @action:             action to perform
 463  *
 464  **/
 465 static void ibmvfc_set_host_action(struct ibmvfc_host *vhost,
 466                                    enum ibmvfc_host_action action)
 467 {
 468         switch (action) {
 469         case IBMVFC_HOST_ACTION_ALLOC_TGTS:
 470                 if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT)
 471                         vhost->action = action;
 472                 break;
 473         case IBMVFC_HOST_ACTION_LOGO_WAIT:
 474                 if (vhost->action == IBMVFC_HOST_ACTION_LOGO)
 475                         vhost->action = action;
 476                 break;
 477         case IBMVFC_HOST_ACTION_INIT_WAIT:
 478                 if (vhost->action == IBMVFC_HOST_ACTION_INIT)
 479                         vhost->action = action;
 480                 break;
 481         case IBMVFC_HOST_ACTION_QUERY:
 482                 switch (vhost->action) {
 483                 case IBMVFC_HOST_ACTION_INIT_WAIT:
 484                 case IBMVFC_HOST_ACTION_NONE:
 485                 case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
 486                         vhost->action = action;
 487                         break;
 488                 default:
 489                         break;
 490                 }
 491                 break;
 492         case IBMVFC_HOST_ACTION_TGT_INIT:
 493                 if (vhost->action == IBMVFC_HOST_ACTION_ALLOC_TGTS)
 494                         vhost->action = action;
 495                 break;
 496         case IBMVFC_HOST_ACTION_REENABLE:
 497         case IBMVFC_HOST_ACTION_RESET:
 498                 vhost->action = action;
 499                 break;
 500         case IBMVFC_HOST_ACTION_INIT:
 501         case IBMVFC_HOST_ACTION_TGT_DEL:
 502         case IBMVFC_HOST_ACTION_LOGO:
 503         case IBMVFC_HOST_ACTION_QUERY_TGTS:
 504         case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
 505         case IBMVFC_HOST_ACTION_NONE:
 506         default:
 507                 switch (vhost->action) {
 508                 case IBMVFC_HOST_ACTION_RESET:
 509                 case IBMVFC_HOST_ACTION_REENABLE:
 510                         break;
 511                 default:
 512                         vhost->action = action;
 513                         break;
 514                 }
 515                 break;
 516         }
 517 }
 518
 519 /**
 520  * ibmvfc_reinit_host - Re-start host initialization (no NPIV Login)
 521  * @vhost:              ibmvfc host struct
 522  *
 523  * Return value:
 524  *      nothing
 525  **/
 526 static void ibmvfc_reinit_host(struct ibmvfc_host *vhost)
 527 {
 528         if (vhost->action == IBMVFC_HOST_ACTION_NONE) {
 529                 if (!ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
 530                         scsi_block_requests(vhost->host);
 531                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
 532                 }
 533         } else
 534                 vhost->reinit = 1;
 535
 536         wake_up(&vhost->work_wait_q);
 537 }
 538
 539 /**
 540  * ibmvfc_link_down - Handle a link down event from the adapter
 541  * @vhost:      ibmvfc host struct
 542  * @state:      ibmvfc host state to enter
 543  *
 544  **/
 545 static void ibmvfc_link_down(struct ibmvfc_host *vhost,
 546                              enum ibmvfc_host_state state)
 547 {
 548         struct ibmvfc_target *tgt;
 549
 550         ENTER;
 551         scsi_block_requests(vhost->host);
 552         list_for_each_entry(tgt, &vhost->targets, queue)
 553                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
 554         ibmvfc_set_host_state(vhost, state);
 555         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL);
 556         vhost->events_to_log |= IBMVFC_AE_LINKDOWN;
 557         wake_up(&vhost->work_wait_q);
 558         LEAVE;
 559 }
 560
 561 /**
 562  * ibmvfc_init_host - Start host initialization
 563  * @vhost:              ibmvfc host struct
 564  *
 565  * Return value:
 566  *      nothing
 567  **/
 568 static void ibmvfc_init_host(struct ibmvfc_host *vhost)
 569 {
 570         struct ibmvfc_target *tgt;
 571
 572         if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT) {
 573                 if (++vhost->init_retries > IBMVFC_MAX_HOST_INIT_RETRIES) {
 574                         dev_err(vhost->dev,
 575                                 "Host initialization retries exceeded. Taking adapter offline\n");
 576                         ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
 577                         return;
 578                 }
 579         }
 580
 581         if (!ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
 582                 memset(vhost->async_crq.msgs, 0, PAGE_SIZE);
 583                 vhost->async_crq.cur = 0;
 584
 585                 list_for_each_entry(tgt, &vhost->targets, queue)
 586                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
 587                 scsi_block_requests(vhost->host);
 588                 ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
 589                 vhost->job_step = ibmvfc_npiv_login;
 590                 wake_up(&vhost->work_wait_q);
 591         }
 592 }
 593
 594 /**
 595  * ibmvfc_send_crq - Send a CRQ
 596  * @vhost:      ibmvfc host struct
 597  * @word1:      the first 64 bits of the data
 598  * @word2:      the second 64 bits of the data
 599  *
 600  * Return value:
 601  *      0 on success / other on failure
 602  **/
 603 static int ibmvfc_send_crq(struct ibmvfc_host *vhost, u64 word1, u64 word2)
 604 {
 605         struct vio_dev *vdev = to_vio_dev(vhost->dev);
 606         return plpar_hcall_norets(H_SEND_CRQ, vdev->unit_address, word1, word2);
 607 }
 608
 609 /**
 610  * ibmvfc_send_crq_init - Send a CRQ init message
 611  * @vhost:      ibmvfc host struct
 612  *
 613  * Return value:
 614  *      0 on success / other on failure
 615  **/
 616 static int ibmvfc_send_crq_init(struct ibmvfc_host *vhost)
 617 {
 618         ibmvfc_dbg(vhost, "Sending CRQ init\n");
 619         return ibmvfc_send_crq(vhost, 0xC001000000000000LL, 0);
 620 }
 621
 622 /**
 623  * ibmvfc_send_crq_init_complete - Send a CRQ init complete message
 624  * @vhost:      ibmvfc host struct
 625  *
 626  * Return value:
 627  *      0 on success / other on failure
 628  **/
 629 static int ibmvfc_send_crq_init_complete(struct ibmvfc_host *vhost)
 630 {
 631         ibmvfc_dbg(vhost, "Sending CRQ init complete\n");
 632         return ibmvfc_send_crq(vhost, 0xC002000000000000LL, 0);
 633 }
 634
 635 /**
 636  * ibmvfc_release_crq_queue - Deallocates data and unregisters CRQ
 637  * @vhost:      ibmvfc host struct
 638  *
 639  * Frees irq, deallocates a page for messages, unmaps dma, and unregisters
 640  * the crq with the hypervisor.
 641  **/
 642 static void ibmvfc_release_crq_queue(struct ibmvfc_host *vhost)
 643 {
 644         long rc = 0;
 645         struct vio_dev *vdev = to_vio_dev(vhost->dev);
 646         struct ibmvfc_crq_queue *crq = &vhost->crq;
 647
 648         ibmvfc_dbg(vhost, "Releasing CRQ\n");
 649         free_irq(vdev->irq, vhost);
 650         tasklet_kill(&vhost->tasklet);
 651         do {
 652                 if (rc)
 653                         msleep(100);
 654                 rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
 655         } while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
 656
 657         vhost->state = IBMVFC_NO_CRQ;
 658         vhost->logged_in = 0;
 659         dma_unmap_single(vhost->dev, crq->msg_token, PAGE_SIZE, DMA_BIDIRECTIONAL);
 660         free_page((unsigned long)crq->msgs);
 661 }
 662
 663 /**
 664  * ibmvfc_reenable_crq_queue - reenables the CRQ
 665  * @vhost:      ibmvfc host struct
 666  *
 667  * Return value:
 668  *      0 on success / other on failure
 669  **/
 670 static int ibmvfc_reenable_crq_queue(struct ibmvfc_host *vhost)
 671 {
 672         int rc = 0;
 673         struct vio_dev *vdev = to_vio_dev(vhost->dev);
 674
 675         /* Re-enable the CRQ */
 676         do {
 677                 if (rc)
 678                         msleep(100);
 679                 rc = plpar_hcall_norets(H_ENABLE_CRQ, vdev->unit_address);
 680         } while (rc == H_IN_PROGRESS || rc == H_BUSY || H_IS_LONG_BUSY(rc));
 681
 682         if (rc)
 683                 dev_err(vhost->dev, "Error enabling adapter (rc=%d)\n", rc);
 684
 685         return rc;
 686 }
 687
 688 /**
 689  * ibmvfc_reset_crq - resets a crq after a failure
 690  * @vhost:      ibmvfc host struct
 691  *
 692  * Return value:
 693  *      0 on success / other on failure
 694  **/
 695 static int ibmvfc_reset_crq(struct ibmvfc_host *vhost)
 696 {
 697         int rc = 0;
 698         unsigned long flags;
 699         struct vio_dev *vdev = to_vio_dev(vhost->dev);
 700         struct ibmvfc_crq_queue *crq = &vhost->crq;
 701
 702         /* Close the CRQ */
 703         do {
 704                 if (rc)
 705                         msleep(100);
 706                 rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
 707         } while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
 708
 709         spin_lock_irqsave(vhost->host->host_lock, flags);
 710         vhost->state = IBMVFC_NO_CRQ;
 711         vhost->logged_in = 0;
 712
 713         /* Clean out the queue */
 714         memset(crq->msgs, 0, PAGE_SIZE);
 715         crq->cur = 0;
 716
 717         /* And re-open it again */
 718         rc = plpar_hcall_norets(H_REG_CRQ, vdev->unit_address,
 719                                 crq->msg_token, PAGE_SIZE);
 720
 721         if (rc == H_CLOSED)
 722                 /* Adapter is good, but other end is not ready */
 723                 dev_warn(vhost->dev, "Partner adapter not ready\n");
 724         else if (rc != 0)
 725                 dev_warn(vhost->dev, "Couldn't register crq (rc=%d)\n", rc);
 726         spin_unlock_irqrestore(vhost->host->host_lock, flags);
 727
 728         return rc;
 729 }
 730
 731 /**
 732  * ibmvfc_valid_event - Determines if event is valid.
 733  * @pool:       event_pool that contains the event
 734  * @evt:        ibmvfc event to be checked for validity
 735  *
 736  * Return value:
 737  *      1 if event is valid / 0 if event is not valid
 738  **/
 739 static int ibmvfc_valid_event(struct ibmvfc_event_pool *pool,
 740                               struct ibmvfc_event *evt)
 741 {
 742         int index = evt - pool->events;
 743         if (index < 0 || index >= pool->size)   /* outside of bounds */
 744                 return 0;
 745         if (evt != pool->events + index)        /* unaligned */
 746                 return 0;
 747         return 1;
 748 }
 749
 750 /**
 751  * ibmvfc_free_event - Free the specified event
 752  * @evt:        ibmvfc_event to be freed
 753  *
 754  **/
 755 static void ibmvfc_free_event(struct ibmvfc_event *evt)
 756 {
 757         struct ibmvfc_host *vhost = evt->vhost;
 758         struct ibmvfc_event_pool *pool = &vhost->pool;
 759
 760         BUG_ON(!ibmvfc_valid_event(pool, evt));
 761         BUG_ON(atomic_inc_return(&evt->free) != 1);
 762         list_add_tail(&evt->queue, &vhost->free);
 763 }
 764
 765 /**
 766  * ibmvfc_scsi_eh_done - EH done function for queuecommand commands
 767  * @evt:        ibmvfc event struct
 768  *
 769  * This function does not setup any error status, that must be done
 770  * before this function gets called.
 771  **/
 772 static void ibmvfc_scsi_eh_done(struct ibmvfc_event *evt)
 773 {
 774         struct scsi_cmnd *cmnd = evt->cmnd;
 775
 776         if (cmnd) {
 777                 scsi_dma_unmap(cmnd);
 778                 cmnd->scsi_done(cmnd);
 779         }
 780
 781         if (evt->eh_comp)
 782                 complete(evt->eh_comp);
 783
 784         ibmvfc_free_event(evt);
 785 }
 786
 787 /**
 788  * ibmvfc_fail_request - Fail request with specified error code
 789  * @evt:                ibmvfc event struct
 790  * @error_code: error code to fail request with
 791  *
 792  * Return value:
 793  *      none
 794  **/
 795 static void ibmvfc_fail_request(struct ibmvfc_event *evt, int error_code)
 796 {
 797         if (evt->cmnd) {
 798                 evt->cmnd->result = (error_code << 16);
 799                 evt->done = ibmvfc_scsi_eh_done;
 800         } else
 801                 evt->xfer_iu->mad_common.status = cpu_to_be16(IBMVFC_MAD_DRIVER_FAILED);
 802
 803         list_del(&evt->queue);
 804         del_timer(&evt->timer);
 805         ibmvfc_trc_end(evt);
 806         evt->done(evt);
 807 }
 808
 809 /**
 810  * ibmvfc_purge_requests - Our virtual adapter just shut down. Purge any sent requests
 811  * @vhost:              ibmvfc host struct
 812  * @error_code: error code to fail requests with
 813  *
 814  * Return value:
 815  *      none
 816  **/
 817 static void ibmvfc_purge_requests(struct ibmvfc_host *vhost, int error_code)
 818 {
 819         struct ibmvfc_event *evt, *pos;
 820
 821         ibmvfc_dbg(vhost, "Purging all requests\n");
 822         list_for_each_entry_safe(evt, pos, &vhost->sent, queue)
 823                 ibmvfc_fail_request(evt, error_code);
 824 }
 825
 826 /**
 827  * ibmvfc_hard_reset_host - Reset the connection to the server by breaking the CRQ
 828  * @vhost:      struct ibmvfc host to reset
 829  **/
 830 static void ibmvfc_hard_reset_host(struct ibmvfc_host *vhost)
 831 {
 832         ibmvfc_purge_requests(vhost, DID_ERROR);
 833         ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
 834         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_RESET);
 835 }
 836
 837 /**
 838  * __ibmvfc_reset_host - Reset the connection to the server (no locking)
 839  * @vhost:      struct ibmvfc host to reset
 840  **/
 841 static void __ibmvfc_reset_host(struct ibmvfc_host *vhost)
 842 {
 843         if (vhost->logged_in && vhost->action != IBMVFC_HOST_ACTION_LOGO_WAIT &&
 844             !ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
 845                 scsi_block_requests(vhost->host);
 846                 ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_LOGO);
 847                 vhost->job_step = ibmvfc_npiv_logout;
 848                 wake_up(&vhost->work_wait_q);
 849         } else
 850                 ibmvfc_hard_reset_host(vhost);
 851 }
 852
 853 /**
 854  * ibmvfc_reset_host - Reset the connection to the server
 855  * @vhost:      ibmvfc host struct
 856  **/
 857 static void ibmvfc_reset_host(struct ibmvfc_host *vhost)
 858 {
 859         unsigned long flags;
 860
 861         spin_lock_irqsave(vhost->host->host_lock, flags);
 862         __ibmvfc_reset_host(vhost);
 863         spin_unlock_irqrestore(vhost->host->host_lock, flags);
 864 }
 865
 866 /**
 867  * ibmvfc_retry_host_init - Retry host initialization if allowed
 868  * @vhost:      ibmvfc host struct
 869  *
 870  * Returns: 1 if init will be retried / 0 if not
 871  *
 872  **/
 873 static int ibmvfc_retry_host_init(struct ibmvfc_host *vhost)
 874 {
 875         int retry = 0;
 876
 877         if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT) {
 878                 vhost->delay_init = 1;
 879                 if (++vhost->init_retries > IBMVFC_MAX_HOST_INIT_RETRIES) {
 880                         dev_err(vhost->dev,
 881                                 "Host initialization retries exceeded. Taking adapter offline\n");
 882                         ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
 883                 } else if (vhost->init_retries == IBMVFC_MAX_HOST_INIT_RETRIES)
 884                         __ibmvfc_reset_host(vhost);
 885                 else {
 886                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
 887                         retry = 1;
 888                 }
 889         }
 890
 891         wake_up(&vhost->work_wait_q);
 892         return retry;
 893 }
 894
 895 /**
 896  * __ibmvfc_get_target - Find the specified scsi_target (no locking)
 897  * @starget:    scsi target struct
 898  *
 899  * Return value:
 900  *      ibmvfc_target struct / NULL if not found
 901  **/
 902 static struct ibmvfc_target *__ibmvfc_get_target(struct scsi_target *starget)
 903 {
 904         struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
 905         struct ibmvfc_host *vhost = shost_priv(shost);
 906         struct ibmvfc_target *tgt;
 907
 908         list_for_each_entry(tgt, &vhost->targets, queue)
 909                 if (tgt->target_id == starget->id) {
 910                         kref_get(&tgt->kref);
 911                         return tgt;
 912                 }
 913         return NULL;
 914 }
 915
 916 /**
 917  * ibmvfc_get_target - Find the specified scsi_target
 918  * @starget:    scsi target struct
 919  *
 920  * Return value:
 921  *      ibmvfc_target struct / NULL if not found
 922  **/
 923 static struct ibmvfc_target *ibmvfc_get_target(struct scsi_target *starget)
 924 {
 925         struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
 926         struct ibmvfc_target *tgt;
 927         unsigned long flags;
 928
 929         spin_lock_irqsave(shost->host_lock, flags);
 930         tgt = __ibmvfc_get_target(starget);
 931         spin_unlock_irqrestore(shost->host_lock, flags);
 932         return tgt;
 933 }
 934
 935 /**
 936  * ibmvfc_get_host_speed - Get host port speed
 937  * @shost:              scsi host struct
 938  *
 939  * Return value:
 940  *      none
 941  **/
 942 static void ibmvfc_get_host_speed(struct Scsi_Host *shost)
 943 {
 944         struct ibmvfc_host *vhost = shost_priv(shost);
 945         unsigned long flags;
 946
 947         spin_lock_irqsave(shost->host_lock, flags);
 948         if (vhost->state == IBMVFC_ACTIVE) {
 949                 switch (be64_to_cpu(vhost->login_buf->resp.link_speed) / 100) {
 950                 case 1:
 951                         fc_host_speed(shost) = FC_PORTSPEED_1GBIT;
 952                         break;
 953                 case 2:
 954                         fc_host_speed(shost) = FC_PORTSPEED_2GBIT;
 955                         break;
 956                 case 4:
 957                         fc_host_speed(shost) = FC_PORTSPEED_4GBIT;
 958                         break;
 959                 case 8:
 960                         fc_host_speed(shost) = FC_PORTSPEED_8GBIT;
 961                         break;
 962                 case 10:
 963                         fc_host_speed(shost) = FC_PORTSPEED_10GBIT;
 964                         break;
 965                 case 16:
 966                         fc_host_speed(shost) = FC_PORTSPEED_16GBIT;
 967                         break;
 968                 default:
 969                         ibmvfc_log(vhost, 3, "Unknown port speed: %lld Gbit\n",
 970                                    be64_to_cpu(vhost->login_buf->resp.link_speed) / 100);
 971                         fc_host_speed(shost) = FC_PORTSPEED_UNKNOWN;
 972                         break;
 973                 }
 974         } else
 975                 fc_host_speed(shost) = FC_PORTSPEED_UNKNOWN;
 976         spin_unlock_irqrestore(shost->host_lock, flags);
 977 }
 978
 979 /**
 980  * ibmvfc_get_host_port_state - Get host port state
 981  * @shost:              scsi host struct
 982  *
 983  * Return value:
 984  *      none
 985  **/
 986 static void ibmvfc_get_host_port_state(struct Scsi_Host *shost)
 987 {
 988         struct ibmvfc_host *vhost = shost_priv(shost);
 989         unsigned long flags;
 990
 991         spin_lock_irqsave(shost->host_lock, flags);
 992         switch (vhost->state) {
 993         case IBMVFC_INITIALIZING:
 994         case IBMVFC_ACTIVE:
 995                 fc_host_port_state(shost) = FC_PORTSTATE_ONLINE;
 996                 break;
 997         case IBMVFC_LINK_DOWN:
 998                 fc_host_port_state(shost) = FC_PORTSTATE_LINKDOWN;
 999                 break;
1000         case IBMVFC_LINK_DEAD:
1001         case IBMVFC_HOST_OFFLINE:
1002                 fc_host_port_state(shost) = FC_PORTSTATE_OFFLINE;
1003                 break;
1004         case IBMVFC_HALTED:
1005                 fc_host_port_state(shost) = FC_PORTSTATE_BLOCKED;
1006                 break;
1007         case IBMVFC_NO_CRQ:
1008                 fc_host_port_state(shost) = FC_PORTSTATE_UNKNOWN;
1009                 break;
1010         default:
1011                 ibmvfc_log(vhost, 3, "Unknown port state: %d\n", vhost->state);
1012                 fc_host_port_state(shost) = FC_PORTSTATE_UNKNOWN;
1013                 break;
1014         }
1015         spin_unlock_irqrestore(shost->host_lock, flags);
1016 }
1017
1018 /**
1019  * ibmvfc_set_rport_dev_loss_tmo - Set rport's device loss timeout
1020  * @rport:              rport struct
1021  * @timeout:    timeout value
1022  *
1023  * Return value:
1024  *      none
1025  **/
1026 static void ibmvfc_set_rport_dev_loss_tmo(struct fc_rport *rport, u32 timeout)
1027 {
1028         if (timeout)
1029                 rport->dev_loss_tmo = timeout;
1030         else
1031                 rport->dev_loss_tmo = 1;
1032 }
1033
1034 /**
1035  * ibmvfc_release_tgt - Free memory allocated for a target
1036  * @kref:               kref struct
1037  *
1038  **/
1039 static void ibmvfc_release_tgt(struct kref *kref)
1040 {
1041         struct ibmvfc_target *tgt = container_of(kref, struct ibmvfc_target, kref);
1042         kfree(tgt);
1043 }
1044
1045 /**
1046  * ibmvfc_get_starget_node_name - Get SCSI target's node name
1047  * @starget:    scsi target struct
1048  *
1049  * Return value:
1050  *      none
1051  **/
1052 static void ibmvfc_get_starget_node_name(struct scsi_target *starget)
1053 {
1054         struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1055         fc_starget_port_name(starget) = tgt ? tgt->ids.node_name : 0;
1056         if (tgt)
1057                 kref_put(&tgt->kref, ibmvfc_release_tgt);
1058 }
1059
1060 /**
1061  * ibmvfc_get_starget_port_name - Get SCSI target's port name
1062  * @starget:    scsi target struct
1063  *
1064  * Return value:
1065  *      none
1066  **/
1067 static void ibmvfc_get_starget_port_name(struct scsi_target *starget)
1068 {
1069         struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1070         fc_starget_port_name(starget) = tgt ? tgt->ids.port_name : 0;
1071         if (tgt)
1072                 kref_put(&tgt->kref, ibmvfc_release_tgt);
1073 }
1074
1075 /**
1076  * ibmvfc_get_starget_port_id - Get SCSI target's port ID
1077  * @starget:    scsi target struct
1078  *
1079  * Return value:
1080  *      none
1081  **/
1082 static void ibmvfc_get_starget_port_id(struct scsi_target *starget)
1083 {
1084         struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1085         fc_starget_port_id(starget) = tgt ? tgt->scsi_id : -1;
1086         if (tgt)
1087                 kref_put(&tgt->kref, ibmvfc_release_tgt);
1088 }
1089
1090 /**
1091  * ibmvfc_wait_while_resetting - Wait while the host resets
1092  * @vhost:              ibmvfc host struct
1093  *
1094  * Return value:
1095  *      0 on success / other on failure
1096  **/
1097 static int ibmvfc_wait_while_resetting(struct ibmvfc_host *vhost)
1098 {
1099         long timeout = wait_event_timeout(vhost->init_wait_q,
1100                                           ((vhost->state == IBMVFC_ACTIVE ||
1101                                             vhost->state == IBMVFC_HOST_OFFLINE ||
1102                                             vhost->state == IBMVFC_LINK_DEAD) &&
1103                                            vhost->action == IBMVFC_HOST_ACTION_NONE),
1104                                           (init_timeout * HZ));
1105
1106         return timeout ? 0 : -EIO;
1107 }
1108
1109 /**
1110  * ibmvfc_issue_fc_host_lip - Re-initiate link initialization
1111  * @shost:              scsi host struct
1112  *
1113  * Return value:
1114  *      0 on success / other on failure
1115  **/
1116 static int ibmvfc_issue_fc_host_lip(struct Scsi_Host *shost)
1117 {
1118         struct ibmvfc_host *vhost = shost_priv(shost);
1119
1120         dev_err(vhost->dev, "Initiating host LIP. Resetting connection\n");
1121         ibmvfc_reset_host(vhost);
1122         return ibmvfc_wait_while_resetting(vhost);
1123 }
1124
1125 /**
1126  * ibmvfc_gather_partition_info - Gather info about the LPAR
1127  *
1128  * Return value:
1129  *      none
1130  **/
1131 static void ibmvfc_gather_partition_info(struct ibmvfc_host *vhost)
1132 {
1133         struct device_node *rootdn;
1134         const char *name;
1135         const unsigned int *num;
1136
1137         rootdn = of_find_node_by_path("/");
1138         if (!rootdn)
1139                 return;
1140
1141         name = of_get_property(rootdn, "ibm,partition-name", NULL);
1142         if (name)
1143                 strncpy(vhost->partition_name, name, sizeof(vhost->partition_name));
1144         num = of_get_property(rootdn, "ibm,partition-no", NULL);
1145         if (num)
1146                 vhost->partition_number = *num;
1147         of_node_put(rootdn);
1148 }
1149
1150 /**
1151  * ibmvfc_set_login_info - Setup info for NPIV login
1152  * @vhost:      ibmvfc host struct
1153  *
1154  * Return value:
1155  *      none
1156  **/
1157 static void ibmvfc_set_login_info(struct ibmvfc_host *vhost)
1158 {
1159         struct ibmvfc_npiv_login *login_info = &vhost->login_info;
1160         struct device_node *of_node = vhost->dev->of_node;
1161         const char *location;
1162
1163         memset(login_info, 0, sizeof(*login_info));
1164
1165         login_info->ostype = cpu_to_be32(IBMVFC_OS_LINUX);
1166         login_info->max_dma_len = cpu_to_be64(IBMVFC_MAX_SECTORS << 9);
1167         login_info->max_payload = cpu_to_be32(sizeof(struct ibmvfc_fcp_cmd_iu));
1168         login_info->max_response = cpu_to_be32(sizeof(struct ibmvfc_fcp_rsp));
1169         login_info->partition_num = cpu_to_be32(vhost->partition_number);
1170         login_info->vfc_frame_version = cpu_to_be32(1);
1171         login_info->fcp_version = cpu_to_be16(3);
1172         login_info->flags = cpu_to_be16(IBMVFC_FLUSH_ON_HALT);
1173         if (vhost->client_migrated)
1174                 login_info->flags |= cpu_to_be16(IBMVFC_CLIENT_MIGRATED);
1175
1176         login_info->max_cmds = cpu_to_be32(max_requests + IBMVFC_NUM_INTERNAL_REQ);
1177         login_info->capabilities = cpu_to_be64(IBMVFC_CAN_MIGRATE);
1178         login_info->async.va = cpu_to_be64(vhost->async_crq.msg_token);
1179         login_info->async.len = cpu_to_be32(vhost->async_crq.size * sizeof(*vhost->async_crq.msgs));
1180         strncpy(login_info->partition_name, vhost->partition_name, IBMVFC_MAX_NAME);
1181         strncpy(login_info->device_name,
1182                 dev_name(&vhost->host->shost_gendev), IBMVFC_MAX_NAME);
1183
1184         location = of_get_property(of_node, "ibm,loc-code", NULL);
1185         location = location ? location : dev_name(vhost->dev);
1186         strncpy(login_info->drc_name, location, IBMVFC_MAX_NAME);
1187 }
1188
1189 /**
1190  * ibmvfc_init_event_pool - Allocates and initializes the event pool for a host
1191  * @vhost:      ibmvfc host who owns the event pool
1192  *
1193  * Returns zero on success.
1194  **/
1195 static int ibmvfc_init_event_pool(struct ibmvfc_host *vhost)
1196 {
1197         int i;
1198         struct ibmvfc_event_pool *pool = &vhost->pool;
1199
1200         ENTER;
1201         pool->size = max_requests + IBMVFC_NUM_INTERNAL_REQ;
1202         pool->events = kcalloc(pool->size, sizeof(*pool->events), GFP_KERNEL);
1203         if (!pool->events)
1204                 return -ENOMEM;
1205
1206         pool->iu_storage = dma_alloc_coherent(vhost->dev,
1207                                               pool->size * sizeof(*pool->iu_storage),
1208                                               &pool->iu_token, 0);
1209
1210         if (!pool->iu_storage) {
1211                 kfree(pool->events);
1212                 return -ENOMEM;
1213         }
1214
1215         for (i = 0; i < pool->size; ++i) {
1216                 struct ibmvfc_event *evt = &pool->events[i];
1217                 atomic_set(&evt->free, 1);
1218                 evt->crq.valid = 0x80;
1219                 evt->crq.ioba = cpu_to_be64(pool->iu_token + (sizeof(*evt->xfer_iu) * i));
1220                 evt->xfer_iu = pool->iu_storage + i;
1221                 evt->vhost = vhost;
1222                 evt->ext_list = NULL;
1223                 list_add_tail(&evt->queue, &vhost->free);
1224         }
1225
1226         LEAVE;
1227         return 0;
1228 }
1229
1230 /**
1231  * ibmvfc_free_event_pool - Frees memory of the event pool of a host
1232  * @vhost:      ibmvfc host who owns the event pool
1233  *
1234  **/
1235 static void ibmvfc_free_event_pool(struct ibmvfc_host *vhost)
1236 {
1237         int i;
1238         struct ibmvfc_event_pool *pool = &vhost->pool;
1239
1240         ENTER;
1241         for (i = 0; i < pool->size; ++i) {
1242                 list_del(&pool->events[i].queue);
1243                 BUG_ON(atomic_read(&pool->events[i].free) != 1);
1244                 if (pool->events[i].ext_list)
1245                         dma_pool_free(vhost->sg_pool,
1246                                       pool->events[i].ext_list,
1247                                       pool->events[i].ext_list_token);
1248         }
1249
1250         kfree(pool->events);
1251         dma_free_coherent(vhost->dev,
1252                           pool->size * sizeof(*pool->iu_storage),
1253                           pool->iu_storage, pool->iu_token);
1254         LEAVE;
1255 }
1256
1257 /**
1258  * ibmvfc_get_event - Gets the next free event in pool
1259  * @vhost:      ibmvfc host struct
1260  *
1261  * Returns a free event from the pool.
1262  **/
1263 static struct ibmvfc_event *ibmvfc_get_event(struct ibmvfc_host *vhost)
1264 {
1265         struct ibmvfc_event *evt;
1266
1267         BUG_ON(list_empty(&vhost->free));
1268         evt = list_entry(vhost->free.next, struct ibmvfc_event, queue);
1269         atomic_set(&evt->free, 0);
1270         list_del(&evt->queue);
1271         return evt;
1272 }
1273
1274 /**
1275  * ibmvfc_init_event - Initialize fields in an event struct that are always
1276  *                              required.
1277  * @evt:        The event
1278  * @done:       Routine to call when the event is responded to
1279  * @format:     SRP or MAD format
1280  **/
1281 static void ibmvfc_init_event(struct ibmvfc_event *evt,
1282                               void (*done) (struct ibmvfc_event *), u8 format)
1283 {
1284         evt->cmnd = NULL;
1285         evt->sync_iu = NULL;
1286         evt->crq.format = format;
1287         evt->done = done;
1288         evt->eh_comp = NULL;
1289 }
1290
1291 /**
1292  * ibmvfc_map_sg_list - Initialize scatterlist
1293  * @scmd:       scsi command struct
1294  * @nseg:       number of scatterlist segments
1295  * @md: memory descriptor list to initialize
1296  **/
1297 static void ibmvfc_map_sg_list(struct scsi_cmnd *scmd, int nseg,
1298                                struct srp_direct_buf *md)
1299 {
1300         int i;
1301         struct scatterlist *sg;
1302
1303         scsi_for_each_sg(scmd, sg, nseg, i) {
1304                 md[i].va = cpu_to_be64(sg_dma_address(sg));
1305                 md[i].len = cpu_to_be32(sg_dma_len(sg));
1306                 md[i].key = 0;
1307         }
1308 }
1309
1310 /**
1311  * ibmvfc_map_sg_data - Maps dma for a scatterlist and initializes decriptor fields
1312  * @scmd:               struct scsi_cmnd with the scatterlist
1313  * @evt:                ibmvfc event struct
1314  * @vfc_cmd:    vfc_cmd that contains the memory descriptor
1315  * @dev:                device for which to map dma memory
1316  *
1317  * Returns:
1318  *      0 on success / non-zero on failure
1319  **/
1320 static int ibmvfc_map_sg_data(struct scsi_cmnd *scmd,
1321                               struct ibmvfc_event *evt,
1322                               struct ibmvfc_cmd *vfc_cmd, struct device *dev)
1323 {
1324
1325         int sg_mapped;
1326         struct srp_direct_buf *data = &vfc_cmd->ioba;
1327         struct ibmvfc_host *vhost = dev_get_drvdata(dev);
1328
1329         if (cls3_error)
1330                 vfc_cmd->flags |= cpu_to_be16(IBMVFC_CLASS_3_ERR);
1331
1332         sg_mapped = scsi_dma_map(scmd);
1333         if (!sg_mapped) {
1334                 vfc_cmd->flags |= cpu_to_be16(IBMVFC_NO_MEM_DESC);
1335                 return 0;
1336         } else if (unlikely(sg_mapped < 0)) {
1337                 if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1338                         scmd_printk(KERN_ERR, scmd, "Failed to map DMA buffer for command\n");
1339                 return sg_mapped;
1340         }
1341
1342         if (scmd->sc_data_direction == DMA_TO_DEVICE) {
1343                 vfc_cmd->flags |= cpu_to_be16(IBMVFC_WRITE);
1344                 vfc_cmd->iu.add_cdb_len |= IBMVFC_WRDATA;
1345         } else {
1346                 vfc_cmd->flags |= cpu_to_be16(IBMVFC_READ);
1347                 vfc_cmd->iu.add_cdb_len |= IBMVFC_RDDATA;
1348         }
1349
1350         if (sg_mapped == 1) {
1351                 ibmvfc_map_sg_list(scmd, sg_mapped, data);
1352                 return 0;
1353         }
1354
1355         vfc_cmd->flags |= cpu_to_be16(IBMVFC_SCATTERLIST);
1356
1357         if (!evt->ext_list) {
1358                 evt->ext_list = dma_pool_alloc(vhost->sg_pool, GFP_ATOMIC,
1359                                                &evt->ext_list_token);
1360
1361                 if (!evt->ext_list) {
1362                         scsi_dma_unmap(scmd);
1363                         if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1364                                 scmd_printk(KERN_ERR, scmd, "Can't allocate memory for scatterlist\n");
1365                         return -ENOMEM;
1366                 }
1367         }
1368
1369         ibmvfc_map_sg_list(scmd, sg_mapped, evt->ext_list);
1370
1371         data->va = cpu_to_be64(evt->ext_list_token);
1372         data->len = cpu_to_be32(sg_mapped * sizeof(struct srp_direct_buf));
1373         data->key = 0;
1374         return 0;
1375 }
1376
1377 /**
1378  * ibmvfc_timeout - Internal command timeout handler
1379  * @evt:        struct ibmvfc_event that timed out
1380  *
1381  * Called when an internally generated command times out
1382  **/
1383 static void ibmvfc_timeout(struct timer_list *t)
1384 {
1385         struct ibmvfc_event *evt = from_timer(evt, t, timer);
1386         struct ibmvfc_host *vhost = evt->vhost;
1387         dev_err(vhost->dev, "Command timed out (%p). Resetting connection\n", evt);
1388         ibmvfc_reset_host(vhost);
1389 }
1390
1391 /**
1392  * ibmvfc_send_event - Transforms event to u64 array and calls send_crq()
1393  * @evt:                event to be sent
1394  * @vhost:              ibmvfc host struct
1395  * @timeout:    timeout in seconds - 0 means do not time command
1396  *
1397  * Returns the value returned from ibmvfc_send_crq(). (Zero for success)
1398  **/
1399 static int ibmvfc_send_event(struct ibmvfc_event *evt,
1400                              struct ibmvfc_host *vhost, unsigned long timeout)
1401 {
1402         __be64 *crq_as_u64 = (__be64 *) &evt->crq;
1403         int rc;
1404
1405         /* Copy the IU into the transfer area */
1406         *evt->xfer_iu = evt->iu;
1407         if (evt->crq.format == IBMVFC_CMD_FORMAT)
1408                 evt->xfer_iu->cmd.tag = cpu_to_be64((u64)evt);
1409         else if (evt->crq.format == IBMVFC_MAD_FORMAT)
1410                 evt->xfer_iu->mad_common.tag = cpu_to_be64((u64)evt);
1411         else
1412                 BUG();
1413
1414         list_add_tail(&evt->queue, &vhost->sent);
1415         timer_setup(&evt->timer, ibmvfc_timeout, 0);
1416
1417         if (timeout) {
1418                 evt->timer.expires = jiffies + (timeout * HZ);
1419                 add_timer(&evt->timer);
1420         }
1421
1422         mb();
1423
1424         if ((rc = ibmvfc_send_crq(vhost, be64_to_cpu(crq_as_u64[0]),
1425                                   be64_to_cpu(crq_as_u64[1])))) {
1426                 list_del(&evt->queue);
1427                 del_timer(&evt->timer);
1428
1429                 /* If send_crq returns H_CLOSED, return SCSI_MLQUEUE_HOST_BUSY.
1430                  * Firmware will send a CRQ with a transport event (0xFF) to
1431                  * tell this client what has happened to the transport. This
1432                  * will be handled in ibmvfc_handle_crq()
1433                  */
1434                 if (rc == H_CLOSED) {
1435                         if (printk_ratelimit())
1436                                 dev_warn(vhost->dev, "Send warning. Receive queue closed, will retry.\n");
1437                         if (evt->cmnd)
1438                                 scsi_dma_unmap(evt->cmnd);
1439                         ibmvfc_free_event(evt);
1440                         return SCSI_MLQUEUE_HOST_BUSY;
1441                 }
1442
1443                 dev_err(vhost->dev, "Send error (rc=%d)\n", rc);
1444                 if (evt->cmnd) {
1445                         evt->cmnd->result = DID_ERROR << 16;
1446                         evt->done = ibmvfc_scsi_eh_done;
1447                 } else
1448                         evt->xfer_iu->mad_common.status = cpu_to_be16(IBMVFC_MAD_CRQ_ERROR);
1449
1450                 evt->done(evt);
1451         } else
1452                 ibmvfc_trc_start(evt);
1453
1454         return 0;
1455 }
1456
1457 /**
1458  * ibmvfc_log_error - Log an error for the failed command if appropriate
1459  * @evt:        ibmvfc event to log
1460  *
1461  **/
1462 static void ibmvfc_log_error(struct ibmvfc_event *evt)
1463 {
1464         struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
1465         struct ibmvfc_host *vhost = evt->vhost;
1466         struct ibmvfc_fcp_rsp *rsp = &vfc_cmd->rsp;
1467         struct scsi_cmnd *cmnd = evt->cmnd;
1468         const char *err = unknown_error;
1469         int index = ibmvfc_get_err_index(be16_to_cpu(vfc_cmd->status), be16_to_cpu(vfc_cmd->error));
1470         int logerr = 0;
1471         int rsp_code = 0;
1472
1473         if (index >= 0) {
1474                 logerr = cmd_status[index].log;
1475                 err = cmd_status[index].name;
1476         }
1477
1478         if (!logerr && (vhost->log_level <= (IBMVFC_DEFAULT_LOG_LEVEL + 1)))
1479                 return;
1480
1481         if (rsp->flags & FCP_RSP_LEN_VALID)
1482                 rsp_code = rsp->data.info.rsp_code;
1483
1484         scmd_printk(KERN_ERR, cmnd, "Command (%02X) : %s (%x:%x) "
1485                     "flags: %x fcp_rsp: %x, resid=%d, scsi_status: %x\n",
1486                     cmnd->cmnd[0], err, be16_to_cpu(vfc_cmd->status), be16_to_cpu(vfc_cmd->error),
1487                     rsp->flags, rsp_code, scsi_get_resid(cmnd), rsp->scsi_status);
1488 }
1489
1490 /**
1491  * ibmvfc_relogin - Log back into the specified device
1492  * @sdev:       scsi device struct
1493  *
1494  **/
1495 static void ibmvfc_relogin(struct scsi_device *sdev)
1496 {
1497         struct ibmvfc_host *vhost = shost_priv(sdev->host);
1498         struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
1499         struct ibmvfc_target *tgt;
1500
1501         list_for_each_entry(tgt, &vhost->targets, queue) {
1502                 if (rport == tgt->rport) {
1503                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
1504                         break;
1505                 }
1506         }
1507
1508         ibmvfc_reinit_host(vhost);
1509 }
1510
1511 /**
1512  * ibmvfc_scsi_done - Handle responses from commands
1513  * @evt:        ibmvfc event to be handled
1514  *
1515  * Used as a callback when sending scsi cmds.
1516  **/
1517 static void ibmvfc_scsi_done(struct ibmvfc_event *evt)
1518 {
1519         struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
1520         struct ibmvfc_fcp_rsp *rsp = &vfc_cmd->rsp;
1521         struct scsi_cmnd *cmnd = evt->cmnd;
1522         u32 rsp_len = 0;
1523         u32 sense_len = be32_to_cpu(rsp->fcp_sense_len);
1524
1525         if (cmnd) {
1526                 if (be16_to_cpu(vfc_cmd->response_flags) & IBMVFC_ADAPTER_RESID_VALID)
1527                         scsi_set_resid(cmnd, be32_to_cpu(vfc_cmd->adapter_resid));
1528                 else if (rsp->flags & FCP_RESID_UNDER)
1529                         scsi_set_resid(cmnd, be32_to_cpu(rsp->fcp_resid));
1530                 else
1531                         scsi_set_resid(cmnd, 0);
1532
1533                 if (vfc_cmd->status) {
1534                         cmnd->result = ibmvfc_get_err_result(vfc_cmd);
1535
1536                         if (rsp->flags & FCP_RSP_LEN_VALID)
1537                                 rsp_len = be32_to_cpu(rsp->fcp_rsp_len);
1538                         if ((sense_len + rsp_len) > SCSI_SENSE_BUFFERSIZE)
1539                                 sense_len = SCSI_SENSE_BUFFERSIZE - rsp_len;
1540                         if ((rsp->flags & FCP_SNS_LEN_VALID) && rsp->fcp_sense_len && rsp_len <= 8)
1541                                 memcpy(cmnd->sense_buffer, rsp->data.sense + rsp_len, sense_len);
1542                         if ((be16_to_cpu(vfc_cmd->status) & IBMVFC_VIOS_FAILURE) &&
1543                             (be16_to_cpu(vfc_cmd->error) == IBMVFC_PLOGI_REQUIRED))
1544                                 ibmvfc_relogin(cmnd->device);
1545
1546                         if (!cmnd->result && (!scsi_get_resid(cmnd) || (rsp->flags & FCP_RESID_OVER)))
1547                                 cmnd->result = (DID_ERROR << 16);
1548
1549                         ibmvfc_log_error(evt);
1550                 }
1551
1552                 if (!cmnd->result &&
1553                     (scsi_bufflen(cmnd) - scsi_get_resid(cmnd) < cmnd->underflow))
1554                         cmnd->result = (DID_ERROR << 16);
1555
1556                 scsi_dma_unmap(cmnd);
1557                 cmnd->scsi_done(cmnd);
1558         }
1559
1560         if (evt->eh_comp)
1561                 complete(evt->eh_comp);
1562
1563         ibmvfc_free_event(evt);
1564 }
1565
1566 /**
1567  * ibmvfc_host_chkready - Check if the host can accept commands
1568  * @vhost:       struct ibmvfc host
1569  *
1570  * Returns:
1571  *      1 if host can accept command / 0 if not
1572  **/
1573 static inline int ibmvfc_host_chkready(struct ibmvfc_host *vhost)
1574 {
1575         int result = 0;
1576
1577         switch (vhost->state) {
1578         case IBMVFC_LINK_DEAD:
1579         case IBMVFC_HOST_OFFLINE:
1580                 result = DID_NO_CONNECT << 16;
1581                 break;
1582         case IBMVFC_NO_CRQ:
1583         case IBMVFC_INITIALIZING:
1584         case IBMVFC_HALTED:
1585         case IBMVFC_LINK_DOWN:
1586                 result = DID_REQUEUE << 16;
1587                 break;
1588         case IBMVFC_ACTIVE:
1589                 result = 0;
1590                 break;
1591         }
1592
1593         return result;
1594 }
1595
1596 /**
1597  * ibmvfc_queuecommand - The queuecommand function of the scsi template
1598  * @cmnd:       struct scsi_cmnd to be executed
1599  * @done:       Callback function to be called when cmnd is completed
1600  *
1601  * Returns:
1602  *      0 on success / other on failure
1603  **/
1604 static int ibmvfc_queuecommand_lck(struct scsi_cmnd *cmnd,
1605                                void (*done) (struct scsi_cmnd *))
1606 {
1607         struct ibmvfc_host *vhost = shost_priv(cmnd->device->host);
1608         struct fc_rport *rport = starget_to_rport(scsi_target(cmnd->device));
1609         struct ibmvfc_cmd *vfc_cmd;
1610         struct ibmvfc_event *evt;
1611         int rc;
1612
1613         if (unlikely((rc = fc_remote_port_chkready(rport))) ||
1614             unlikely((rc = ibmvfc_host_chkready(vhost)))) {
1615                 cmnd->result = rc;
1616                 done(cmnd);
1617                 return 0;
1618         }
1619
1620         cmnd->result = (DID_OK << 16);
1621         evt = ibmvfc_get_event(vhost);
1622         ibmvfc_init_event(evt, ibmvfc_scsi_done, IBMVFC_CMD_FORMAT);
1623         evt->cmnd = cmnd;
1624         cmnd->scsi_done = done;
1625         vfc_cmd = &evt->iu.cmd;
1626         memset(vfc_cmd, 0, sizeof(*vfc_cmd));
1627         vfc_cmd->resp.va = cpu_to_be64(be64_to_cpu(evt->crq.ioba) + offsetof(struct ibmvfc_cmd, rsp));
1628         vfc_cmd->resp.len = cpu_to_be32(sizeof(vfc_cmd->rsp));
1629         vfc_cmd->frame_type = cpu_to_be32(IBMVFC_SCSI_FCP_TYPE);
1630         vfc_cmd->payload_len = cpu_to_be32(sizeof(vfc_cmd->iu));
1631         vfc_cmd->resp_len = cpu_to_be32(sizeof(vfc_cmd->rsp));
1632         vfc_cmd->cancel_key = cpu_to_be32((unsigned long)cmnd->device->hostdata);
1633         vfc_cmd->tgt_scsi_id = cpu_to_be64(rport->port_id);
1634         vfc_cmd->iu.xfer_len = cpu_to_be32(scsi_bufflen(cmnd));
1635         int_to_scsilun(cmnd->device->lun, &vfc_cmd->iu.lun);
1636         memcpy(vfc_cmd->iu.cdb, cmnd->cmnd, cmnd->cmd_len);
1637
1638         if (cmnd->flags & SCMD_TAGGED) {
1639                 vfc_cmd->task_tag = cpu_to_be64(cmnd->tag);
1640                 vfc_cmd->iu.pri_task_attr = IBMVFC_SIMPLE_TASK;
1641         }
1642
1643         if (likely(!(rc = ibmvfc_map_sg_data(cmnd, evt, vfc_cmd, vhost->dev))))
1644                 return ibmvfc_send_event(evt, vhost, 0);
1645
1646         ibmvfc_free_event(evt);
1647         if (rc == -ENOMEM)
1648                 return SCSI_MLQUEUE_HOST_BUSY;
1649
1650         if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1651                 scmd_printk(KERN_ERR, cmnd,
1652                             "Failed to map DMA buffer for command. rc=%d\n", rc);
1653
1654         cmnd->result = DID_ERROR << 16;
1655         done(cmnd);
1656         return 0;
1657 }
1658
1659 static DEF_SCSI_QCMD(ibmvfc_queuecommand)
1660
1661 /**
1662  * ibmvfc_sync_completion - Signal that a synchronous command has completed
1663  * @evt:        ibmvfc event struct
1664  *
1665  **/
1666 static void ibmvfc_sync_completion(struct ibmvfc_event *evt)
1667 {
1668         /* copy the response back */
1669         if (evt->sync_iu)
1670                 *evt->sync_iu = *evt->xfer_iu;
1671
1672         complete(&evt->comp);
1673 }
1674
1675 /**
1676  * ibmvfc_bsg_timeout_done - Completion handler for cancelling BSG commands
1677  * @evt:        struct ibmvfc_event
1678  *
1679  **/
1680 static void ibmvfc_bsg_timeout_done(struct ibmvfc_event *evt)
1681 {
1682         struct ibmvfc_host *vhost = evt->vhost;
1683
1684         ibmvfc_free_event(evt);
1685         vhost->aborting_passthru = 0;
1686         dev_info(vhost->dev, "Passthru command cancelled\n");
1687 }
1688
1689 /**
1690  * ibmvfc_bsg_timeout - Handle a BSG timeout
1691  * @job:        struct bsg_job that timed out
1692  *
1693  * Returns:
1694  *      0 on success / other on failure
1695  **/
1696 static int ibmvfc_bsg_timeout(struct bsg_job *job)
1697 {
1698         struct ibmvfc_host *vhost = shost_priv(fc_bsg_to_shost(job));
1699         unsigned long port_id = (unsigned long)job->dd_data;
1700         struct ibmvfc_event *evt;
1701         struct ibmvfc_tmf *tmf;
1702         unsigned long flags;
1703         int rc;
1704
1705         ENTER;
1706         spin_lock_irqsave(vhost->host->host_lock, flags);
1707         if (vhost->aborting_passthru || vhost->state != IBMVFC_ACTIVE) {
1708                 __ibmvfc_reset_host(vhost);
1709                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
1710                 return 0;
1711         }
1712
1713         vhost->aborting_passthru = 1;
1714         evt = ibmvfc_get_event(vhost);
1715         ibmvfc_init_event(evt, ibmvfc_bsg_timeout_done, IBMVFC_MAD_FORMAT);
1716
1717         tmf = &evt->iu.tmf;
1718         memset(tmf, 0, sizeof(*tmf));
1719         tmf->common.version = cpu_to_be32(1);
1720         tmf->common.opcode = cpu_to_be32(IBMVFC_TMF_MAD);
1721         tmf->common.length = cpu_to_be16(sizeof(*tmf));
1722         tmf->scsi_id = cpu_to_be64(port_id);
1723         tmf->cancel_key = cpu_to_be32(IBMVFC_PASSTHRU_CANCEL_KEY);
1724         tmf->my_cancel_key = cpu_to_be32(IBMVFC_INTERNAL_CANCEL_KEY);
1725         rc = ibmvfc_send_event(evt, vhost, default_timeout);
1726
1727         if (rc != 0) {
1728                 vhost->aborting_passthru = 0;
1729                 dev_err(vhost->dev, "Failed to send cancel event. rc=%d\n", rc);
1730                 rc = -EIO;
1731         } else
1732                 dev_info(vhost->dev, "Cancelling passthru command to port id 0x%lx\n",
1733                          port_id);
1734
1735         spin_unlock_irqrestore(vhost->host->host_lock, flags);
1736
1737         LEAVE;
1738         return rc;
1739 }
1740
1741 /**
1742  * ibmvfc_bsg_plogi - PLOGI into a target to handle a BSG command
1743  * @vhost:              struct ibmvfc_host to send command
1744  * @port_id:    port ID to send command
1745  *
1746  * Returns:
1747  *      0 on success / other on failure
1748  **/
1749 static int ibmvfc_bsg_plogi(struct ibmvfc_host *vhost, unsigned int port_id)
1750 {
1751         struct ibmvfc_port_login *plogi;
1752         struct ibmvfc_target *tgt;
1753         struct ibmvfc_event *evt;
1754         union ibmvfc_iu rsp_iu;
1755         unsigned long flags;
1756         int rc = 0, issue_login = 1;
1757
1758         ENTER;
1759         spin_lock_irqsave(vhost->host->host_lock, flags);
1760         list_for_each_entry(tgt, &vhost->targets, queue) {
1761                 if (tgt->scsi_id == port_id) {
1762                         issue_login = 0;
1763                         break;
1764                 }
1765         }
1766
1767         if (!issue_login)
1768                 goto unlock_out;
1769         if (unlikely((rc = ibmvfc_host_chkready(vhost))))
1770                 goto unlock_out;
1771
1772         evt = ibmvfc_get_event(vhost);
1773         ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_MAD_FORMAT);
1774         plogi = &evt->iu.plogi;
1775         memset(plogi, 0, sizeof(*plogi));
1776         plogi->common.version = cpu_to_be32(1);
1777         plogi->common.opcode = cpu_to_be32(IBMVFC_PORT_LOGIN);
1778         plogi->common.length = cpu_to_be16(sizeof(*plogi));
1779         plogi->scsi_id = cpu_to_be64(port_id);
1780         evt->sync_iu = &rsp_iu;
1781         init_completion(&evt->comp);
1782
1783         rc = ibmvfc_send_event(evt, vhost, default_timeout);
1784         spin_unlock_irqrestore(vhost->host->host_lock, flags);
1785
1786         if (rc)
1787                 return -EIO;
1788
1789         wait_for_completion(&evt->comp);
1790
1791         if (rsp_iu.plogi.common.status)
1792                 rc = -EIO;
1793
1794         spin_lock_irqsave(vhost->host->host_lock, flags);
1795         ibmvfc_free_event(evt);
1796 unlock_out:
1797         spin_unlock_irqrestore(vhost->host->host_lock, flags);
1798         LEAVE;
1799         return rc;
1800 }
1801
1802 /**
1803  * ibmvfc_bsg_request - Handle a BSG request
1804  * @job:        struct bsg_job to be executed
1805  *
1806  * Returns:
1807  *      0 on success / other on failure
1808  **/
1809 static int ibmvfc_bsg_request(struct bsg_job *job)
1810 {
1811         struct ibmvfc_host *vhost = shost_priv(fc_bsg_to_shost(job));
1812         struct fc_rport *rport = fc_bsg_to_rport(job);
1813         struct ibmvfc_passthru_mad *mad;
1814         struct ibmvfc_event *evt;
1815         union ibmvfc_iu rsp_iu;
1816         unsigned long flags, port_id = -1;
1817         struct fc_bsg_request *bsg_request = job->request;
1818         struct fc_bsg_reply *bsg_reply = job->reply;
1819         unsigned int code = bsg_request->msgcode;
1820         int rc = 0, req_seg, rsp_seg, issue_login = 0;
1821         u32 fc_flags, rsp_len;
1822
1823         ENTER;
1824         bsg_reply->reply_payload_rcv_len = 0;
1825         if (rport)
1826                 port_id = rport->port_id;
1827
1828         switch (code) {
1829         case FC_BSG_HST_ELS_NOLOGIN:
1830                 port_id = (bsg_request->rqst_data.h_els.port_id[0] << 16) |
1831                         (bsg_request->rqst_data.h_els.port_id[1] << 8) |
1832                         bsg_request->rqst_data.h_els.port_id[2];
1833                 /* fall through */
1834         case FC_BSG_RPT_ELS:
1835                 fc_flags = IBMVFC_FC_ELS;
1836                 break;
1837         case FC_BSG_HST_CT:
1838                 issue_login = 1;
1839                 port_id = (bsg_request->rqst_data.h_ct.port_id[0] << 16) |
1840                         (bsg_request->rqst_data.h_ct.port_id[1] << 8) |
1841                         bsg_request->rqst_data.h_ct.port_id[2];
1842                 /* fall through */
1843         case FC_BSG_RPT_CT:
1844                 fc_flags = IBMVFC_FC_CT_IU;
1845                 break;
1846         default:
1847                 return -ENOTSUPP;
1848         }
1849
1850         if (port_id == -1)
1851                 return -EINVAL;
1852         if (!mutex_trylock(&vhost->passthru_mutex))
1853                 return -EBUSY;
1854
1855         job->dd_data = (void *)port_id;
1856         req_seg = dma_map_sg(vhost->dev, job->request_payload.sg_list,
1857                              job->request_payload.sg_cnt, DMA_TO_DEVICE);
1858
1859         if (!req_seg) {
1860                 mutex_unlock(&vhost->passthru_mutex);
1861                 return -ENOMEM;
1862         }
1863
1864         rsp_seg = dma_map_sg(vhost->dev, job->reply_payload.sg_list,
1865                              job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
1866
1867         if (!rsp_seg) {
1868                 dma_unmap_sg(vhost->dev, job->request_payload.sg_list,
1869                              job->request_payload.sg_cnt, DMA_TO_DEVICE);
1870                 mutex_unlock(&vhost->passthru_mutex);
1871                 return -ENOMEM;
1872         }
1873
1874         if (req_seg > 1 || rsp_seg > 1) {
1875                 rc = -EINVAL;
1876                 goto out;
1877         }
1878
1879         if (issue_login)
1880                 rc = ibmvfc_bsg_plogi(vhost, port_id);
1881
1882         spin_lock_irqsave(vhost->host->host_lock, flags);
1883
1884         if (unlikely(rc || (rport && (rc = fc_remote_port_chkready(rport)))) ||
1885             unlikely((rc = ibmvfc_host_chkready(vhost)))) {
1886                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
1887                 goto out;
1888         }
1889
1890         evt = ibmvfc_get_event(vhost);
1891         ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_MAD_FORMAT);
1892         mad = &evt->iu.passthru;
1893
1894         memset(mad, 0, sizeof(*mad));
1895         mad->common.version = cpu_to_be32(1);
1896         mad->common.opcode = cpu_to_be32(IBMVFC_PASSTHRU);
1897         mad->common.length = cpu_to_be16(sizeof(*mad) - sizeof(mad->fc_iu) - sizeof(mad->iu));
1898
1899         mad->cmd_ioba.va = cpu_to_be64(be64_to_cpu(evt->crq.ioba) +
1900                 offsetof(struct ibmvfc_passthru_mad, iu));
1901         mad->cmd_ioba.len = cpu_to_be32(sizeof(mad->iu));
1902
1903         mad->iu.cmd_len = cpu_to_be32(job->request_payload.payload_len);
1904         mad->iu.rsp_len = cpu_to_be32(job->reply_payload.payload_len);
1905         mad->iu.flags = cpu_to_be32(fc_flags);
1906         mad->iu.cancel_key = cpu_to_be32(IBMVFC_PASSTHRU_CANCEL_KEY);
1907
1908         mad->iu.cmd.va = cpu_to_be64(sg_dma_address(job->request_payload.sg_list));
1909         mad->iu.cmd.len = cpu_to_be32(sg_dma_len(job->request_payload.sg_list));
1910         mad->iu.rsp.va = cpu_to_be64(sg_dma_address(job->reply_payload.sg_list));
1911         mad->iu.rsp.len = cpu_to_be32(sg_dma_len(job->reply_payload.sg_list));
1912         mad->iu.scsi_id = cpu_to_be64(port_id);
1913         mad->iu.tag = cpu_to_be64((u64)evt);
1914         rsp_len = be32_to_cpu(mad->iu.rsp.len);
1915
1916         evt->sync_iu = &rsp_iu;
1917         init_completion(&evt->comp);
1918         rc = ibmvfc_send_event(evt, vhost, 0);
1919         spin_unlock_irqrestore(vhost->host->host_lock, flags);
1920
1921         if (rc) {
1922                 rc = -EIO;
1923                 goto out;
1924         }
1925
1926         wait_for_completion(&evt->comp);
1927
1928         if (rsp_iu.passthru.common.status)
1929                 rc = -EIO;
1930         else
1931                 bsg_reply->reply_payload_rcv_len = rsp_len;
1932
1933         spin_lock_irqsave(vhost->host->host_lock, flags);
1934         ibmvfc_free_event(evt);
1935         spin_unlock_irqrestore(vhost->host->host_lock, flags);
1936         bsg_reply->result = rc;
1937         bsg_job_done(job, bsg_reply->result,
1938                        bsg_reply->reply_payload_rcv_len);
1939         rc = 0;
1940 out:
1941         dma_unmap_sg(vhost->dev, job->request_payload.sg_list,
1942                      job->request_payload.sg_cnt, DMA_TO_DEVICE);
1943         dma_unmap_sg(vhost->dev, job->reply_payload.sg_list,
1944                      job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
1945         mutex_unlock(&vhost->passthru_mutex);
1946         LEAVE;
1947         return rc;
1948 }
1949
1950 /**
1951  * ibmvfc_reset_device - Reset the device with the specified reset type
1952  * @sdev:       scsi device to reset
1953  * @type:       reset type
1954  * @desc:       reset type description for log messages
1955  *
1956  * Returns:
1957  *      0 on success / other on failure
1958  **/
1959 static int ibmvfc_reset_device(struct scsi_device *sdev, int type, char *desc)
1960 {
1961         struct ibmvfc_host *vhost = shost_priv(sdev->host);
1962         struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
1963         struct ibmvfc_cmd *tmf;
1964         struct ibmvfc_event *evt = NULL;
1965         union ibmvfc_iu rsp_iu;
1966         struct ibmvfc_fcp_rsp *fc_rsp = &rsp_iu.cmd.rsp;
1967         int rsp_rc = -EBUSY;
1968         unsigned long flags;
1969         int rsp_code = 0;
1970
1971         spin_lock_irqsave(vhost->host->host_lock, flags);
1972         if (vhost->state == IBMVFC_ACTIVE) {
1973                 evt = ibmvfc_get_event(vhost);
1974                 ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_CMD_FORMAT);
1975
1976                 tmf = &evt->iu.cmd;
1977                 memset(tmf, 0, sizeof(*tmf));
1978                 tmf->resp.va = cpu_to_be64(be64_to_cpu(evt->crq.ioba) + offsetof(struct ibmvfc_cmd, rsp));
1979                 tmf->resp.len = cpu_to_be32(sizeof(tmf->rsp));
1980                 tmf->frame_type = cpu_to_be32(IBMVFC_SCSI_FCP_TYPE);
1981                 tmf->payload_len = cpu_to_be32(sizeof(tmf->iu));
1982                 tmf->resp_len = cpu_to_be32(sizeof(tmf->rsp));
1983                 tmf->cancel_key = cpu_to_be32((unsigned long)sdev->hostdata);
1984                 tmf->tgt_scsi_id = cpu_to_be64(rport->port_id);
1985                 int_to_scsilun(sdev->lun, &tmf->iu.lun);
1986                 tmf->flags = cpu_to_be16((IBMVFC_NO_MEM_DESC | IBMVFC_TMF));
1987                 tmf->iu.tmf_flags = type;
1988                 evt->sync_iu = &rsp_iu;
1989
1990                 init_completion(&evt->comp);
1991                 rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
1992         }
1993         spin_unlock_irqrestore(vhost->host->host_lock, flags);
1994
1995         if (rsp_rc != 0) {
1996                 sdev_printk(KERN_ERR, sdev, "Failed to send %s reset event. rc=%d\n",
1997                             desc, rsp_rc);
1998                 return -EIO;
1999         }
2000
2001         sdev_printk(KERN_INFO, sdev, "Resetting %s\n", desc);
2002         wait_for_completion(&evt->comp);
2003
2004         if (rsp_iu.cmd.status)
2005                 rsp_code = ibmvfc_get_err_result(&rsp_iu.cmd);
2006
2007         if (rsp_code) {
2008                 if (fc_rsp->flags & FCP_RSP_LEN_VALID)
2009                         rsp_code = fc_rsp->data.info.rsp_code;
2010
2011                 sdev_printk(KERN_ERR, sdev, "%s reset failed: %s (%x:%x) "
2012                             "flags: %x fcp_rsp: %x, scsi_status: %x\n", desc,
2013                             ibmvfc_get_cmd_error(be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error)),
2014                             be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error), fc_rsp->flags, rsp_code,
2015                             fc_rsp->scsi_status);
2016                 rsp_rc = -EIO;
2017         } else
2018                 sdev_printk(KERN_INFO, sdev, "%s reset successful\n", desc);
2019
2020         spin_lock_irqsave(vhost->host->host_lock, flags);
2021         ibmvfc_free_event(evt);
2022         spin_unlock_irqrestore(vhost->host->host_lock, flags);
2023         return rsp_rc;
2024 }
2025
2026 /**
2027  * ibmvfc_match_rport - Match function for specified remote port
2028  * @evt:        ibmvfc event struct
2029  * @device:     device to match (rport)
2030  *
2031  * Returns:
2032  *      1 if event matches rport / 0 if event does not match rport
2033  **/
2034 static int ibmvfc_match_rport(struct ibmvfc_event *evt, void *rport)
2035 {
2036         struct fc_rport *cmd_rport;
2037
2038         if (evt->cmnd) {
2039                 cmd_rport = starget_to_rport(scsi_target(evt->cmnd->device));
2040                 if (cmd_rport == rport)
2041                         return 1;
2042         }
2043         return 0;
2044 }
2045
2046 /**
2047  * ibmvfc_match_target - Match function for specified target
2048  * @evt:        ibmvfc event struct
2049  * @device:     device to match (starget)
2050  *
2051  * Returns:
2052  *      1 if event matches starget / 0 if event does not match starget
2053  **/
2054 static int ibmvfc_match_target(struct ibmvfc_event *evt, void *device)
2055 {
2056         if (evt->cmnd && scsi_target(evt->cmnd->device) == device)
2057                 return 1;
2058         return 0;
2059 }
2060
2061 /**
2062  * ibmvfc_match_lun - Match function for specified LUN
2063  * @evt:        ibmvfc event struct
2064  * @device:     device to match (sdev)
2065  *
2066  * Returns:
2067  *      1 if event matches sdev / 0 if event does not match sdev
2068  **/
2069 static int ibmvfc_match_lun(struct ibmvfc_event *evt, void *device)
2070 {
2071         if (evt->cmnd && evt->cmnd->device == device)
2072                 return 1;
2073         return 0;
2074 }
2075
2076 /**
2077  * ibmvfc_wait_for_ops - Wait for ops to complete
2078  * @vhost:      ibmvfc host struct
2079  * @device:     device to match (starget or sdev)
2080  * @match:      match function
2081  *
2082  * Returns:
2083  *      SUCCESS / FAILED
2084  **/
2085 static int ibmvfc_wait_for_ops(struct ibmvfc_host *vhost, void *device,
2086                                int (*match) (struct ibmvfc_event *, void *))
2087 {
2088         struct ibmvfc_event *evt;
2089         DECLARE_COMPLETION_ONSTACK(comp);
2090         int wait;
2091         unsigned long flags;
2092         signed long timeout = IBMVFC_ABORT_WAIT_TIMEOUT * HZ;
2093
2094         ENTER;
2095         do {
2096                 wait = 0;
2097                 spin_lock_irqsave(vhost->host->host_lock, flags);
2098                 list_for_each_entry(evt, &vhost->sent, queue) {
2099                         if (match(evt, device)) {
2100                                 evt->eh_comp = &comp;
2101                                 wait++;
2102                         }
2103                 }
2104                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
2105
2106                 if (wait) {
2107                         timeout = wait_for_completion_timeout(&comp, timeout);
2108
2109                         if (!timeout) {
2110                                 wait = 0;
2111                                 spin_lock_irqsave(vhost->host->host_lock, flags);
2112                                 list_for_each_entry(evt, &vhost->sent, queue) {
2113                                         if (match(evt, device)) {
2114                                                 evt->eh_comp = NULL;
2115                                                 wait++;
2116                                         }
2117                                 }
2118                                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
2119                                 if (wait)
2120                                         dev_err(vhost->dev, "Timed out waiting for aborted commands\n");
2121                                 LEAVE;
2122                                 return wait ? FAILED : SUCCESS;
2123                         }
2124                 }
2125         } while (wait);
2126
2127         LEAVE;
2128         return SUCCESS;
2129 }
2130
2131 /**
2132  * ibmvfc_cancel_all - Cancel all outstanding commands to the device
2133  * @sdev:       scsi device to cancel commands
2134  * @type:       type of error recovery being performed
2135  *
2136  * This sends a cancel to the VIOS for the specified device. This does
2137  * NOT send any abort to the actual device. That must be done separately.
2138  *
2139  * Returns:
2140  *      0 on success / other on failure
2141  **/
2142 static int ibmvfc_cancel_all(struct scsi_device *sdev, int type)
2143 {
2144         struct ibmvfc_host *vhost = shost_priv(sdev->host);
2145         struct scsi_target *starget = scsi_target(sdev);
2146         struct fc_rport *rport = starget_to_rport(starget);
2147         struct ibmvfc_tmf *tmf;
2148         struct ibmvfc_event *evt, *found_evt;
2149         union ibmvfc_iu rsp;
2150         int rsp_rc = -EBUSY;
2151         unsigned long flags;
2152         u16 status;
2153
2154         ENTER;
2155         spin_lock_irqsave(vhost->host->host_lock, flags);
2156         found_evt = NULL;
2157         list_for_each_entry(evt, &vhost->sent, queue) {
2158                 if (evt->cmnd && evt->cmnd->device == sdev) {
2159                         found_evt = evt;
2160                         break;
2161                 }
2162         }
2163
2164         if (!found_evt) {
2165                 if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
2166                         sdev_printk(KERN_INFO, sdev, "No events found to cancel\n");
2167                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
2168                 return 0;
2169         }
2170
2171         if (vhost->logged_in) {
2172                 evt = ibmvfc_get_event(vhost);
2173                 ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_MAD_FORMAT);
2174
2175                 tmf = &evt->iu.tmf;
2176                 memset(tmf, 0, sizeof(*tmf));
2177                 tmf->common.version = cpu_to_be32(1);
2178                 tmf->common.opcode = cpu_to_be32(IBMVFC_TMF_MAD);
2179                 tmf->common.length = cpu_to_be16(sizeof(*tmf));
2180                 tmf->scsi_id = cpu_to_be64(rport->port_id);
2181                 int_to_scsilun(sdev->lun, &tmf->lun);
2182                 if (!(be64_to_cpu(vhost->login_buf->resp.capabilities) & IBMVFC_CAN_SUPPRESS_ABTS))
2183                         type &= ~IBMVFC_TMF_SUPPRESS_ABTS;
2184                 if (vhost->state == IBMVFC_ACTIVE)
2185                         tmf->flags = cpu_to_be32((type | IBMVFC_TMF_LUA_VALID));
2186                 else
2187                         tmf->flags = cpu_to_be32(((type & IBMVFC_TMF_SUPPRESS_ABTS) | IBMVFC_TMF_LUA_VALID));
2188                 tmf->cancel_key = cpu_to_be32((unsigned long)sdev->hostdata);
2189                 tmf->my_cancel_key = cpu_to_be32((unsigned long)starget->hostdata);
2190
2191                 evt->sync_iu = &rsp;
2192                 init_completion(&evt->comp);
2193                 rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
2194         }
2195
2196         spin_unlock_irqrestore(vhost->host->host_lock, flags);
2197
2198         if (rsp_rc != 0) {
2199                 sdev_printk(KERN_ERR, sdev, "Failed to send cancel event. rc=%d\n", rsp_rc);
2200                 /* If failure is received, the host adapter is most likely going
2201                  through reset, return success so the caller will wait for the command
2202                  being cancelled to get returned */
2203                 return 0;
2204         }
2205
2206         sdev_printk(KERN_INFO, sdev, "Cancelling outstanding commands.\n");
2207
2208         wait_for_completion(&evt->comp);
2209         status = be16_to_cpu(rsp.mad_common.status);
2210         spin_lock_irqsave(vhost->host->host_lock, flags);
2211         ibmvfc_free_event(evt);
2212         spin_unlock_irqrestore(vhost->host->host_lock, flags);
2213
2214         if (status != IBMVFC_MAD_SUCCESS) {
2215                 sdev_printk(KERN_WARNING, sdev, "Cancel failed with rc=%x\n", status);
2216                 switch (status) {
2217                 case IBMVFC_MAD_DRIVER_FAILED:
2218                 case IBMVFC_MAD_CRQ_ERROR:
2219                         /* Host adapter most likely going through reset, return success to
2220                          the caller will wait for the command being cancelled to get returned */
2221                         return 0;
2222                 default:
2223                         return -EIO;
2224                 };
2225         }
2226
2227         sdev_printk(KERN_INFO, sdev, "Successfully cancelled outstanding commands\n");
2228         return 0;
2229 }
2230
2231 /**
2232  * ibmvfc_match_key - Match function for specified cancel key
2233  * @evt:        ibmvfc event struct
2234  * @key:        cancel key to match
2235  *
2236  * Returns:
2237  *      1 if event matches key / 0 if event does not match key
2238  **/
2239 static int ibmvfc_match_key(struct ibmvfc_event *evt, void *key)
2240 {
2241         unsigned long cancel_key = (unsigned long)key;
2242
2243         if (evt->crq.format == IBMVFC_CMD_FORMAT &&
2244             be32_to_cpu(evt->iu.cmd.cancel_key) == cancel_key)
2245                 return 1;
2246         return 0;
2247 }
2248
2249 /**
2250  * ibmvfc_match_evt - Match function for specified event
2251  * @evt:        ibmvfc event struct
2252  * @match:      event to match
2253  *
2254  * Returns:
2255  *      1 if event matches key / 0 if event does not match key
2256  **/
2257 static int ibmvfc_match_evt(struct ibmvfc_event *evt, void *match)
2258 {
2259         if (evt == match)
2260                 return 1;
2261         return 0;
2262 }
2263
2264 /**
2265  * ibmvfc_abort_task_set - Abort outstanding commands to the device
2266  * @sdev:       scsi device to abort commands
2267  *
2268  * This sends an Abort Task Set to the VIOS for the specified device. This does
2269  * NOT send any cancel to the VIOS. That must be done separately.
2270  *
2271  * Returns:
2272  *      0 on success / other on failure
2273  **/
2274 static int ibmvfc_abort_task_set(struct scsi_device *sdev)
2275 {
2276         struct ibmvfc_host *vhost = shost_priv(sdev->host);
2277         struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
2278         struct ibmvfc_cmd *tmf;
2279         struct ibmvfc_event *evt, *found_evt;
2280         union ibmvfc_iu rsp_iu;
2281         struct ibmvfc_fcp_rsp *fc_rsp = &rsp_iu.cmd.rsp;
2282         int rc, rsp_rc = -EBUSY;
2283         unsigned long flags, timeout = IBMVFC_ABORT_TIMEOUT;
2284         int rsp_code = 0;
2285
2286         spin_lock_irqsave(vhost->host->host_lock, flags);
2287         found_evt = NULL;
2288         list_for_each_entry(evt, &vhost->sent, queue) {
2289                 if (evt->cmnd && evt->cmnd->device == sdev) {
2290                         found_evt = evt;
2291                         break;
2292                 }
2293         }
2294
2295         if (!found_evt) {
2296                 if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
2297                         sdev_printk(KERN_INFO, sdev, "No events found to abort\n");
2298                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
2299                 return 0;
2300         }
2301
2302         if (vhost->state == IBMVFC_ACTIVE) {
2303                 evt = ibmvfc_get_event(vhost);
2304                 ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_CMD_FORMAT);
2305
2306                 tmf = &evt->iu.cmd;
2307                 memset(tmf, 0, sizeof(*tmf));
2308                 tmf->resp.va = cpu_to_be64(be64_to_cpu(evt->crq.ioba) + offsetof(struct ibmvfc_cmd, rsp));
2309                 tmf->resp.len = cpu_to_be32(sizeof(tmf->rsp));
2310                 tmf->frame_type = cpu_to_be32(IBMVFC_SCSI_FCP_TYPE);
2311                 tmf->payload_len = cpu_to_be32(sizeof(tmf->iu));
2312                 tmf->resp_len = cpu_to_be32(sizeof(tmf->rsp));
2313                 tmf->cancel_key = cpu_to_be32((unsigned long)sdev->hostdata);
2314                 tmf->tgt_scsi_id = cpu_to_be64(rport->port_id);
2315                 int_to_scsilun(sdev->lun, &tmf->iu.lun);
2316                 tmf->flags = cpu_to_be16((IBMVFC_NO_MEM_DESC | IBMVFC_TMF));
2317                 tmf->iu.tmf_flags = IBMVFC_ABORT_TASK_SET;
2318                 evt->sync_iu = &rsp_iu;
2319
2320                 init_completion(&evt->comp);
2321                 rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
2322         }
2323
2324         spin_unlock_irqrestore(vhost->host->host_lock, flags);
2325
2326         if (rsp_rc != 0) {
2327                 sdev_printk(KERN_ERR, sdev, "Failed to send abort. rc=%d\n", rsp_rc);
2328                 return -EIO;
2329         }
2330
2331         sdev_printk(KERN_INFO, sdev, "Aborting outstanding commands\n");
2332         timeout = wait_for_completion_timeout(&evt->comp, timeout);
2333
2334         if (!timeout) {
2335                 rc = ibmvfc_cancel_all(sdev, 0);
2336                 if (!rc) {
2337                         rc = ibmvfc_wait_for_ops(vhost, sdev->hostdata, ibmvfc_match_key);
2338                         if (rc == SUCCESS)
2339                                 rc = 0;
2340                 }
2341
2342                 if (rc) {
2343                         sdev_printk(KERN_INFO, sdev, "Cancel failed, resetting host\n");
2344                         ibmvfc_reset_host(vhost);
2345                         rsp_rc = -EIO;
2346                         rc = ibmvfc_wait_for_ops(vhost, sdev->hostdata, ibmvfc_match_key);
2347
2348                         if (rc == SUCCESS)
2349                                 rsp_rc = 0;
2350
2351                         rc = ibmvfc_wait_for_ops(vhost, evt, ibmvfc_match_evt);
2352                         if (rc != SUCCESS) {
2353                                 spin_lock_irqsave(vhost->host->host_lock, flags);
2354                                 ibmvfc_hard_reset_host(vhost);
2355                                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
2356                                 rsp_rc = 0;
2357                         }
2358
2359                         goto out;
2360                 }
2361         }
2362
2363         if (rsp_iu.cmd.status)
2364                 rsp_code = ibmvfc_get_err_result(&rsp_iu.cmd);
2365
2366         if (rsp_code) {
2367                 if (fc_rsp->flags & FCP_RSP_LEN_VALID)
2368                         rsp_code = fc_rsp->data.info.rsp_code;
2369
2370                 sdev_printk(KERN_ERR, sdev, "Abort failed: %s (%x:%x) "
2371                             "flags: %x fcp_rsp: %x, scsi_status: %x\n",
2372                             ibmvfc_get_cmd_error(be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error)),
2373                             be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error), fc_rsp->flags, rsp_code,
2374                             fc_rsp->scsi_status);
2375                 rsp_rc = -EIO;
2376         } else
2377                 sdev_printk(KERN_INFO, sdev, "Abort successful\n");
2378
2379 out:
2380         spin_lock_irqsave(vhost->host->host_lock, flags);
2381         ibmvfc_free_event(evt);
2382         spin_unlock_irqrestore(vhost->host->host_lock, flags);
2383         return rsp_rc;
2384 }
2385
2386 /**
2387  * ibmvfc_eh_abort_handler - Abort a command
2388  * @cmd:        scsi command to abort
2389  *
2390  * Returns:
2391  *      SUCCESS / FAST_IO_FAIL / FAILED
2392  **/
2393 static int ibmvfc_eh_abort_handler(struct scsi_cmnd *cmd)
2394 {
2395         struct scsi_device *sdev = cmd->device;
2396         struct ibmvfc_host *vhost = shost_priv(sdev->host);
2397         int cancel_rc, block_rc;
2398         int rc = FAILED;
2399
2400         ENTER;
2401         block_rc = fc_block_scsi_eh(cmd);
2402         ibmvfc_wait_while_resetting(vhost);
2403         if (block_rc != FAST_IO_FAIL) {
2404                 cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_ABORT_TASK_SET);
2405                 ibmvfc_abort_task_set(sdev);
2406         } else
2407                 cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2408
2409         if (!cancel_rc)
2410                 rc = ibmvfc_wait_for_ops(vhost, sdev, ibmvfc_match_lun);
2411
2412         if (block_rc == FAST_IO_FAIL && rc != FAILED)
2413                 rc = FAST_IO_FAIL;
2414
2415         LEAVE;
2416         return rc;
2417 }
2418
2419 /**
2420  * ibmvfc_eh_device_reset_handler - Reset a single LUN
2421  * @cmd:        scsi command struct
2422  *
2423  * Returns:
2424  *      SUCCESS / FAST_IO_FAIL / FAILED
2425  **/
2426 static int ibmvfc_eh_device_reset_handler(struct scsi_cmnd *cmd)
2427 {
2428         struct scsi_device *sdev = cmd->device;
2429         struct ibmvfc_host *vhost = shost_priv(sdev->host);
2430         int cancel_rc, block_rc, reset_rc = 0;
2431         int rc = FAILED;
2432
2433         ENTER;
2434         block_rc = fc_block_scsi_eh(cmd);
2435         ibmvfc_wait_while_resetting(vhost);
2436         if (block_rc != FAST_IO_FAIL) {
2437                 cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_LUN_RESET);
2438                 reset_rc = ibmvfc_reset_device(sdev, IBMVFC_LUN_RESET, "LUN");
2439         } else
2440                 cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2441
2442         if (!cancel_rc && !reset_rc)
2443                 rc = ibmvfc_wait_for_ops(vhost, sdev, ibmvfc_match_lun);
2444
2445         if (block_rc == FAST_IO_FAIL && rc != FAILED)
2446                 rc = FAST_IO_FAIL;
2447
2448         LEAVE;
2449         return rc;
2450 }
2451
2452 /**
2453  * ibmvfc_dev_cancel_all_noreset - Device iterated cancel all function
2454  * @sdev:       scsi device struct
2455  * @data:       return code
2456  *
2457  **/
2458 static void ibmvfc_dev_cancel_all_noreset(struct scsi_device *sdev, void *data)
2459 {
2460         unsigned long *rc = data;
2461         *rc |= ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2462 }
2463
2464 /**
2465  * ibmvfc_dev_cancel_all_reset - Device iterated cancel all function
2466  * @sdev:       scsi device struct
2467  * @data:       return code
2468  *
2469  **/
2470 static void ibmvfc_dev_cancel_all_reset(struct scsi_device *sdev, void *data)
2471 {
2472         unsigned long *rc = data;
2473         *rc |= ibmvfc_cancel_all(sdev, IBMVFC_TMF_TGT_RESET);
2474 }
2475
2476 /**
2477  * ibmvfc_eh_target_reset_handler - Reset the target
2478  * @cmd:        scsi command struct
2479  *
2480  * Returns:
2481  *      SUCCESS / FAST_IO_FAIL / FAILED
2482  **/
2483 static int ibmvfc_eh_target_reset_handler(struct scsi_cmnd *cmd)
2484 {
2485         struct scsi_device *sdev = cmd->device;
2486         struct ibmvfc_host *vhost = shost_priv(sdev->host);
2487         struct scsi_target *starget = scsi_target(sdev);
2488         int block_rc;
2489         int reset_rc = 0;
2490         int rc = FAILED;
2491         unsigned long cancel_rc = 0;
2492
2493         ENTER;
2494         block_rc = fc_block_scsi_eh(cmd);
2495         ibmvfc_wait_while_resetting(vhost);
2496         if (block_rc != FAST_IO_FAIL) {
2497                 starget_for_each_device(starget, &cancel_rc, ibmvfc_dev_cancel_all_reset);
2498                 reset_rc = ibmvfc_reset_device(sdev, IBMVFC_TARGET_RESET, "target");
2499         } else
2500                 starget_for_each_device(starget, &cancel_rc, ibmvfc_dev_cancel_all_noreset);
2501
2502         if (!cancel_rc && !reset_rc)
2503                 rc = ibmvfc_wait_for_ops(vhost, starget, ibmvfc_match_target);
2504
2505         if (block_rc == FAST_IO_FAIL && rc != FAILED)
2506                 rc = FAST_IO_FAIL;
2507
2508         LEAVE;
2509         return rc;
2510 }
2511
2512 /**
2513  * ibmvfc_eh_host_reset_handler - Reset the connection to the server
2514  * @cmd:        struct scsi_cmnd having problems
2515  *
2516  **/
2517 static int ibmvfc_eh_host_reset_handler(struct scsi_cmnd *cmd)
2518 {
2519         int rc;
2520         struct ibmvfc_host *vhost = shost_priv(cmd->device->host);
2521
2522         dev_err(vhost->dev, "Resetting connection due to error recovery\n");
2523         rc = ibmvfc_issue_fc_host_lip(vhost->host);
2524
2525         return rc ? FAILED : SUCCESS;
2526 }
2527
2528 /**
2529  * ibmvfc_terminate_rport_io - Terminate all pending I/O to the rport.
2530  * @rport:              rport struct
2531  *
2532  * Return value:
2533  *      none
2534  **/
2535 static void ibmvfc_terminate_rport_io(struct fc_rport *rport)
2536 {
2537         struct Scsi_Host *shost = rport_to_shost(rport);
2538         struct ibmvfc_host *vhost = shost_priv(shost);
2539         struct fc_rport *dev_rport;
2540         struct scsi_device *sdev;
2541         unsigned long rc;
2542
2543         ENTER;
2544         shost_for_each_device(sdev, shost) {
2545                 dev_rport = starget_to_rport(scsi_target(sdev));
2546                 if (dev_rport != rport)
2547                         continue;
2548                 ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2549         }
2550
2551         rc = ibmvfc_wait_for_ops(vhost, rport, ibmvfc_match_rport);
2552
2553         if (rc == FAILED)
2554                 ibmvfc_issue_fc_host_lip(shost);
2555         LEAVE;
2556 }
2557
2558 static const struct ibmvfc_async_desc ae_desc [] = {
2559         { "PLOGI",      IBMVFC_AE_ELS_PLOGI,    IBMVFC_DEFAULT_LOG_LEVEL + 1 },
2560         { "LOGO",       IBMVFC_AE_ELS_LOGO,     IBMVFC_DEFAULT_LOG_LEVEL + 1 },
2561         { "PRLO",       IBMVFC_AE_ELS_PRLO,     IBMVFC_DEFAULT_LOG_LEVEL + 1 },
2562         { "N-Port SCN", IBMVFC_AE_SCN_NPORT,    IBMVFC_DEFAULT_LOG_LEVEL + 1 },
2563         { "Group SCN",  IBMVFC_AE_SCN_GROUP,    IBMVFC_DEFAULT_LOG_LEVEL + 1 },
2564         { "Domain SCN", IBMVFC_AE_SCN_DOMAIN,   IBMVFC_DEFAULT_LOG_LEVEL },
2565         { "Fabric SCN", IBMVFC_AE_SCN_FABRIC,   IBMVFC_DEFAULT_LOG_LEVEL },
2566         { "Link Up",    IBMVFC_AE_LINK_UP,      IBMVFC_DEFAULT_LOG_LEVEL },
2567         { "Link Down",  IBMVFC_AE_LINK_DOWN,    IBMVFC_DEFAULT_LOG_LEVEL },
2568         { "Link Dead",  IBMVFC_AE_LINK_DEAD,    IBMVFC_DEFAULT_LOG_LEVEL },
2569         { "Halt",       IBMVFC_AE_HALT,         IBMVFC_DEFAULT_LOG_LEVEL },
2570         { "Resume",     IBMVFC_AE_RESUME,       IBMVFC_DEFAULT_LOG_LEVEL },
2571         { "Adapter Failed", IBMVFC_AE_ADAPTER_FAILED, IBMVFC_DEFAULT_LOG_LEVEL },
2572 };
2573
2574 static const struct ibmvfc_async_desc unknown_ae = {
2575         "Unknown async", 0, IBMVFC_DEFAULT_LOG_LEVEL
2576 };
2577
2578 /**
2579  * ibmvfc_get_ae_desc - Get text description for async event
2580  * @ae: async event
2581  *
2582  **/
2583 static const struct ibmvfc_async_desc *ibmvfc_get_ae_desc(u64 ae)
2584 {
2585         int i;
2586
2587         for (i = 0; i < ARRAY_SIZE(ae_desc); i++)
2588                 if (ae_desc[i].ae == ae)
2589                         return &ae_desc[i];
2590
2591         return &unknown_ae;
2592 }
2593
2594 static const struct {
2595         enum ibmvfc_ae_link_state state;
2596         const char *desc;
2597 } link_desc [] = {
2598         { IBMVFC_AE_LS_LINK_UP,         " link up" },
2599         { IBMVFC_AE_LS_LINK_BOUNCED,    " link bounced" },
2600         { IBMVFC_AE_LS_LINK_DOWN,       " link down" },
2601         { IBMVFC_AE_LS_LINK_DEAD,       " link dead" },
2602 };
2603
2604 /**
2605  * ibmvfc_get_link_state - Get text description for link state
2606  * @state:      link state
2607  *
2608  **/
2609 static const char *ibmvfc_get_link_state(enum ibmvfc_ae_link_state state)
2610 {
2611         int i;
2612
2613         for (i = 0; i < ARRAY_SIZE(link_desc); i++)
2614                 if (link_desc[i].state == state)
2615                         return link_desc[i].desc;
2616
2617         return "";
2618 }
2619
2620 /**
2621  * ibmvfc_handle_async - Handle an async event from the adapter
2622  * @crq:        crq to process
2623  * @vhost:      ibmvfc host struct
2624  *
2625  **/
2626 static void ibmvfc_handle_async(struct ibmvfc_async_crq *crq,
2627                                 struct ibmvfc_host *vhost)
2628 {
2629         const struct ibmvfc_async_desc *desc = ibmvfc_get_ae_desc(be64_to_cpu(crq->event));
2630         struct ibmvfc_target *tgt;
2631
2632         ibmvfc_log(vhost, desc->log_level, "%s event received. scsi_id: %llx, wwpn: %llx,"
2633                    " node_name: %llx%s\n", desc->desc, be64_to_cpu(crq->scsi_id),
2634                    be64_to_cpu(crq->wwpn), be64_to_cpu(crq->node_name),
2635                    ibmvfc_get_link_state(crq->link_state));
2636
2637         switch (be64_to_cpu(crq->event)) {
2638         case IBMVFC_AE_RESUME:
2639                 switch (crq->link_state) {
2640                 case IBMVFC_AE_LS_LINK_DOWN:
2641                         ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
2642                         break;
2643                 case IBMVFC_AE_LS_LINK_DEAD:
2644                         ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
2645                         break;
2646                 case IBMVFC_AE_LS_LINK_UP:
2647                 case IBMVFC_AE_LS_LINK_BOUNCED:
2648                 default:
2649                         vhost->events_to_log |= IBMVFC_AE_LINKUP;
2650                         vhost->delay_init = 1;
2651                         __ibmvfc_reset_host(vhost);
2652                         break;
2653                 }
2654
2655                 break;
2656         case IBMVFC_AE_LINK_UP:
2657                 vhost->events_to_log |= IBMVFC_AE_LINKUP;
2658                 vhost->delay_init = 1;
2659                 __ibmvfc_reset_host(vhost);
2660                 break;
2661         case IBMVFC_AE_SCN_FABRIC:
2662         case IBMVFC_AE_SCN_DOMAIN:
2663                 vhost->events_to_log |= IBMVFC_AE_RSCN;
2664                 if (vhost->state < IBMVFC_HALTED) {
2665                         vhost->delay_init = 1;
2666                         __ibmvfc_reset_host(vhost);
2667                 }
2668                 break;
2669         case IBMVFC_AE_SCN_NPORT:
2670         case IBMVFC_AE_SCN_GROUP:
2671                 vhost->events_to_log |= IBMVFC_AE_RSCN;
2672                 ibmvfc_reinit_host(vhost);
2673                 break;
2674         case IBMVFC_AE_ELS_LOGO:
2675         case IBMVFC_AE_ELS_PRLO:
2676         case IBMVFC_AE_ELS_PLOGI:
2677                 list_for_each_entry(tgt, &vhost->targets, queue) {
2678                         if (!crq->scsi_id && !crq->wwpn && !crq->node_name)
2679                                 break;
2680                         if (crq->scsi_id && cpu_to_be64(tgt->scsi_id) != crq->scsi_id)
2681                                 continue;
2682                         if (crq->wwpn && cpu_to_be64(tgt->ids.port_name) != crq->wwpn)
2683                                 continue;
2684                         if (crq->node_name && cpu_to_be64(tgt->ids.node_name) != crq->node_name)
2685                                 continue;
2686                         if (tgt->need_login && be64_to_cpu(crq->event) == IBMVFC_AE_ELS_LOGO)
2687                                 tgt->logo_rcvd = 1;
2688                         if (!tgt->need_login || be64_to_cpu(crq->event) == IBMVFC_AE_ELS_PLOGI) {
2689                                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
2690                                 ibmvfc_reinit_host(vhost);
2691                         }
2692                 }
2693                 break;
2694         case IBMVFC_AE_LINK_DOWN:
2695         case IBMVFC_AE_ADAPTER_FAILED:
2696                 ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
2697                 break;
2698         case IBMVFC_AE_LINK_DEAD:
2699                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
2700                 break;
2701         case IBMVFC_AE_HALT:
2702                 ibmvfc_link_down(vhost, IBMVFC_HALTED);
2703                 break;
2704         default:
2705                 dev_err(vhost->dev, "Unknown async event received: %lld\n", crq->event);
2706                 break;
2707         }
2708 }
2709
2710 /**
2711  * ibmvfc_handle_crq - Handles and frees received events in the CRQ
2712  * @crq:        Command/Response queue
2713  * @vhost:      ibmvfc host struct
2714  *
2715  **/
2716 static void ibmvfc_handle_crq(struct ibmvfc_crq *crq, struct ibmvfc_host *vhost)
2717 {
2718         long rc;
2719         struct ibmvfc_event *evt = (struct ibmvfc_event *)be64_to_cpu(crq->ioba);
2720
2721         switch (crq->valid) {
2722         case IBMVFC_CRQ_INIT_RSP:
2723                 switch (crq->format) {
2724                 case IBMVFC_CRQ_INIT:
2725                         dev_info(vhost->dev, "Partner initialized\n");
2726                         /* Send back a response */
2727                         rc = ibmvfc_send_crq_init_complete(vhost);
2728                         if (rc == 0)
2729                                 ibmvfc_init_host(vhost);
2730                         else
2731                                 dev_err(vhost->dev, "Unable to send init rsp. rc=%ld\n", rc);
2732                         break;
2733                 case IBMVFC_CRQ_INIT_COMPLETE:
2734                         dev_info(vhost->dev, "Partner initialization complete\n");
2735                         ibmvfc_init_host(vhost);
2736                         break;
2737                 default:
2738                         dev_err(vhost->dev, "Unknown crq message type: %d\n", crq->format);
2739                 }
2740                 return;
2741         case IBMVFC_CRQ_XPORT_EVENT:
2742                 vhost->state = IBMVFC_NO_CRQ;
2743                 vhost->logged_in = 0;
2744                 ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
2745                 if (crq->format == IBMVFC_PARTITION_MIGRATED) {
2746                         /* We need to re-setup the interpartition connection */
2747                         dev_info(vhost->dev, "Partition migrated, Re-enabling adapter\n");
2748                         vhost->client_migrated = 1;
2749                         ibmvfc_purge_requests(vhost, DID_REQUEUE);
2750                         ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
2751                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_REENABLE);
2752                 } else if (crq->format == IBMVFC_PARTNER_FAILED || crq->format == IBMVFC_PARTNER_DEREGISTER) {
2753                         dev_err(vhost->dev, "Host partner adapter deregistered or failed (rc=%d)\n", crq->format);
2754                         ibmvfc_purge_requests(vhost, DID_ERROR);
2755                         ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
2756                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_RESET);
2757                 } else {
2758                         dev_err(vhost->dev, "Received unknown transport event from partner (rc=%d)\n", crq->format);
2759                 }
2760                 return;
2761         case IBMVFC_CRQ_CMD_RSP:
2762                 break;
2763         default:
2764                 dev_err(vhost->dev, "Got an invalid message type 0x%02x\n", crq->valid);
2765                 return;
2766         }
2767
2768         if (crq->format == IBMVFC_ASYNC_EVENT)
2769                 return;
2770
2771         /* The only kind of payload CRQs we should get are responses to
2772          * things we send. Make sure this response is to something we
2773          * actually sent
2774          */
2775         if (unlikely(!ibmvfc_valid_event(&vhost->pool, evt))) {
2776                 dev_err(vhost->dev, "Returned correlation_token 0x%08llx is invalid!\n",
2777                         crq->ioba);
2778                 return;
2779         }
2780
2781         if (unlikely(atomic_read(&evt->free))) {
2782                 dev_err(vhost->dev, "Received duplicate correlation_token 0x%08llx!\n",
2783                         crq->ioba);
2784                 return;
2785         }
2786
2787         del_timer(&evt->timer);
2788         list_del(&evt->queue);
2789         ibmvfc_trc_end(evt);
2790         evt->done(evt);
2791 }
2792
2793 /**
2794  * ibmvfc_scan_finished - Check if the device scan is done.
2795  * @shost:      scsi host struct
2796  * @time:       current elapsed time
2797  *
2798  * Returns:
2799  *      0 if scan is not done / 1 if scan is done
2800  **/
2801 static int ibmvfc_scan_finished(struct Scsi_Host *shost, unsigned long time)
2802 {
2803         unsigned long flags;
2804         struct ibmvfc_host *vhost = shost_priv(shost);
2805         int done = 0;
2806
2807         spin_lock_irqsave(shost->host_lock, flags);
2808         if (time >= (init_timeout * HZ)) {
2809                 dev_info(vhost->dev, "Scan taking longer than %d seconds, "
2810                          "continuing initialization\n", init_timeout);
2811                 done = 1;
2812         }
2813
2814         if (vhost->scan_complete)
2815                 done = 1;
2816         spin_unlock_irqrestore(shost->host_lock, flags);
2817         return done;
2818 }
2819
2820 /**
2821  * ibmvfc_slave_alloc - Setup the device's task set value
2822  * @sdev:       struct scsi_device device to configure
2823  *
2824  * Set the device's task set value so that error handling works as
2825  * expected.
2826  *
2827  * Returns:
2828  *      0 on success / -ENXIO if device does not exist
2829  **/
2830 static int ibmvfc_slave_alloc(struct scsi_device *sdev)
2831 {
2832         struct Scsi_Host *shost = sdev->host;
2833         struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
2834         struct ibmvfc_host *vhost = shost_priv(shost);
2835         unsigned long flags = 0;
2836
2837         if (!rport || fc_remote_port_chkready(rport))
2838                 return -ENXIO;
2839
2840         spin_lock_irqsave(shost->host_lock, flags);
2841         sdev->hostdata = (void *)(unsigned long)vhost->task_set++;
2842         spin_unlock_irqrestore(shost->host_lock, flags);
2843         return 0;
2844 }
2845
2846 /**
2847  * ibmvfc_target_alloc - Setup the target's task set value
2848  * @starget:    struct scsi_target
2849  *
2850  * Set the target's task set value so that error handling works as
2851  * expected.
2852  *
2853  * Returns:
2854  *      0 on success / -ENXIO if device does not exist
2855  **/
2856 static int ibmvfc_target_alloc(struct scsi_target *starget)
2857 {
2858         struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
2859         struct ibmvfc_host *vhost = shost_priv(shost);
2860         unsigned long flags = 0;
2861
2862         spin_lock_irqsave(shost->host_lock, flags);
2863         starget->hostdata = (void *)(unsigned long)vhost->task_set++;
2864         spin_unlock_irqrestore(shost->host_lock, flags);
2865         return 0;
2866 }
2867
2868 /**
2869  * ibmvfc_slave_configure - Configure the device
2870  * @sdev:       struct scsi_device device to configure
2871  *
2872  * Enable allow_restart for a device if it is a disk. Adjust the
2873  * queue_depth here also.
2874  *
2875  * Returns:
2876  *      0
2877  **/
2878 static int ibmvfc_slave_configure(struct scsi_device *sdev)
2879 {
2880         struct Scsi_Host *shost = sdev->host;
2881         unsigned long flags = 0;
2882
2883         spin_lock_irqsave(shost->host_lock, flags);
2884         if (sdev->type == TYPE_DISK) {
2885                 sdev->allow_restart = 1;
2886                 blk_queue_rq_timeout(sdev->request_queue, 120 * HZ);
2887         }
2888         spin_unlock_irqrestore(shost->host_lock, flags);
2889         return 0;
2890 }
2891
2892 /**
2893  * ibmvfc_change_queue_depth - Change the device's queue depth
2894  * @sdev:       scsi device struct
2895  * @qdepth:     depth to set
2896  * @reason:     calling context
2897  *
2898  * Return value:
2899  *      actual depth set
2900  **/
2901 static int ibmvfc_change_queue_depth(struct scsi_device *sdev, int qdepth)
2902 {
2903         if (qdepth > IBMVFC_MAX_CMDS_PER_LUN)
2904                 qdepth = IBMVFC_MAX_CMDS_PER_LUN;
2905
2906         return scsi_change_queue_depth(sdev, qdepth);
2907 }
2908
2909 static ssize_t ibmvfc_show_host_partition_name(struct device *dev,
2910                                                  struct device_attribute *attr, char *buf)
2911 {
2912         struct Scsi_Host *shost = class_to_shost(dev);
2913         struct ibmvfc_host *vhost = shost_priv(shost);
2914
2915         return snprintf(buf, PAGE_SIZE, "%s\n",
2916                         vhost->login_buf->resp.partition_name);
2917 }
2918
2919 static ssize_t ibmvfc_show_host_device_name(struct device *dev,
2920                                             struct device_attribute *attr, char *buf)
2921 {
2922         struct Scsi_Host *shost = class_to_shost(dev);
2923         struct ibmvfc_host *vhost = shost_priv(shost);
2924
2925         return snprintf(buf, PAGE_SIZE, "%s\n",
2926                         vhost->login_buf->resp.device_name);
2927 }
2928
2929 static ssize_t ibmvfc_show_host_loc_code(struct device *dev,
2930                                          struct device_attribute *attr, char *buf)
2931 {
2932         struct Scsi_Host *shost = class_to_shost(dev);
2933         struct ibmvfc_host *vhost = shost_priv(shost);
2934
2935         return snprintf(buf, PAGE_SIZE, "%s\n",
2936                         vhost->login_buf->resp.port_loc_code);
2937 }
2938
2939 static ssize_t ibmvfc_show_host_drc_name(struct device *dev,
2940                                          struct device_attribute *attr, char *buf)
2941 {
2942         struct Scsi_Host *shost = class_to_shost(dev);
2943         struct ibmvfc_host *vhost = shost_priv(shost);
2944
2945         return snprintf(buf, PAGE_SIZE, "%s\n",
2946                         vhost->login_buf->resp.drc_name);
2947 }
2948
2949 static ssize_t ibmvfc_show_host_npiv_version(struct device *dev,
2950                                              struct device_attribute *attr, char *buf)
2951 {
2952         struct Scsi_Host *shost = class_to_shost(dev);
2953         struct ibmvfc_host *vhost = shost_priv(shost);
2954         return snprintf(buf, PAGE_SIZE, "%d\n", vhost->login_buf->resp.version);
2955 }
2956
2957 static ssize_t ibmvfc_show_host_capabilities(struct device *dev,
2958                                              struct device_attribute *attr, char *buf)
2959 {
2960         struct Scsi_Host *shost = class_to_shost(dev);
2961         struct ibmvfc_host *vhost = shost_priv(shost);
2962         return snprintf(buf, PAGE_SIZE, "%llx\n", vhost->login_buf->resp.capabilities);
2963 }
2964
2965 /**
2966  * ibmvfc_show_log_level - Show the adapter's error logging level
2967  * @dev:        class device struct
2968  * @buf:        buffer
2969  *
2970  * Return value:
2971  *      number of bytes printed to buffer
2972  **/
2973 static ssize_t ibmvfc_show_log_level(struct device *dev,
2974                                      struct device_attribute *attr, char *buf)
2975 {
2976         struct Scsi_Host *shost = class_to_shost(dev);
2977         struct ibmvfc_host *vhost = shost_priv(shost);
2978         unsigned long flags = 0;
2979         int len;
2980
2981         spin_lock_irqsave(shost->host_lock, flags);
2982         len = snprintf(buf, PAGE_SIZE, "%d\n", vhost->log_level);
2983         spin_unlock_irqrestore(shost->host_lock, flags);
2984         return len;
2985 }
2986
2987 /**
2988  * ibmvfc_store_log_level - Change the adapter's error logging level
2989  * @dev:        class device struct
2990  * @buf:        buffer
2991  *
2992  * Return value:
2993  *      number of bytes printed to buffer
2994  **/
2995 static ssize_t ibmvfc_store_log_level(struct device *dev,
2996                                       struct device_attribute *attr,
2997                                       const char *buf, size_t count)
2998 {
2999         struct Scsi_Host *shost = class_to_shost(dev);
3000         struct ibmvfc_host *vhost = shost_priv(shost);
3001         unsigned long flags = 0;
3002
3003         spin_lock_irqsave(shost->host_lock, flags);
3004         vhost->log_level = simple_strtoul(buf, NULL, 10);
3005         spin_unlock_irqrestore(shost->host_lock, flags);
3006         return strlen(buf);
3007 }
3008
3009 static DEVICE_ATTR(partition_name, S_IRUGO, ibmvfc_show_host_partition_name, NULL);
3010 static DEVICE_ATTR(device_name, S_IRUGO, ibmvfc_show_host_device_name, NULL);
3011 static DEVICE_ATTR(port_loc_code, S_IRUGO, ibmvfc_show_host_loc_code, NULL);
3012 static DEVICE_ATTR(drc_name, S_IRUGO, ibmvfc_show_host_drc_name, NULL);
3013 static DEVICE_ATTR(npiv_version, S_IRUGO, ibmvfc_show_host_npiv_version, NULL);
3014 static DEVICE_ATTR(capabilities, S_IRUGO, ibmvfc_show_host_capabilities, NULL);
3015 static DEVICE_ATTR(log_level, S_IRUGO | S_IWUSR,
3016                    ibmvfc_show_log_level, ibmvfc_store_log_level);
3017
3018 #ifdef CONFIG_SCSI_IBMVFC_TRACE
3019 /**
3020  * ibmvfc_read_trace - Dump the adapter trace
3021  * @filp:               open sysfs file
3022  * @kobj:               kobject struct
3023  * @bin_attr:   bin_attribute struct
3024  * @buf:                buffer
3025  * @off:                offset
3026  * @count:              buffer size
3027  *
3028  * Return value:
3029  *      number of bytes printed to buffer
3030  **/
3031 static ssize_t ibmvfc_read_trace(struct file *filp, struct kobject *kobj,
3032                                  struct bin_attribute *bin_attr,
3033                                  char *buf, loff_t off, size_t count)
3034 {
3035         struct device *dev = container_of(kobj, struct device, kobj);
3036         struct Scsi_Host *shost = class_to_shost(dev);
3037         struct ibmvfc_host *vhost = shost_priv(shost);
3038         unsigned long flags = 0;
3039         int size = IBMVFC_TRACE_SIZE;
3040         char *src = (char *)vhost->trace;
3041
3042         if (off > size)
3043                 return 0;
3044         if (off + count > size) {
3045                 size -= off;
3046                 count = size;
3047         }
3048
3049         spin_lock_irqsave(shost->host_lock, flags);
3050         memcpy(buf, &src[off], count);
3051         spin_unlock_irqrestore(shost->host_lock, flags);
3052         return count;
3053 }
3054
3055 static struct bin_attribute ibmvfc_trace_attr = {
3056         .attr = {
3057                 .name = "trace",
3058                 .mode = S_IRUGO,
3059         },
3060         .size = 0,
3061         .read = ibmvfc_read_trace,
3062 };
3063 #endif
3064
3065 static struct device_attribute *ibmvfc_attrs[] = {
3066         &dev_attr_partition_name,
3067         &dev_attr_device_name,
3068         &dev_attr_port_loc_code,
3069         &dev_attr_drc_name,
3070         &dev_attr_npiv_version,
3071         &dev_attr_capabilities,
3072         &dev_attr_log_level,
3073         NULL
3074 };
3075
3076 static struct scsi_host_template driver_template = {
3077         .module = THIS_MODULE,
3078         .name = "IBM POWER Virtual FC Adapter",
3079         .proc_name = IBMVFC_NAME,
3080         .queuecommand = ibmvfc_queuecommand,
3081         .eh_timed_out = fc_eh_timed_out,
3082         .eh_abort_handler = ibmvfc_eh_abort_handler,
3083         .eh_device_reset_handler = ibmvfc_eh_device_reset_handler,
3084         .eh_target_reset_handler = ibmvfc_eh_target_reset_handler,
3085         .eh_host_reset_handler = ibmvfc_eh_host_reset_handler,
3086         .slave_alloc = ibmvfc_slave_alloc,
3087         .slave_configure = ibmvfc_slave_configure,
3088         .target_alloc = ibmvfc_target_alloc,
3089         .scan_finished = ibmvfc_scan_finished,
3090         .change_queue_depth = ibmvfc_change_queue_depth,
3091         .cmd_per_lun = 16,
3092         .can_queue = IBMVFC_MAX_REQUESTS_DEFAULT,
3093         .this_id = -1,
3094         .sg_tablesize = SG_ALL,
3095         .max_sectors = IBMVFC_MAX_SECTORS,
3096         .shost_attrs = ibmvfc_attrs,
3097         .track_queue_depth = 1,
3098 };
3099
3100 /**
3101  * ibmvfc_next_async_crq - Returns the next entry in async queue
3102  * @vhost:      ibmvfc host struct
3103  *
3104  * Returns:
3105  *      Pointer to next entry in queue / NULL if empty
3106  **/
3107 static struct ibmvfc_async_crq *ibmvfc_next_async_crq(struct ibmvfc_host *vhost)
3108 {
3109         struct ibmvfc_async_crq_queue *async_crq = &vhost->async_crq;
3110         struct ibmvfc_async_crq *crq;
3111
3112         crq = &async_crq->msgs[async_crq->cur];
3113         if (crq->valid & 0x80) {
3114                 if (++async_crq->cur == async_crq->size)
3115                         async_crq->cur = 0;
3116                 rmb();
3117         } else
3118                 crq = NULL;
3119
3120         return crq;
3121 }
3122
3123 /**
3124  * ibmvfc_next_crq - Returns the next entry in message queue
3125  * @vhost:      ibmvfc host struct
3126  *
3127  * Returns:
3128  *      Pointer to next entry in queue / NULL if empty
3129  **/
3130 static struct ibmvfc_crq *ibmvfc_next_crq(struct ibmvfc_host *vhost)
3131 {
3132         struct ibmvfc_crq_queue *queue = &vhost->crq;
3133         struct ibmvfc_crq *crq;
3134
3135         crq = &queue->msgs[queue->cur];
3136         if (crq->valid & 0x80) {
3137                 if (++queue->cur == queue->size)
3138                         queue->cur = 0;
3139                 rmb();
3140         } else
3141                 crq = NULL;
3142
3143         return crq;
3144 }
3145
3146 /**
3147  * ibmvfc_interrupt - Interrupt handler
3148  * @irq:                number of irq to handle, not used
3149  * @dev_instance: ibmvfc_host that received interrupt
3150  *
3151  * Returns:
3152  *      IRQ_HANDLED
3153  **/
3154 static irqreturn_t ibmvfc_interrupt(int irq, void *dev_instance)
3155 {
3156         struct ibmvfc_host *vhost = (struct ibmvfc_host *)dev_instance;
3157         unsigned long flags;
3158
3159         spin_lock_irqsave(vhost->host->host_lock, flags);
3160         vio_disable_interrupts(to_vio_dev(vhost->dev));
3161         tasklet_schedule(&vhost->tasklet);
3162         spin_unlock_irqrestore(vhost->host->host_lock, flags);
3163         return IRQ_HANDLED;
3164 }
3165
3166 /**
3167  * ibmvfc_tasklet - Interrupt handler tasklet
3168  * @data:               ibmvfc host struct
3169  *
3170  * Returns:
3171  *      Nothing
3172  **/
3173 static void ibmvfc_tasklet(void *data)
3174 {
3175         struct ibmvfc_host *vhost = data;
3176         struct vio_dev *vdev = to_vio_dev(vhost->dev);
3177         struct ibmvfc_crq *crq;
3178         struct ibmvfc_async_crq *async;
3179         unsigned long flags;
3180         int done = 0;
3181
3182         spin_lock_irqsave(vhost->host->host_lock, flags);
3183         while (!done) {
3184                 /* Pull all the valid messages off the async CRQ */
3185                 while ((async = ibmvfc_next_async_crq(vhost)) != NULL) {
3186                         ibmvfc_handle_async(async, vhost);
3187                         async->valid = 0;
3188                         wmb();
3189                 }
3190
3191                 /* Pull all the valid messages off the CRQ */
3192                 while ((crq = ibmvfc_next_crq(vhost)) != NULL) {
3193                         ibmvfc_handle_crq(crq, vhost);
3194                         crq->valid = 0;
3195                         wmb();
3196                 }
3197
3198                 vio_enable_interrupts(vdev);
3199                 if ((async = ibmvfc_next_async_crq(vhost)) != NULL) {
3200                         vio_disable_interrupts(vdev);
3201                         ibmvfc_handle_async(async, vhost);
3202                         async->valid = 0;
3203                         wmb();
3204                 } else if ((crq = ibmvfc_next_crq(vhost)) != NULL) {
3205                         vio_disable_interrupts(vdev);
3206                         ibmvfc_handle_crq(crq, vhost);
3207                         crq->valid = 0;
3208                         wmb();
3209                 } else
3210                         done = 1;
3211         }
3212
3213         spin_unlock_irqrestore(vhost->host->host_lock, flags);
3214 }
3215
3216 /**
3217  * ibmvfc_init_tgt - Set the next init job step for the target
3218  * @tgt:                ibmvfc target struct
3219  * @job_step:   job step to perform
3220  *
3221  **/
3222 static void ibmvfc_init_tgt(struct ibmvfc_target *tgt,
3223                             void (*job_step) (struct ibmvfc_target *))
3224 {
3225         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT);
3226         tgt->job_step = job_step;
3227         wake_up(&tgt->vhost->work_wait_q);
3228 }
3229
3230 /**
3231  * ibmvfc_retry_tgt_init - Attempt to retry a step in target initialization
3232  * @tgt:                ibmvfc target struct
3233  * @job_step:   initialization job step
3234  *
3235  * Returns: 1 if step will be retried / 0 if not
3236  *
3237  **/
3238 static int ibmvfc_retry_tgt_init(struct ibmvfc_target *tgt,
3239                                   void (*job_step) (struct ibmvfc_target *))
3240 {
3241         if (++tgt->init_retries > IBMVFC_MAX_TGT_INIT_RETRIES) {
3242                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3243                 wake_up(&tgt->vhost->work_wait_q);
3244                 return 0;
3245         } else
3246                 ibmvfc_init_tgt(tgt, job_step);
3247         return 1;
3248 }
3249
3250 /* Defined in FC-LS */
3251 static const struct {
3252         int code;
3253         int retry;
3254         int logged_in;
3255 } prli_rsp [] = {
3256         { 0, 1, 0 },
3257         { 1, 0, 1 },
3258         { 2, 1, 0 },
3259         { 3, 1, 0 },
3260         { 4, 0, 0 },
3261         { 5, 0, 0 },
3262         { 6, 0, 1 },
3263         { 7, 0, 0 },
3264         { 8, 1, 0 },
3265 };
3266
3267 /**
3268  * ibmvfc_get_prli_rsp - Find PRLI response index
3269  * @flags:      PRLI response flags
3270  *
3271  **/
3272 static int ibmvfc_get_prli_rsp(u16 flags)
3273 {
3274         int i;
3275         int code = (flags & 0x0f00) >> 8;
3276
3277         for (i = 0; i < ARRAY_SIZE(prli_rsp); i++)
3278                 if (prli_rsp[i].code == code)
3279                         return i;
3280
3281         return 0;
3282 }
3283
3284 /**
3285  * ibmvfc_tgt_prli_done - Completion handler for Process Login
3286  * @evt:        ibmvfc event struct
3287  *
3288  **/
3289 static void ibmvfc_tgt_prli_done(struct ibmvfc_event *evt)
3290 {
3291         struct ibmvfc_target *tgt = evt->tgt;
3292         struct ibmvfc_host *vhost = evt->vhost;
3293         struct ibmvfc_process_login *rsp = &evt->xfer_iu->prli;
3294         struct ibmvfc_prli_svc_parms *parms = &rsp->parms;
3295         u32 status = be16_to_cpu(rsp->common.status);
3296         int index, level = IBMVFC_DEFAULT_LOG_LEVEL;
3297
3298         vhost->discovery_threads--;
3299         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3300         switch (status) {
3301         case IBMVFC_MAD_SUCCESS:
3302                 tgt_dbg(tgt, "Process Login succeeded: %X %02X %04X\n",
3303                         parms->type, parms->flags, parms->service_parms);
3304
3305                 if (parms->type == IBMVFC_SCSI_FCP_TYPE) {
3306                         index = ibmvfc_get_prli_rsp(be16_to_cpu(parms->flags));
3307                         if (prli_rsp[index].logged_in) {
3308                                 if (be16_to_cpu(parms->flags) & IBMVFC_PRLI_EST_IMG_PAIR) {
3309                                         tgt->need_login = 0;
3310                                         tgt->ids.roles = 0;
3311                                         if (be32_to_cpu(parms->service_parms) & IBMVFC_PRLI_TARGET_FUNC)
3312                                                 tgt->ids.roles |= FC_PORT_ROLE_FCP_TARGET;
3313                                         if (be32_to_cpu(parms->service_parms) & IBMVFC_PRLI_INITIATOR_FUNC)
3314                                                 tgt->ids.roles |= FC_PORT_ROLE_FCP_INITIATOR;
3315                                         tgt->add_rport = 1;
3316                                 } else
3317                                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3318                         } else if (prli_rsp[index].retry)
3319                                 ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
3320                         else
3321                                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3322                 } else
3323                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3324                 break;
3325         case IBMVFC_MAD_DRIVER_FAILED:
3326                 break;
3327         case IBMVFC_MAD_CRQ_ERROR:
3328                 ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
3329                 break;
3330         case IBMVFC_MAD_FAILED:
3331         default:
3332                 if ((be16_to_cpu(rsp->status) & IBMVFC_VIOS_FAILURE) &&
3333                      be16_to_cpu(rsp->error) == IBMVFC_PLOGI_REQUIRED)
3334                         level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
3335                 else if (tgt->logo_rcvd)
3336                         level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
3337                 else if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
3338                         level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
3339                 else
3340                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3341
3342                 tgt_log(tgt, level, "Process Login failed: %s (%x:%x) rc=0x%02X\n",
3343                         ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
3344                         be16_to_cpu(rsp->status), be16_to_cpu(rsp->error), status);
3345                 break;
3346         }
3347
3348         kref_put(&tgt->kref, ibmvfc_release_tgt);
3349         ibmvfc_free_event(evt);
3350         wake_up(&vhost->work_wait_q);
3351 }
3352
3353 /**
3354  * ibmvfc_tgt_send_prli - Send a process login
3355  * @tgt:        ibmvfc target struct
3356  *
3357  **/
3358 static void ibmvfc_tgt_send_prli(struct ibmvfc_target *tgt)
3359 {
3360         struct ibmvfc_process_login *prli;
3361         struct ibmvfc_host *vhost = tgt->vhost;
3362         struct ibmvfc_event *evt;
3363
3364         if (vhost->discovery_threads >= disc_threads)
3365                 return;
3366
3367         kref_get(&tgt->kref);
3368         evt = ibmvfc_get_event(vhost);
3369         vhost->discovery_threads++;
3370         ibmvfc_init_event(evt, ibmvfc_tgt_prli_done, IBMVFC_MAD_FORMAT);
3371         evt->tgt = tgt;
3372         prli = &evt->iu.prli;
3373         memset(prli, 0, sizeof(*prli));
3374         prli->common.version = cpu_to_be32(1);
3375         prli->common.opcode = cpu_to_be32(IBMVFC_PROCESS_LOGIN);
3376         prli->common.length = cpu_to_be16(sizeof(*prli));
3377         prli->scsi_id = cpu_to_be64(tgt->scsi_id);
3378
3379         prli->parms.type = IBMVFC_SCSI_FCP_TYPE;
3380         prli->parms.flags = cpu_to_be16(IBMVFC_PRLI_EST_IMG_PAIR);
3381         prli->parms.service_parms = cpu_to_be32(IBMVFC_PRLI_INITIATOR_FUNC);
3382         prli->parms.service_parms |= cpu_to_be32(IBMVFC_PRLI_READ_FCP_XFER_RDY_DISABLED);
3383
3384         if (cls3_error)
3385                 prli->parms.service_parms |= cpu_to_be32(IBMVFC_PRLI_RETRY);
3386
3387         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3388         if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3389                 vhost->discovery_threads--;
3390                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3391                 kref_put(&tgt->kref, ibmvfc_release_tgt);
3392         } else
3393                 tgt_dbg(tgt, "Sent process login\n");
3394 }
3395
3396 /**
3397  * ibmvfc_tgt_plogi_done - Completion handler for Port Login
3398  * @evt:        ibmvfc event struct
3399  *
3400  **/
3401 static void ibmvfc_tgt_plogi_done(struct ibmvfc_event *evt)
3402 {
3403         struct ibmvfc_target *tgt = evt->tgt;
3404         struct ibmvfc_host *vhost = evt->vhost;
3405         struct ibmvfc_port_login *rsp = &evt->xfer_iu->plogi;
3406         u32 status = be16_to_cpu(rsp->common.status);
3407         int level = IBMVFC_DEFAULT_LOG_LEVEL;
3408
3409         vhost->discovery_threads--;
3410         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3411         switch (status) {
3412         case IBMVFC_MAD_SUCCESS:
3413                 tgt_dbg(tgt, "Port Login succeeded\n");
3414                 if (tgt->ids.port_name &&
3415                     tgt->ids.port_name != wwn_to_u64(rsp->service_parms.port_name)) {
3416                         vhost->reinit = 1;
3417                         tgt_dbg(tgt, "Port re-init required\n");
3418                         break;
3419                 }
3420                 tgt->ids.node_name = wwn_to_u64(rsp->service_parms.node_name);
3421                 tgt->ids.port_name = wwn_to_u64(rsp->service_parms.port_name);
3422                 tgt->ids.port_id = tgt->scsi_id;
3423                 memcpy(&tgt->service_parms, &rsp->service_parms,
3424                        sizeof(tgt->service_parms));
3425                 memcpy(&tgt->service_parms_change, &rsp->service_parms_change,
3426                        sizeof(tgt->service_parms_change));
3427                 ibmvfc_init_tgt(tgt, ibmvfc_tgt_send_prli);
3428                 break;
3429         case IBMVFC_MAD_DRIVER_FAILED:
3430                 break;
3431         case IBMVFC_MAD_CRQ_ERROR:
3432                 ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
3433                 break;
3434         case IBMVFC_MAD_FAILED:
3435         default:
3436                 if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
3437                         level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
3438                 else
3439                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3440
3441                 tgt_log(tgt, level, "Port Login failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
3442                         ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
3443                                              be16_to_cpu(rsp->status), be16_to_cpu(rsp->error),
3444                         ibmvfc_get_fc_type(be16_to_cpu(rsp->fc_type)), be16_to_cpu(rsp->fc_type),
3445                         ibmvfc_get_ls_explain(be16_to_cpu(rsp->fc_explain)), be16_to_cpu(rsp->fc_explain), status);
3446                 break;
3447         }
3448
3449         kref_put(&tgt->kref, ibmvfc_release_tgt);
3450         ibmvfc_free_event(evt);
3451         wake_up(&vhost->work_wait_q);
3452 }
3453
3454 /**
3455  * ibmvfc_tgt_send_plogi - Send PLOGI to the specified target
3456  * @tgt:        ibmvfc target struct
3457  *
3458  **/
3459 static void ibmvfc_tgt_send_plogi(struct ibmvfc_target *tgt)
3460 {
3461         struct ibmvfc_port_login *plogi;
3462         struct ibmvfc_host *vhost = tgt->vhost;
3463         struct ibmvfc_event *evt;
3464
3465         if (vhost->discovery_threads >= disc_threads)
3466                 return;
3467
3468         kref_get(&tgt->kref);
3469         tgt->logo_rcvd = 0;
3470         evt = ibmvfc_get_event(vhost);
3471         vhost->discovery_threads++;
3472         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3473         ibmvfc_init_event(evt, ibmvfc_tgt_plogi_done, IBMVFC_MAD_FORMAT);
3474         evt->tgt = tgt;
3475         plogi = &evt->iu.plogi;
3476         memset(plogi, 0, sizeof(*plogi));
3477         plogi->common.version = cpu_to_be32(1);
3478         plogi->common.opcode = cpu_to_be32(IBMVFC_PORT_LOGIN);
3479         plogi->common.length = cpu_to_be16(sizeof(*plogi));
3480         plogi->scsi_id = cpu_to_be64(tgt->scsi_id);
3481
3482         if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3483                 vhost->discovery_threads--;
3484                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3485                 kref_put(&tgt->kref, ibmvfc_release_tgt);
3486         } else
3487                 tgt_dbg(tgt, "Sent port login\n");
3488 }
3489
3490 /**
3491  * ibmvfc_tgt_implicit_logout_done - Completion handler for Implicit Logout MAD
3492  * @evt:        ibmvfc event struct
3493  *
3494  **/
3495 static void ibmvfc_tgt_implicit_logout_done(struct ibmvfc_event *evt)
3496 {
3497         struct ibmvfc_target *tgt = evt->tgt;
3498         struct ibmvfc_host *vhost = evt->vhost;
3499         struct ibmvfc_implicit_logout *rsp = &evt->xfer_iu->implicit_logout;
3500         u32 status = be16_to_cpu(rsp->common.status);
3501
3502         vhost->discovery_threads--;
3503         ibmvfc_free_event(evt);
3504         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3505
3506         switch (status) {
3507         case IBMVFC_MAD_SUCCESS:
3508                 tgt_dbg(tgt, "Implicit Logout succeeded\n");
3509                 break;
3510         case IBMVFC_MAD_DRIVER_FAILED:
3511                 kref_put(&tgt->kref, ibmvfc_release_tgt);
3512                 wake_up(&vhost->work_wait_q);
3513                 return;
3514         case IBMVFC_MAD_FAILED:
3515         default:
3516                 tgt_err(tgt, "Implicit Logout failed: rc=0x%02X\n", status);
3517                 break;
3518         }
3519
3520         if (vhost->action == IBMVFC_HOST_ACTION_TGT_INIT)
3521                 ibmvfc_init_tgt(tgt, ibmvfc_tgt_send_plogi);
3522         else if (vhost->action == IBMVFC_HOST_ACTION_QUERY_TGTS &&
3523                  tgt->scsi_id != tgt->new_scsi_id)
3524                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3525         kref_put(&tgt->kref, ibmvfc_release_tgt);
3526         wake_up(&vhost->work_wait_q);
3527 }
3528
3529 /**
3530  * ibmvfc_tgt_implicit_logout - Initiate an Implicit Logout for specified target
3531  * @tgt:                ibmvfc target struct
3532  *
3533  **/
3534 static void ibmvfc_tgt_implicit_logout(struct ibmvfc_target *tgt)
3535 {
3536         struct ibmvfc_implicit_logout *mad;
3537         struct ibmvfc_host *vhost = tgt->vhost;
3538         struct ibmvfc_event *evt;
3539
3540         if (vhost->discovery_threads >= disc_threads)
3541                 return;
3542
3543         kref_get(&tgt->kref);
3544         evt = ibmvfc_get_event(vhost);
3545         vhost->discovery_threads++;
3546         ibmvfc_init_event(evt, ibmvfc_tgt_implicit_logout_done, IBMVFC_MAD_FORMAT);
3547         evt->tgt = tgt;
3548         mad = &evt->iu.implicit_logout;
3549         memset(mad, 0, sizeof(*mad));
3550         mad->common.version = cpu_to_be32(1);
3551         mad->common.opcode = cpu_to_be32(IBMVFC_IMPLICIT_LOGOUT);
3552         mad->common.length = cpu_to_be16(sizeof(*mad));
3553         mad->old_scsi_id = cpu_to_be64(tgt->scsi_id);
3554
3555         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3556         if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3557                 vhost->discovery_threads--;
3558                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3559                 kref_put(&tgt->kref, ibmvfc_release_tgt);
3560         } else
3561                 tgt_dbg(tgt, "Sent Implicit Logout\n");
3562 }
3563
3564 /**
3565  * ibmvfc_adisc_needs_plogi - Does device need PLOGI?
3566  * @mad:        ibmvfc passthru mad struct
3567  * @tgt:        ibmvfc target struct
3568  *
3569  * Returns:
3570  *      1 if PLOGI needed / 0 if PLOGI not needed
3571  **/
3572 static int ibmvfc_adisc_needs_plogi(struct ibmvfc_passthru_mad *mad,
3573                                     struct ibmvfc_target *tgt)
3574 {
3575         if (wwn_to_u64((u8 *)&mad->fc_iu.response[2]) != tgt->ids.port_name)
3576                 return 1;
3577         if (wwn_to_u64((u8 *)&mad->fc_iu.response[4]) != tgt->ids.node_name)
3578                 return 1;
3579         if (be32_to_cpu(mad->fc_iu.response[6]) != tgt->scsi_id)
3580                 return 1;
3581         return 0;
3582 }
3583
3584 /**
3585  * ibmvfc_tgt_adisc_done - Completion handler for ADISC
3586  * @evt:        ibmvfc event struct
3587  *
3588  **/
3589 static void ibmvfc_tgt_adisc_done(struct ibmvfc_event *evt)
3590 {
3591         struct ibmvfc_target *tgt = evt->tgt;
3592         struct ibmvfc_host *vhost = evt->vhost;
3593         struct ibmvfc_passthru_mad *mad = &evt->xfer_iu->passthru;
3594         u32 status = be16_to_cpu(mad->common.status);
3595         u8 fc_reason, fc_explain;
3596
3597         vhost->discovery_threads--;
3598         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3599         del_timer(&tgt->timer);
3600
3601         switch (status) {
3602         case IBMVFC_MAD_SUCCESS:
3603                 tgt_dbg(tgt, "ADISC succeeded\n");
3604                 if (ibmvfc_adisc_needs_plogi(mad, tgt))
3605                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3606                 break;
3607         case IBMVFC_MAD_DRIVER_FAILED:
3608                 break;
3609         case IBMVFC_MAD_FAILED:
3610         default:
3611                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3612                 fc_reason = (be32_to_cpu(mad->fc_iu.response[1]) & 0x00ff0000) >> 16;
3613                 fc_explain = (be32_to_cpu(mad->fc_iu.response[1]) & 0x0000ff00) >> 8;
3614                 tgt_info(tgt, "ADISC failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
3615                          ibmvfc_get_cmd_error(be16_to_cpu(mad->iu.status), be16_to_cpu(mad->iu.error)),
3616                          be16_to_cpu(mad->iu.status), be16_to_cpu(mad->iu.error),
3617                          ibmvfc_get_fc_type(fc_reason), fc_reason,
3618                          ibmvfc_get_ls_explain(fc_explain), fc_explain, status);
3619                 break;
3620         }
3621
3622         kref_put(&tgt->kref, ibmvfc_release_tgt);
3623         ibmvfc_free_event(evt);
3624         wake_up(&vhost->work_wait_q);
3625 }
3626
3627 /**
3628  * ibmvfc_init_passthru - Initialize an event struct for FC passthru
3629  * @evt:                ibmvfc event struct
3630  *
3631  **/
3632 static void ibmvfc_init_passthru(struct ibmvfc_event *evt)
3633 {
3634         struct ibmvfc_passthru_mad *mad = &evt->iu.passthru;
3635
3636         memset(mad, 0, sizeof(*mad));
3637         mad->common.version = cpu_to_be32(1);
3638         mad->common.opcode = cpu_to_be32(IBMVFC_PASSTHRU);
3639         mad->common.length = cpu_to_be16(sizeof(*mad) - sizeof(mad->fc_iu) - sizeof(mad->iu));
3640         mad->cmd_ioba.va = cpu_to_be64((u64)be64_to_cpu(evt->crq.ioba) +
3641                 offsetof(struct ibmvfc_passthru_mad, iu));
3642         mad->cmd_ioba.len = cpu_to_be32(sizeof(mad->iu));
3643         mad->iu.cmd_len = cpu_to_be32(sizeof(mad->fc_iu.payload));
3644         mad->iu.rsp_len = cpu_to_be32(sizeof(mad->fc_iu.response));
3645         mad->iu.cmd.va = cpu_to_be64((u64)be64_to_cpu(evt->crq.ioba) +
3646                 offsetof(struct ibmvfc_passthru_mad, fc_iu) +
3647                 offsetof(struct ibmvfc_passthru_fc_iu, payload));
3648         mad->iu.cmd.len = cpu_to_be32(sizeof(mad->fc_iu.payload));
3649         mad->iu.rsp.va = cpu_to_be64((u64)be64_to_cpu(evt->crq.ioba) +
3650                 offsetof(struct ibmvfc_passthru_mad, fc_iu) +
3651                 offsetof(struct ibmvfc_passthru_fc_iu, response));
3652         mad->iu.rsp.len = cpu_to_be32(sizeof(mad->fc_iu.response));
3653 }
3654
3655 /**
3656  * ibmvfc_tgt_adisc_cancel_done - Completion handler when cancelling an ADISC
3657  * @evt:                ibmvfc event struct
3658  *
3659  * Just cleanup this event struct. Everything else is handled by
3660  * the ADISC completion handler. If the ADISC never actually comes
3661  * back, we still have the timer running on the ADISC event struct
3662  * which will fire and cause the CRQ to get reset.
3663  *
3664  **/
3665 static void ibmvfc_tgt_adisc_cancel_done(struct ibmvfc_event *evt)
3666 {
3667         struct ibmvfc_host *vhost = evt->vhost;
3668         struct ibmvfc_target *tgt = evt->tgt;
3669
3670         tgt_dbg(tgt, "ADISC cancel complete\n");
3671         vhost->abort_threads--;
3672         ibmvfc_free_event(evt);
3673         kref_put(&tgt->kref, ibmvfc_release_tgt);
3674         wake_up(&vhost->work_wait_q);
3675 }
3676
3677 /**
3678  * ibmvfc_adisc_timeout - Handle an ADISC timeout
3679  * @tgt:                ibmvfc target struct
3680  *
3681  * If an ADISC times out, send a cancel. If the cancel times
3682  * out, reset the CRQ. When the ADISC comes back as cancelled,
3683  * log back into the target.
3684  **/
3685 static void ibmvfc_adisc_timeout(struct timer_list *t)
3686 {
3687         struct ibmvfc_target *tgt = from_timer(tgt, t, timer);
3688         struct ibmvfc_host *vhost = tgt->vhost;
3689         struct ibmvfc_event *evt;
3690         struct ibmvfc_tmf *tmf;
3691         unsigned long flags;
3692         int rc;
3693
3694         tgt_dbg(tgt, "ADISC timeout\n");
3695         spin_lock_irqsave(vhost->host->host_lock, flags);
3696         if (vhost->abort_threads >= disc_threads ||
3697             tgt->action != IBMVFC_TGT_ACTION_INIT_WAIT ||
3698             vhost->state != IBMVFC_INITIALIZING ||
3699             vhost->action != IBMVFC_HOST_ACTION_QUERY_TGTS) {
3700                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
3701                 return;
3702         }
3703
3704         vhost->abort_threads++;
3705         kref_get(&tgt->kref);
3706         evt = ibmvfc_get_event(vhost);
3707         ibmvfc_init_event(evt, ibmvfc_tgt_adisc_cancel_done, IBMVFC_MAD_FORMAT);
3708
3709         evt->tgt = tgt;
3710         tmf = &evt->iu.tmf;
3711         memset(tmf, 0, sizeof(*tmf));
3712         tmf->common.version = cpu_to_be32(1);
3713         tmf->common.opcode = cpu_to_be32(IBMVFC_TMF_MAD);
3714         tmf->common.length = cpu_to_be16(sizeof(*tmf));
3715         tmf->scsi_id = cpu_to_be64(tgt->scsi_id);
3716         tmf->cancel_key = cpu_to_be32(tgt->cancel_key);
3717
3718         rc = ibmvfc_send_event(evt, vhost, default_timeout);
3719
3720         if (rc) {
3721                 tgt_err(tgt, "Failed to send cancel event for ADISC. rc=%d\n", rc);
3722                 vhost->abort_threads--;
3723                 kref_put(&tgt->kref, ibmvfc_release_tgt);
3724                 __ibmvfc_reset_host(vhost);
3725         } else
3726                 tgt_dbg(tgt, "Attempting to cancel ADISC\n");
3727         spin_unlock_irqrestore(vhost->host->host_lock, flags);
3728 }
3729
3730 /**
3731  * ibmvfc_tgt_adisc - Initiate an ADISC for specified target
3732  * @tgt:                ibmvfc target struct
3733  *
3734  * When sending an ADISC we end up with two timers running. The
3735  * first timer is the timer in the ibmvfc target struct. If this
3736  * fires, we send a cancel to the target. The second timer is the
3737  * timer on the ibmvfc event for the ADISC, which is longer. If that
3738  * fires, it means the ADISC timed out and our attempt to cancel it
3739  * also failed, so we need to reset the CRQ.
3740  **/
3741 static void ibmvfc_tgt_adisc(struct ibmvfc_target *tgt)
3742 {
3743         struct ibmvfc_passthru_mad *mad;
3744         struct ibmvfc_host *vhost = tgt->vhost;
3745         struct ibmvfc_event *evt;
3746
3747         if (vhost->discovery_threads >= disc_threads)
3748                 return;
3749
3750         kref_get(&tgt->kref);
3751         evt = ibmvfc_get_event(vhost);
3752         vhost->discovery_threads++;
3753         ibmvfc_init_event(evt, ibmvfc_tgt_adisc_done, IBMVFC_MAD_FORMAT);
3754         evt->tgt = tgt;
3755
3756         ibmvfc_init_passthru(evt);
3757         mad = &evt->iu.passthru;
3758         mad->iu.flags = cpu_to_be32(IBMVFC_FC_ELS);
3759         mad->iu.scsi_id = cpu_to_be64(tgt->scsi_id);
3760         mad->iu.cancel_key = cpu_to_be32(tgt->cancel_key);
3761
3762         mad->fc_iu.payload[0] = cpu_to_be32(IBMVFC_ADISC);
3763         memcpy(&mad->fc_iu.payload[2], &vhost->login_buf->resp.port_name,
3764                sizeof(vhost->login_buf->resp.port_name));
3765         memcpy(&mad->fc_iu.payload[4], &vhost->login_buf->resp.node_name,
3766                sizeof(vhost->login_buf->resp.node_name));
3767         mad->fc_iu.payload[6] = cpu_to_be32(be64_to_cpu(vhost->login_buf->resp.scsi_id) & 0x00ffffff);
3768
3769         if (timer_pending(&tgt->timer))
3770                 mod_timer(&tgt->timer, jiffies + (IBMVFC_ADISC_TIMEOUT * HZ));
3771         else {
3772                 tgt->timer.expires = jiffies + (IBMVFC_ADISC_TIMEOUT * HZ);
3773                 add_timer(&tgt->timer);
3774         }
3775
3776         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3777         if (ibmvfc_send_event(evt, vhost, IBMVFC_ADISC_PLUS_CANCEL_TIMEOUT)) {
3778                 vhost->discovery_threads--;
3779                 del_timer(&tgt->timer);
3780                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3781                 kref_put(&tgt->kref, ibmvfc_release_tgt);
3782         } else
3783                 tgt_dbg(tgt, "Sent ADISC\n");
3784 }
3785
3786 /**
3787  * ibmvfc_tgt_query_target_done - Completion handler for Query Target MAD
3788  * @evt:        ibmvfc event struct
3789  *
3790  **/
3791 static void ibmvfc_tgt_query_target_done(struct ibmvfc_event *evt)
3792 {
3793         struct ibmvfc_target *tgt = evt->tgt;
3794         struct ibmvfc_host *vhost = evt->vhost;
3795         struct ibmvfc_query_tgt *rsp = &evt->xfer_iu->query_tgt;
3796         u32 status = be16_to_cpu(rsp->common.status);
3797         int level = IBMVFC_DEFAULT_LOG_LEVEL;
3798
3799         vhost->discovery_threads--;
3800         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3801         switch (status) {
3802         case IBMVFC_MAD_SUCCESS:
3803                 tgt_dbg(tgt, "Query Target succeeded\n");
3804                 tgt->new_scsi_id = be64_to_cpu(rsp->scsi_id);
3805                 if (be64_to_cpu(rsp->scsi_id) != tgt->scsi_id)
3806                         ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
3807                 else
3808                         ibmvfc_init_tgt(tgt, ibmvfc_tgt_adisc);
3809                 break;
3810         case IBMVFC_MAD_DRIVER_FAILED:
3811                 break;
3812         case IBMVFC_MAD_CRQ_ERROR:
3813                 ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_query_target);
3814                 break;
3815         case IBMVFC_MAD_FAILED:
3816         default:
3817                 if ((be16_to_cpu(rsp->status) & IBMVFC_FABRIC_MAPPED) == IBMVFC_FABRIC_MAPPED &&
3818                     be16_to_cpu(rsp->error) == IBMVFC_UNABLE_TO_PERFORM_REQ &&
3819                     be16_to_cpu(rsp->fc_explain) == IBMVFC_PORT_NAME_NOT_REG)
3820                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3821                 else if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
3822                         level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_query_target);
3823                 else
3824                         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3825
3826                 tgt_log(tgt, level, "Query Target failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
3827                         ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
3828                         be16_to_cpu(rsp->status), be16_to_cpu(rsp->error),
3829                         ibmvfc_get_fc_type(be16_to_cpu(rsp->fc_type)), be16_to_cpu(rsp->fc_type),
3830                         ibmvfc_get_gs_explain(be16_to_cpu(rsp->fc_explain)), be16_to_cpu(rsp->fc_explain),
3831                         status);
3832                 break;
3833         }
3834
3835         kref_put(&tgt->kref, ibmvfc_release_tgt);
3836         ibmvfc_free_event(evt);
3837         wake_up(&vhost->work_wait_q);
3838 }
3839
3840 /**
3841  * ibmvfc_tgt_query_target - Initiate a Query Target for specified target
3842  * @tgt:        ibmvfc target struct
3843  *
3844  **/
3845 static void ibmvfc_tgt_query_target(struct ibmvfc_target *tgt)
3846 {
3847         struct ibmvfc_query_tgt *query_tgt;
3848         struct ibmvfc_host *vhost = tgt->vhost;
3849         struct ibmvfc_event *evt;
3850
3851         if (vhost->discovery_threads >= disc_threads)
3852                 return;
3853
3854         kref_get(&tgt->kref);
3855         evt = ibmvfc_get_event(vhost);
3856         vhost->discovery_threads++;
3857         evt->tgt = tgt;
3858         ibmvfc_init_event(evt, ibmvfc_tgt_query_target_done, IBMVFC_MAD_FORMAT);
3859         query_tgt = &evt->iu.query_tgt;
3860         memset(query_tgt, 0, sizeof(*query_tgt));
3861         query_tgt->common.version = cpu_to_be32(1);
3862         query_tgt->common.opcode = cpu_to_be32(IBMVFC_QUERY_TARGET);
3863         query_tgt->common.length = cpu_to_be16(sizeof(*query_tgt));
3864         query_tgt->wwpn = cpu_to_be64(tgt->ids.port_name);
3865
3866         ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3867         if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3868                 vhost->discovery_threads--;
3869                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3870                 kref_put(&tgt->kref, ibmvfc_release_tgt);
3871         } else
3872                 tgt_dbg(tgt, "Sent Query Target\n");
3873 }
3874
3875 /**
3876  * ibmvfc_alloc_target - Allocate and initialize an ibmvfc target
3877  * @vhost:              ibmvfc host struct
3878  * @scsi_id:    SCSI ID to allocate target for
3879  *
3880  * Returns:
3881  *      0 on success / other on failure
3882  **/
3883 static int ibmvfc_alloc_target(struct ibmvfc_host *vhost, u64 scsi_id)
3884 {
3885         struct ibmvfc_target *tgt;
3886         unsigned long flags;
3887
3888         spin_lock_irqsave(vhost->host->host_lock, flags);
3889         list_for_each_entry(tgt, &vhost->targets, queue) {
3890                 if (tgt->scsi_id == scsi_id) {
3891                         if (tgt->need_login)
3892                                 ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
3893                         goto unlock_out;
3894                 }
3895         }
3896         spin_unlock_irqrestore(vhost->host->host_lock, flags);
3897
3898         tgt = mempool_alloc(vhost->tgt_pool, GFP_NOIO);
3899         memset(tgt, 0, sizeof(*tgt));
3900         tgt->scsi_id = scsi_id;
3901         tgt->new_scsi_id = scsi_id;
3902         tgt->vhost = vhost;
3903         tgt->need_login = 1;
3904         tgt->cancel_key = vhost->task_set++;
3905         timer_setup(&tgt->timer, ibmvfc_adisc_timeout, 0);
3906         kref_init(&tgt->kref);
3907         ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
3908         spin_lock_irqsave(vhost->host->host_lock, flags);
3909         list_add_tail(&tgt->queue, &vhost->targets);
3910
3911 unlock_out:
3912         spin_unlock_irqrestore(vhost->host->host_lock, flags);
3913         return 0;
3914 }
3915
3916 /**
3917  * ibmvfc_alloc_targets - Allocate and initialize ibmvfc targets
3918  * @vhost:              ibmvfc host struct
3919  *
3920  * Returns:
3921  *      0 on success / other on failure
3922  **/
3923 static int ibmvfc_alloc_targets(struct ibmvfc_host *vhost)
3924 {
3925         int i, rc;
3926
3927         for (i = 0, rc = 0; !rc && i < vhost->num_targets; i++)
3928                 rc = ibmvfc_alloc_target(vhost,
3929                                          be32_to_cpu(vhost->disc_buf->scsi_id[i]) &
3930                                          IBMVFC_DISC_TGT_SCSI_ID_MASK);
3931
3932         return rc;
3933 }
3934
3935 /**
3936  * ibmvfc_discover_targets_done - Completion handler for discover targets MAD
3937  * @evt:        ibmvfc event struct
3938  *
3939  **/
3940 static void ibmvfc_discover_targets_done(struct ibmvfc_event *evt)
3941 {
3942         struct ibmvfc_host *vhost = evt->vhost;
3943         struct ibmvfc_discover_targets *rsp = &evt->xfer_iu->discover_targets;
3944         u32 mad_status = be16_to_cpu(rsp->common.status);
3945         int level = IBMVFC_DEFAULT_LOG_LEVEL;
3946
3947         switch (mad_status) {
3948         case IBMVFC_MAD_SUCCESS:
3949                 ibmvfc_dbg(vhost, "Discover Targets succeeded\n");
3950                 vhost->num_targets = be32_to_cpu(rsp->num_written);
3951                 ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_ALLOC_TGTS);
3952                 break;
3953         case IBMVFC_MAD_FAILED:
3954                 level += ibmvfc_retry_host_init(vhost);
3955                 ibmvfc_log(vhost, level, "Discover Targets failed: %s (%x:%x)\n",
3956                            ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
3957                            be16_to_cpu(rsp->status), be16_to_cpu(rsp->error));
3958                 break;
3959         case IBMVFC_MAD_DRIVER_FAILED:
3960                 break;
3961         default:
3962                 dev_err(vhost->dev, "Invalid Discover Targets response: 0x%x\n", mad_status);
3963                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3964                 break;
3965         }
3966
3967         ibmvfc_free_event(evt);
3968         wake_up(&vhost->work_wait_q);
3969 }
3970
3971 /**
3972  * ibmvfc_discover_targets - Send Discover Targets MAD
3973  * @vhost:      ibmvfc host struct
3974  *
3975  **/
3976 static void ibmvfc_discover_targets(struct ibmvfc_host *vhost)
3977 {
3978         struct ibmvfc_discover_targets *mad;
3979         struct ibmvfc_event *evt = ibmvfc_get_event(vhost);
3980
3981         ibmvfc_init_event(evt, ibmvfc_discover_targets_done, IBMVFC_MAD_FORMAT);
3982         mad = &evt->iu.discover_targets;
3983         memset(mad, 0, sizeof(*mad));
3984         mad->common.version = cpu_to_be32(1);
3985         mad->common.opcode = cpu_to_be32(IBMVFC_DISC_TARGETS);
3986         mad->common.length = cpu_to_be16(sizeof(*mad));
3987         mad->bufflen = cpu_to_be32(vhost->disc_buf_sz);
3988         mad->buffer.va = cpu_to_be64(vhost->disc_buf_dma);
3989         mad->buffer.len = cpu_to_be32(vhost->disc_buf_sz);
3990         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
3991
3992         if (!ibmvfc_send_event(evt, vhost, default_timeout))
3993                 ibmvfc_dbg(vhost, "Sent discover targets\n");
3994         else
3995                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3996 }
3997
3998 /**
3999  * ibmvfc_npiv_login_done - Completion handler for NPIV Login
4000  * @evt:        ibmvfc event struct
4001  *
4002  **/
4003 static void ibmvfc_npiv_login_done(struct ibmvfc_event *evt)
4004 {
4005         struct ibmvfc_host *vhost = evt->vhost;
4006         u32 mad_status = be16_to_cpu(evt->xfer_iu->npiv_login.common.status);
4007         struct ibmvfc_npiv_login_resp *rsp = &vhost->login_buf->resp;
4008         unsigned int npiv_max_sectors;
4009         int level = IBMVFC_DEFAULT_LOG_LEVEL;
4010
4011         switch (mad_status) {
4012         case IBMVFC_MAD_SUCCESS:
4013                 ibmvfc_free_event(evt);
4014                 break;
4015         case IBMVFC_MAD_FAILED:
4016                 if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
4017                         level += ibmvfc_retry_host_init(vhost);
4018                 else
4019                         ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4020                 ibmvfc_log(vhost, level, "NPIV Login failed: %s (%x:%x)\n",
4021                            ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
4022                                                 be16_to_cpu(rsp->status), be16_to_cpu(rsp->error));
4023                 ibmvfc_free_event(evt);
4024                 return;
4025         case IBMVFC_MAD_CRQ_ERROR:
4026                 ibmvfc_retry_host_init(vhost);
4027                 /* fall through */
4028         case IBMVFC_MAD_DRIVER_FAILED:
4029                 ibmvfc_free_event(evt);
4030                 return;
4031         default:
4032                 dev_err(vhost->dev, "Invalid NPIV Login response: 0x%x\n", mad_status);
4033                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4034                 ibmvfc_free_event(evt);
4035                 return;
4036         }
4037
4038         vhost->client_migrated = 0;
4039
4040         if (!(be32_to_cpu(rsp->flags) & IBMVFC_NATIVE_FC)) {
4041                 dev_err(vhost->dev, "Virtual adapter does not support FC. %x\n",
4042                         rsp->flags);
4043                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4044                 wake_up(&vhost->work_wait_q);
4045                 return;
4046         }
4047
4048         if (be32_to_cpu(rsp->max_cmds) <= IBMVFC_NUM_INTERNAL_REQ) {
4049                 dev_err(vhost->dev, "Virtual adapter supported queue depth too small: %d\n",
4050                         rsp->max_cmds);
4051                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4052                 wake_up(&vhost->work_wait_q);
4053                 return;
4054         }
4055
4056         vhost->logged_in = 1;
4057         npiv_max_sectors = min((uint)(be64_to_cpu(rsp->max_dma_len) >> 9), IBMVFC_MAX_SECTORS);
4058         dev_info(vhost->dev, "Host partition: %s, device: %s %s %s max sectors %u\n",
4059                  rsp->partition_name, rsp->device_name, rsp->port_loc_code,
4060                  rsp->drc_name, npiv_max_sectors);
4061
4062         fc_host_fabric_name(vhost->host) = be64_to_cpu(rsp->node_name);
4063         fc_host_node_name(vhost->host) = be64_to_cpu(rsp->node_name);
4064         fc_host_port_name(vhost->host) = be64_to_cpu(rsp->port_name);
4065         fc_host_port_id(vhost->host) = be64_to_cpu(rsp->scsi_id);
4066         fc_host_port_type(vhost->host) = FC_PORTTYPE_NPIV;
4067         fc_host_supported_classes(vhost->host) = 0;
4068         if (be32_to_cpu(rsp->service_parms.class1_parms[0]) & 0x80000000)
4069                 fc_host_supported_classes(vhost->host) |= FC_COS_CLASS1;
4070         if (be32_to_cpu(rsp->service_parms.class2_parms[0]) & 0x80000000)
4071                 fc_host_supported_classes(vhost->host) |= FC_COS_CLASS2;
4072         if (be32_to_cpu(rsp->service_parms.class3_parms[0]) & 0x80000000)
4073                 fc_host_supported_classes(vhost->host) |= FC_COS_CLASS3;
4074         fc_host_maxframe_size(vhost->host) =
4075                 be16_to_cpu(rsp->service_parms.common.bb_rcv_sz) & 0x0fff;
4076
4077         vhost->host->can_queue = be32_to_cpu(rsp->max_cmds) - IBMVFC_NUM_INTERNAL_REQ;
4078         vhost->host->max_sectors = npiv_max_sectors;
4079         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
4080         wake_up(&vhost->work_wait_q);
4081 }
4082
4083 /**
4084  * ibmvfc_npiv_login - Sends NPIV login
4085  * @vhost:      ibmvfc host struct
4086  *
4087  **/
4088 static void ibmvfc_npiv_login(struct ibmvfc_host *vhost)
4089 {
4090         struct ibmvfc_npiv_login_mad *mad;
4091         struct ibmvfc_event *evt = ibmvfc_get_event(vhost);
4092
4093         ibmvfc_gather_partition_info(vhost);
4094         ibmvfc_set_login_info(vhost);
4095         ibmvfc_init_event(evt, ibmvfc_npiv_login_done, IBMVFC_MAD_FORMAT);
4096
4097         memcpy(vhost->login_buf, &vhost->login_info, sizeof(vhost->login_info));
4098         mad = &evt->iu.npiv_login;
4099         memset(mad, 0, sizeof(struct ibmvfc_npiv_login_mad));
4100         mad->common.version = cpu_to_be32(1);
4101         mad->common.opcode = cpu_to_be32(IBMVFC_NPIV_LOGIN);
4102         mad->common.length = cpu_to_be16(sizeof(struct ibmvfc_npiv_login_mad));
4103         mad->buffer.va = cpu_to_be64(vhost->login_buf_dma);
4104         mad->buffer.len = cpu_to_be32(sizeof(*vhost->login_buf));
4105
4106         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
4107
4108         if (!ibmvfc_send_event(evt, vhost, default_timeout))
4109                 ibmvfc_dbg(vhost, "Sent NPIV login\n");
4110         else
4111                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4112 };
4113
4114 /**
4115  * ibmvfc_npiv_logout_done - Completion handler for NPIV Logout
4116  * @vhost:              ibmvfc host struct
4117  *
4118  **/
4119 static void ibmvfc_npiv_logout_done(struct ibmvfc_event *evt)
4120 {
4121         struct ibmvfc_host *vhost = evt->vhost;
4122         u32 mad_status = be16_to_cpu(evt->xfer_iu->npiv_logout.common.status);
4123
4124         ibmvfc_free_event(evt);
4125
4126         switch (mad_status) {
4127         case IBMVFC_MAD_SUCCESS:
4128                 if (list_empty(&vhost->sent) &&
4129                     vhost->action == IBMVFC_HOST_ACTION_LOGO_WAIT) {
4130                         ibmvfc_init_host(vhost);
4131                         return;
4132                 }
4133                 break;
4134         case IBMVFC_MAD_FAILED:
4135         case IBMVFC_MAD_NOT_SUPPORTED:
4136         case IBMVFC_MAD_CRQ_ERROR:
4137         case IBMVFC_MAD_DRIVER_FAILED:
4138         default:
4139                 ibmvfc_dbg(vhost, "NPIV Logout failed. 0x%X\n", mad_status);
4140                 break;
4141         }
4142
4143         ibmvfc_hard_reset_host(vhost);
4144 }
4145
4146 /**
4147  * ibmvfc_npiv_logout - Issue an NPIV Logout
4148  * @vhost:              ibmvfc host struct
4149  *
4150  **/
4151 static void ibmvfc_npiv_logout(struct ibmvfc_host *vhost)
4152 {
4153         struct ibmvfc_npiv_logout_mad *mad;
4154         struct ibmvfc_event *evt;
4155
4156         evt = ibmvfc_get_event(vhost);
4157         ibmvfc_init_event(evt, ibmvfc_npiv_logout_done, IBMVFC_MAD_FORMAT);
4158
4159         mad = &evt->iu.npiv_logout;
4160         memset(mad, 0, sizeof(*mad));
4161         mad->common.version = cpu_to_be32(1);
4162         mad->common.opcode = cpu_to_be32(IBMVFC_NPIV_LOGOUT);
4163         mad->common.length = cpu_to_be16(sizeof(struct ibmvfc_npiv_logout_mad));
4164
4165         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_LOGO_WAIT);
4166
4167         if (!ibmvfc_send_event(evt, vhost, default_timeout))
4168                 ibmvfc_dbg(vhost, "Sent NPIV logout\n");
4169         else
4170                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4171 }
4172
4173 /**
4174  * ibmvfc_dev_init_to_do - Is there target initialization work to do?
4175  * @vhost:              ibmvfc host struct
4176  *
4177  * Returns:
4178  *      1 if work to do / 0 if not
4179  **/
4180 static int ibmvfc_dev_init_to_do(struct ibmvfc_host *vhost)
4181 {
4182         struct ibmvfc_target *tgt;
4183
4184         list_for_each_entry(tgt, &vhost->targets, queue) {
4185                 if (tgt->action == IBMVFC_TGT_ACTION_INIT ||
4186                     tgt->action == IBMVFC_TGT_ACTION_INIT_WAIT)
4187                         return 1;
4188         }
4189
4190         return 0;
4191 }
4192
4193 /**
4194  * __ibmvfc_work_to_do - Is there task level work to do? (no locking)
4195  * @vhost:              ibmvfc host struct
4196  *
4197  * Returns:
4198  *      1 if work to do / 0 if not
4199  **/
4200 static int __ibmvfc_work_to_do(struct ibmvfc_host *vhost)
4201 {
4202         struct ibmvfc_target *tgt;
4203
4204         if (kthread_should_stop())
4205                 return 1;
4206         switch (vhost->action) {
4207         case IBMVFC_HOST_ACTION_NONE:
4208         case IBMVFC_HOST_ACTION_INIT_WAIT:
4209         case IBMVFC_HOST_ACTION_LOGO_WAIT:
4210                 return 0;
4211         case IBMVFC_HOST_ACTION_TGT_INIT:
4212         case IBMVFC_HOST_ACTION_QUERY_TGTS:
4213                 if (vhost->discovery_threads == disc_threads)
4214                         return 0;
4215                 list_for_each_entry(tgt, &vhost->targets, queue)
4216                         if (tgt->action == IBMVFC_TGT_ACTION_INIT)
4217                                 return 1;
4218                 list_for_each_entry(tgt, &vhost->targets, queue)
4219                         if (tgt->action == IBMVFC_TGT_ACTION_INIT_WAIT)
4220                                 return 0;
4221                 return 1;
4222         case IBMVFC_HOST_ACTION_LOGO:
4223         case IBMVFC_HOST_ACTION_INIT:
4224         case IBMVFC_HOST_ACTION_ALLOC_TGTS:
4225         case IBMVFC_HOST_ACTION_TGT_DEL:
4226         case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
4227         case IBMVFC_HOST_ACTION_QUERY:
4228         case IBMVFC_HOST_ACTION_RESET:
4229         case IBMVFC_HOST_ACTION_REENABLE:
4230         default:
4231                 break;
4232         }
4233
4234         return 1;
4235 }
4236
4237 /**
4238  * ibmvfc_work_to_do - Is there task level work to do?
4239  * @vhost:              ibmvfc host struct
4240  *
4241  * Returns:
4242  *      1 if work to do / 0 if not
4243  **/
4244 static int ibmvfc_work_to_do(struct ibmvfc_host *vhost)
4245 {
4246         unsigned long flags;
4247         int rc;
4248
4249         spin_lock_irqsave(vhost->host->host_lock, flags);
4250         rc = __ibmvfc_work_to_do(vhost);
4251         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4252         return rc;
4253 }
4254
4255 /**
4256  * ibmvfc_log_ae - Log async events if necessary
4257  * @vhost:              ibmvfc host struct
4258  * @events:             events to log
4259  *
4260  **/
4261 static void ibmvfc_log_ae(struct ibmvfc_host *vhost, int events)
4262 {
4263         if (events & IBMVFC_AE_RSCN)
4264                 fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_RSCN, 0);
4265         if ((events & IBMVFC_AE_LINKDOWN) &&
4266             vhost->state >= IBMVFC_HALTED)
4267                 fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_LINKDOWN, 0);
4268         if ((events & IBMVFC_AE_LINKUP) &&
4269             vhost->state == IBMVFC_INITIALIZING)
4270                 fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_LINKUP, 0);
4271 }
4272
4273 /**
4274  * ibmvfc_tgt_add_rport - Tell the FC transport about a new remote port
4275  * @tgt:                ibmvfc target struct
4276  *
4277  **/
4278 static void ibmvfc_tgt_add_rport(struct ibmvfc_target *tgt)
4279 {
4280         struct ibmvfc_host *vhost = tgt->vhost;
4281         struct fc_rport *rport;
4282         unsigned long flags;
4283
4284         tgt_dbg(tgt, "Adding rport\n");
4285         rport = fc_remote_port_add(vhost->host, 0, &tgt->ids);
4286         spin_lock_irqsave(vhost->host->host_lock, flags);
4287
4288         if (rport && tgt->action == IBMVFC_TGT_ACTION_DEL_RPORT) {
4289                 tgt_dbg(tgt, "Deleting rport\n");
4290                 list_del(&tgt->queue);
4291                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DELETED_RPORT);
4292                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
4293                 fc_remote_port_delete(rport);
4294                 del_timer_sync(&tgt->timer);
4295                 kref_put(&tgt->kref, ibmvfc_release_tgt);
4296                 return;
4297         } else if (rport && tgt->action == IBMVFC_TGT_ACTION_DELETED_RPORT) {
4298                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
4299                 return;
4300         }
4301
4302         if (rport) {
4303                 tgt_dbg(tgt, "rport add succeeded\n");
4304                 tgt->rport = rport;
4305                 rport->maxframe_size = be16_to_cpu(tgt->service_parms.common.bb_rcv_sz) & 0x0fff;
4306                 rport->supported_classes = 0;
4307                 tgt->target_id = rport->scsi_target_id;
4308                 if (be32_to_cpu(tgt->service_parms.class1_parms[0]) & 0x80000000)
4309                         rport->supported_classes |= FC_COS_CLASS1;
4310                 if (be32_to_cpu(tgt->service_parms.class2_parms[0]) & 0x80000000)
4311                         rport->supported_classes |= FC_COS_CLASS2;
4312                 if (be32_to_cpu(tgt->service_parms.class3_parms[0]) & 0x80000000)
4313                         rport->supported_classes |= FC_COS_CLASS3;
4314                 if (rport->rqst_q)
4315                         blk_queue_max_segments(rport->rqst_q, 1);
4316         } else
4317                 tgt_dbg(tgt, "rport add failed\n");
4318         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4319 }
4320
4321 /**
4322  * ibmvfc_do_work - Do task level work
4323  * @vhost:              ibmvfc host struct
4324  *
4325  **/
4326 static void ibmvfc_do_work(struct ibmvfc_host *vhost)
4327 {
4328         struct ibmvfc_target *tgt;
4329         unsigned long flags;
4330         struct fc_rport *rport;
4331         int rc;
4332
4333         ibmvfc_log_ae(vhost, vhost->events_to_log);
4334         spin_lock_irqsave(vhost->host->host_lock, flags);
4335         vhost->events_to_log = 0;
4336         switch (vhost->action) {
4337         case IBMVFC_HOST_ACTION_NONE:
4338         case IBMVFC_HOST_ACTION_LOGO_WAIT:
4339         case IBMVFC_HOST_ACTION_INIT_WAIT:
4340                 break;
4341         case IBMVFC_HOST_ACTION_RESET:
4342                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
4343                 rc = ibmvfc_reset_crq(vhost);
4344
4345                 spin_lock_irqsave(vhost->host->host_lock, flags);
4346                 if (!rc || rc == H_CLOSED)
4347                         vio_enable_interrupts(to_vio_dev(vhost->dev));
4348                 if (vhost->action == IBMVFC_HOST_ACTION_RESET) {
4349                         /*
4350                          * The only action we could have changed to would have
4351                          * been reenable, in which case, we skip the rest of
4352                          * this path and wait until we've done the re-enable
4353                          * before sending the crq init.
4354                          */
4355                         vhost->action = IBMVFC_HOST_ACTION_TGT_DEL;
4356
4357                         if (rc || (rc = ibmvfc_send_crq_init(vhost)) ||
4358                             (rc = vio_enable_interrupts(to_vio_dev(vhost->dev)))) {
4359                                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4360                                 dev_err(vhost->dev, "Error after reset (rc=%d)\n", rc);
4361                         }
4362                 }
4363                 break;
4364         case IBMVFC_HOST_ACTION_REENABLE:
4365                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
4366                 rc = ibmvfc_reenable_crq_queue(vhost);
4367
4368                 spin_lock_irqsave(vhost->host->host_lock, flags);
4369                 if (vhost->action == IBMVFC_HOST_ACTION_REENABLE) {
4370                         /*
4371                          * The only action we could have changed to would have
4372                          * been reset, in which case, we skip the rest of this
4373                          * path and wait until we've done the reset before
4374                          * sending the crq init.
4375                          */
4376                         vhost->action = IBMVFC_HOST_ACTION_TGT_DEL;
4377                         if (rc || (rc = ibmvfc_send_crq_init(vhost))) {
4378                                 ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4379                                 dev_err(vhost->dev, "Error after enable (rc=%d)\n", rc);
4380                         }
4381                 }
4382                 break;
4383         case IBMVFC_HOST_ACTION_LOGO:
4384                 vhost->job_step(vhost);
4385                 break;
4386         case IBMVFC_HOST_ACTION_INIT:
4387                 BUG_ON(vhost->state != IBMVFC_INITIALIZING);
4388                 if (vhost->delay_init) {
4389                         vhost->delay_init = 0;
4390                         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4391                         ssleep(15);
4392                         return;
4393                 } else
4394                         vhost->job_step(vhost);
4395                 break;
4396         case IBMVFC_HOST_ACTION_QUERY:
4397                 list_for_each_entry(tgt, &vhost->targets, queue)
4398                         ibmvfc_init_tgt(tgt, ibmvfc_tgt_query_target);
4399                 ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY_TGTS);
4400                 break;
4401         case IBMVFC_HOST_ACTION_QUERY_TGTS:
4402                 list_for_each_entry(tgt, &vhost->targets, queue) {
4403                         if (tgt->action == IBMVFC_TGT_ACTION_INIT) {
4404                                 tgt->job_step(tgt);
4405                                 break;
4406                         }
4407                 }
4408
4409                 if (!ibmvfc_dev_init_to_do(vhost))
4410                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL);
4411                 break;
4412         case IBMVFC_HOST_ACTION_TGT_DEL:
4413         case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
4414                 list_for_each_entry(tgt, &vhost->targets, queue) {
4415                         if (tgt->action == IBMVFC_TGT_ACTION_DEL_RPORT) {
4416                                 tgt_dbg(tgt, "Deleting rport\n");
4417                                 rport = tgt->rport;
4418                                 tgt->rport = NULL;
4419                                 list_del(&tgt->queue);
4420                                 ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DELETED_RPORT);
4421                                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
4422                                 if (rport)
4423                                         fc_remote_port_delete(rport);
4424                                 del_timer_sync(&tgt->timer);
4425                                 kref_put(&tgt->kref, ibmvfc_release_tgt);
4426                                 return;
4427                         }
4428                 }
4429
4430                 if (vhost->state == IBMVFC_INITIALIZING) {
4431                         if (vhost->action == IBMVFC_HOST_ACTION_TGT_DEL_FAILED) {
4432                                 if (vhost->reinit) {
4433                                         vhost->reinit = 0;
4434                                         scsi_block_requests(vhost->host);
4435                                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
4436                                         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4437                                 } else {
4438                                         ibmvfc_set_host_state(vhost, IBMVFC_ACTIVE);
4439                                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
4440                                         wake_up(&vhost->init_wait_q);
4441                                         schedule_work(&vhost->rport_add_work_q);
4442                                         vhost->init_retries = 0;
4443                                         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4444                                         scsi_unblock_requests(vhost->host);
4445                                 }
4446
4447                                 return;
4448                         } else {
4449                                 ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
4450                                 vhost->job_step = ibmvfc_discover_targets;
4451                         }
4452                 } else {
4453                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
4454                         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4455                         scsi_unblock_requests(vhost->host);
4456                         wake_up(&vhost->init_wait_q);
4457                         return;
4458                 }
4459                 break;
4460         case IBMVFC_HOST_ACTION_ALLOC_TGTS:
4461                 ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_INIT);
4462                 spin_unlock_irqrestore(vhost->host->host_lock, flags);
4463                 ibmvfc_alloc_targets(vhost);
4464                 spin_lock_irqsave(vhost->host->host_lock, flags);
4465                 break;
4466         case IBMVFC_HOST_ACTION_TGT_INIT:
4467                 list_for_each_entry(tgt, &vhost->targets, queue) {
4468                         if (tgt->action == IBMVFC_TGT_ACTION_INIT) {
4469                                 tgt->job_step(tgt);
4470                                 break;
4471                         }
4472                 }
4473
4474                 if (!ibmvfc_dev_init_to_do(vhost))
4475                         ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL_FAILED);
4476                 break;
4477         default:
4478                 break;
4479         }
4480
4481         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4482 }
4483
4484 /**
4485  * ibmvfc_work - Do task level work
4486  * @data:               ibmvfc host struct
4487  *
4488  * Returns:
4489  *      zero
4490  **/
4491 static int ibmvfc_work(void *data)
4492 {
4493         struct ibmvfc_host *vhost = data;
4494         int rc;
4495
4496         set_user_nice(current, MIN_NICE);
4497
4498         while (1) {
4499                 rc = wait_event_interruptible(vhost->work_wait_q,
4500                                               ibmvfc_work_to_do(vhost));
4501
4502                 BUG_ON(rc);
4503
4504                 if (kthread_should_stop())
4505                         break;
4506
4507                 ibmvfc_do_work(vhost);
4508         }
4509
4510         ibmvfc_dbg(vhost, "ibmvfc kthread exiting...\n");
4511         return 0;
4512 }
4513
4514 /**
4515  * ibmvfc_init_crq - Initializes and registers CRQ with hypervisor
4516  * @vhost:      ibmvfc host struct
4517  *
4518  * Allocates a page for messages, maps it for dma, and registers
4519  * the crq with the hypervisor.
4520  *
4521  * Return value:
4522  *      zero on success / other on failure
4523  **/
4524 static int ibmvfc_init_crq(struct ibmvfc_host *vhost)
4525 {
4526         int rc, retrc = -ENOMEM;
4527         struct device *dev = vhost->dev;
4528         struct vio_dev *vdev = to_vio_dev(dev);
4529         struct ibmvfc_crq_queue *crq = &vhost->crq;
4530
4531         ENTER;
4532         crq->msgs = (struct ibmvfc_crq *)get_zeroed_page(GFP_KERNEL);
4533
4534         if (!crq->msgs)
4535                 return -ENOMEM;
4536
4537         crq->size = PAGE_SIZE / sizeof(*crq->msgs);
4538         crq->msg_token = dma_map_single(dev, crq->msgs,
4539                                         PAGE_SIZE, DMA_BIDIRECTIONAL);
4540
4541         if (dma_mapping_error(dev, crq->msg_token))
4542                 goto map_failed;
4543
4544         retrc = rc = plpar_hcall_norets(H_REG_CRQ, vdev->unit_address,
4545                                         crq->msg_token, PAGE_SIZE);
4546
4547         if (rc == H_RESOURCE)
4548                 /* maybe kexecing and resource is busy. try a reset */
4549                 retrc = rc = ibmvfc_reset_crq(vhost);
4550
4551         if (rc == H_CLOSED)
4552                 dev_warn(dev, "Partner adapter not ready\n");
4553         else if (rc) {
4554                 dev_warn(dev, "Error %d opening adapter\n", rc);
4555                 goto reg_crq_failed;
4556         }
4557
4558         retrc = 0;
4559
4560         tasklet_init(&vhost->tasklet, (void *)ibmvfc_tasklet, (unsigned long)vhost);
4561
4562         if ((rc = request_irq(vdev->irq, ibmvfc_interrupt, 0, IBMVFC_NAME, vhost))) {
4563                 dev_err(dev, "Couldn't register irq 0x%x. rc=%d\n", vdev->irq, rc);
4564                 goto req_irq_failed;
4565         }
4566
4567         if ((rc = vio_enable_interrupts(vdev))) {
4568                 dev_err(dev, "Error %d enabling interrupts\n", rc);
4569                 goto req_irq_failed;
4570         }
4571
4572         crq->cur = 0;
4573         LEAVE;
4574         return retrc;
4575
4576 req_irq_failed:
4577         tasklet_kill(&vhost->tasklet);
4578         do {
4579                 rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
4580         } while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
4581 reg_crq_failed:
4582         dma_unmap_single(dev, crq->msg_token, PAGE_SIZE, DMA_BIDIRECTIONAL);
4583 map_failed:
4584         free_page((unsigned long)crq->msgs);
4585         return retrc;
4586 }
4587
4588 /**
4589  * ibmvfc_free_mem - Free memory for vhost
4590  * @vhost:      ibmvfc host struct
4591  *
4592  * Return value:
4593  *      none
4594  **/
4595 static void ibmvfc_free_mem(struct ibmvfc_host *vhost)
4596 {
4597         struct ibmvfc_async_crq_queue *async_q = &vhost->async_crq;
4598
4599         ENTER;
4600         mempool_destroy(vhost->tgt_pool);
4601         kfree(vhost->trace);
4602         dma_free_coherent(vhost->dev, vhost->disc_buf_sz, vhost->disc_buf,
4603                           vhost->disc_buf_dma);
4604         dma_free_coherent(vhost->dev, sizeof(*vhost->login_buf),
4605                           vhost->login_buf, vhost->login_buf_dma);
4606         dma_pool_destroy(vhost->sg_pool);
4607         dma_unmap_single(vhost->dev, async_q->msg_token,
4608                          async_q->size * sizeof(*async_q->msgs), DMA_BIDIRECTIONAL);
4609         free_page((unsigned long)async_q->msgs);
4610         LEAVE;
4611 }
4612
4613 /**
4614  * ibmvfc_alloc_mem - Allocate memory for vhost
4615  * @vhost:      ibmvfc host struct
4616  *
4617  * Return value:
4618  *      0 on success / non-zero on failure
4619  **/
4620 static int ibmvfc_alloc_mem(struct ibmvfc_host *vhost)
4621 {
4622         struct ibmvfc_async_crq_queue *async_q = &vhost->async_crq;
4623         struct device *dev = vhost->dev;
4624
4625         ENTER;
4626         async_q->msgs = (struct ibmvfc_async_crq *)get_zeroed_page(GFP_KERNEL);
4627         if (!async_q->msgs) {
4628                 dev_err(dev, "Couldn't allocate async queue.\n");
4629                 goto nomem;
4630         }
4631
4632         async_q->size = PAGE_SIZE / sizeof(struct ibmvfc_async_crq);
4633         async_q->msg_token = dma_map_single(dev, async_q->msgs,
4634                                             async_q->size * sizeof(*async_q->msgs),
4635                                             DMA_BIDIRECTIONAL);
4636
4637         if (dma_mapping_error(dev, async_q->msg_token)) {
4638                 dev_err(dev, "Failed to map async queue\n");
4639                 goto free_async_crq;
4640         }
4641
4642         vhost->sg_pool = dma_pool_create(IBMVFC_NAME, dev,
4643                                          SG_ALL * sizeof(struct srp_direct_buf),
4644                                          sizeof(struct srp_direct_buf), 0);
4645
4646         if (!vhost->sg_pool) {
4647                 dev_err(dev, "Failed to allocate sg pool\n");
4648                 goto unmap_async_crq;
4649         }
4650
4651         vhost->login_buf = dma_alloc_coherent(dev, sizeof(*vhost->login_buf),
4652                                               &vhost->login_buf_dma, GFP_KERNEL);
4653
4654         if (!vhost->login_buf) {
4655                 dev_err(dev, "Couldn't allocate NPIV login buffer\n");
4656                 goto free_sg_pool;
4657         }
4658
4659         vhost->disc_buf_sz = sizeof(vhost->disc_buf->scsi_id[0]) * max_targets;
4660         vhost->disc_buf = dma_alloc_coherent(dev, vhost->disc_buf_sz,
4661                                              &vhost->disc_buf_dma, GFP_KERNEL);
4662
4663         if (!vhost->disc_buf) {
4664                 dev_err(dev, "Couldn't allocate Discover Targets buffer\n");
4665                 goto free_login_buffer;
4666         }
4667
4668         vhost->trace = kcalloc(IBMVFC_NUM_TRACE_ENTRIES,
4669                                sizeof(struct ibmvfc_trace_entry), GFP_KERNEL);
4670
4671         if (!vhost->trace)
4672                 goto free_disc_buffer;
4673
4674         vhost->tgt_pool = mempool_create_kmalloc_pool(IBMVFC_TGT_MEMPOOL_SZ,
4675                                                       sizeof(struct ibmvfc_target));
4676
4677         if (!vhost->tgt_pool) {
4678                 dev_err(dev, "Couldn't allocate target memory pool\n");
4679                 goto free_trace;
4680         }
4681
4682         LEAVE;
4683         return 0;
4684
4685 free_trace:
4686         kfree(vhost->trace);
4687 free_disc_buffer:
4688         dma_free_coherent(dev, vhost->disc_buf_sz, vhost->disc_buf,
4689                           vhost->disc_buf_dma);
4690 free_login_buffer:
4691         dma_free_coherent(dev, sizeof(*vhost->login_buf),
4692                           vhost->login_buf, vhost->login_buf_dma);
4693 free_sg_pool:
4694         dma_pool_destroy(vhost->sg_pool);
4695 unmap_async_crq:
4696         dma_unmap_single(dev, async_q->msg_token,
4697                          async_q->size * sizeof(*async_q->msgs), DMA_BIDIRECTIONAL);
4698 free_async_crq:
4699         free_page((unsigned long)async_q->msgs);
4700 nomem:
4701         LEAVE;
4702         return -ENOMEM;
4703 }
4704
4705 /**
4706  * ibmvfc_rport_add_thread - Worker thread for rport adds
4707  * @work:       work struct
4708  *
4709  **/
4710 static void ibmvfc_rport_add_thread(struct work_struct *work)
4711 {
4712         struct ibmvfc_host *vhost = container_of(work, struct ibmvfc_host,
4713                                                  rport_add_work_q);
4714         struct ibmvfc_target *tgt;
4715         struct fc_rport *rport;
4716         unsigned long flags;
4717         int did_work;
4718
4719         ENTER;
4720         spin_lock_irqsave(vhost->host->host_lock, flags);
4721         do {
4722                 did_work = 0;
4723                 if (vhost->state != IBMVFC_ACTIVE)
4724                         break;
4725
4726                 list_for_each_entry(tgt, &vhost->targets, queue) {
4727                         if (tgt->add_rport) {
4728                                 did_work = 1;
4729                                 tgt->add_rport = 0;
4730                                 kref_get(&tgt->kref);
4731                                 rport = tgt->rport;
4732                                 if (!rport) {
4733                                         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4734                                         ibmvfc_tgt_add_rport(tgt);
4735                                 } else if (get_device(&rport->dev)) {
4736                                         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4737                                         tgt_dbg(tgt, "Setting rport roles\n");
4738                                         fc_remote_port_rolechg(rport, tgt->ids.roles);
4739                                         put_device(&rport->dev);
4740                                 } else {
4741                                         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4742                                 }
4743
4744                                 kref_put(&tgt->kref, ibmvfc_release_tgt);
4745                                 spin_lock_irqsave(vhost->host->host_lock, flags);
4746                                 break;
4747                         }
4748                 }
4749         } while(did_work);
4750
4751         if (vhost->state == IBMVFC_ACTIVE)
4752                 vhost->scan_complete = 1;
4753         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4754         LEAVE;
4755 }
4756
4757 /**
4758  * ibmvfc_probe - Adapter hot plug add entry point
4759  * @vdev:       vio device struct
4760  * @id: vio device id struct
4761  *
4762  * Return value:
4763  *      0 on success / non-zero on failure
4764  **/
4765 static int ibmvfc_probe(struct vio_dev *vdev, const struct vio_device_id *id)
4766 {
4767         struct ibmvfc_host *vhost;
4768         struct Scsi_Host *shost;
4769         struct device *dev = &vdev->dev;
4770         int rc = -ENOMEM;
4771
4772         ENTER;
4773         shost = scsi_host_alloc(&driver_template, sizeof(*vhost));
4774         if (!shost) {
4775                 dev_err(dev, "Couldn't allocate host data\n");
4776                 goto out;
4777         }
4778
4779         shost->transportt = ibmvfc_transport_template;
4780         shost->can_queue = max_requests;
4781         shost->max_lun = max_lun;
4782         shost->max_id = max_targets;
4783         shost->max_sectors = IBMVFC_MAX_SECTORS;
4784         shost->max_cmd_len = IBMVFC_MAX_CDB_LEN;
4785         shost->unique_id = shost->host_no;
4786
4787         vhost = shost_priv(shost);
4788         INIT_LIST_HEAD(&vhost->sent);
4789         INIT_LIST_HEAD(&vhost->free);
4790         INIT_LIST_HEAD(&vhost->targets);
4791         sprintf(vhost->name, IBMVFC_NAME);
4792         vhost->host = shost;
4793         vhost->dev = dev;
4794         vhost->partition_number = -1;
4795         vhost->log_level = log_level;
4796         vhost->task_set = 1;
4797         strcpy(vhost->partition_name, "UNKNOWN");
4798         init_waitqueue_head(&vhost->work_wait_q);
4799         init_waitqueue_head(&vhost->init_wait_q);
4800         INIT_WORK(&vhost->rport_add_work_q, ibmvfc_rport_add_thread);
4801         mutex_init(&vhost->passthru_mutex);
4802
4803         if ((rc = ibmvfc_alloc_mem(vhost)))
4804                 goto free_scsi_host;
4805
4806         vhost->work_thread = kthread_run(ibmvfc_work, vhost, "%s_%d", IBMVFC_NAME,
4807                                          shost->host_no);
4808
4809         if (IS_ERR(vhost->work_thread)) {
4810                 dev_err(dev, "Couldn't create kernel thread: %ld\n",
4811                         PTR_ERR(vhost->work_thread));
4812                 rc = PTR_ERR(vhost->work_thread);
4813                 goto free_host_mem;
4814         }
4815
4816         if ((rc = ibmvfc_init_crq(vhost))) {
4817                 dev_err(dev, "Couldn't initialize crq. rc=%d\n", rc);
4818                 goto kill_kthread;
4819         }
4820
4821         if ((rc = ibmvfc_init_event_pool(vhost))) {
4822                 dev_err(dev, "Couldn't initialize event pool. rc=%d\n", rc);
4823                 goto release_crq;
4824         }
4825
4826         if ((rc = scsi_add_host(shost, dev)))
4827                 goto release_event_pool;
4828
4829         fc_host_dev_loss_tmo(shost) = IBMVFC_DEV_LOSS_TMO;
4830
4831         if ((rc = ibmvfc_create_trace_file(&shost->shost_dev.kobj,
4832                                            &ibmvfc_trace_attr))) {
4833                 dev_err(dev, "Failed to create trace file. rc=%d\n", rc);
4834                 goto remove_shost;
4835         }
4836
4837         if (shost_to_fc_host(shost)->rqst_q)
4838                 blk_queue_max_segments(shost_to_fc_host(shost)->rqst_q, 1);
4839         dev_set_drvdata(dev, vhost);
4840         spin_lock(&ibmvfc_driver_lock);
4841         list_add_tail(&vhost->queue, &ibmvfc_head);
4842         spin_unlock(&ibmvfc_driver_lock);
4843
4844         ibmvfc_send_crq_init(vhost);
4845         scsi_scan_host(shost);
4846         return 0;
4847
4848 remove_shost:
4849         scsi_remove_host(shost);
4850 release_event_pool:
4851         ibmvfc_free_event_pool(vhost);
4852 release_crq:
4853         ibmvfc_release_crq_queue(vhost);
4854 kill_kthread:
4855         kthread_stop(vhost->work_thread);
4856 free_host_mem:
4857         ibmvfc_free_mem(vhost);
4858 free_scsi_host:
4859         scsi_host_put(shost);
4860 out:
4861         LEAVE;
4862         return rc;
4863 }
4864
4865 /**
4866  * ibmvfc_remove - Adapter hot plug remove entry point
4867  * @vdev:       vio device struct
4868  *
4869  * Return value:
4870  *      0
4871  **/
4872 static int ibmvfc_remove(struct vio_dev *vdev)
4873 {
4874         struct ibmvfc_host *vhost = dev_get_drvdata(&vdev->dev);
4875         unsigned long flags;
4876
4877         ENTER;
4878         ibmvfc_remove_trace_file(&vhost->host->shost_dev.kobj, &ibmvfc_trace_attr);
4879
4880         spin_lock_irqsave(vhost->host->host_lock, flags);
4881         ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
4882         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4883
4884         ibmvfc_wait_while_resetting(vhost);
4885         ibmvfc_release_crq_queue(vhost);
4886         kthread_stop(vhost->work_thread);
4887         fc_remove_host(vhost->host);
4888         scsi_remove_host(vhost->host);
4889
4890         spin_lock_irqsave(vhost->host->host_lock, flags);
4891         ibmvfc_purge_requests(vhost, DID_ERROR);
4892         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4893         ibmvfc_free_event_pool(vhost);
4894
4895         ibmvfc_free_mem(vhost);
4896         spin_lock(&ibmvfc_driver_lock);
4897         list_del(&vhost->queue);
4898         spin_unlock(&ibmvfc_driver_lock);
4899         scsi_host_put(vhost->host);
4900         LEAVE;
4901         return 0;
4902 }
4903
4904 /**
4905  * ibmvfc_resume - Resume from suspend
4906  * @dev:        device struct
4907  *
4908  * We may have lost an interrupt across suspend/resume, so kick the
4909  * interrupt handler
4910  *
4911  */
4912 static int ibmvfc_resume(struct device *dev)
4913 {
4914         unsigned long flags;
4915         struct ibmvfc_host *vhost = dev_get_drvdata(dev);
4916         struct vio_dev *vdev = to_vio_dev(dev);
4917
4918         spin_lock_irqsave(vhost->host->host_lock, flags);
4919         vio_disable_interrupts(vdev);
4920         tasklet_schedule(&vhost->tasklet);
4921         spin_unlock_irqrestore(vhost->host->host_lock, flags);
4922         return 0;
4923 }
4924
4925 /**
4926  * ibmvfc_get_desired_dma - Calculate DMA resources needed by the driver
4927  * @vdev:       vio device struct
4928  *
4929  * Return value:
4930  *      Number of bytes the driver will need to DMA map at the same time in
4931  *      order to perform well.
4932  */
4933 static unsigned long ibmvfc_get_desired_dma(struct vio_dev *vdev)
4934 {
4935         unsigned long pool_dma = max_requests * sizeof(union ibmvfc_iu);
4936         return pool_dma + ((512 * 1024) * driver_template.cmd_per_lun);
4937 }
4938
4939 static const struct vio_device_id ibmvfc_device_table[] = {
4940         {"fcp", "IBM,vfc-client"},
4941         { "", "" }
4942 };
4943 MODULE_DEVICE_TABLE(vio, ibmvfc_device_table);
4944
4945 static const struct dev_pm_ops ibmvfc_pm_ops = {
4946         .resume = ibmvfc_resume
4947 };
4948
4949 static struct vio_driver ibmvfc_driver = {
4950         .id_table = ibmvfc_device_table,
4951         .probe = ibmvfc_probe,
4952         .remove = ibmvfc_remove,
4953         .get_desired_dma = ibmvfc_get_desired_dma,
4954         .name = IBMVFC_NAME,
4955         .pm = &ibmvfc_pm_ops,
4956 };
4957
4958 static struct fc_function_template ibmvfc_transport_functions = {
4959         .show_host_fabric_name = 1,
4960         .show_host_node_name = 1,
4961         .show_host_port_name = 1,
4962         .show_host_supported_classes = 1,
4963         .show_host_port_type = 1,
4964         .show_host_port_id = 1,
4965         .show_host_maxframe_size = 1,
4966
4967         .get_host_port_state = ibmvfc_get_host_port_state,
4968         .show_host_port_state = 1,
4969
4970         .get_host_speed = ibmvfc_get_host_speed,
4971         .show_host_speed = 1,
4972
4973         .issue_fc_host_lip = ibmvfc_issue_fc_host_lip,
4974         .terminate_rport_io = ibmvfc_terminate_rport_io,
4975
4976         .show_rport_maxframe_size = 1,
4977         .show_rport_supported_classes = 1,
4978
4979         .set_rport_dev_loss_tmo = ibmvfc_set_rport_dev_loss_tmo,
4980         .show_rport_dev_loss_tmo = 1,
4981
4982         .get_starget_node_name = ibmvfc_get_starget_node_name,
4983         .show_starget_node_name = 1,
4984
4985         .get_starget_port_name = ibmvfc_get_starget_port_name,
4986         .show_starget_port_name = 1,
4987
4988         .get_starget_port_id = ibmvfc_get_starget_port_id,
4989         .show_starget_port_id = 1,
4990
4991         .bsg_request = ibmvfc_bsg_request,
4992         .bsg_timeout = ibmvfc_bsg_timeout,
4993 };
4994
4995 /**
4996  * ibmvfc_module_init - Initialize the ibmvfc module
4997  *
4998  * Return value:
4999  *      0 on success / other on failure
5000  **/
5001 static int __init ibmvfc_module_init(void)
5002 {
5003         int rc;
5004
5005         if (!firmware_has_feature(FW_FEATURE_VIO))
5006                 return -ENODEV;
5007
5008         printk(KERN_INFO IBMVFC_NAME": IBM Virtual Fibre Channel Driver version: %s %s\n",
5009                IBMVFC_DRIVER_VERSION, IBMVFC_DRIVER_DATE);
5010
5011         ibmvfc_transport_template = fc_attach_transport(&ibmvfc_transport_functions);
5012         if (!ibmvfc_transport_template)
5013                 return -ENOMEM;
5014
5015         rc = vio_register_driver(&ibmvfc_driver);
5016         if (rc)
5017                 fc_release_transport(ibmvfc_transport_template);
5018         return rc;
5019 }
5020
5021 /**
5022  * ibmvfc_module_exit - Teardown the ibmvfc module
5023  *
5024  * Return value:
5025  *      nothing
5026  **/
5027 static void __exit ibmvfc_module_exit(void)
5028 {
5029         vio_unregister_driver(&ibmvfc_driver);
5030         fc_release_transport(ibmvfc_transport_template);
5031 }
5032
5033 module_init(ibmvfc_module_init);
5034 module_exit(ibmvfc_module_exit);