?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
kbuild: Fix instrumentation removal breakage on avr32
[wrt350n-kernel.git] / drivers / s390 / scsi / zfcp_aux.c
blob874b55ed00a3473f44a71227e69c33fa70eba04e
1 /*
2 * This file is part of the zfcp device driver for
3 * FCP adapters for IBM System z9 and zSeries.
4 *
5 * (C) Copyright IBM Corp. 2002, 2006
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2, or (at your option)
10 * any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 */
21
22 /*
23 * Driver authors:
24 * Martin Peschke (originator of the driver)
25 * Raimund Schroeder
26 * Aron Zeh
27 * Wolfgang Taphorn
28 * Stefan Bader
29 * Heiko Carstens (kernel 2.6 port of the driver)
30 * Andreas Herrmann
31 * Maxim Shchetynin
32 * Volker Sameske
33 * Ralph Wuerthner
34 */
35
36 #include "zfcp_ext.h"
37
38 /* accumulated log level (module parameter) */
39 static u32 loglevel = ZFCP_LOG_LEVEL_DEFAULTS;
40 static char *device;
41 /*********************** FUNCTION PROTOTYPES *********************************/
42
43 /* written against the module interface */
44 static int __init zfcp_module_init(void);
45
46 /* FCP related */
47 static void zfcp_ns_gid_pn_handler(unsigned long);
48
49 /* miscellaneous */
50 static int zfcp_sg_list_alloc(struct zfcp_sg_list *, size_t);
51 static void zfcp_sg_list_free(struct zfcp_sg_list *);
52 static int zfcp_sg_list_copy_from_user(struct zfcp_sg_list *,
53 void __user *, size_t);
54 static int zfcp_sg_list_copy_to_user(void __user *,
55 struct zfcp_sg_list *, size_t);
56 static long zfcp_cfdc_dev_ioctl(struct file *, unsigned int, unsigned long);
57
58 #define ZFCP_CFDC_IOC_MAGIC 0xDD
59 #define ZFCP_CFDC_IOC \
60 _IOWR(ZFCP_CFDC_IOC_MAGIC, 0, struct zfcp_cfdc_sense_data)
61
62
63 static const struct file_operations zfcp_cfdc_fops = {
64 .unlocked_ioctl = zfcp_cfdc_dev_ioctl,
65 #ifdef CONFIG_COMPAT
66 .compat_ioctl = zfcp_cfdc_dev_ioctl
67 #endif
68 };
69
70 static struct miscdevice zfcp_cfdc_misc = {
71 .minor = ZFCP_CFDC_DEV_MINOR,
72 .name = ZFCP_CFDC_DEV_NAME,
73 .fops = &zfcp_cfdc_fops
74 };
75
76 /*********************** KERNEL/MODULE PARAMETERS ***************************/
77
78 /* declare driver module init/cleanup functions */
79 module_init(zfcp_module_init);
80
81 MODULE_AUTHOR("IBM Deutschland Entwicklung GmbH - linux390@de.ibm.com");
82 MODULE_DESCRIPTION
83 ("FCP (SCSI over Fibre Channel) HBA driver for IBM System z9 and zSeries");
84 MODULE_LICENSE("GPL");
85
86 module_param(device, charp, 0400);
87 MODULE_PARM_DESC(device, "specify initial device");
88
89 module_param(loglevel, uint, 0400);
90 MODULE_PARM_DESC(loglevel,
91 "log levels, 8 nibbles: "
92 "FC ERP QDIO CIO Config FSF SCSI Other, "
93 "levels: 0=none 1=normal 2=devel 3=trace");
94
95 /****************************************************************/
96 /************** Functions without logging ***********************/
97 /****************************************************************/
98
99 void
100 _zfcp_hex_dump(char *addr, int count)
101 {
102 int i;
103 for (i = 0; i < count; i++) {
104 printk("%02x", addr[i]);
105 if ((i % 4) == 3)
106 printk(" ");
107 if ((i % 32) == 31)
108 printk("\n");
109 }
110 if (((i-1) % 32) != 31)
111 printk("\n");
112 }
113
114
115 /****************************************************************/
116 /****** Functions to handle the request ID hash table ********/
117 /****************************************************************/
118
119 #define ZFCP_LOG_AREA ZFCP_LOG_AREA_FSF
120
121 static int zfcp_reqlist_alloc(struct zfcp_adapter *adapter)
122 {
123 int idx;
124
125 adapter->req_list = kcalloc(REQUEST_LIST_SIZE, sizeof(struct list_head),
126 GFP_KERNEL);
127 if (!adapter->req_list)
128 return -ENOMEM;
129
130 for (idx = 0; idx < REQUEST_LIST_SIZE; idx++)
131 INIT_LIST_HEAD(&adapter->req_list[idx]);
132 return 0;
133 }
134
135 static void zfcp_reqlist_free(struct zfcp_adapter *adapter)
136 {
137 kfree(adapter->req_list);
138 }
139
140 int zfcp_reqlist_isempty(struct zfcp_adapter *adapter)
141 {
142 unsigned int idx;
143
144 for (idx = 0; idx < REQUEST_LIST_SIZE; idx++)
145 if (!list_empty(&adapter->req_list[idx]))
146 return 0;
147 return 1;
148 }
149
150 #undef ZFCP_LOG_AREA
151
152 /****************************************************************/
153 /************** Uncategorised Functions *************************/
154 /****************************************************************/
155
156 #define ZFCP_LOG_AREA ZFCP_LOG_AREA_OTHER
157
158 /**
159 * zfcp_device_setup - setup function
160 * @str: pointer to parameter string
161 *
162 * Parse "device=..." parameter string.
163 */
164 static int __init
165 zfcp_device_setup(char *devstr)
166 {
167 char *tmp, *str;
168 size_t len;
169
170 if (!devstr)
171 return 0;
172
173 len = strlen(devstr) + 1;
174 str = kmalloc(len, GFP_KERNEL);
175 if (!str)
176 goto err_out;
177 memcpy(str, devstr, len);
178
179 tmp = strchr(str, ',');
180 if (!tmp)
181 goto err_out;
182 *tmp++ = '\0';
183 strncpy(zfcp_data.init_busid, str, BUS_ID_SIZE);
184 zfcp_data.init_busid[BUS_ID_SIZE-1] = '\0';
185
186 zfcp_data.init_wwpn = simple_strtoull(tmp, &tmp, 0);
187 if (*tmp++ != ',')
188 goto err_out;
189 if (*tmp == '\0')
190 goto err_out;
191
192 zfcp_data.init_fcp_lun = simple_strtoull(tmp, &tmp, 0);
193 if (*tmp != '\0')
194 goto err_out;
195 kfree(str);
196 return 1;
197
198 err_out:
199 ZFCP_LOG_NORMAL("Parse error for device parameter string %s\n", str);
200 kfree(str);
201 return 0;
202 }
203
204 static void __init
205 zfcp_init_device_configure(void)
206 {
207 struct zfcp_adapter *adapter;
208 struct zfcp_port *port;
209 struct zfcp_unit *unit;
210
211 down(&zfcp_data.config_sema);
212 read_lock_irq(&zfcp_data.config_lock);
213 adapter = zfcp_get_adapter_by_busid(zfcp_data.init_busid);
214 if (adapter)
215 zfcp_adapter_get(adapter);
216 read_unlock_irq(&zfcp_data.config_lock);
217
218 if (adapter == NULL)
219 goto out_adapter;
220 port = zfcp_port_enqueue(adapter, zfcp_data.init_wwpn, 0, 0);
221 if (!port)
222 goto out_port;
223 unit = zfcp_unit_enqueue(port, zfcp_data.init_fcp_lun);
224 if (!unit)
225 goto out_unit;
226 up(&zfcp_data.config_sema);
227 ccw_device_set_online(adapter->ccw_device);
228 zfcp_erp_wait(adapter);
229 down(&zfcp_data.config_sema);
230 zfcp_unit_put(unit);
231 out_unit:
232 zfcp_port_put(port);
233 out_port:
234 zfcp_adapter_put(adapter);
235 out_adapter:
236 up(&zfcp_data.config_sema);
237 return;
238 }
239
240 static int calc_alignment(int size)
241 {
242 int align = 1;
243
244 if (!size)
245 return 0;
246
247 while ((size - align) > 0)
248 align <<= 1;
249
250 return align;
251 }
252
253 static int __init
254 zfcp_module_init(void)
255 {
256 int retval = -ENOMEM;
257 int size, align;
258
259 size = sizeof(struct zfcp_fsf_req_qtcb);
260 align = calc_alignment(size);
261 zfcp_data.fsf_req_qtcb_cache =
262 kmem_cache_create("zfcp_fsf", size, align, 0, NULL);
263 if (!zfcp_data.fsf_req_qtcb_cache)
264 goto out;
265
266 size = sizeof(struct fsf_status_read_buffer);
267 align = calc_alignment(size);
268 zfcp_data.sr_buffer_cache =
269 kmem_cache_create("zfcp_sr", size, align, 0, NULL);
270 if (!zfcp_data.sr_buffer_cache)
271 goto out_sr_cache;
272
273 size = sizeof(struct zfcp_gid_pn_data);
274 align = calc_alignment(size);
275 zfcp_data.gid_pn_cache =
276 kmem_cache_create("zfcp_gid", size, align, 0, NULL);
277 if (!zfcp_data.gid_pn_cache)
278 goto out_gid_cache;
279
280 atomic_set(&zfcp_data.loglevel, loglevel);
281
282 /* initialize adapter list */
283 INIT_LIST_HEAD(&zfcp_data.adapter_list_head);
284
285 /* initialize adapters to be removed list head */
286 INIT_LIST_HEAD(&zfcp_data.adapter_remove_lh);
287
288 zfcp_data.scsi_transport_template =
289 fc_attach_transport(&zfcp_transport_functions);
290 if (!zfcp_data.scsi_transport_template)
291 goto out_transport;
292
293 retval = misc_register(&zfcp_cfdc_misc);
294 if (retval != 0) {
295 ZFCP_LOG_INFO("registration of misc device "
296 "zfcp_cfdc failed\n");
297 goto out_misc;
298 }
299
300 ZFCP_LOG_TRACE("major/minor for zfcp_cfdc: %d/%d\n",
301 ZFCP_CFDC_DEV_MAJOR, zfcp_cfdc_misc.minor);
302
303 /* Initialise proc semaphores */
304 sema_init(&zfcp_data.config_sema, 1);
305
306 /* initialise configuration rw lock */
307 rwlock_init(&zfcp_data.config_lock);
308
309 /* setup dynamic I/O */
310 retval = zfcp_ccw_register();
311 if (retval) {
312 ZFCP_LOG_NORMAL("registration with common I/O layer failed\n");
313 goto out_ccw_register;
314 }
315
316 if (zfcp_device_setup(device))
317 zfcp_init_device_configure();
318
319 goto out;
320
321 out_ccw_register:
322 misc_deregister(&zfcp_cfdc_misc);
323 out_misc:
324 fc_release_transport(zfcp_data.scsi_transport_template);
325 out_transport:
326 kmem_cache_destroy(zfcp_data.gid_pn_cache);
327 out_gid_cache:
328 kmem_cache_destroy(zfcp_data.sr_buffer_cache);
329 out_sr_cache:
330 kmem_cache_destroy(zfcp_data.fsf_req_qtcb_cache);
331 out:
332 return retval;
333 }
334
335 /*
336 * function: zfcp_cfdc_dev_ioctl
337 *
338 * purpose: Handle control file upload/download transaction via IOCTL
339 * interface
340 *
341 * returns: 0 - Operation completed successfuly
342 * -ENOTTY - Unknown IOCTL command
343 * -EINVAL - Invalid sense data record
344 * -ENXIO - The FCP adapter is not available
345 * -EOPNOTSUPP - The FCP adapter does not have CFDC support
346 * -ENOMEM - Insufficient memory
347 * -EFAULT - User space memory I/O operation fault
348 * -EPERM - Cannot create or queue FSF request or create SBALs
349 * -ERESTARTSYS- Received signal (is mapped to EAGAIN by VFS)
350 */
351 static long
352 zfcp_cfdc_dev_ioctl(struct file *file, unsigned int command,
353 unsigned long buffer)
354 {
355 struct zfcp_cfdc_sense_data *sense_data, __user *sense_data_user;
356 struct zfcp_adapter *adapter = NULL;
357 struct zfcp_fsf_req *fsf_req = NULL;
358 struct zfcp_sg_list *sg_list = NULL;
359 u32 fsf_command, option;
360 char *bus_id = NULL;
361 int retval = 0;
362
363 sense_data = kmalloc(sizeof(struct zfcp_cfdc_sense_data), GFP_KERNEL);
364 if (sense_data == NULL) {
365 retval = -ENOMEM;
366 goto out;
367 }
368
369 sg_list = kzalloc(sizeof(struct zfcp_sg_list), GFP_KERNEL);
370 if (sg_list == NULL) {
371 retval = -ENOMEM;
372 goto out;
373 }
374
375 if (command != ZFCP_CFDC_IOC) {
376 ZFCP_LOG_INFO("IOC request code 0x%x invalid\n", command);
377 retval = -ENOTTY;
378 goto out;
379 }
380
381 if ((sense_data_user = (void __user *) buffer) == NULL) {
382 ZFCP_LOG_INFO("sense data record is required\n");
383 retval = -EINVAL;
384 goto out;
385 }
386
387 retval = copy_from_user(sense_data, sense_data_user,
388 sizeof(struct zfcp_cfdc_sense_data));
389 if (retval) {
390 retval = -EFAULT;
391 goto out;
392 }
393
394 if (sense_data->signature != ZFCP_CFDC_SIGNATURE) {
395 ZFCP_LOG_INFO("invalid sense data request signature 0x%08x\n",
396 ZFCP_CFDC_SIGNATURE);
397 retval = -EINVAL;
398 goto out;
399 }
400
401 switch (sense_data->command) {
402
403 case ZFCP_CFDC_CMND_DOWNLOAD_NORMAL:
404 fsf_command = FSF_QTCB_DOWNLOAD_CONTROL_FILE;
405 option = FSF_CFDC_OPTION_NORMAL_MODE;
406 break;
407
408 case ZFCP_CFDC_CMND_DOWNLOAD_FORCE:
409 fsf_command = FSF_QTCB_DOWNLOAD_CONTROL_FILE;
410 option = FSF_CFDC_OPTION_FORCE;
411 break;
412
413 case ZFCP_CFDC_CMND_FULL_ACCESS:
414 fsf_command = FSF_QTCB_DOWNLOAD_CONTROL_FILE;
415 option = FSF_CFDC_OPTION_FULL_ACCESS;
416 break;
417
418 case ZFCP_CFDC_CMND_RESTRICTED_ACCESS:
419 fsf_command = FSF_QTCB_DOWNLOAD_CONTROL_FILE;
420 option = FSF_CFDC_OPTION_RESTRICTED_ACCESS;
421 break;
422
423 case ZFCP_CFDC_CMND_UPLOAD:
424 fsf_command = FSF_QTCB_UPLOAD_CONTROL_FILE;
425 option = 0;
426 break;
427
428 default:
429 ZFCP_LOG_INFO("invalid command code 0x%08x\n",
430 sense_data->command);
431 retval = -EINVAL;
432 goto out;
433 }
434
435 bus_id = kmalloc(BUS_ID_SIZE, GFP_KERNEL);
436 if (bus_id == NULL) {
437 retval = -ENOMEM;
438 goto out;
439 }
440 snprintf(bus_id, BUS_ID_SIZE, "%d.%d.%04x",
441 (sense_data->devno >> 24),
442 (sense_data->devno >> 16) & 0xFF,
443 (sense_data->devno & 0xFFFF));
444
445 read_lock_irq(&zfcp_data.config_lock);
446 adapter = zfcp_get_adapter_by_busid(bus_id);
447 if (adapter)
448 zfcp_adapter_get(adapter);
449 read_unlock_irq(&zfcp_data.config_lock);
450
451 kfree(bus_id);
452
453 if (adapter == NULL) {
454 ZFCP_LOG_INFO("invalid adapter\n");
455 retval = -ENXIO;
456 goto out;
457 }
458
459 if (sense_data->command & ZFCP_CFDC_WITH_CONTROL_FILE) {
460 retval = zfcp_sg_list_alloc(sg_list,
461 ZFCP_CFDC_MAX_CONTROL_FILE_SIZE);
462 if (retval) {
463 retval = -ENOMEM;
464 goto out;
465 }
466 }
467
468 if ((sense_data->command & ZFCP_CFDC_DOWNLOAD) &&
469 (sense_data->command & ZFCP_CFDC_WITH_CONTROL_FILE)) {
470 retval = zfcp_sg_list_copy_from_user(
471 sg_list, &sense_data_user->control_file,
472 ZFCP_CFDC_MAX_CONTROL_FILE_SIZE);
473 if (retval) {
474 retval = -EFAULT;
475 goto out;
476 }
477 }
478
479 retval = zfcp_fsf_control_file(adapter, &fsf_req, fsf_command,
480 option, sg_list);
481 if (retval)
482 goto out;
483
484 if ((fsf_req->qtcb->prefix.prot_status != FSF_PROT_GOOD) &&
485 (fsf_req->qtcb->prefix.prot_status != FSF_PROT_FSF_STATUS_PRESENTED)) {
486 retval = -ENXIO;
487 goto out;
488 }
489
490 sense_data->fsf_status = fsf_req->qtcb->header.fsf_status;
491 memcpy(&sense_data->fsf_status_qual,
492 &fsf_req->qtcb->header.fsf_status_qual,
493 sizeof(union fsf_status_qual));
494 memcpy(&sense_data->payloads, &fsf_req->qtcb->bottom.support.els, 256);
495
496 retval = copy_to_user(sense_data_user, sense_data,
497 sizeof(struct zfcp_cfdc_sense_data));
498 if (retval) {
499 retval = -EFAULT;
500 goto out;
501 }
502
503 if (sense_data->command & ZFCP_CFDC_UPLOAD) {
504 retval = zfcp_sg_list_copy_to_user(
505 &sense_data_user->control_file, sg_list,
506 ZFCP_CFDC_MAX_CONTROL_FILE_SIZE);
507 if (retval) {
508 retval = -EFAULT;
509 goto out;
510 }
511 }
512
513 out:
514 if (fsf_req != NULL)
515 zfcp_fsf_req_free(fsf_req);
516
517 if ((adapter != NULL) && (retval != -ENXIO))
518 zfcp_adapter_put(adapter);
519
520 if (sg_list != NULL) {
521 zfcp_sg_list_free(sg_list);
522 kfree(sg_list);
523 }
524
525 kfree(sense_data);
526
527 return retval;
528 }
529
530
531 /**
532 * zfcp_sg_list_alloc - create a scatter-gather list of the specified size
533 * @sg_list: structure describing a scatter gather list
534 * @size: size of scatter-gather list
535 * Return: 0 on success, else -ENOMEM
536 *
537 * In sg_list->sg a pointer to the created scatter-gather list is returned,
538 * or NULL if we run out of memory. sg_list->count specifies the number of
539 * elements of the scatter-gather list. The maximum size of a single element
540 * in the scatter-gather list is PAGE_SIZE.
541 */
542 static int
543 zfcp_sg_list_alloc(struct zfcp_sg_list *sg_list, size_t size)
544 {
545 struct scatterlist *sg;
546 unsigned int i;
547 int retval = 0;
548 void *address;
549
550 BUG_ON(sg_list == NULL);
551
552 sg_list->count = size >> PAGE_SHIFT;
553 if (size & ~PAGE_MASK)
554 sg_list->count++;
555 sg_list->sg = kcalloc(sg_list->count, sizeof(struct scatterlist),
556 GFP_KERNEL);
557 if (sg_list->sg == NULL) {
558 sg_list->count = 0;
559 retval = -ENOMEM;
560 goto out;
561 }
562 sg_init_table(sg_list->sg, sg_list->count);
563
564 for (i = 0, sg = sg_list->sg; i < sg_list->count; i++, sg++) {
565 address = (void *) get_zeroed_page(GFP_KERNEL);
566 if (address == NULL) {
567 sg_list->count = i;
568 zfcp_sg_list_free(sg_list);
569 retval = -ENOMEM;
570 goto out;
571 }
572 zfcp_address_to_sg(address, sg, min(size, PAGE_SIZE));
573 size -= sg->length;
574 }
575
576 out:
577 return retval;
578 }
579
580
581 /**
582 * zfcp_sg_list_free - free memory of a scatter-gather list
583 * @sg_list: structure describing a scatter-gather list
584 *
585 * Memory for each element in the scatter-gather list is freed.
586 * Finally sg_list->sg is freed itself and sg_list->count is reset.
587 */
588 static void
589 zfcp_sg_list_free(struct zfcp_sg_list *sg_list)
590 {
591 struct scatterlist *sg;
592 unsigned int i;
593
594 BUG_ON(sg_list == NULL);
595
596 for (i = 0, sg = sg_list->sg; i < sg_list->count; i++, sg++)
597 free_page((unsigned long) zfcp_sg_to_address(sg));
598
599 sg_list->count = 0;
600 kfree(sg_list->sg);
601 }
602
603 /**
604 * zfcp_sg_size - determine size of a scatter-gather list
605 * @sg: array of (struct scatterlist)
606 * @sg_count: elements in array
607 * Return: size of entire scatter-gather list
608 */
609 static size_t zfcp_sg_size(struct scatterlist *sg, unsigned int sg_count)
610 {
611 unsigned int i;
612 struct scatterlist *p;
613 size_t size;
614
615 size = 0;
616 for (i = 0, p = sg; i < sg_count; i++, p++) {
617 BUG_ON(p == NULL);
618 size += p->length;
619 }
620
621 return size;
622 }
623
624
625 /**
626 * zfcp_sg_list_copy_from_user -copy data from user space to scatter-gather list
627 * @sg_list: structure describing a scatter-gather list
628 * @user_buffer: pointer to buffer in user space
629 * @size: number of bytes to be copied
630 * Return: 0 on success, -EFAULT if copy_from_user fails.
631 */
632 static int
633 zfcp_sg_list_copy_from_user(struct zfcp_sg_list *sg_list,
634 void __user *user_buffer,
635 size_t size)
636 {
637 struct scatterlist *sg;
638 unsigned int length;
639 void *zfcp_buffer;
640 int retval = 0;
641
642 BUG_ON(sg_list == NULL);
643
644 if (zfcp_sg_size(sg_list->sg, sg_list->count) < size)
645 return -EFAULT;
646
647 for (sg = sg_list->sg; size > 0; sg++) {
648 length = min((unsigned int)size, sg->length);
649 zfcp_buffer = zfcp_sg_to_address(sg);
650 if (copy_from_user(zfcp_buffer, user_buffer, length)) {
651 retval = -EFAULT;
652 goto out;
653 }
654 user_buffer += length;
655 size -= length;
656 }
657
658 out:
659 return retval;
660 }
661
662
663 /**
664 * zfcp_sg_list_copy_to_user - copy data from scatter-gather list to user space
665 * @user_buffer: pointer to buffer in user space
666 * @sg_list: structure describing a scatter-gather list
667 * @size: number of bytes to be copied
668 * Return: 0 on success, -EFAULT if copy_to_user fails
669 */
670 static int
671 zfcp_sg_list_copy_to_user(void __user *user_buffer,
672 struct zfcp_sg_list *sg_list,
673 size_t size)
674 {
675 struct scatterlist *sg;
676 unsigned int length;
677 void *zfcp_buffer;
678 int retval = 0;
679
680 BUG_ON(sg_list == NULL);
681
682 if (zfcp_sg_size(sg_list->sg, sg_list->count) < size)
683 return -EFAULT;
684
685 for (sg = sg_list->sg; size > 0; sg++) {
686 length = min((unsigned int) size, sg->length);
687 zfcp_buffer = zfcp_sg_to_address(sg);
688 if (copy_to_user(user_buffer, zfcp_buffer, length)) {
689 retval = -EFAULT;
690 goto out;
691 }
692 user_buffer += length;
693 size -= length;
694 }
695
696 out:
697 return retval;
698 }
699
700
701 #undef ZFCP_LOG_AREA
702
703 /****************************************************************/
704 /****** Functions for configuration/set-up of structures ********/
705 /****************************************************************/
706
707 #define ZFCP_LOG_AREA ZFCP_LOG_AREA_CONFIG
708
709 /**
710 * zfcp_get_unit_by_lun - find unit in unit list of port by FCP LUN
711 * @port: pointer to port to search for unit
712 * @fcp_lun: FCP LUN to search for
713 * Traverse list of all units of a port and return pointer to a unit
714 * with the given FCP LUN.
715 */
716 struct zfcp_unit *
717 zfcp_get_unit_by_lun(struct zfcp_port *port, fcp_lun_t fcp_lun)
718 {
719 struct zfcp_unit *unit;
720 int found = 0;
721
722 list_for_each_entry(unit, &port->unit_list_head, list) {
723 if ((unit->fcp_lun == fcp_lun) &&
724 !atomic_test_mask(ZFCP_STATUS_COMMON_REMOVE, &unit->status))
725 {
726 found = 1;
727 break;
728 }
729 }
730 return found ? unit : NULL;
731 }
732
733 /**
734 * zfcp_get_port_by_wwpn - find port in port list of adapter by wwpn
735 * @adapter: pointer to adapter to search for port
736 * @wwpn: wwpn to search for
737 * Traverse list of all ports of an adapter and return pointer to a port
738 * with the given wwpn.
739 */
740 struct zfcp_port *
741 zfcp_get_port_by_wwpn(struct zfcp_adapter *adapter, wwn_t wwpn)
742 {
743 struct zfcp_port *port;
744 int found = 0;
745
746 list_for_each_entry(port, &adapter->port_list_head, list) {
747 if ((port->wwpn == wwpn) &&
748 !(atomic_read(&port->status) &
749 (ZFCP_STATUS_PORT_NO_WWPN | ZFCP_STATUS_COMMON_REMOVE))) {
750 found = 1;
751 break;
752 }
753 }
754 return found ? port : NULL;
755 }
756
757 /**
758 * zfcp_get_port_by_did - find port in port list of adapter by d_id
759 * @adapter: pointer to adapter to search for port
760 * @d_id: d_id to search for
761 * Traverse list of all ports of an adapter and return pointer to a port
762 * with the given d_id.
763 */
764 struct zfcp_port *
765 zfcp_get_port_by_did(struct zfcp_adapter *adapter, u32 d_id)
766 {
767 struct zfcp_port *port;
768 int found = 0;
769
770 list_for_each_entry(port, &adapter->port_list_head, list) {
771 if ((port->d_id == d_id) &&
772 !atomic_test_mask(ZFCP_STATUS_COMMON_REMOVE, &port->status))
773 {
774 found = 1;
775 break;
776 }
777 }
778 return found ? port : NULL;
779 }
780
781 /**
782 * zfcp_get_adapter_by_busid - find adpater in adapter list by bus_id
783 * @bus_id: bus_id to search for
784 * Traverse list of all adapters and return pointer to an adapter
785 * with the given bus_id.
786 */
787 struct zfcp_adapter *
788 zfcp_get_adapter_by_busid(char *bus_id)
789 {
790 struct zfcp_adapter *adapter;
791 int found = 0;
792
793 list_for_each_entry(adapter, &zfcp_data.adapter_list_head, list) {
794 if ((strncmp(bus_id, zfcp_get_busid_by_adapter(adapter),
795 BUS_ID_SIZE) == 0) &&
796 !atomic_test_mask(ZFCP_STATUS_COMMON_REMOVE,
797 &adapter->status)){
798 found = 1;
799 break;
800 }
801 }
802 return found ? adapter : NULL;
803 }
804
805 /**
806 * zfcp_unit_enqueue - enqueue unit to unit list of a port.
807 * @port: pointer to port where unit is added
808 * @fcp_lun: FCP LUN of unit to be enqueued
809 * Return: pointer to enqueued unit on success, NULL on error
810 * Locks: config_sema must be held to serialize changes to the unit list
811 *
812 * Sets up some unit internal structures and creates sysfs entry.
813 */
814 struct zfcp_unit *
815 zfcp_unit_enqueue(struct zfcp_port *port, fcp_lun_t fcp_lun)
816 {
817 struct zfcp_unit *unit;
818
819 /*
820 * check that there is no unit with this FCP_LUN already in list
821 * and enqueue it.
822 * Note: Unlike for the adapter and the port, this is an error
823 */
824 read_lock_irq(&zfcp_data.config_lock);
825 unit = zfcp_get_unit_by_lun(port, fcp_lun);
826 read_unlock_irq(&zfcp_data.config_lock);
827 if (unit)
828 return NULL;
829
830 unit = kzalloc(sizeof (struct zfcp_unit), GFP_KERNEL);
831 if (!unit)
832 return NULL;
833
834 /* initialise reference count stuff */
835 atomic_set(&unit->refcount, 0);
836 init_waitqueue_head(&unit->remove_wq);
837
838 unit->port = port;
839 unit->fcp_lun = fcp_lun;
840
841 /* setup for sysfs registration */
842 snprintf(unit->sysfs_device.bus_id, BUS_ID_SIZE, "0x%016llx", fcp_lun);
843 unit->sysfs_device.parent = &port->sysfs_device;
844 unit->sysfs_device.release = zfcp_sysfs_unit_release;
845 dev_set_drvdata(&unit->sysfs_device, unit);
846
847 /* mark unit unusable as long as sysfs registration is not complete */
848 atomic_set_mask(ZFCP_STATUS_COMMON_REMOVE, &unit->status);
849
850 if (device_register(&unit->sysfs_device)) {
851 kfree(unit);
852 return NULL;
853 }
854
855 if (zfcp_sysfs_unit_create_files(&unit->sysfs_device)) {
856 device_unregister(&unit->sysfs_device);
857 return NULL;
858 }
859
860 zfcp_unit_get(unit);
861 unit->scsi_lun = scsilun_to_int((struct scsi_lun *)&unit->fcp_lun);
862
863 write_lock_irq(&zfcp_data.config_lock);
864 list_add_tail(&unit->list, &port->unit_list_head);
865 atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &unit->status);
866 atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &unit->status);
867 write_unlock_irq(&zfcp_data.config_lock);
868
869 port->units++;
870 zfcp_port_get(port);
871
872 return unit;
873 }
874
875 void
876 zfcp_unit_dequeue(struct zfcp_unit *unit)
877 {
878 zfcp_unit_wait(unit);
879 write_lock_irq(&zfcp_data.config_lock);
880 list_del(&unit->list);
881 write_unlock_irq(&zfcp_data.config_lock);
882 unit->port->units--;
883 zfcp_port_put(unit->port);
884 zfcp_sysfs_unit_remove_files(&unit->sysfs_device);
885 device_unregister(&unit->sysfs_device);
886 }
887
888 /*
889 * Allocates a combined QTCB/fsf_req buffer for erp actions and fcp/SCSI
890 * commands.
891 * It also genrates fcp-nameserver request/response buffer and unsolicited
892 * status read fsf_req buffers.
893 *
894 * locks: must only be called with zfcp_data.config_sema taken
895 */
896 static int
897 zfcp_allocate_low_mem_buffers(struct zfcp_adapter *adapter)
898 {
899 adapter->pool.fsf_req_erp =
900 mempool_create_slab_pool(ZFCP_POOL_FSF_REQ_ERP_NR,
901 zfcp_data.fsf_req_qtcb_cache);
902 if (!adapter->pool.fsf_req_erp)
903 return -ENOMEM;
904
905 adapter->pool.fsf_req_scsi =
906 mempool_create_slab_pool(ZFCP_POOL_FSF_REQ_SCSI_NR,
907 zfcp_data.fsf_req_qtcb_cache);
908 if (!adapter->pool.fsf_req_scsi)
909 return -ENOMEM;
910
911 adapter->pool.fsf_req_abort =
912 mempool_create_slab_pool(ZFCP_POOL_FSF_REQ_ABORT_NR,
913 zfcp_data.fsf_req_qtcb_cache);
914 if (!adapter->pool.fsf_req_abort)
915 return -ENOMEM;
916
917 adapter->pool.fsf_req_status_read =
918 mempool_create_kmalloc_pool(ZFCP_POOL_STATUS_READ_NR,
919 sizeof(struct zfcp_fsf_req));
920 if (!adapter->pool.fsf_req_status_read)
921 return -ENOMEM;
922
923 adapter->pool.data_status_read =
924 mempool_create_slab_pool(ZFCP_POOL_STATUS_READ_NR,
925 zfcp_data.sr_buffer_cache);
926 if (!adapter->pool.data_status_read)
927 return -ENOMEM;
928
929 adapter->pool.data_gid_pn =
930 mempool_create_slab_pool(ZFCP_POOL_DATA_GID_PN_NR,
931 zfcp_data.gid_pn_cache);
932 if (!adapter->pool.data_gid_pn)
933 return -ENOMEM;
934
935 return 0;
936 }
937
938 /**
939 * zfcp_free_low_mem_buffers - free memory pools of an adapter
940 * @adapter: pointer to zfcp_adapter for which memory pools should be freed
941 * locking: zfcp_data.config_sema must be held
942 */
943 static void
944 zfcp_free_low_mem_buffers(struct zfcp_adapter *adapter)
945 {
946 if (adapter->pool.fsf_req_erp)
947 mempool_destroy(adapter->pool.fsf_req_erp);
948 if (adapter->pool.fsf_req_scsi)
949 mempool_destroy(adapter->pool.fsf_req_scsi);
950 if (adapter->pool.fsf_req_abort)
951 mempool_destroy(adapter->pool.fsf_req_abort);
952 if (adapter->pool.fsf_req_status_read)
953 mempool_destroy(adapter->pool.fsf_req_status_read);
954 if (adapter->pool.data_status_read)
955 mempool_destroy(adapter->pool.data_status_read);
956 if (adapter->pool.data_gid_pn)
957 mempool_destroy(adapter->pool.data_gid_pn);
958 }
959
960 static void zfcp_dummy_release(struct device *dev)
961 {
962 return;
963 }
964
965 /*
966 * Enqueues an adapter at the end of the adapter list in the driver data.
967 * All adapter internal structures are set up.
968 * Proc-fs entries are also created.
969 *
970 * returns: 0 if a new adapter was successfully enqueued
971 * ZFCP_KNOWN if an adapter with this devno was already present
972 * -ENOMEM if alloc failed
973 * locks: config_sema must be held to serialise changes to the adapter list
974 */
975 struct zfcp_adapter *
976 zfcp_adapter_enqueue(struct ccw_device *ccw_device)
977 {
978 int retval = 0;
979 struct zfcp_adapter *adapter;
980
981 /*
982 * Note: It is safe to release the list_lock, as any list changes
983 * are protected by the config_sema, which must be held to get here
984 */
985
986 /* try to allocate new adapter data structure (zeroed) */
987 adapter = kzalloc(sizeof (struct zfcp_adapter), GFP_KERNEL);
988 if (!adapter) {
989 ZFCP_LOG_INFO("error: allocation of base adapter "
990 "structure failed\n");
991 goto out;
992 }
993
994 ccw_device->handler = NULL;
995
996 /* save ccw_device pointer */
997 adapter->ccw_device = ccw_device;
998
999 retval = zfcp_qdio_allocate_queues(adapter);
1000 if (retval)
1001 goto queues_alloc_failed;
1002
1003 retval = zfcp_qdio_allocate(adapter);
1004 if (retval)
1005 goto qdio_allocate_failed;
1006
1007 retval = zfcp_allocate_low_mem_buffers(adapter);
1008 if (retval) {
1009 ZFCP_LOG_INFO("error: pool allocation failed\n");
1010 goto failed_low_mem_buffers;
1011 }
1012
1013 /* initialise reference count stuff */
1014 atomic_set(&adapter->refcount, 0);
1015 init_waitqueue_head(&adapter->remove_wq);
1016
1017 /* initialise list of ports */
1018 INIT_LIST_HEAD(&adapter->port_list_head);
1019
1020 /* initialise list of ports to be removed */
1021 INIT_LIST_HEAD(&adapter->port_remove_lh);
1022
1023 /* initialize list of fsf requests */
1024 spin_lock_init(&adapter->req_list_lock);
1025 retval = zfcp_reqlist_alloc(adapter);
1026 if (retval) {
1027 ZFCP_LOG_INFO("request list initialization failed\n");
1028 goto failed_low_mem_buffers;
1029 }
1030
1031 /* initialize debug locks */
1032
1033 spin_lock_init(&adapter->erp_dbf_lock);
1034 spin_lock_init(&adapter->hba_dbf_lock);
1035 spin_lock_init(&adapter->san_dbf_lock);
1036 spin_lock_init(&adapter->scsi_dbf_lock);
1037
1038 retval = zfcp_adapter_debug_register(adapter);
1039 if (retval)
1040 goto debug_register_failed;
1041
1042 /* initialize error recovery stuff */
1043
1044 rwlock_init(&adapter->erp_lock);
1045 sema_init(&adapter->erp_ready_sem, 0);
1046 INIT_LIST_HEAD(&adapter->erp_ready_head);
1047 INIT_LIST_HEAD(&adapter->erp_running_head);
1048
1049 /* initialize abort lock */
1050 rwlock_init(&adapter->abort_lock);
1051
1052 /* initialise some erp stuff */
1053 init_waitqueue_head(&adapter->erp_thread_wqh);
1054 init_waitqueue_head(&adapter->erp_done_wqh);
1055
1056 /* initialize lock of associated request queue */
1057 rwlock_init(&adapter->request_queue.queue_lock);
1058
1059 /* mark adapter unusable as long as sysfs registration is not complete */
1060 atomic_set_mask(ZFCP_STATUS_COMMON_REMOVE, &adapter->status);
1061
1062 dev_set_drvdata(&ccw_device->dev, adapter);
1063
1064 if (zfcp_sysfs_adapter_create_files(&ccw_device->dev))
1065 goto sysfs_failed;
1066
1067 adapter->generic_services.parent = &adapter->ccw_device->dev;
1068 adapter->generic_services.release = zfcp_dummy_release;
1069 snprintf(adapter->generic_services.bus_id, BUS_ID_SIZE,
1070 "generic_services");
1071
1072 if (device_register(&adapter->generic_services))
1073 goto generic_services_failed;
1074
1075 /* put allocated adapter at list tail */
1076 write_lock_irq(&zfcp_data.config_lock);
1077 atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &adapter->status);
1078 list_add_tail(&adapter->list, &zfcp_data.adapter_list_head);
1079 write_unlock_irq(&zfcp_data.config_lock);
1080
1081 zfcp_data.adapters++;
1082
1083 goto out;
1084
1085 generic_services_failed:
1086 zfcp_sysfs_adapter_remove_files(&adapter->ccw_device->dev);
1087 sysfs_failed:
1088 zfcp_adapter_debug_unregister(adapter);
1089 debug_register_failed:
1090 dev_set_drvdata(&ccw_device->dev, NULL);
1091 zfcp_reqlist_free(adapter);
1092 failed_low_mem_buffers:
1093 zfcp_free_low_mem_buffers(adapter);
1094 if (qdio_free(ccw_device) != 0)
1095 ZFCP_LOG_NORMAL("bug: qdio_free for adapter %s failed\n",
1096 zfcp_get_busid_by_adapter(adapter));
1097 qdio_allocate_failed:
1098 zfcp_qdio_free_queues(adapter);
1099 queues_alloc_failed:
1100 kfree(adapter);
1101 adapter = NULL;
1102 out:
1103 return adapter;
1104 }
1105
1106 /*
1107 * returns: 0 - struct zfcp_adapter data structure successfully removed
1108 * !0 - struct zfcp_adapter data structure could not be removed
1109 * (e.g. still used)
1110 * locks: adapter list write lock is assumed to be held by caller
1111 */
1112 void
1113 zfcp_adapter_dequeue(struct zfcp_adapter *adapter)
1114 {
1115 int retval = 0;
1116 unsigned long flags;
1117
1118 zfcp_adapter_scsi_unregister(adapter);
1119 device_unregister(&adapter->generic_services);
1120 zfcp_sysfs_adapter_remove_files(&adapter->ccw_device->dev);
1121 dev_set_drvdata(&adapter->ccw_device->dev, NULL);
1122 /* sanity check: no pending FSF requests */
1123 spin_lock_irqsave(&adapter->req_list_lock, flags);
1124 retval = zfcp_reqlist_isempty(adapter);
1125 spin_unlock_irqrestore(&adapter->req_list_lock, flags);
1126 if (!retval) {
1127 ZFCP_LOG_NORMAL("bug: adapter %s (%p) still in use, "
1128 "%i requests outstanding\n",
1129 zfcp_get_busid_by_adapter(adapter), adapter,
1130 atomic_read(&adapter->reqs_active));
1131 retval = -EBUSY;
1132 goto out;
1133 }
1134
1135 zfcp_adapter_debug_unregister(adapter);
1136
1137 /* remove specified adapter data structure from list */
1138 write_lock_irq(&zfcp_data.config_lock);
1139 list_del(&adapter->list);
1140 write_unlock_irq(&zfcp_data.config_lock);
1141
1142 /* decrease number of adapters in list */
1143 zfcp_data.adapters--;
1144
1145 ZFCP_LOG_TRACE("adapter %s (%p) removed from list, "
1146 "%i adapters still in list\n",
1147 zfcp_get_busid_by_adapter(adapter),
1148 adapter, zfcp_data.adapters);
1149
1150 retval = qdio_free(adapter->ccw_device);
1151 if (retval)
1152 ZFCP_LOG_NORMAL("bug: qdio_free for adapter %s failed\n",
1153 zfcp_get_busid_by_adapter(adapter));
1154
1155 zfcp_free_low_mem_buffers(adapter);
1156 /* free memory of adapter data structure and queues */
1157 zfcp_qdio_free_queues(adapter);
1158 zfcp_reqlist_free(adapter);
1159 kfree(adapter->fc_stats);
1160 kfree(adapter->stats_reset_data);
1161 ZFCP_LOG_TRACE("freeing adapter structure\n");
1162 kfree(adapter);
1163 out:
1164 return;
1165 }
1166
1167 /**
1168 * zfcp_port_enqueue - enqueue port to port list of adapter
1169 * @adapter: adapter where remote port is added
1170 * @wwpn: WWPN of the remote port to be enqueued
1171 * @status: initial status for the port
1172 * @d_id: destination id of the remote port to be enqueued
1173 * Return: pointer to enqueued port on success, NULL on error
1174 * Locks: config_sema must be held to serialize changes to the port list
1175 *
1176 * All port internal structures are set up and the sysfs entry is generated.
1177 * d_id is used to enqueue ports with a well known address like the Directory
1178 * Service for nameserver lookup.
1179 */
1180 struct zfcp_port *
1181 zfcp_port_enqueue(struct zfcp_adapter *adapter, wwn_t wwpn, u32 status,
1182 u32 d_id)
1183 {
1184 struct zfcp_port *port;
1185 int check_wwpn;
1186
1187 check_wwpn = !(status & ZFCP_STATUS_PORT_NO_WWPN);
1188 /*
1189 * check that there is no port with this WWPN already in list
1190 */
1191 if (check_wwpn) {
1192 read_lock_irq(&zfcp_data.config_lock);
1193 port = zfcp_get_port_by_wwpn(adapter, wwpn);
1194 read_unlock_irq(&zfcp_data.config_lock);
1195 if (port)
1196 return NULL;
1197 }
1198
1199 port = kzalloc(sizeof (struct zfcp_port), GFP_KERNEL);
1200 if (!port)
1201 return NULL;
1202
1203 /* initialise reference count stuff */
1204 atomic_set(&port->refcount, 0);
1205 init_waitqueue_head(&port->remove_wq);
1206
1207 INIT_LIST_HEAD(&port->unit_list_head);
1208 INIT_LIST_HEAD(&port->unit_remove_lh);
1209
1210 port->adapter = adapter;
1211
1212 if (check_wwpn)
1213 port->wwpn = wwpn;
1214
1215 atomic_set_mask(status, &port->status);
1216
1217 /* setup for sysfs registration */
1218 if (status & ZFCP_STATUS_PORT_WKA) {
1219 switch (d_id) {
1220 case ZFCP_DID_DIRECTORY_SERVICE:
1221 snprintf(port->sysfs_device.bus_id, BUS_ID_SIZE,
1222 "directory");
1223 break;
1224 case ZFCP_DID_MANAGEMENT_SERVICE:
1225 snprintf(port->sysfs_device.bus_id, BUS_ID_SIZE,
1226 "management");
1227 break;
1228 case ZFCP_DID_KEY_DISTRIBUTION_SERVICE:
1229 snprintf(port->sysfs_device.bus_id, BUS_ID_SIZE,
1230 "key_distribution");
1231 break;
1232 case ZFCP_DID_ALIAS_SERVICE:
1233 snprintf(port->sysfs_device.bus_id, BUS_ID_SIZE,
1234 "alias");
1235 break;
1236 case ZFCP_DID_TIME_SERVICE:
1237 snprintf(port->sysfs_device.bus_id, BUS_ID_SIZE,
1238 "time");
1239 break;
1240 default:
1241 kfree(port);
1242 return NULL;
1243 }
1244 port->d_id = d_id;
1245 port->sysfs_device.parent = &adapter->generic_services;
1246 } else {
1247 snprintf(port->sysfs_device.bus_id,
1248 BUS_ID_SIZE, "0x%016llx", wwpn);
1249 port->sysfs_device.parent = &adapter->ccw_device->dev;
1250 }
1251 port->sysfs_device.release = zfcp_sysfs_port_release;
1252 dev_set_drvdata(&port->sysfs_device, port);
1253
1254 /* mark port unusable as long as sysfs registration is not complete */
1255 atomic_set_mask(ZFCP_STATUS_COMMON_REMOVE, &port->status);
1256
1257 if (device_register(&port->sysfs_device)) {
1258 kfree(port);
1259 return NULL;
1260 }
1261
1262 if (zfcp_sysfs_port_create_files(&port->sysfs_device, status)) {
1263 device_unregister(&port->sysfs_device);
1264 return NULL;
1265 }
1266
1267 zfcp_port_get(port);
1268
1269 write_lock_irq(&zfcp_data.config_lock);
1270 list_add_tail(&port->list, &adapter->port_list_head);
1271 atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &port->status);
1272 atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &port->status);
1273 if (d_id == ZFCP_DID_DIRECTORY_SERVICE)
1274 if (!adapter->nameserver_port)
1275 adapter->nameserver_port = port;
1276 adapter->ports++;
1277 write_unlock_irq(&zfcp_data.config_lock);
1278
1279 zfcp_adapter_get(adapter);
1280
1281 return port;
1282 }
1283
1284 void
1285 zfcp_port_dequeue(struct zfcp_port *port)
1286 {
1287 zfcp_port_wait(port);
1288 write_lock_irq(&zfcp_data.config_lock);
1289 list_del(&port->list);
1290 port->adapter->ports--;
1291 write_unlock_irq(&zfcp_data.config_lock);
1292 if (port->rport)
1293 fc_remote_port_delete(port->rport);
1294 port->rport = NULL;
1295 zfcp_adapter_put(port->adapter);
1296 zfcp_sysfs_port_remove_files(&port->sysfs_device,
1297 atomic_read(&port->status));
1298 device_unregister(&port->sysfs_device);
1299 }
1300
1301 /* Enqueues a nameserver port */
1302 int
1303 zfcp_nameserver_enqueue(struct zfcp_adapter *adapter)
1304 {
1305 struct zfcp_port *port;
1306
1307 port = zfcp_port_enqueue(adapter, 0, ZFCP_STATUS_PORT_WKA,
1308 ZFCP_DID_DIRECTORY_SERVICE);
1309 if (!port) {
1310 ZFCP_LOG_INFO("error: enqueue of nameserver port for "
1311 "adapter %s failed\n",
1312 zfcp_get_busid_by_adapter(adapter));
1313 return -ENXIO;
1314 }
1315 zfcp_port_put(port);
1316
1317 return 0;
1318 }
1319
1320 #undef ZFCP_LOG_AREA
1321
1322 /****************************************************************/
1323 /******* Fibre Channel Standard related Functions **************/
1324 /****************************************************************/
1325
1326 #define ZFCP_LOG_AREA ZFCP_LOG_AREA_FC
1327
1328 static void
1329 zfcp_fsf_incoming_els_rscn(struct zfcp_adapter *adapter,
1330 struct fsf_status_read_buffer *status_buffer)
1331 {
1332 struct fcp_rscn_head *fcp_rscn_head;
1333 struct fcp_rscn_element *fcp_rscn_element;
1334 struct zfcp_port *port;
1335 u16 i;
1336 u16 no_entries;
1337 u32 range_mask;
1338 unsigned long flags;
1339
1340 fcp_rscn_head = (struct fcp_rscn_head *) status_buffer->payload;
1341 fcp_rscn_element = (struct fcp_rscn_element *) status_buffer->payload;
1342
1343 /* see FC-FS */
1344 no_entries = (fcp_rscn_head->payload_len / 4);
1345
1346 for (i = 1; i < no_entries; i++) {
1347 /* skip head and start with 1st element */
1348 fcp_rscn_element++;
1349 switch (fcp_rscn_element->addr_format) {
1350 case ZFCP_PORT_ADDRESS:
1351 range_mask = ZFCP_PORTS_RANGE_PORT;
1352 break;
1353 case ZFCP_AREA_ADDRESS:
1354 range_mask = ZFCP_PORTS_RANGE_AREA;
1355 break;
1356 case ZFCP_DOMAIN_ADDRESS:
1357 range_mask = ZFCP_PORTS_RANGE_DOMAIN;
1358 break;
1359 case ZFCP_FABRIC_ADDRESS:
1360 range_mask = ZFCP_PORTS_RANGE_FABRIC;
1361 break;
1362 default:
1363 ZFCP_LOG_INFO("incoming RSCN with unknown "
1364 "address format\n");
1365 continue;
1366 }
1367 read_lock_irqsave(&zfcp_data.config_lock, flags);
1368 list_for_each_entry(port, &adapter->port_list_head, list) {
1369 if (atomic_test_mask
1370 (ZFCP_STATUS_PORT_WKA, &port->status))
1371 continue;
1372 /* Do we know this port? If not skip it. */
1373 if (!atomic_test_mask
1374 (ZFCP_STATUS_PORT_DID_DID, &port->status)) {
1375 ZFCP_LOG_INFO("incoming RSCN, trying to open "
1376 "port 0x%016Lx\n", port->wwpn);
1377 zfcp_erp_port_reopen(port,
1378 ZFCP_STATUS_COMMON_ERP_FAILED);
1379 continue;
1380 }
1381
1382 /*
1383 * FIXME: race: d_id might being invalidated
1384 * (...DID_DID reset)
1385 */
1386 if ((port->d_id & range_mask)
1387 == (fcp_rscn_element->nport_did & range_mask)) {
1388 ZFCP_LOG_TRACE("reopen did 0x%08x\n",
1389 fcp_rscn_element->nport_did);
1390 /*
1391 * Unfortunately, an RSCN does not specify the
1392 * type of change a target underwent. We assume
1393 * that it makes sense to reopen the link.
1394 * FIXME: Shall we try to find out more about
1395 * the target and link state before closing it?
1396 * How to accomplish this? (nameserver?)
1397 * Where would such code be put in?
1398 * (inside or outside erp)
1399 */
1400 ZFCP_LOG_INFO("incoming RSCN, trying to open "
1401 "port 0x%016Lx\n", port->wwpn);
1402 zfcp_test_link(port);
1403 }
1404 }
1405 read_unlock_irqrestore(&zfcp_data.config_lock, flags);
1406 }
1407 }
1408
1409 static void
1410 zfcp_fsf_incoming_els_plogi(struct zfcp_adapter *adapter,
1411 struct fsf_status_read_buffer *status_buffer)
1412 {
1413 struct fsf_plogi *els_plogi;
1414 struct zfcp_port *port;
1415 unsigned long flags;
1416
1417 els_plogi = (struct fsf_plogi *) status_buffer->payload;
1418 read_lock_irqsave(&zfcp_data.config_lock, flags);
1419 list_for_each_entry(port, &adapter->port_list_head, list) {
1420 if (port->wwpn == (*(wwn_t *) &els_plogi->serv_param.wwpn))
1421 break;
1422 }
1423 read_unlock_irqrestore(&zfcp_data.config_lock, flags);
1424
1425 if (!port || (port->wwpn != (*(wwn_t *) &els_plogi->serv_param.wwpn))) {
1426 ZFCP_LOG_DEBUG("ignored incoming PLOGI for nonexisting port "
1427 "with d_id 0x%06x on adapter %s\n",
1428 status_buffer->d_id,
1429 zfcp_get_busid_by_adapter(adapter));
1430 } else {
1431 zfcp_erp_port_forced_reopen(port, 0);
1432 }
1433 }
1434
1435 static void
1436 zfcp_fsf_incoming_els_logo(struct zfcp_adapter *adapter,
1437 struct fsf_status_read_buffer *status_buffer)
1438 {
1439 struct fcp_logo *els_logo = (struct fcp_logo *) status_buffer->payload;
1440 struct zfcp_port *port;
1441 unsigned long flags;
1442
1443 read_lock_irqsave(&zfcp_data.config_lock, flags);
1444 list_for_each_entry(port, &adapter->port_list_head, list) {
1445 if (port->wwpn == els_logo->nport_wwpn)
1446 break;
1447 }
1448 read_unlock_irqrestore(&zfcp_data.config_lock, flags);
1449
1450 if (!port || (port->wwpn != els_logo->nport_wwpn)) {
1451 ZFCP_LOG_DEBUG("ignored incoming LOGO for nonexisting port "
1452 "with d_id 0x%06x on adapter %s\n",
1453 status_buffer->d_id,
1454 zfcp_get_busid_by_adapter(adapter));
1455 } else {
1456 zfcp_erp_port_forced_reopen(port, 0);
1457 }
1458 }
1459
1460 static void
1461 zfcp_fsf_incoming_els_unknown(struct zfcp_adapter *adapter,
1462 struct fsf_status_read_buffer *status_buffer)
1463 {
1464 ZFCP_LOG_NORMAL("warning: unknown incoming ELS 0x%08x "
1465 "for adapter %s\n", *(u32 *) (status_buffer->payload),
1466 zfcp_get_busid_by_adapter(adapter));
1467
1468 }
1469
1470 void
1471 zfcp_fsf_incoming_els(struct zfcp_fsf_req *fsf_req)
1472 {
1473 struct fsf_status_read_buffer *status_buffer;
1474 u32 els_type;
1475 struct zfcp_adapter *adapter;
1476
1477 status_buffer = (struct fsf_status_read_buffer *) fsf_req->data;
1478 els_type = *(u32 *) (status_buffer->payload);
1479 adapter = fsf_req->adapter;
1480
1481 zfcp_san_dbf_event_incoming_els(fsf_req);
1482 if (els_type == LS_PLOGI)
1483 zfcp_fsf_incoming_els_plogi(adapter, status_buffer);
1484 else if (els_type == LS_LOGO)
1485 zfcp_fsf_incoming_els_logo(adapter, status_buffer);
1486 else if ((els_type & 0xffff0000) == LS_RSCN)
1487 /* we are only concerned with the command, not the length */
1488 zfcp_fsf_incoming_els_rscn(adapter, status_buffer);
1489 else
1490 zfcp_fsf_incoming_els_unknown(adapter, status_buffer);
1491 }
1492
1493
1494 /**
1495 * zfcp_gid_pn_buffers_alloc - allocate buffers for GID_PN nameserver request
1496 * @gid_pn: pointer to return pointer to struct zfcp_gid_pn_data
1497 * @pool: pointer to mempool_t if non-null memory pool is used for allocation
1498 */
1499 static int
1500 zfcp_gid_pn_buffers_alloc(struct zfcp_gid_pn_data **gid_pn, mempool_t *pool)
1501 {
1502 struct zfcp_gid_pn_data *data;
1503
1504 if (pool != NULL) {
1505 data = mempool_alloc(pool, GFP_ATOMIC);
1506 if (likely(data != NULL)) {
1507 data->ct.pool = pool;
1508 }
1509 } else {
1510 data = kmem_cache_alloc(zfcp_data.gid_pn_cache, GFP_ATOMIC);
1511 }
1512
1513 if (NULL == data)
1514 return -ENOMEM;
1515
1516 memset(data, 0, sizeof(*data));
1517 sg_init_table(&data->req , 1);
1518 sg_init_table(&data->resp , 1);
1519 data->ct.req = &data->req;
1520 data->ct.resp = &data->resp;
1521 data->ct.req_count = data->ct.resp_count = 1;
1522 zfcp_address_to_sg(&data->ct_iu_req, &data->req, sizeof(struct ct_iu_gid_pn_req));
1523 zfcp_address_to_sg(&data->ct_iu_resp, &data->resp, sizeof(struct ct_iu_gid_pn_resp));
1524
1525 *gid_pn = data;
1526 return 0;
1527 }
1528
1529 /**
1530 * zfcp_gid_pn_buffers_free - free buffers for GID_PN nameserver request
1531 * @gid_pn: pointer to struct zfcp_gid_pn_data which has to be freed
1532 */
1533 static void zfcp_gid_pn_buffers_free(struct zfcp_gid_pn_data *gid_pn)
1534 {
1535 if (gid_pn->ct.pool)
1536 mempool_free(gid_pn, gid_pn->ct.pool);
1537 else
1538 kmem_cache_free(zfcp_data.gid_pn_cache, gid_pn);
1539 }
1540
1541 /**
1542 * zfcp_ns_gid_pn_request - initiate GID_PN nameserver request
1543 * @erp_action: pointer to zfcp_erp_action where GID_PN request is needed
1544 */
1545 int
1546 zfcp_ns_gid_pn_request(struct zfcp_erp_action *erp_action)
1547 {
1548 int ret;
1549 struct ct_iu_gid_pn_req *ct_iu_req;
1550 struct zfcp_gid_pn_data *gid_pn;
1551 struct zfcp_adapter *adapter = erp_action->adapter;
1552
1553 ret = zfcp_gid_pn_buffers_alloc(&gid_pn, adapter->pool.data_gid_pn);
1554 if (ret < 0) {
1555 ZFCP_LOG_INFO("error: buffer allocation for gid_pn nameserver "
1556 "request failed for adapter %s\n",
1557 zfcp_get_busid_by_adapter(adapter));
1558 goto out;
1559 }
1560
1561 /* setup nameserver request */
1562 ct_iu_req = zfcp_sg_to_address(gid_pn->ct.req);
1563 ct_iu_req->header.revision = ZFCP_CT_REVISION;
1564 ct_iu_req->header.gs_type = ZFCP_CT_DIRECTORY_SERVICE;
1565 ct_iu_req->header.gs_subtype = ZFCP_CT_NAME_SERVER;
1566 ct_iu_req->header.options = ZFCP_CT_SYNCHRONOUS;
1567 ct_iu_req->header.cmd_rsp_code = ZFCP_CT_GID_PN;
1568 ct_iu_req->header.max_res_size = ZFCP_CT_MAX_SIZE;
1569 ct_iu_req->wwpn = erp_action->port->wwpn;
1570
1571 /* setup parameters for send generic command */
1572 gid_pn->ct.port = adapter->nameserver_port;
1573 gid_pn->ct.handler = zfcp_ns_gid_pn_handler;
1574 gid_pn->ct.handler_data = (unsigned long) gid_pn;
1575 gid_pn->ct.timeout = ZFCP_NS_GID_PN_TIMEOUT;
1576 gid_pn->port = erp_action->port;
1577
1578 ret = zfcp_fsf_send_ct(&gid_pn->ct, adapter->pool.fsf_req_erp,
1579 erp_action);
1580 if (ret) {
1581 ZFCP_LOG_INFO("error: initiation of gid_pn nameserver request "
1582 "failed for adapter %s\n",
1583 zfcp_get_busid_by_adapter(adapter));
1584
1585 zfcp_gid_pn_buffers_free(gid_pn);
1586 }
1587
1588 out:
1589 return ret;
1590 }
1591
1592 /**
1593 * zfcp_ns_gid_pn_handler - handler for GID_PN nameserver request
1594 * @data: unsigned long, contains pointer to struct zfcp_gid_pn_data
1595 */
1596 static void zfcp_ns_gid_pn_handler(unsigned long data)
1597 {
1598 struct zfcp_port *port;
1599 struct zfcp_send_ct *ct;
1600 struct ct_iu_gid_pn_req *ct_iu_req;
1601 struct ct_iu_gid_pn_resp *ct_iu_resp;
1602 struct zfcp_gid_pn_data *gid_pn;
1603
1604
1605 gid_pn = (struct zfcp_gid_pn_data *) data;
1606 port = gid_pn->port;
1607 ct = &gid_pn->ct;
1608 ct_iu_req = zfcp_sg_to_address(ct->req);
1609 ct_iu_resp = zfcp_sg_to_address(ct->resp);
1610
1611 if (ct->status != 0)
1612 goto failed;
1613
1614 if (zfcp_check_ct_response(&ct_iu_resp->header)) {
1615 /* FIXME: do we need some specific erp entry points */
1616 atomic_set_mask(ZFCP_STATUS_PORT_INVALID_WWPN, &port->status);
1617 goto failed;
1618 }
1619 /* paranoia */
1620 if (ct_iu_req->wwpn != port->wwpn) {
1621 ZFCP_LOG_NORMAL("bug: wwpn 0x%016Lx returned by nameserver "
1622 "lookup does not match expected wwpn 0x%016Lx "
1623 "for adapter %s\n", ct_iu_req->wwpn, port->wwpn,
1624 zfcp_get_busid_by_port(port));
1625 goto mismatch;
1626 }
1627
1628 /* looks like a valid d_id */
1629 port->d_id = ct_iu_resp->d_id & ZFCP_DID_MASK;
1630 atomic_set_mask(ZFCP_STATUS_PORT_DID_DID, &port->status);
1631 ZFCP_LOG_DEBUG("adapter %s: wwpn=0x%016Lx ---> d_id=0x%06x\n",
1632 zfcp_get_busid_by_port(port), port->wwpn, port->d_id);
1633 goto out;
1634
1635 mismatch:
1636 ZFCP_LOG_DEBUG("CT IUs do not match:\n");
1637 ZFCP_HEX_DUMP(ZFCP_LOG_LEVEL_DEBUG, (char *) ct_iu_req,
1638 sizeof(struct ct_iu_gid_pn_req));
1639 ZFCP_HEX_DUMP(ZFCP_LOG_LEVEL_DEBUG, (char *) ct_iu_resp,
1640 sizeof(struct ct_iu_gid_pn_resp));
1641
1642 failed:
1643 ZFCP_LOG_NORMAL("warning: failed gid_pn nameserver request for wwpn "
1644 "0x%016Lx for adapter %s\n",
1645 port->wwpn, zfcp_get_busid_by_port(port));
1646 out:
1647 zfcp_gid_pn_buffers_free(gid_pn);
1648 return;
1649 }
1650
1651 /* reject CT_IU reason codes acc. to FC-GS-4 */
1652 static const struct zfcp_rc_entry zfcp_ct_rc[] = {
1653 {0x01, "invalid command code"},
1654 {0x02, "invalid version level"},
1655 {0x03, "logical error"},
1656 {0x04, "invalid CT_IU size"},
1657 {0x05, "logical busy"},
1658 {0x07, "protocol error"},
1659 {0x09, "unable to perform command request"},
1660 {0x0b, "command not supported"},
1661 {0x0d, "server not available"},
1662 {0x0e, "session could not be established"},
1663 {0xff, "vendor specific error"},
1664 {0, NULL},
1665 };
1666
1667 /* LS_RJT reason codes acc. to FC-FS */
1668 static const struct zfcp_rc_entry zfcp_ls_rjt_rc[] = {
1669 {0x01, "invalid LS_Command code"},
1670 {0x03, "logical error"},
1671 {0x05, "logical busy"},
1672 {0x07, "protocol error"},
1673 {0x09, "unable to perform command request"},
1674 {0x0b, "command not supported"},
1675 {0x0e, "command already in progress"},
1676 {0xff, "vendor specific error"},
1677 {0, NULL},
1678 };
1679
1680 /* reject reason codes according to FC-PH/FC-FS */
1681 static const struct zfcp_rc_entry zfcp_p_rjt_rc[] = {
1682 {0x01, "invalid D_ID"},
1683 {0x02, "invalid S_ID"},
1684 {0x03, "Nx_Port not available, temporary"},
1685 {0x04, "Nx_Port not available, permament"},
1686 {0x05, "class not supported"},
1687 {0x06, "delimiter usage error"},
1688 {0x07, "TYPE not supported"},
1689 {0x08, "invalid Link_Control"},
1690 {0x09, "invalid R_CTL field"},
1691 {0x0a, "invalid F_CTL field"},
1692 {0x0b, "invalid OX_ID"},
1693 {0x0c, "invalid RX_ID"},
1694 {0x0d, "invalid SEQ_ID"},
1695 {0x0e, "invalid DF_CTL"},
1696 {0x0f, "invalid SEQ_CNT"},
1697 {0x10, "invalid parameter field"},
1698 {0x11, "exchange error"},
1699 {0x12, "protocol error"},
1700 {0x13, "incorrect length"},
1701 {0x14, "unsupported ACK"},
1702 {0x15, "class of service not supported by entity at FFFFFE"},
1703 {0x16, "login required"},
1704 {0x17, "excessive sequences attempted"},
1705 {0x18, "unable to establish exchange"},
1706 {0x1a, "fabric path not available"},
1707 {0x1b, "invalid VC_ID (class 4)"},
1708 {0x1c, "invalid CS_CTL field"},
1709 {0x1d, "insufficient resources for VC (class 4)"},
1710 {0x1f, "invalid class of service"},
1711 {0x20, "preemption request rejected"},
1712 {0x21, "preemption not enabled"},
1713 {0x22, "multicast error"},
1714 {0x23, "multicast error terminate"},
1715 {0x24, "process login required"},
1716 {0xff, "vendor specific reject"},
1717 {0, NULL},
1718 };
1719
1720 /**
1721 * zfcp_rc_description - return description for given reaon code
1722 * @code: reason code
1723 * @rc_table: table of reason codes and descriptions
1724 */
1725 static const char *
1726 zfcp_rc_description(u8 code, const struct zfcp_rc_entry *rc_table)
1727 {
1728 const char *descr = "unknown reason code";
1729
1730 do {
1731 if (code == rc_table->code) {
1732 descr = rc_table->description;
1733 break;
1734 }
1735 rc_table++;
1736 } while (rc_table->code && rc_table->description);
1737
1738 return descr;
1739 }
1740
1741 /**
1742 * zfcp_check_ct_response - evaluate reason code for CT_IU
1743 * @rjt: response payload to an CT_IU request
1744 * Return: 0 for accept CT_IU, 1 for reject CT_IU or invlid response code
1745 */
1746 int
1747 zfcp_check_ct_response(struct ct_hdr *rjt)
1748 {
1749 if (rjt->cmd_rsp_code == ZFCP_CT_ACCEPT)
1750 return 0;
1751
1752 if (rjt->cmd_rsp_code != ZFCP_CT_REJECT) {
1753 ZFCP_LOG_NORMAL("error: invalid Generic Service command/"
1754 "response code (0x%04hx)\n",
1755 rjt->cmd_rsp_code);
1756 return 1;
1757 }
1758
1759 ZFCP_LOG_INFO("Generic Service command rejected\n");
1760 ZFCP_LOG_INFO("%s (0x%02x, 0x%02x, 0x%02x)\n",
1761 zfcp_rc_description(rjt->reason_code, zfcp_ct_rc),
1762 (u32) rjt->reason_code, (u32) rjt->reason_code_expl,
1763 (u32) rjt->vendor_unique);
1764
1765 return 1;
1766 }
1767
1768 /**
1769 * zfcp_print_els_rjt - print reject parameter and description for ELS reject
1770 * @rjt_par: reject parameter acc. to FC-PH/FC-FS
1771 * @rc_table: table of reason codes and descriptions
1772 */
1773 static void
1774 zfcp_print_els_rjt(struct zfcp_ls_rjt_par *rjt_par,
1775 const struct zfcp_rc_entry *rc_table)
1776 {
1777 ZFCP_LOG_INFO("%s (%02x %02x %02x %02x)\n",
1778 zfcp_rc_description(rjt_par->reason_code, rc_table),
1779 (u32) rjt_par->action, (u32) rjt_par->reason_code,
1780 (u32) rjt_par->reason_expl, (u32) rjt_par->vendor_unique);
1781 }
1782
1783 /**
1784 * zfcp_fsf_handle_els_rjt - evaluate status qualifier/reason code on ELS reject
1785 * @sq: status qualifier word
1786 * @rjt_par: reject parameter as described in FC-PH and FC-FS
1787 * Return: -EROMTEIO for LS_RJT, -EREMCHG for invalid D_ID, -EIO else
1788 */
1789 int
1790 zfcp_handle_els_rjt(u32 sq, struct zfcp_ls_rjt_par *rjt_par)
1791 {
1792 int ret = -EIO;
1793
1794 if (sq == FSF_IOSTAT_NPORT_RJT) {
1795 ZFCP_LOG_INFO("ELS rejected (P_RJT)\n");
1796 zfcp_print_els_rjt(rjt_par, zfcp_p_rjt_rc);
1797 /* invalid d_id */
1798 if (rjt_par->reason_code == 0x01)
1799 ret = -EREMCHG;
1800 } else if (sq == FSF_IOSTAT_FABRIC_RJT) {
1801 ZFCP_LOG_INFO("ELS rejected (F_RJT)\n");
1802 zfcp_print_els_rjt(rjt_par, zfcp_p_rjt_rc);
1803 /* invalid d_id */
1804 if (rjt_par->reason_code == 0x01)
1805 ret = -EREMCHG;
1806 } else if (sq == FSF_IOSTAT_LS_RJT) {
1807 ZFCP_LOG_INFO("ELS rejected (LS_RJT)\n");
1808 zfcp_print_els_rjt(rjt_par, zfcp_ls_rjt_rc);
1809 ret = -EREMOTEIO;
1810 } else
1811 ZFCP_LOG_INFO("unexpected SQ: 0x%02x\n", sq);
1812
1813 return ret;
1814 }
1815
1816 /**
1817 * zfcp_plogi_evaluate - evaluate PLOGI playload and copy important fields
1818 * into zfcp_port structure
1819 * @port: zfcp_port structure
1820 * @plogi: plogi payload
1821 */
1822 void
1823 zfcp_plogi_evaluate(struct zfcp_port *port, struct fsf_plogi *plogi)
1824 {
1825 port->maxframe_size = plogi->serv_param.common_serv_param[7] |
1826 ((plogi->serv_param.common_serv_param[6] & 0x0F) << 8);
1827 if (plogi->serv_param.class1_serv_param[0] & 0x80)
1828 port->supported_classes |= FC_COS_CLASS1;
1829 if (plogi->serv_param.class2_serv_param[0] & 0x80)
1830 port->supported_classes |= FC_COS_CLASS2;
1831 if (plogi->serv_param.class3_serv_param[0] & 0x80)
1832 port->supported_classes |= FC_COS_CLASS3;
1833 if (plogi->serv_param.class4_serv_param[0] & 0x80)
1834 port->supported_classes |= FC_COS_CLASS4;
1835 }
1836
1837 #undef ZFCP_LOG_AREA
WRT350N Kernel Patches