Commit | Line | Data |
---|---|---|
24073b47 CS |
1 | /* |
2 | * zfcp device driver | |
3 | * | |
4 | * Fibre Channel related functions for the zfcp device driver. | |
5 | * | |
6 | * Copyright IBM Corporation 2008 | |
7 | */ | |
8 | ||
ecf39d42 CS |
9 | #define KMSG_COMPONENT "zfcp" |
10 | #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt | |
11 | ||
24073b47 CS |
12 | #include "zfcp_ext.h" |
13 | ||
e0d7fcb5 CS |
14 | enum rscn_address_format { |
15 | RSCN_PORT_ADDRESS = 0x0, | |
16 | RSCN_AREA_ADDRESS = 0x1, | |
17 | RSCN_DOMAIN_ADDRESS = 0x2, | |
18 | RSCN_FABRIC_ADDRESS = 0x3, | |
19 | }; | |
20 | ||
21 | static u32 rscn_range_mask[] = { | |
22 | [RSCN_PORT_ADDRESS] = 0xFFFFFF, | |
23 | [RSCN_AREA_ADDRESS] = 0xFFFF00, | |
24 | [RSCN_DOMAIN_ADDRESS] = 0xFF0000, | |
25 | [RSCN_FABRIC_ADDRESS] = 0x000000, | |
26 | }; | |
27 | ||
cc8c2829 SS |
28 | struct ct_iu_gpn_ft_req { |
29 | struct ct_hdr header; | |
30 | u8 flags; | |
31 | u8 domain_id_scope; | |
32 | u8 area_id_scope; | |
33 | u8 fc4_type; | |
34 | } __attribute__ ((packed)); | |
35 | ||
36 | struct gpn_ft_resp_acc { | |
37 | u8 control; | |
38 | u8 port_id[3]; | |
39 | u8 reserved[4]; | |
40 | u64 wwpn; | |
41 | } __attribute__ ((packed)); | |
42 | ||
43 | #define ZFCP_GPN_FT_ENTRIES ((PAGE_SIZE - sizeof(struct ct_hdr)) \ | |
44 | / sizeof(struct gpn_ft_resp_acc)) | |
45 | #define ZFCP_GPN_FT_BUFFERS 4 | |
46 | #define ZFCP_GPN_FT_MAX_ENTRIES ZFCP_GPN_FT_BUFFERS * (ZFCP_GPN_FT_ENTRIES + 1) | |
47 | ||
48 | struct ct_iu_gpn_ft_resp { | |
49 | struct ct_hdr header; | |
50 | struct gpn_ft_resp_acc accept[ZFCP_GPN_FT_ENTRIES]; | |
51 | } __attribute__ ((packed)); | |
52 | ||
53 | struct zfcp_gpn_ft { | |
54 | struct zfcp_send_ct ct; | |
55 | struct scatterlist sg_req; | |
56 | struct scatterlist sg_resp[ZFCP_GPN_FT_BUFFERS]; | |
57 | }; | |
58 | ||
5ab944f9 SS |
59 | struct zfcp_fc_ns_handler_data { |
60 | struct completion done; | |
61 | void (*handler)(unsigned long); | |
62 | unsigned long handler_data; | |
63 | }; | |
64 | ||
65 | static int zfcp_wka_port_get(struct zfcp_wka_port *wka_port) | |
66 | { | |
67 | if (mutex_lock_interruptible(&wka_port->mutex)) | |
68 | return -ERESTARTSYS; | |
69 | ||
1c1cba17 CS |
70 | if (wka_port->status == ZFCP_WKA_PORT_OFFLINE || |
71 | wka_port->status == ZFCP_WKA_PORT_CLOSING) { | |
5ab944f9 SS |
72 | wka_port->status = ZFCP_WKA_PORT_OPENING; |
73 | if (zfcp_fsf_open_wka_port(wka_port)) | |
74 | wka_port->status = ZFCP_WKA_PORT_OFFLINE; | |
75 | } | |
76 | ||
77 | mutex_unlock(&wka_port->mutex); | |
78 | ||
79 | wait_event_timeout( | |
80 | wka_port->completion_wq, | |
81 | wka_port->status == ZFCP_WKA_PORT_ONLINE || | |
82 | wka_port->status == ZFCP_WKA_PORT_OFFLINE, | |
83 | HZ >> 1); | |
84 | ||
85 | if (wka_port->status == ZFCP_WKA_PORT_ONLINE) { | |
86 | atomic_inc(&wka_port->refcount); | |
87 | return 0; | |
88 | } | |
89 | return -EIO; | |
90 | } | |
91 | ||
92 | static void zfcp_wka_port_offline(struct work_struct *work) | |
93 | { | |
94 | struct delayed_work *dw = container_of(work, struct delayed_work, work); | |
95 | struct zfcp_wka_port *wka_port = | |
96 | container_of(dw, struct zfcp_wka_port, work); | |
97 | ||
98 | wait_event(wka_port->completion_wq, | |
99 | atomic_read(&wka_port->refcount) == 0); | |
100 | ||
101 | mutex_lock(&wka_port->mutex); | |
102 | if ((atomic_read(&wka_port->refcount) != 0) || | |
103 | (wka_port->status != ZFCP_WKA_PORT_ONLINE)) | |
104 | goto out; | |
105 | ||
106 | wka_port->status = ZFCP_WKA_PORT_CLOSING; | |
107 | if (zfcp_fsf_close_wka_port(wka_port)) { | |
108 | wka_port->status = ZFCP_WKA_PORT_OFFLINE; | |
109 | wake_up(&wka_port->completion_wq); | |
110 | } | |
111 | out: | |
112 | mutex_unlock(&wka_port->mutex); | |
113 | } | |
114 | ||
115 | static void zfcp_wka_port_put(struct zfcp_wka_port *wka_port) | |
116 | { | |
117 | if (atomic_dec_return(&wka_port->refcount) != 0) | |
118 | return; | |
119 | /* wait 10 miliseconds, other reqs might pop in */ | |
120 | schedule_delayed_work(&wka_port->work, HZ / 100); | |
121 | } | |
122 | ||
123 | void zfcp_fc_nameserver_init(struct zfcp_adapter *adapter) | |
124 | { | |
125 | struct zfcp_wka_port *wka_port = &adapter->nsp; | |
126 | ||
127 | init_waitqueue_head(&wka_port->completion_wq); | |
128 | ||
129 | wka_port->adapter = adapter; | |
130 | wka_port->d_id = ZFCP_DID_DIRECTORY_SERVICE; | |
131 | ||
132 | wka_port->status = ZFCP_WKA_PORT_OFFLINE; | |
133 | atomic_set(&wka_port->refcount, 0); | |
134 | mutex_init(&wka_port->mutex); | |
135 | INIT_DELAYED_WORK(&wka_port->work, zfcp_wka_port_offline); | |
136 | } | |
137 | ||
24073b47 CS |
138 | static void _zfcp_fc_incoming_rscn(struct zfcp_fsf_req *fsf_req, u32 range, |
139 | struct fcp_rscn_element *elem) | |
140 | { | |
141 | unsigned long flags; | |
142 | struct zfcp_port *port; | |
143 | ||
144 | read_lock_irqsave(&zfcp_data.config_lock, flags); | |
145 | list_for_each_entry(port, &fsf_req->adapter->port_list_head, list) { | |
bce02614 | 146 | if (!(atomic_read(&port->status) & ZFCP_STATUS_PORT_PHYS_OPEN)) |
24073b47 CS |
147 | /* Try to connect to unused ports anyway. */ |
148 | zfcp_erp_port_reopen(port, | |
149 | ZFCP_STATUS_COMMON_ERP_FAILED, | |
150 | 82, fsf_req); | |
151 | else if ((port->d_id & range) == (elem->nport_did & range)) | |
152 | /* Check connection status for connected ports */ | |
153 | zfcp_test_link(port); | |
154 | } | |
155 | read_unlock_irqrestore(&zfcp_data.config_lock, flags); | |
156 | } | |
157 | ||
158 | static void zfcp_fc_incoming_rscn(struct zfcp_fsf_req *fsf_req) | |
159 | { | |
160 | struct fsf_status_read_buffer *status_buffer = (void *)fsf_req->data; | |
161 | struct fcp_rscn_head *fcp_rscn_head; | |
162 | struct fcp_rscn_element *fcp_rscn_element; | |
163 | u16 i; | |
164 | u16 no_entries; | |
165 | u32 range_mask; | |
166 | ||
c41f8cbd SS |
167 | fcp_rscn_head = (struct fcp_rscn_head *) status_buffer->payload.data; |
168 | fcp_rscn_element = (struct fcp_rscn_element *) fcp_rscn_head; | |
24073b47 CS |
169 | |
170 | /* see FC-FS */ | |
171 | no_entries = fcp_rscn_head->payload_len / | |
172 | sizeof(struct fcp_rscn_element); | |
173 | ||
174 | for (i = 1; i < no_entries; i++) { | |
175 | /* skip head and start with 1st element */ | |
176 | fcp_rscn_element++; | |
e0d7fcb5 | 177 | range_mask = rscn_range_mask[fcp_rscn_element->addr_format]; |
24073b47 CS |
178 | _zfcp_fc_incoming_rscn(fsf_req, range_mask, fcp_rscn_element); |
179 | } | |
cc8c2829 | 180 | schedule_work(&fsf_req->adapter->scan_work); |
24073b47 CS |
181 | } |
182 | ||
7ba58c9c | 183 | static void zfcp_fc_incoming_wwpn(struct zfcp_fsf_req *req, u64 wwpn) |
24073b47 CS |
184 | { |
185 | struct zfcp_adapter *adapter = req->adapter; | |
186 | struct zfcp_port *port; | |
187 | unsigned long flags; | |
188 | ||
189 | read_lock_irqsave(&zfcp_data.config_lock, flags); | |
190 | list_for_each_entry(port, &adapter->port_list_head, list) | |
191 | if (port->wwpn == wwpn) | |
192 | break; | |
193 | read_unlock_irqrestore(&zfcp_data.config_lock, flags); | |
194 | ||
195 | if (port && (port->wwpn == wwpn)) | |
196 | zfcp_erp_port_forced_reopen(port, 0, 83, req); | |
197 | } | |
198 | ||
199 | static void zfcp_fc_incoming_plogi(struct zfcp_fsf_req *req) | |
200 | { | |
201 | struct fsf_status_read_buffer *status_buffer = | |
202 | (struct fsf_status_read_buffer *)req->data; | |
203 | struct fsf_plogi *els_plogi = | |
c41f8cbd | 204 | (struct fsf_plogi *) status_buffer->payload.data; |
24073b47 CS |
205 | |
206 | zfcp_fc_incoming_wwpn(req, els_plogi->serv_param.wwpn); | |
207 | } | |
208 | ||
209 | static void zfcp_fc_incoming_logo(struct zfcp_fsf_req *req) | |
210 | { | |
211 | struct fsf_status_read_buffer *status_buffer = | |
212 | (struct fsf_status_read_buffer *)req->data; | |
c41f8cbd SS |
213 | struct fcp_logo *els_logo = |
214 | (struct fcp_logo *) status_buffer->payload.data; | |
24073b47 CS |
215 | |
216 | zfcp_fc_incoming_wwpn(req, els_logo->nport_wwpn); | |
217 | } | |
218 | ||
219 | /** | |
220 | * zfcp_fc_incoming_els - handle incoming ELS | |
221 | * @fsf_req - request which contains incoming ELS | |
222 | */ | |
223 | void zfcp_fc_incoming_els(struct zfcp_fsf_req *fsf_req) | |
224 | { | |
225 | struct fsf_status_read_buffer *status_buffer = | |
226 | (struct fsf_status_read_buffer *) fsf_req->data; | |
c41f8cbd | 227 | unsigned int els_type = status_buffer->payload.data[0]; |
24073b47 CS |
228 | |
229 | zfcp_san_dbf_event_incoming_els(fsf_req); | |
230 | if (els_type == LS_PLOGI) | |
231 | zfcp_fc_incoming_plogi(fsf_req); | |
232 | else if (els_type == LS_LOGO) | |
233 | zfcp_fc_incoming_logo(fsf_req); | |
234 | else if (els_type == LS_RSCN) | |
235 | zfcp_fc_incoming_rscn(fsf_req); | |
236 | } | |
237 | ||
5ab944f9 SS |
238 | static void zfcp_fc_ns_handler(unsigned long data) |
239 | { | |
240 | struct zfcp_fc_ns_handler_data *compl_rec = | |
241 | (struct zfcp_fc_ns_handler_data *) data; | |
242 | ||
243 | if (compl_rec->handler) | |
244 | compl_rec->handler(compl_rec->handler_data); | |
245 | ||
246 | complete(&compl_rec->done); | |
247 | } | |
248 | ||
249 | static void zfcp_fc_ns_gid_pn_eval(unsigned long data) | |
24073b47 CS |
250 | { |
251 | struct zfcp_gid_pn_data *gid_pn = (struct zfcp_gid_pn_data *) data; | |
252 | struct zfcp_send_ct *ct = &gid_pn->ct; | |
253 | struct ct_iu_gid_pn_req *ct_iu_req = sg_virt(ct->req); | |
254 | struct ct_iu_gid_pn_resp *ct_iu_resp = sg_virt(ct->resp); | |
255 | struct zfcp_port *port = gid_pn->port; | |
256 | ||
257 | if (ct->status) | |
5ab944f9 | 258 | return; |
24073b47 CS |
259 | if (ct_iu_resp->header.cmd_rsp_code != ZFCP_CT_ACCEPT) { |
260 | atomic_set_mask(ZFCP_STATUS_PORT_INVALID_WWPN, &port->status); | |
5ab944f9 | 261 | return; |
24073b47 CS |
262 | } |
263 | /* paranoia */ | |
264 | if (ct_iu_req->wwpn != port->wwpn) | |
5ab944f9 | 265 | return; |
24073b47 CS |
266 | /* looks like a valid d_id */ |
267 | port->d_id = ct_iu_resp->d_id & ZFCP_DID_MASK; | |
24073b47 CS |
268 | } |
269 | ||
5ab944f9 SS |
270 | int static zfcp_fc_ns_gid_pn_request(struct zfcp_erp_action *erp_action, |
271 | struct zfcp_gid_pn_data *gid_pn) | |
24073b47 | 272 | { |
24073b47 | 273 | struct zfcp_adapter *adapter = erp_action->adapter; |
5ab944f9 SS |
274 | struct zfcp_fc_ns_handler_data compl_rec; |
275 | int ret; | |
24073b47 CS |
276 | |
277 | /* setup parameters for send generic command */ | |
278 | gid_pn->port = erp_action->port; | |
5ab944f9 SS |
279 | gid_pn->ct.wka_port = &adapter->nsp; |
280 | gid_pn->ct.handler = zfcp_fc_ns_handler; | |
281 | gid_pn->ct.handler_data = (unsigned long) &compl_rec; | |
24073b47 CS |
282 | gid_pn->ct.timeout = ZFCP_NS_GID_PN_TIMEOUT; |
283 | gid_pn->ct.req = &gid_pn->req; | |
284 | gid_pn->ct.resp = &gid_pn->resp; | |
285 | gid_pn->ct.req_count = 1; | |
286 | gid_pn->ct.resp_count = 1; | |
287 | sg_init_one(&gid_pn->req, &gid_pn->ct_iu_req, | |
288 | sizeof(struct ct_iu_gid_pn_req)); | |
289 | sg_init_one(&gid_pn->resp, &gid_pn->ct_iu_resp, | |
290 | sizeof(struct ct_iu_gid_pn_resp)); | |
291 | ||
292 | /* setup nameserver request */ | |
293 | gid_pn->ct_iu_req.header.revision = ZFCP_CT_REVISION; | |
294 | gid_pn->ct_iu_req.header.gs_type = ZFCP_CT_DIRECTORY_SERVICE; | |
295 | gid_pn->ct_iu_req.header.gs_subtype = ZFCP_CT_NAME_SERVER; | |
296 | gid_pn->ct_iu_req.header.options = ZFCP_CT_SYNCHRONOUS; | |
297 | gid_pn->ct_iu_req.header.cmd_rsp_code = ZFCP_CT_GID_PN; | |
298 | gid_pn->ct_iu_req.header.max_res_size = ZFCP_CT_MAX_SIZE; | |
299 | gid_pn->ct_iu_req.wwpn = erp_action->port->wwpn; | |
300 | ||
5ab944f9 SS |
301 | init_completion(&compl_rec.done); |
302 | compl_rec.handler = zfcp_fc_ns_gid_pn_eval; | |
303 | compl_rec.handler_data = (unsigned long) gid_pn; | |
24073b47 CS |
304 | ret = zfcp_fsf_send_ct(&gid_pn->ct, adapter->pool.fsf_req_erp, |
305 | erp_action); | |
5ab944f9 SS |
306 | if (!ret) |
307 | wait_for_completion(&compl_rec.done); | |
308 | return ret; | |
309 | } | |
310 | ||
311 | /** | |
312 | * zfcp_fc_ns_gid_pn_request - initiate GID_PN nameserver request | |
313 | * @erp_action: pointer to zfcp_erp_action where GID_PN request is needed | |
314 | * return: -ENOMEM on error, 0 otherwise | |
315 | */ | |
316 | int zfcp_fc_ns_gid_pn(struct zfcp_erp_action *erp_action) | |
317 | { | |
318 | int ret; | |
319 | struct zfcp_gid_pn_data *gid_pn; | |
320 | struct zfcp_adapter *adapter = erp_action->adapter; | |
321 | ||
322 | gid_pn = mempool_alloc(adapter->pool.data_gid_pn, GFP_ATOMIC); | |
323 | if (!gid_pn) | |
324 | return -ENOMEM; | |
325 | ||
326 | memset(gid_pn, 0, sizeof(*gid_pn)); | |
327 | ||
328 | ret = zfcp_wka_port_get(&adapter->nsp); | |
24073b47 | 329 | if (ret) |
5ab944f9 SS |
330 | goto out; |
331 | ||
332 | ret = zfcp_fc_ns_gid_pn_request(erp_action, gid_pn); | |
333 | ||
334 | zfcp_wka_port_put(&adapter->nsp); | |
335 | out: | |
336 | mempool_free(gid_pn, adapter->pool.data_gid_pn); | |
24073b47 CS |
337 | return ret; |
338 | } | |
339 | ||
340 | /** | |
341 | * zfcp_fc_plogi_evaluate - evaluate PLOGI playload | |
342 | * @port: zfcp_port structure | |
343 | * @plogi: plogi payload | |
344 | * | |
345 | * Evaluate PLOGI playload and copy important fields into zfcp_port structure | |
346 | */ | |
347 | void zfcp_fc_plogi_evaluate(struct zfcp_port *port, struct fsf_plogi *plogi) | |
348 | { | |
349 | port->maxframe_size = plogi->serv_param.common_serv_param[7] | | |
350 | ((plogi->serv_param.common_serv_param[6] & 0x0F) << 8); | |
351 | if (plogi->serv_param.class1_serv_param[0] & 0x80) | |
352 | port->supported_classes |= FC_COS_CLASS1; | |
353 | if (plogi->serv_param.class2_serv_param[0] & 0x80) | |
354 | port->supported_classes |= FC_COS_CLASS2; | |
355 | if (plogi->serv_param.class3_serv_param[0] & 0x80) | |
356 | port->supported_classes |= FC_COS_CLASS3; | |
357 | if (plogi->serv_param.class4_serv_param[0] & 0x80) | |
358 | port->supported_classes |= FC_COS_CLASS4; | |
359 | } | |
360 | ||
361 | struct zfcp_els_adisc { | |
362 | struct zfcp_send_els els; | |
363 | struct scatterlist req; | |
364 | struct scatterlist resp; | |
365 | struct zfcp_ls_adisc ls_adisc; | |
44cc76f2 | 366 | struct zfcp_ls_adisc ls_adisc_acc; |
24073b47 CS |
367 | }; |
368 | ||
369 | static void zfcp_fc_adisc_handler(unsigned long data) | |
370 | { | |
371 | struct zfcp_els_adisc *adisc = (struct zfcp_els_adisc *) data; | |
372 | struct zfcp_port *port = adisc->els.port; | |
44cc76f2 | 373 | struct zfcp_ls_adisc *ls_adisc = &adisc->ls_adisc_acc; |
24073b47 | 374 | |
3968ce80 | 375 | if (adisc->els.status) { |
24073b47 CS |
376 | /* request rejected or timed out */ |
377 | zfcp_erp_port_forced_reopen(port, 0, 63, NULL); | |
378 | goto out; | |
379 | } | |
380 | ||
381 | if (!port->wwnn) | |
382 | port->wwnn = ls_adisc->wwnn; | |
383 | ||
384 | if (port->wwpn != ls_adisc->wwpn) | |
385 | zfcp_erp_port_reopen(port, 0, 64, NULL); | |
386 | ||
387 | out: | |
388 | zfcp_port_put(port); | |
389 | kfree(adisc); | |
390 | } | |
391 | ||
392 | static int zfcp_fc_adisc(struct zfcp_port *port) | |
393 | { | |
394 | struct zfcp_els_adisc *adisc; | |
395 | struct zfcp_adapter *adapter = port->adapter; | |
396 | ||
397 | adisc = kzalloc(sizeof(struct zfcp_els_adisc), GFP_ATOMIC); | |
398 | if (!adisc) | |
399 | return -ENOMEM; | |
400 | ||
401 | adisc->els.req = &adisc->req; | |
402 | adisc->els.resp = &adisc->resp; | |
403 | sg_init_one(adisc->els.req, &adisc->ls_adisc, | |
404 | sizeof(struct zfcp_ls_adisc)); | |
405 | sg_init_one(adisc->els.resp, &adisc->ls_adisc_acc, | |
44cc76f2 | 406 | sizeof(struct zfcp_ls_adisc)); |
24073b47 CS |
407 | |
408 | adisc->els.req_count = 1; | |
409 | adisc->els.resp_count = 1; | |
410 | adisc->els.adapter = adapter; | |
411 | adisc->els.port = port; | |
412 | adisc->els.d_id = port->d_id; | |
413 | adisc->els.handler = zfcp_fc_adisc_handler; | |
414 | adisc->els.handler_data = (unsigned long) adisc; | |
415 | adisc->els.ls_code = adisc->ls_adisc.code = ZFCP_LS_ADISC; | |
416 | ||
417 | /* acc. to FC-FS, hard_nport_id in ADISC should not be set for ports | |
418 | without FC-AL-2 capability, so we don't set it */ | |
419 | adisc->ls_adisc.wwpn = fc_host_port_name(adapter->scsi_host); | |
420 | adisc->ls_adisc.wwnn = fc_host_node_name(adapter->scsi_host); | |
421 | adisc->ls_adisc.nport_id = fc_host_port_id(adapter->scsi_host); | |
422 | ||
423 | return zfcp_fsf_send_els(&adisc->els); | |
424 | } | |
425 | ||
426 | /** | |
427 | * zfcp_test_link - lightweight link test procedure | |
428 | * @port: port to be tested | |
429 | * | |
430 | * Test status of a link to a remote port using the ELS command ADISC. | |
431 | * If there is a problem with the remote port, error recovery steps | |
432 | * will be triggered. | |
433 | */ | |
434 | void zfcp_test_link(struct zfcp_port *port) | |
435 | { | |
436 | int retval; | |
437 | ||
438 | zfcp_port_get(port); | |
439 | retval = zfcp_fc_adisc(port); | |
9528539c | 440 | if (retval == 0) |
24073b47 CS |
441 | return; |
442 | ||
443 | /* send of ADISC was not possible */ | |
444 | zfcp_port_put(port); | |
9528539c SS |
445 | if (retval != -EBUSY) |
446 | zfcp_erp_port_forced_reopen(port, 0, 65, NULL); | |
24073b47 | 447 | } |
cc8c2829 | 448 | |
cc8c2829 SS |
449 | static void zfcp_free_sg_env(struct zfcp_gpn_ft *gpn_ft) |
450 | { | |
451 | struct scatterlist *sg = &gpn_ft->sg_req; | |
452 | ||
453 | kfree(sg_virt(sg)); /* free request buffer */ | |
454 | zfcp_sg_free_table(gpn_ft->sg_resp, ZFCP_GPN_FT_BUFFERS); | |
455 | ||
456 | kfree(gpn_ft); | |
457 | } | |
458 | ||
459 | static struct zfcp_gpn_ft *zfcp_alloc_sg_env(void) | |
460 | { | |
461 | struct zfcp_gpn_ft *gpn_ft; | |
462 | struct ct_iu_gpn_ft_req *req; | |
463 | ||
464 | gpn_ft = kzalloc(sizeof(*gpn_ft), GFP_KERNEL); | |
465 | if (!gpn_ft) | |
466 | return NULL; | |
467 | ||
468 | req = kzalloc(sizeof(struct ct_iu_gpn_ft_req), GFP_KERNEL); | |
469 | if (!req) { | |
470 | kfree(gpn_ft); | |
471 | gpn_ft = NULL; | |
472 | goto out; | |
473 | } | |
474 | sg_init_one(&gpn_ft->sg_req, req, sizeof(*req)); | |
475 | ||
476 | if (zfcp_sg_setup_table(gpn_ft->sg_resp, ZFCP_GPN_FT_BUFFERS)) { | |
477 | zfcp_free_sg_env(gpn_ft); | |
478 | gpn_ft = NULL; | |
479 | } | |
480 | out: | |
481 | return gpn_ft; | |
482 | } | |
483 | ||
484 | ||
485 | static int zfcp_scan_issue_gpn_ft(struct zfcp_gpn_ft *gpn_ft, | |
486 | struct zfcp_adapter *adapter) | |
487 | { | |
488 | struct zfcp_send_ct *ct = &gpn_ft->ct; | |
489 | struct ct_iu_gpn_ft_req *req = sg_virt(&gpn_ft->sg_req); | |
5ab944f9 | 490 | struct zfcp_fc_ns_handler_data compl_rec; |
cc8c2829 SS |
491 | int ret; |
492 | ||
493 | /* prepare CT IU for GPN_FT */ | |
494 | req->header.revision = ZFCP_CT_REVISION; | |
495 | req->header.gs_type = ZFCP_CT_DIRECTORY_SERVICE; | |
496 | req->header.gs_subtype = ZFCP_CT_NAME_SERVER; | |
497 | req->header.options = ZFCP_CT_SYNCHRONOUS; | |
498 | req->header.cmd_rsp_code = ZFCP_CT_GPN_FT; | |
499 | req->header.max_res_size = (sizeof(struct gpn_ft_resp_acc) * | |
500 | (ZFCP_GPN_FT_MAX_ENTRIES - 1)) >> 2; | |
501 | req->flags = 0; | |
502 | req->domain_id_scope = 0; | |
503 | req->area_id_scope = 0; | |
504 | req->fc4_type = ZFCP_CT_SCSI_FCP; | |
505 | ||
506 | /* prepare zfcp_send_ct */ | |
5ab944f9 SS |
507 | ct->wka_port = &adapter->nsp; |
508 | ct->handler = zfcp_fc_ns_handler; | |
509 | ct->handler_data = (unsigned long)&compl_rec; | |
cc8c2829 SS |
510 | ct->timeout = 10; |
511 | ct->req = &gpn_ft->sg_req; | |
512 | ct->resp = gpn_ft->sg_resp; | |
513 | ct->req_count = 1; | |
514 | ct->resp_count = ZFCP_GPN_FT_BUFFERS; | |
515 | ||
5ab944f9 SS |
516 | init_completion(&compl_rec.done); |
517 | compl_rec.handler = NULL; | |
cc8c2829 SS |
518 | ret = zfcp_fsf_send_ct(ct, NULL, NULL); |
519 | if (!ret) | |
5ab944f9 | 520 | wait_for_completion(&compl_rec.done); |
cc8c2829 SS |
521 | return ret; |
522 | } | |
523 | ||
524 | static void zfcp_validate_port(struct zfcp_port *port) | |
525 | { | |
526 | struct zfcp_adapter *adapter = port->adapter; | |
527 | ||
528 | atomic_clear_mask(ZFCP_STATUS_COMMON_NOESC, &port->status); | |
529 | ||
0406289e CS |
530 | if ((port->supported_classes != 0) || |
531 | !list_empty(&port->unit_list_head)) { | |
cc8c2829 SS |
532 | zfcp_port_put(port); |
533 | return; | |
534 | } | |
535 | zfcp_erp_port_shutdown(port, 0, 151, NULL); | |
536 | zfcp_erp_wait(adapter); | |
537 | zfcp_port_put(port); | |
538 | zfcp_port_dequeue(port); | |
539 | } | |
540 | ||
541 | static int zfcp_scan_eval_gpn_ft(struct zfcp_gpn_ft *gpn_ft) | |
542 | { | |
543 | struct zfcp_send_ct *ct = &gpn_ft->ct; | |
544 | struct scatterlist *sg = gpn_ft->sg_resp; | |
545 | struct ct_hdr *hdr = sg_virt(sg); | |
546 | struct gpn_ft_resp_acc *acc = sg_virt(sg); | |
5ab944f9 | 547 | struct zfcp_adapter *adapter = ct->wka_port->adapter; |
cc8c2829 SS |
548 | struct zfcp_port *port, *tmp; |
549 | u32 d_id; | |
47f7bba5 | 550 | int ret = 0, x, last = 0; |
cc8c2829 SS |
551 | |
552 | if (ct->status) | |
553 | return -EIO; | |
554 | ||
555 | if (hdr->cmd_rsp_code != ZFCP_CT_ACCEPT) { | |
556 | if (hdr->reason_code == ZFCP_CT_UNABLE_TO_PERFORM_CMD) | |
557 | return -EAGAIN; /* might be a temporary condition */ | |
558 | return -EIO; | |
559 | } | |
560 | ||
561 | if (hdr->max_res_size) | |
562 | return -E2BIG; | |
563 | ||
564 | down(&zfcp_data.config_sema); | |
565 | ||
566 | /* first entry is the header */ | |
47f7bba5 | 567 | for (x = 1; x < ZFCP_GPN_FT_MAX_ENTRIES && !last; x++) { |
cc8c2829 SS |
568 | if (x % (ZFCP_GPN_FT_ENTRIES + 1)) |
569 | acc++; | |
570 | else | |
571 | acc = sg_virt(++sg); | |
572 | ||
47f7bba5 | 573 | last = acc->control & 0x80; |
cc8c2829 SS |
574 | d_id = acc->port_id[0] << 16 | acc->port_id[1] << 8 | |
575 | acc->port_id[2]; | |
576 | ||
5ab944f9 SS |
577 | /* don't attach ports with a well known address */ |
578 | if ((d_id & ZFCP_DID_WKA) == ZFCP_DID_WKA) | |
579 | continue; | |
cc8c2829 | 580 | /* skip the adapter's port and known remote ports */ |
9528539c | 581 | if (acc->wwpn == fc_host_port_name(adapter->scsi_host)) |
cc8c2829 | 582 | continue; |
9528539c SS |
583 | port = zfcp_get_port_by_wwpn(adapter, acc->wwpn); |
584 | if (port) { | |
585 | zfcp_port_get(port); | |
586 | continue; | |
587 | } | |
cc8c2829 SS |
588 | |
589 | port = zfcp_port_enqueue(adapter, acc->wwpn, | |
cc8c2829 | 590 | ZFCP_STATUS_COMMON_NOESC, d_id); |
317e6b65 SS |
591 | if (IS_ERR(port)) |
592 | ret = PTR_ERR(port); | |
cc8c2829 | 593 | else |
317e6b65 | 594 | zfcp_erp_port_reopen(port, 0, 149, NULL); |
cc8c2829 SS |
595 | } |
596 | ||
597 | zfcp_erp_wait(adapter); | |
598 | list_for_each_entry_safe(port, tmp, &adapter->port_list_head, list) | |
599 | zfcp_validate_port(port); | |
600 | up(&zfcp_data.config_sema); | |
601 | return ret; | |
602 | } | |
603 | ||
604 | /** | |
605 | * zfcp_scan_ports - scan remote ports and attach new ports | |
606 | * @adapter: pointer to struct zfcp_adapter | |
607 | */ | |
608 | int zfcp_scan_ports(struct zfcp_adapter *adapter) | |
609 | { | |
610 | int ret, i; | |
611 | struct zfcp_gpn_ft *gpn_ft; | |
612 | ||
613 | if (fc_host_port_type(adapter->scsi_host) != FC_PORTTYPE_NPORT) | |
614 | return 0; | |
615 | ||
5ab944f9 | 616 | ret = zfcp_wka_port_get(&adapter->nsp); |
cc8c2829 SS |
617 | if (ret) |
618 | return ret; | |
619 | ||
620 | gpn_ft = zfcp_alloc_sg_env(); | |
5ab944f9 SS |
621 | if (!gpn_ft) { |
622 | ret = -ENOMEM; | |
623 | goto out; | |
624 | } | |
cc8c2829 SS |
625 | |
626 | for (i = 0; i < 3; i++) { | |
627 | ret = zfcp_scan_issue_gpn_ft(gpn_ft, adapter); | |
628 | if (!ret) { | |
629 | ret = zfcp_scan_eval_gpn_ft(gpn_ft); | |
630 | if (ret == -EAGAIN) | |
631 | ssleep(1); | |
632 | else | |
633 | break; | |
634 | } | |
635 | } | |
636 | zfcp_free_sg_env(gpn_ft); | |
5ab944f9 SS |
637 | out: |
638 | zfcp_wka_port_put(&adapter->nsp); | |
cc8c2829 SS |
639 | return ret; |
640 | } | |
641 | ||
642 | ||
643 | void _zfcp_scan_ports_later(struct work_struct *work) | |
644 | { | |
645 | zfcp_scan_ports(container_of(work, struct zfcp_adapter, scan_work)); | |
646 | } |