drivers/scsi/ibmvscsi/ibmvfc.c

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