release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/s390/scsi/zfcp_fc.c

   1 /*
   2  * zfcp device driver
   3  *
   4  * Fibre Channel related functions for the zfcp device driver.
   5  *
   6  * Copyright IBM Corporation 2008, 2010
   7  */
   8
   9 #define KMSG_COMPONENT "zfcp"
  10 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
  11
  12 #include <linux/types.h>
  13 #include <linux/slab.h>
  14 #include <scsi/fc/fc_els.h>
  15 #include <scsi/libfc.h>
  16 #include "zfcp_ext.h"
  17 #include "zfcp_fc.h"
  18
  19 static u32 zfcp_fc_rscn_range_mask[] = {
  20         [ELS_ADDR_FMT_PORT]             = 0xFFFFFF,
  21         [ELS_ADDR_FMT_AREA]             = 0xFFFF00,
  22         [ELS_ADDR_FMT_DOM]              = 0xFF0000,
  23         [ELS_ADDR_FMT_FAB]              = 0x000000,
  24 };
  25
  26 /**
  27  * zfcp_fc_post_event - post event to userspace via fc_transport
  28  * @work: work struct with enqueued events
  29  */
  30 void zfcp_fc_post_event(struct work_struct *work)
  31 {
  32         struct zfcp_fc_event *event = NULL, *tmp = NULL;
  33         LIST_HEAD(tmp_lh);
  34         struct zfcp_fc_events *events = container_of(work,
  35                                         struct zfcp_fc_events, work);
  36         struct zfcp_adapter *adapter = container_of(events, struct zfcp_adapter,
  37                                                 events);
  38
  39         spin_lock_bh(&events->list_lock);
  40         list_splice_init(&events->list, &tmp_lh);
  41         spin_unlock_bh(&events->list_lock);
  42
  43         list_for_each_entry_safe(event, tmp, &tmp_lh, list) {
  44                 fc_host_post_event(adapter->scsi_host, fc_get_event_number(),
  45                                 event->code, event->data);
  46                 list_del(&event->list);
  47                 kfree(event);
  48         }
  49
  50 }
  51
  52 /**
  53  * zfcp_fc_enqueue_event - safely enqueue FC HBA API event from irq context
  54  * @adapter: The adapter where to enqueue the event
  55  * @event_code: The event code (as defined in fc_host_event_code in
  56  *              scsi_transport_fc.h)
  57  * @event_data: The event data (e.g. n_port page in case of els)
  58  */
  59 void zfcp_fc_enqueue_event(struct zfcp_adapter *adapter,
  60                         enum fc_host_event_code event_code, u32 event_data)
  61 {
  62         struct zfcp_fc_event *event;
  63
  64         event = kmalloc(sizeof(struct zfcp_fc_event), GFP_ATOMIC);
  65         if (!event)
  66                 return;
  67
  68         event->code = event_code;
  69         event->data = event_data;
  70
  71         spin_lock(&adapter->events.list_lock);
  72         list_add_tail(&event->list, &adapter->events.list);
  73         spin_unlock(&adapter->events.list_lock);
  74
  75         queue_work(adapter->work_queue, &adapter->events.work);
  76 }
  77
  78 static int zfcp_fc_wka_port_get(struct zfcp_fc_wka_port *wka_port)
  79 {
  80         if (mutex_lock_interruptible(&wka_port->mutex))
  81                 return -ERESTARTSYS;
  82
  83         if (wka_port->status == ZFCP_FC_WKA_PORT_OFFLINE ||
  84             wka_port->status == ZFCP_FC_WKA_PORT_CLOSING) {
  85                 wka_port->status = ZFCP_FC_WKA_PORT_OPENING;
  86                 if (zfcp_fsf_open_wka_port(wka_port))
  87                         wka_port->status = ZFCP_FC_WKA_PORT_OFFLINE;
  88         }
  89
  90         mutex_unlock(&wka_port->mutex);
  91
  92         wait_event(wka_port->completion_wq,
  93                    wka_port->status == ZFCP_FC_WKA_PORT_ONLINE ||
  94                    wka_port->status == ZFCP_FC_WKA_PORT_OFFLINE);
  95
  96         if (wka_port->status == ZFCP_FC_WKA_PORT_ONLINE) {
  97                 atomic_inc(&wka_port->refcount);
  98                 return 0;
  99         }
 100         return -EIO;
 101 }
 102
 103 static void zfcp_fc_wka_port_offline(struct work_struct *work)
 104 {
 105         struct delayed_work *dw = to_delayed_work(work);
 106         struct zfcp_fc_wka_port *wka_port =
 107                         container_of(dw, struct zfcp_fc_wka_port, work);
 108
 109         mutex_lock(&wka_port->mutex);
 110         if ((atomic_read(&wka_port->refcount) != 0) ||
 111             (wka_port->status != ZFCP_FC_WKA_PORT_ONLINE))
 112                 goto out;
 113
 114         wka_port->status = ZFCP_FC_WKA_PORT_CLOSING;
 115         if (zfcp_fsf_close_wka_port(wka_port)) {
 116                 wka_port->status = ZFCP_FC_WKA_PORT_OFFLINE;
 117                 wake_up(&wka_port->completion_wq);
 118         }
 119 out:
 120         mutex_unlock(&wka_port->mutex);
 121 }
 122
 123 static void zfcp_fc_wka_port_put(struct zfcp_fc_wka_port *wka_port)
 124 {
 125         if (atomic_dec_return(&wka_port->refcount) != 0)
 126                 return;
 127         /* wait 10 milliseconds, other reqs might pop in */
 128         schedule_delayed_work(&wka_port->work, HZ / 100);
 129 }
 130
 131 static void zfcp_fc_wka_port_init(struct zfcp_fc_wka_port *wka_port, u32 d_id,
 132                                   struct zfcp_adapter *adapter)
 133 {
 134         init_waitqueue_head(&wka_port->completion_wq);
 135
 136         wka_port->adapter = adapter;
 137         wka_port->d_id = d_id;
 138
 139         wka_port->status = ZFCP_FC_WKA_PORT_OFFLINE;
 140         atomic_set(&wka_port->refcount, 0);
 141         mutex_init(&wka_port->mutex);
 142         INIT_DELAYED_WORK(&wka_port->work, zfcp_fc_wka_port_offline);
 143 }
 144
 145 static void zfcp_fc_wka_port_force_offline(struct zfcp_fc_wka_port *wka)
 146 {
 147         cancel_delayed_work_sync(&wka->work);
 148         mutex_lock(&wka->mutex);
 149         wka->status = ZFCP_FC_WKA_PORT_OFFLINE;
 150         mutex_unlock(&wka->mutex);
 151 }
 152
 153 void zfcp_fc_wka_ports_force_offline(struct zfcp_fc_wka_ports *gs)
 154 {
 155         if (!gs)
 156                 return;
 157         zfcp_fc_wka_port_force_offline(&gs->ms);
 158         zfcp_fc_wka_port_force_offline(&gs->ts);
 159         zfcp_fc_wka_port_force_offline(&gs->ds);
 160         zfcp_fc_wka_port_force_offline(&gs->as);
 161 }
 162
 163 static void _zfcp_fc_incoming_rscn(struct zfcp_fsf_req *fsf_req, u32 range,
 164                                    struct fc_els_rscn_page *page)
 165 {
 166         unsigned long flags;
 167         struct zfcp_adapter *adapter = fsf_req->adapter;
 168         struct zfcp_port *port;
 169
 170         read_lock_irqsave(&adapter->port_list_lock, flags);
 171         list_for_each_entry(port, &adapter->port_list, list) {
 172                 if ((port->d_id & range) == (ntoh24(page->rscn_fid) & range))
 173                         zfcp_fc_test_link(port);
 174                 if (!port->d_id)
 175                         zfcp_erp_port_reopen(port,
 176                                              ZFCP_STATUS_COMMON_ERP_FAILED,
 177                                              "fcrscn1", NULL);
 178         }
 179         read_unlock_irqrestore(&adapter->port_list_lock, flags);
 180 }
 181
 182 static void zfcp_fc_incoming_rscn(struct zfcp_fsf_req *fsf_req)
 183 {
 184         struct fsf_status_read_buffer *status_buffer = (void *)fsf_req->data;
 185         struct fc_els_rscn *head;
 186         struct fc_els_rscn_page *page;
 187         u16 i;
 188         u16 no_entries;
 189         unsigned int afmt;
 190
 191         head = (struct fc_els_rscn *) status_buffer->payload.data;
 192         page = (struct fc_els_rscn_page *) head;
 193
 194         /* see FC-FS */
 195         no_entries = head->rscn_plen / sizeof(struct fc_els_rscn_page);
 196
 197         for (i = 1; i < no_entries; i++) {
 198                 /* skip head and start with 1st element */
 199                 page++;
 200                 afmt = page->rscn_page_flags & ELS_RSCN_ADDR_FMT_MASK;
 201                 _zfcp_fc_incoming_rscn(fsf_req, zfcp_fc_rscn_range_mask[afmt],
 202                                        page);
 203                 zfcp_fc_enqueue_event(fsf_req->adapter, FCH_EVT_RSCN,
 204                                       *(u32 *)page);
 205         }
 206         queue_work(fsf_req->adapter->work_queue, &fsf_req->adapter->scan_work);
 207 }
 208
 209 static void zfcp_fc_incoming_wwpn(struct zfcp_fsf_req *req, u64 wwpn)
 210 {
 211         unsigned long flags;
 212         struct zfcp_adapter *adapter = req->adapter;
 213         struct zfcp_port *port;
 214
 215         read_lock_irqsave(&adapter->port_list_lock, flags);
 216         list_for_each_entry(port, &adapter->port_list, list)
 217                 if (port->wwpn == wwpn) {
 218                         zfcp_erp_port_forced_reopen(port, 0, "fciwwp1", req);
 219                         break;
 220                 }
 221         read_unlock_irqrestore(&adapter->port_list_lock, flags);
 222 }
 223
 224 static void zfcp_fc_incoming_plogi(struct zfcp_fsf_req *req)
 225 {
 226         struct fsf_status_read_buffer *status_buffer;
 227         struct fc_els_flogi *plogi;
 228
 229         status_buffer = (struct fsf_status_read_buffer *) req->data;
 230         plogi = (struct fc_els_flogi *) status_buffer->payload.data;
 231         zfcp_fc_incoming_wwpn(req, plogi->fl_wwpn);
 232 }
 233
 234 static void zfcp_fc_incoming_logo(struct zfcp_fsf_req *req)
 235 {
 236         struct fsf_status_read_buffer *status_buffer =
 237                 (struct fsf_status_read_buffer *)req->data;
 238         struct fc_els_logo *logo =
 239                 (struct fc_els_logo *) status_buffer->payload.data;
 240
 241         zfcp_fc_incoming_wwpn(req, logo->fl_n_port_wwn);
 242 }
 243
 244 /**
 245  * zfcp_fc_incoming_els - handle incoming ELS
 246  * @fsf_req - request which contains incoming ELS
 247  */
 248 void zfcp_fc_incoming_els(struct zfcp_fsf_req *fsf_req)
 249 {
 250         struct fsf_status_read_buffer *status_buffer =
 251                 (struct fsf_status_read_buffer *) fsf_req->data;
 252         unsigned int els_type = status_buffer->payload.data[0];
 253
 254         zfcp_dbf_san_incoming_els(fsf_req);
 255         if (els_type == ELS_PLOGI)
 256                 zfcp_fc_incoming_plogi(fsf_req);
 257         else if (els_type == ELS_LOGO)
 258                 zfcp_fc_incoming_logo(fsf_req);
 259         else if (els_type == ELS_RSCN)
 260                 zfcp_fc_incoming_rscn(fsf_req);
 261 }
 262
 263 static void zfcp_fc_ns_gid_pn_eval(void *data)
 264 {
 265         struct zfcp_fc_gid_pn *gid_pn = data;
 266         struct zfcp_fsf_ct_els *ct = &gid_pn->ct;
 267         struct zfcp_fc_gid_pn_req *gid_pn_req = sg_virt(ct->req);
 268         struct zfcp_fc_gid_pn_resp *gid_pn_resp = sg_virt(ct->resp);
 269         struct zfcp_port *port = gid_pn->port;
 270
 271         if (ct->status)
 272                 return;
 273         if (gid_pn_resp->ct_hdr.ct_cmd != FC_FS_ACC)
 274                 return;
 275
 276         /* paranoia */
 277         if (gid_pn_req->gid_pn.fn_wwpn != port->wwpn)
 278                 return;
 279         /* looks like a valid d_id */
 280         port->d_id = ntoh24(gid_pn_resp->gid_pn.fp_fid);
 281 }
 282
 283 static void zfcp_fc_complete(void *data)
 284 {
 285         complete(data);
 286 }
 287
 288 static int zfcp_fc_ns_gid_pn_request(struct zfcp_port *port,
 289                                      struct zfcp_fc_gid_pn *gid_pn)
 290 {
 291         struct zfcp_adapter *adapter = port->adapter;
 292         DECLARE_COMPLETION_ONSTACK(completion);
 293         int ret;
 294
 295         /* setup parameters for send generic command */
 296         gid_pn->port = port;
 297         gid_pn->ct.handler = zfcp_fc_complete;
 298         gid_pn->ct.handler_data = &completion;
 299         gid_pn->ct.req = &gid_pn->sg_req;
 300         gid_pn->ct.resp = &gid_pn->sg_resp;
 301         sg_init_one(&gid_pn->sg_req, &gid_pn->gid_pn_req,
 302                     sizeof(struct zfcp_fc_gid_pn_req));
 303         sg_init_one(&gid_pn->sg_resp, &gid_pn->gid_pn_resp,
 304                     sizeof(struct zfcp_fc_gid_pn_resp));
 305
 306         /* setup nameserver request */
 307         gid_pn->gid_pn_req.ct_hdr.ct_rev = FC_CT_REV;
 308         gid_pn->gid_pn_req.ct_hdr.ct_fs_type = FC_FST_DIR;
 309         gid_pn->gid_pn_req.ct_hdr.ct_fs_subtype = FC_NS_SUBTYPE;
 310         gid_pn->gid_pn_req.ct_hdr.ct_options = 0;
 311         gid_pn->gid_pn_req.ct_hdr.ct_cmd = FC_NS_GID_PN;
 312         gid_pn->gid_pn_req.ct_hdr.ct_mr_size = ZFCP_FC_CT_SIZE_PAGE / 4;
 313         gid_pn->gid_pn_req.gid_pn.fn_wwpn = port->wwpn;
 314
 315         ret = zfcp_fsf_send_ct(&adapter->gs->ds, &gid_pn->ct,
 316                                adapter->pool.gid_pn_req,
 317                                ZFCP_FC_CTELS_TMO);
 318         if (!ret) {
 319                 wait_for_completion(&completion);
 320                 zfcp_fc_ns_gid_pn_eval(gid_pn);
 321         }
 322         return ret;
 323 }
 324
 325 /**
 326  * zfcp_fc_ns_gid_pn_request - initiate GID_PN nameserver request
 327  * @port: port where GID_PN request is needed
 328  * return: -ENOMEM on error, 0 otherwise
 329  */
 330 static int zfcp_fc_ns_gid_pn(struct zfcp_port *port)
 331 {
 332         int ret;
 333         struct zfcp_fc_gid_pn *gid_pn;
 334         struct zfcp_adapter *adapter = port->adapter;
 335
 336         gid_pn = mempool_alloc(adapter->pool.gid_pn, GFP_ATOMIC);
 337         if (!gid_pn)
 338                 return -ENOMEM;
 339
 340         memset(gid_pn, 0, sizeof(*gid_pn));
 341
 342         ret = zfcp_fc_wka_port_get(&adapter->gs->ds);
 343         if (ret)
 344                 goto out;
 345
 346         ret = zfcp_fc_ns_gid_pn_request(port, gid_pn);
 347
 348         zfcp_fc_wka_port_put(&adapter->gs->ds);
 349 out:
 350         mempool_free(gid_pn, adapter->pool.gid_pn);
 351         return ret;
 352 }
 353
 354 void zfcp_fc_port_did_lookup(struct work_struct *work)
 355 {
 356         int ret;
 357         struct zfcp_port *port = container_of(work, struct zfcp_port,
 358                                               gid_pn_work);
 359
 360         ret = zfcp_fc_ns_gid_pn(port);
 361         if (ret) {
 362                 /* could not issue gid_pn for some reason */
 363                 zfcp_erp_adapter_reopen(port->adapter, 0, "fcgpn_1", NULL);
 364                 goto out;
 365         }
 366
 367         if (!port->d_id) {
 368                 zfcp_erp_port_failed(port, "fcgpn_2", NULL);
 369                 goto out;
 370         }
 371
 372         zfcp_erp_port_reopen(port, 0, "fcgpn_3", NULL);
 373 out:
 374         put_device(&port->dev);
 375 }
 376
 377 /**
 378  * zfcp_fc_trigger_did_lookup - trigger the d_id lookup using a GID_PN request
 379  * @port: The zfcp_port to lookup the d_id for.
 380  */
 381 void zfcp_fc_trigger_did_lookup(struct zfcp_port *port)
 382 {
 383         get_device(&port->dev);
 384         if (!queue_work(port->adapter->work_queue, &port->gid_pn_work))
 385                 put_device(&port->dev);
 386 }
 387
 388 /**
 389  * zfcp_fc_plogi_evaluate - evaluate PLOGI playload
 390  * @port: zfcp_port structure
 391  * @plogi: plogi payload
 392  *
 393  * Evaluate PLOGI playload and copy important fields into zfcp_port structure
 394  */
 395 void zfcp_fc_plogi_evaluate(struct zfcp_port *port, struct fc_els_flogi *plogi)
 396 {
 397         if (plogi->fl_wwpn != port->wwpn) {
 398                 port->d_id = 0;
 399                 dev_warn(&port->adapter->ccw_device->dev,
 400                          "A port opened with WWPN 0x%016Lx returned data that "
 401                          "identifies it as WWPN 0x%016Lx\n",
 402                          (unsigned long long) port->wwpn,
 403                          (unsigned long long) plogi->fl_wwpn);
 404                 return;
 405         }
 406
 407         port->wwnn = plogi->fl_wwnn;
 408         port->maxframe_size = plogi->fl_csp.sp_bb_data;
 409
 410         if (plogi->fl_cssp[0].cp_class & FC_CPC_VALID)
 411                 port->supported_classes |= FC_COS_CLASS1;
 412         if (plogi->fl_cssp[1].cp_class & FC_CPC_VALID)
 413                 port->supported_classes |= FC_COS_CLASS2;
 414         if (plogi->fl_cssp[2].cp_class & FC_CPC_VALID)
 415                 port->supported_classes |= FC_COS_CLASS3;
 416         if (plogi->fl_cssp[3].cp_class & FC_CPC_VALID)
 417                 port->supported_classes |= FC_COS_CLASS4;
 418 }
 419
 420 static void zfcp_fc_adisc_handler(void *data)
 421 {
 422         struct zfcp_fc_els_adisc *adisc = data;
 423         struct zfcp_port *port = adisc->els.port;
 424         struct fc_els_adisc *adisc_resp = &adisc->adisc_resp;
 425
 426         if (adisc->els.status) {
 427                 /* request rejected or timed out */
 428                 zfcp_erp_port_forced_reopen(port, ZFCP_STATUS_COMMON_ERP_FAILED,
 429                                             "fcadh_1", NULL);
 430                 goto out;
 431         }
 432
 433         if (!port->wwnn)
 434                 port->wwnn = adisc_resp->adisc_wwnn;
 435
 436         if ((port->wwpn != adisc_resp->adisc_wwpn) ||
 437             !(atomic_read(&port->status) & ZFCP_STATUS_COMMON_OPEN)) {
 438                 zfcp_erp_port_reopen(port, ZFCP_STATUS_COMMON_ERP_FAILED,
 439                                      "fcadh_2", NULL);
 440                 goto out;
 441         }
 442
 443         /* port is good, unblock rport without going through erp */
 444         zfcp_scsi_schedule_rport_register(port);
 445  out:
 446         atomic_clear_mask(ZFCP_STATUS_PORT_LINK_TEST, &port->status);
 447         put_device(&port->dev);
 448         kmem_cache_free(zfcp_data.adisc_cache, adisc);
 449 }
 450
 451 static int zfcp_fc_adisc(struct zfcp_port *port)
 452 {
 453         struct zfcp_fc_els_adisc *adisc;
 454         struct zfcp_adapter *adapter = port->adapter;
 455         int ret;
 456
 457         adisc = kmem_cache_zalloc(zfcp_data.adisc_cache, GFP_ATOMIC);
 458         if (!adisc)
 459                 return -ENOMEM;
 460
 461         adisc->els.port = port;
 462         adisc->els.req = &adisc->req;
 463         adisc->els.resp = &adisc->resp;
 464         sg_init_one(adisc->els.req, &adisc->adisc_req,
 465                     sizeof(struct fc_els_adisc));
 466         sg_init_one(adisc->els.resp, &adisc->adisc_resp,
 467                     sizeof(struct fc_els_adisc));
 468
 469         adisc->els.handler = zfcp_fc_adisc_handler;
 470         adisc->els.handler_data = adisc;
 471
 472         /* acc. to FC-FS, hard_nport_id in ADISC should not be set for ports
 473            without FC-AL-2 capability, so we don't set it */
 474         adisc->adisc_req.adisc_wwpn = fc_host_port_name(adapter->scsi_host);
 475         adisc->adisc_req.adisc_wwnn = fc_host_node_name(adapter->scsi_host);
 476         adisc->adisc_req.adisc_cmd = ELS_ADISC;
 477         hton24(adisc->adisc_req.adisc_port_id,
 478                fc_host_port_id(adapter->scsi_host));
 479
 480         ret = zfcp_fsf_send_els(adapter, port->d_id, &adisc->els,
 481                                 ZFCP_FC_CTELS_TMO);
 482         if (ret)
 483                 kmem_cache_free(zfcp_data.adisc_cache, adisc);
 484
 485         return ret;
 486 }
 487
 488 void zfcp_fc_link_test_work(struct work_struct *work)
 489 {
 490         struct zfcp_port *port =
 491                 container_of(work, struct zfcp_port, test_link_work);
 492         int retval;
 493
 494         get_device(&port->dev);
 495         port->rport_task = RPORT_DEL;
 496         zfcp_scsi_rport_work(&port->rport_work);
 497
 498         /* only issue one test command at one time per port */
 499         if (atomic_read(&port->status) & ZFCP_STATUS_PORT_LINK_TEST)
 500                 goto out;
 501
 502         atomic_set_mask(ZFCP_STATUS_PORT_LINK_TEST, &port->status);
 503
 504         retval = zfcp_fc_adisc(port);
 505         if (retval == 0)
 506                 return;
 507
 508         /* send of ADISC was not possible */
 509         atomic_clear_mask(ZFCP_STATUS_PORT_LINK_TEST, &port->status);
 510         zfcp_erp_port_forced_reopen(port, 0, "fcltwk1", NULL);
 511
 512 out:
 513         put_device(&port->dev);
 514 }
 515
 516 /**
 517  * zfcp_fc_test_link - lightweight link test procedure
 518  * @port: port to be tested
 519  *
 520  * Test status of a link to a remote port using the ELS command ADISC.
 521  * If there is a problem with the remote port, error recovery steps
 522  * will be triggered.
 523  */
 524 void zfcp_fc_test_link(struct zfcp_port *port)
 525 {
 526         get_device(&port->dev);
 527         if (!queue_work(port->adapter->work_queue, &port->test_link_work))
 528                 put_device(&port->dev);
 529 }
 530
 531 static void zfcp_free_sg_env(struct zfcp_fc_gpn_ft *gpn_ft, int buf_num)
 532 {
 533         struct scatterlist *sg = &gpn_ft->sg_req;
 534
 535         kmem_cache_free(zfcp_data.gpn_ft_cache, sg_virt(sg));
 536         zfcp_sg_free_table(gpn_ft->sg_resp, buf_num);
 537
 538         kfree(gpn_ft);
 539 }
 540
 541 static struct zfcp_fc_gpn_ft *zfcp_alloc_sg_env(int buf_num)
 542 {
 543         struct zfcp_fc_gpn_ft *gpn_ft;
 544         struct zfcp_fc_gpn_ft_req *req;
 545
 546         gpn_ft = kzalloc(sizeof(*gpn_ft), GFP_KERNEL);
 547         if (!gpn_ft)
 548                 return NULL;
 549
 550         req = kmem_cache_zalloc(zfcp_data.gpn_ft_cache, GFP_KERNEL);
 551         if (!req) {
 552                 kfree(gpn_ft);
 553                 gpn_ft = NULL;
 554                 goto out;
 555         }
 556         sg_init_one(&gpn_ft->sg_req, req, sizeof(*req));
 557
 558         if (zfcp_sg_setup_table(gpn_ft->sg_resp, buf_num)) {
 559                 zfcp_free_sg_env(gpn_ft, buf_num);
 560                 gpn_ft = NULL;
 561         }
 562 out:
 563         return gpn_ft;
 564 }
 565
 566
 567 static int zfcp_fc_send_gpn_ft(struct zfcp_fc_gpn_ft *gpn_ft,
 568                                struct zfcp_adapter *adapter, int max_bytes)
 569 {
 570         struct zfcp_fsf_ct_els *ct = &gpn_ft->ct;
 571         struct zfcp_fc_gpn_ft_req *req = sg_virt(&gpn_ft->sg_req);
 572         DECLARE_COMPLETION_ONSTACK(completion);
 573         int ret;
 574
 575         /* prepare CT IU for GPN_FT */
 576         req->ct_hdr.ct_rev = FC_CT_REV;
 577         req->ct_hdr.ct_fs_type = FC_FST_DIR;
 578         req->ct_hdr.ct_fs_subtype = FC_NS_SUBTYPE;
 579         req->ct_hdr.ct_options = 0;
 580         req->ct_hdr.ct_cmd = FC_NS_GPN_FT;
 581         req->ct_hdr.ct_mr_size = max_bytes / 4;
 582         req->gpn_ft.fn_domain_id_scope = 0;
 583         req->gpn_ft.fn_area_id_scope = 0;
 584         req->gpn_ft.fn_fc4_type = FC_TYPE_FCP;
 585
 586         /* prepare zfcp_send_ct */
 587         ct->handler = zfcp_fc_complete;
 588         ct->handler_data = &completion;
 589         ct->req = &gpn_ft->sg_req;
 590         ct->resp = gpn_ft->sg_resp;
 591
 592         ret = zfcp_fsf_send_ct(&adapter->gs->ds, ct, NULL,
 593                                ZFCP_FC_CTELS_TMO);
 594         if (!ret)
 595                 wait_for_completion(&completion);
 596         return ret;
 597 }
 598
 599 static void zfcp_fc_validate_port(struct zfcp_port *port, struct list_head *lh)
 600 {
 601         if (!(atomic_read(&port->status) & ZFCP_STATUS_COMMON_NOESC))
 602                 return;
 603
 604         atomic_clear_mask(ZFCP_STATUS_COMMON_NOESC, &port->status);
 605
 606         if ((port->supported_classes != 0) ||
 607             !list_empty(&port->unit_list))
 608                 return;
 609
 610         list_move_tail(&port->list, lh);
 611 }
 612
 613 static int zfcp_fc_eval_gpn_ft(struct zfcp_fc_gpn_ft *gpn_ft,
 614                                struct zfcp_adapter *adapter, int max_entries)
 615 {
 616         struct zfcp_fsf_ct_els *ct = &gpn_ft->ct;
 617         struct scatterlist *sg = gpn_ft->sg_resp;
 618         struct fc_ct_hdr *hdr = sg_virt(sg);
 619         struct fc_gpn_ft_resp *acc = sg_virt(sg);
 620         struct zfcp_port *port, *tmp;
 621         unsigned long flags;
 622         LIST_HEAD(remove_lh);
 623         u32 d_id;
 624         int ret = 0, x, last = 0;
 625
 626         if (ct->status)
 627                 return -EIO;
 628
 629         if (hdr->ct_cmd != FC_FS_ACC) {
 630                 if (hdr->ct_reason == FC_BA_RJT_UNABLE)
 631                         return -EAGAIN; /* might be a temporary condition */
 632                 return -EIO;
 633         }
 634
 635         if (hdr->ct_mr_size) {
 636                 dev_warn(&adapter->ccw_device->dev,
 637                          "The name server reported %d words residual data\n",
 638                          hdr->ct_mr_size);
 639                 return -E2BIG;
 640         }
 641
 642         /* first entry is the header */
 643         for (x = 1; x < max_entries && !last; x++) {
 644                 if (x % (ZFCP_FC_GPN_FT_ENT_PAGE + 1))
 645                         acc++;
 646                 else
 647                         acc = sg_virt(++sg);
 648
 649                 last = acc->fp_flags & FC_NS_FID_LAST;
 650                 d_id = ntoh24(acc->fp_fid);
 651
 652                 /* don't attach ports with a well known address */
 653                 if (d_id >= FC_FID_WELL_KNOWN_BASE)
 654                         continue;
 655                 /* skip the adapter's port and known remote ports */
 656                 if (acc->fp_wwpn == fc_host_port_name(adapter->scsi_host))
 657                         continue;
 658
 659                 port = zfcp_port_enqueue(adapter, acc->fp_wwpn,
 660                                          ZFCP_STATUS_COMMON_NOESC, d_id);
 661                 if (!IS_ERR(port))
 662                         zfcp_erp_port_reopen(port, 0, "fcegpf1", NULL);
 663                 else if (PTR_ERR(port) != -EEXIST)
 664                         ret = PTR_ERR(port);
 665         }
 666
 667         zfcp_erp_wait(adapter);
 668         write_lock_irqsave(&adapter->port_list_lock, flags);
 669         list_for_each_entry_safe(port, tmp, &adapter->port_list, list)
 670                 zfcp_fc_validate_port(port, &remove_lh);
 671         write_unlock_irqrestore(&adapter->port_list_lock, flags);
 672
 673         list_for_each_entry_safe(port, tmp, &remove_lh, list) {
 674                 zfcp_erp_port_shutdown(port, 0, "fcegpf2", NULL);
 675                 zfcp_device_unregister(&port->dev, &zfcp_sysfs_port_attrs);
 676         }
 677
 678         return ret;
 679 }
 680
 681 /**
 682  * zfcp_fc_scan_ports - scan remote ports and attach new ports
 683  * @work: reference to scheduled work
 684  */
 685 void zfcp_fc_scan_ports(struct work_struct *work)
 686 {
 687         struct zfcp_adapter *adapter = container_of(work, struct zfcp_adapter,
 688                                                     scan_work);
 689         int ret, i;
 690         struct zfcp_fc_gpn_ft *gpn_ft;
 691         int chain, max_entries, buf_num, max_bytes;
 692
 693         chain = adapter->adapter_features & FSF_FEATURE_ELS_CT_CHAINED_SBALS;
 694         buf_num = chain ? ZFCP_FC_GPN_FT_NUM_BUFS : 1;
 695         max_entries = chain ? ZFCP_FC_GPN_FT_MAX_ENT : ZFCP_FC_GPN_FT_ENT_PAGE;
 696         max_bytes = chain ? ZFCP_FC_GPN_FT_MAX_SIZE : ZFCP_FC_CT_SIZE_PAGE;
 697
 698         if (fc_host_port_type(adapter->scsi_host) != FC_PORTTYPE_NPORT &&
 699             fc_host_port_type(adapter->scsi_host) != FC_PORTTYPE_NPIV)
 700                 return;
 701
 702         if (zfcp_fc_wka_port_get(&adapter->gs->ds))
 703                 return;
 704
 705         gpn_ft = zfcp_alloc_sg_env(buf_num);
 706         if (!gpn_ft)
 707                 goto out;
 708
 709         for (i = 0; i < 3; i++) {
 710                 ret = zfcp_fc_send_gpn_ft(gpn_ft, adapter, max_bytes);
 711                 if (!ret) {
 712                         ret = zfcp_fc_eval_gpn_ft(gpn_ft, adapter, max_entries);
 713                         if (ret == -EAGAIN)
 714                                 ssleep(1);
 715                         else
 716                                 break;
 717                 }
 718         }
 719         zfcp_free_sg_env(gpn_ft, buf_num);
 720 out:
 721         zfcp_fc_wka_port_put(&adapter->gs->ds);
 722 }
 723
 724 static void zfcp_fc_ct_els_job_handler(void *data)
 725 {
 726         struct fc_bsg_job *job = data;
 727         struct zfcp_fsf_ct_els *zfcp_ct_els = job->dd_data;
 728         struct fc_bsg_reply *jr = job->reply;
 729
 730         jr->reply_payload_rcv_len = job->reply_payload.payload_len;
 731         jr->reply_data.ctels_reply.status = FC_CTELS_STATUS_OK;
 732         jr->result = zfcp_ct_els->status ? -EIO : 0;
 733         job->job_done(job);
 734 }
 735
 736 static struct zfcp_fc_wka_port *zfcp_fc_job_wka_port(struct fc_bsg_job *job)
 737 {
 738         u32 preamble_word1;
 739         u8 gs_type;
 740         struct zfcp_adapter *adapter;
 741
 742         preamble_word1 = job->request->rqst_data.r_ct.preamble_word1;
 743         gs_type = (preamble_word1 & 0xff000000) >> 24;
 744
 745         adapter = (struct zfcp_adapter *) job->shost->hostdata[0];
 746
 747         switch (gs_type) {
 748         case FC_FST_ALIAS:
 749                 return &adapter->gs->as;
 750         case FC_FST_MGMT:
 751                 return &adapter->gs->ms;
 752         case FC_FST_TIME:
 753                 return &adapter->gs->ts;
 754                 break;
 755         case FC_FST_DIR:
 756                 return &adapter->gs->ds;
 757                 break;
 758         default:
 759                 return NULL;
 760         }
 761 }
 762
 763 static void zfcp_fc_ct_job_handler(void *data)
 764 {
 765         struct fc_bsg_job *job = data;
 766         struct zfcp_fc_wka_port *wka_port;
 767
 768         wka_port = zfcp_fc_job_wka_port(job);
 769         zfcp_fc_wka_port_put(wka_port);
 770
 771         zfcp_fc_ct_els_job_handler(data);
 772 }
 773
 774 static int zfcp_fc_exec_els_job(struct fc_bsg_job *job,
 775                                 struct zfcp_adapter *adapter)
 776 {
 777         struct zfcp_fsf_ct_els *els = job->dd_data;
 778         struct fc_rport *rport = job->rport;
 779         struct zfcp_port *port;
 780         u32 d_id;
 781
 782         if (rport) {
 783                 port = zfcp_get_port_by_wwpn(adapter, rport->port_name);
 784                 if (!port)
 785                         return -EINVAL;
 786
 787                 d_id = port->d_id;
 788                 put_device(&port->dev);
 789         } else
 790                 d_id = ntoh24(job->request->rqst_data.h_els.port_id);
 791
 792         els->handler = zfcp_fc_ct_els_job_handler;
 793         return zfcp_fsf_send_els(adapter, d_id, els, job->req->timeout / HZ);
 794 }
 795
 796 static int zfcp_fc_exec_ct_job(struct fc_bsg_job *job,
 797                                struct zfcp_adapter *adapter)
 798 {
 799         int ret;
 800         struct zfcp_fsf_ct_els *ct = job->dd_data;
 801         struct zfcp_fc_wka_port *wka_port;
 802
 803         wka_port = zfcp_fc_job_wka_port(job);
 804         if (!wka_port)
 805                 return -EINVAL;
 806
 807         ret = zfcp_fc_wka_port_get(wka_port);
 808         if (ret)
 809                 return ret;
 810
 811         ct->handler = zfcp_fc_ct_job_handler;
 812         ret = zfcp_fsf_send_ct(wka_port, ct, NULL, job->req->timeout / HZ);
 813         if (ret)
 814                 zfcp_fc_wka_port_put(wka_port);
 815
 816         return ret;
 817 }
 818
 819 int zfcp_fc_exec_bsg_job(struct fc_bsg_job *job)
 820 {
 821         struct Scsi_Host *shost;
 822         struct zfcp_adapter *adapter;
 823         struct zfcp_fsf_ct_els *ct_els = job->dd_data;
 824
 825         shost = job->rport ? rport_to_shost(job->rport) : job->shost;
 826         adapter = (struct zfcp_adapter *)shost->hostdata[0];
 827
 828         if (!(atomic_read(&adapter->status) & ZFCP_STATUS_COMMON_OPEN))
 829                 return -EINVAL;
 830
 831         ct_els->req = job->request_payload.sg_list;
 832         ct_els->resp = job->reply_payload.sg_list;
 833         ct_els->handler_data = job;
 834
 835         switch (job->request->msgcode) {
 836         case FC_BSG_RPT_ELS:
 837         case FC_BSG_HST_ELS_NOLOGIN:
 838                 return zfcp_fc_exec_els_job(job, adapter);
 839         case FC_BSG_RPT_CT:
 840         case FC_BSG_HST_CT:
 841                 return zfcp_fc_exec_ct_job(job, adapter);
 842         default:
 843                 return -EINVAL;
 844         }
 845 }
 846
 847 int zfcp_fc_timeout_bsg_job(struct fc_bsg_job *job)
 848 {
 849         /* hardware tracks timeout, reset bsg timeout to not interfere */
 850         return -EAGAIN;
 851 }
 852
 853 int zfcp_fc_gs_setup(struct zfcp_adapter *adapter)
 854 {
 855         struct zfcp_fc_wka_ports *wka_ports;
 856
 857         wka_ports = kzalloc(sizeof(struct zfcp_fc_wka_ports), GFP_KERNEL);
 858         if (!wka_ports)
 859                 return -ENOMEM;
 860
 861         adapter->gs = wka_ports;
 862         zfcp_fc_wka_port_init(&wka_ports->ms, FC_FID_MGMT_SERV, adapter);
 863         zfcp_fc_wka_port_init(&wka_ports->ts, FC_FID_TIME_SERV, adapter);
 864         zfcp_fc_wka_port_init(&wka_ports->ds, FC_FID_DIR_SERV, adapter);
 865         zfcp_fc_wka_port_init(&wka_ports->as, FC_FID_ALIASES, adapter);
 866
 867         return 0;
 868 }
 869
 870 void zfcp_fc_gs_destroy(struct zfcp_adapter *adapter)
 871 {
 872         kfree(adapter->gs);
 873         adapter->gs = NULL;
 874 }