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