]> git.proxmox.com Git - mirror_ubuntu-focal-kernel.git/blame - drivers/s390/scsi/zfcp_aux.c
Merge remote-tracking branches 'asoc/topic/tas6424', 'asoc/topic/tfa9879', 'asoc...
[mirror_ubuntu-focal-kernel.git] / drivers / s390 / scsi / zfcp_aux.c
CommitLineData
40bf411e 1// SPDX-License-Identifier: GPL-2.0
1da177e4 2/*
553448f6 3 * zfcp device driver
1da177e4 4 *
553448f6 5 * Module interface and handling of zfcp data structures.
1da177e4 6 *
9edf7d75 7 * Copyright IBM Corp. 2002, 2013
1da177e4
LT
8 */
9
4a9d2d8b
AH
10/*
11 * Driver authors:
12 * Martin Peschke (originator of the driver)
13 * Raimund Schroeder
14 * Aron Zeh
15 * Wolfgang Taphorn
16 * Stefan Bader
17 * Heiko Carstens (kernel 2.6 port of the driver)
18 * Andreas Herrmann
19 * Maxim Shchetynin
20 * Volker Sameske
21 * Ralph Wuerthner
553448f6
CS
22 * Michael Loehr
23 * Swen Schillig
24 * Christof Schmitt
25 * Martin Petermann
26 * Sven Schuetz
9edf7d75 27 * Steffen Maier
4a9d2d8b
AH
28 */
29
ecf39d42
CS
30#define KMSG_COMPONENT "zfcp"
31#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
32
bd43a42b 33#include <linux/seq_file.h>
5a0e3ad6 34#include <linux/slab.h>
3a4c5d59 35#include <linux/module.h>
1da177e4 36#include "zfcp_ext.h"
dbf5dfe9 37#include "zfcp_fc.h"
b6bd2fb9 38#include "zfcp_reqlist.h"
1da177e4 39
98df67b3
KS
40#define ZFCP_BUS_ID_SIZE 20
41
4a9d2d8b 42MODULE_AUTHOR("IBM Deutschland Entwicklung GmbH - linux390@de.ibm.com");
317e6b65 43MODULE_DESCRIPTION("FCP HBA driver");
1da177e4
LT
44MODULE_LICENSE("GPL");
45
3623ecba
CS
46static char *init_device;
47module_param_named(device, init_device, charp, 0400);
1da177e4
LT
48MODULE_PARM_DESC(device, "specify initial device");
49
51780d2c
CS
50static struct kmem_cache * __init zfcp_cache_hw_align(const char *name,
51 unsigned long size)
a4623c46
SS
52{
53 return kmem_cache_create(name, size, roundup_pow_of_two(size), 0, NULL);
54}
55
3623ecba 56static void __init zfcp_init_device_configure(char *busid, u64 wwpn, u64 lun)
1da177e4 57{
de3dc572 58 struct ccw_device *cdev;
1da177e4
LT
59 struct zfcp_adapter *adapter;
60 struct zfcp_port *port;
1da177e4 61
de3dc572
SS
62 cdev = get_ccwdev_by_busid(&zfcp_ccw_driver, busid);
63 if (!cdev)
c5afd81e
CS
64 return;
65
de3dc572
SS
66 if (ccw_device_set_online(cdev))
67 goto out_ccw_device;
1da177e4 68
de3dc572 69 adapter = zfcp_ccw_adapter_by_cdev(cdev);
317e6b65 70 if (!adapter)
de3dc572 71 goto out_ccw_device;
c5afd81e
CS
72
73 port = zfcp_get_port_by_wwpn(adapter, wwpn);
74 if (!port)
1da177e4 75 goto out_port;
91978465 76 flush_work(&port->rport_work);
091694a5 77
1daa4eb5 78 zfcp_unit_add(port, lun);
615f59e0 79 put_device(&port->dev);
1daa4eb5 80
317e6b65 81out_port:
de3dc572
SS
82 zfcp_ccw_adapter_put(adapter);
83out_ccw_device:
84 put_device(&cdev->dev);
1da177e4
LT
85 return;
86}
87
3623ecba
CS
88static void __init zfcp_init_device_setup(char *devstr)
89{
90 char *token;
d10c0858 91 char *str, *str_saved;
3623ecba
CS
92 char busid[ZFCP_BUS_ID_SIZE];
93 u64 wwpn, lun;
94
95 /* duplicate devstr and keep the original for sysfs presentation*/
674c3a99 96 str_saved = kstrdup(devstr, GFP_KERNEL);
d10c0858 97 str = str_saved;
3623ecba
CS
98 if (!str)
99 return;
100
3623ecba
CS
101 token = strsep(&str, ",");
102 if (!token || strlen(token) >= ZFCP_BUS_ID_SIZE)
103 goto err_out;
104 strncpy(busid, token, ZFCP_BUS_ID_SIZE);
105
106 token = strsep(&str, ",");
ee732ea8 107 if (!token || kstrtoull(token, 0, (unsigned long long *) &wwpn))
3623ecba
CS
108 goto err_out;
109
110 token = strsep(&str, ",");
ee732ea8 111 if (!token || kstrtoull(token, 0, (unsigned long long *) &lun))
3623ecba
CS
112 goto err_out;
113
d10c0858 114 kfree(str_saved);
3623ecba
CS
115 zfcp_init_device_configure(busid, wwpn, lun);
116 return;
117
d10c0858
HC
118err_out:
119 kfree(str_saved);
3623ecba
CS
120 pr_err("%s is not a valid SCSI device\n", devstr);
121}
122
317e6b65 123static int __init zfcp_module_init(void)
1da177e4 124{
dd52e0ea 125 int retval = -ENOMEM;
dd52e0ea 126
259afe2e
CS
127 zfcp_fsf_qtcb_cache = zfcp_cache_hw_align("zfcp_fsf_qtcb",
128 sizeof(struct fsf_qtcb));
129 if (!zfcp_fsf_qtcb_cache)
a4623c46
SS
130 goto out_qtcb_cache;
131
087897e3
CS
132 zfcp_fc_req_cache = zfcp_cache_hw_align("zfcp_fc_req",
133 sizeof(struct zfcp_fc_req));
134 if (!zfcp_fc_req_cache)
135 goto out_fc_cache;
ee744622 136
1947c72a 137 zfcp_scsi_transport_template =
dd52e0ea 138 fc_attach_transport(&zfcp_transport_functions);
1947c72a 139 if (!zfcp_scsi_transport_template)
dd52e0ea 140 goto out_transport;
1947c72a 141 scsi_transport_reserve_device(zfcp_scsi_transport_template,
57c23773
CS
142 sizeof(struct zfcp_scsi_dev));
143
c1fad417 144 retval = ccw_driver_register(&zfcp_ccw_driver);
1da177e4 145 if (retval) {
ecf39d42 146 pr_err("The zfcp device driver could not register with "
ff3b24fa 147 "the common I/O layer\n");
1da177e4
LT
148 goto out_ccw_register;
149 }
150
3623ecba
CS
151 if (init_device)
152 zfcp_init_device_setup(init_device);
153 return 0;
1da177e4 154
317e6b65 155out_ccw_register:
1947c72a 156 fc_release_transport(zfcp_scsi_transport_template);
317e6b65 157out_transport:
087897e3
CS
158 kmem_cache_destroy(zfcp_fc_req_cache);
159out_fc_cache:
259afe2e 160 kmem_cache_destroy(zfcp_fsf_qtcb_cache);
a4623c46 161out_qtcb_cache:
1da177e4
LT
162 return retval;
163}
164
317e6b65 165module_init(zfcp_module_init);
1da177e4 166
c1fad417
CS
167static void __exit zfcp_module_exit(void)
168{
169 ccw_driver_unregister(&zfcp_ccw_driver);
1947c72a 170 fc_release_transport(zfcp_scsi_transport_template);
087897e3 171 kmem_cache_destroy(zfcp_fc_req_cache);
259afe2e 172 kmem_cache_destroy(zfcp_fsf_qtcb_cache);
c1fad417
CS
173}
174
175module_exit(zfcp_module_exit);
176
1da177e4
LT
177/**
178 * zfcp_get_port_by_wwpn - find port in port list of adapter by wwpn
179 * @adapter: pointer to adapter to search for port
180 * @wwpn: wwpn to search for
317e6b65
SS
181 *
182 * Returns: pointer to zfcp_port or NULL
1da177e4 183 */
317e6b65 184struct zfcp_port *zfcp_get_port_by_wwpn(struct zfcp_adapter *adapter,
7ba58c9c 185 u64 wwpn)
1da177e4 186{
ecf0c772 187 unsigned long flags;
1da177e4 188 struct zfcp_port *port;
1da177e4 189
ecf0c772
SS
190 read_lock_irqsave(&adapter->port_list_lock, flags);
191 list_for_each_entry(port, &adapter->port_list, list)
6b183334 192 if (port->wwpn == wwpn) {
615f59e0 193 if (!get_device(&port->dev))
6b183334 194 port = NULL;
ecf0c772 195 read_unlock_irqrestore(&adapter->port_list_lock, flags);
317e6b65 196 return port;
ecf0c772
SS
197 }
198 read_unlock_irqrestore(&adapter->port_list_lock, flags);
317e6b65 199 return NULL;
1da177e4
LT
200}
201
317e6b65 202static int zfcp_allocate_low_mem_buffers(struct zfcp_adapter *adapter)
1da177e4 203{
a4623c46
SS
204 adapter->pool.erp_req =
205 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
206 if (!adapter->pool.erp_req)
1da177e4
LT
207 return -ENOMEM;
208
799b76d0
CS
209 adapter->pool.gid_pn_req =
210 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
211 if (!adapter->pool.gid_pn_req)
212 return -ENOMEM;
213
a4623c46
SS
214 adapter->pool.scsi_req =
215 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
216 if (!adapter->pool.scsi_req)
1da177e4
LT
217 return -ENOMEM;
218
a4623c46
SS
219 adapter->pool.scsi_abort =
220 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
221 if (!adapter->pool.scsi_abort)
1da177e4
LT
222 return -ENOMEM;
223
a4623c46 224 adapter->pool.status_read_req =
317e6b65 225 mempool_create_kmalloc_pool(FSF_STATUS_READS_RECOM,
0eaae62a 226 sizeof(struct zfcp_fsf_req));
a4623c46
SS
227 if (!adapter->pool.status_read_req)
228 return -ENOMEM;
229
230 adapter->pool.qtcb_pool =
259afe2e 231 mempool_create_slab_pool(4, zfcp_fsf_qtcb_cache);
a4623c46 232 if (!adapter->pool.qtcb_pool)
1da177e4
LT
233 return -ENOMEM;
234
c7b279ae
CS
235 BUILD_BUG_ON(sizeof(struct fsf_status_read_buffer) > PAGE_SIZE);
236 adapter->pool.sr_data =
237 mempool_create_page_pool(FSF_STATUS_READS_RECOM, 0);
238 if (!adapter->pool.sr_data)
1da177e4
LT
239 return -ENOMEM;
240
dbf5dfe9 241 adapter->pool.gid_pn =
fcf7e614 242 mempool_create_slab_pool(1, zfcp_fc_req_cache);
dbf5dfe9 243 if (!adapter->pool.gid_pn)
1da177e4
LT
244 return -ENOMEM;
245
246 return 0;
247}
248
317e6b65 249static void zfcp_free_low_mem_buffers(struct zfcp_adapter *adapter)
1da177e4 250{
a4623c46
SS
251 if (adapter->pool.erp_req)
252 mempool_destroy(adapter->pool.erp_req);
253 if (adapter->pool.scsi_req)
254 mempool_destroy(adapter->pool.scsi_req);
255 if (adapter->pool.scsi_abort)
256 mempool_destroy(adapter->pool.scsi_abort);
257 if (adapter->pool.qtcb_pool)
258 mempool_destroy(adapter->pool.qtcb_pool);
259 if (adapter->pool.status_read_req)
260 mempool_destroy(adapter->pool.status_read_req);
c7b279ae
CS
261 if (adapter->pool.sr_data)
262 mempool_destroy(adapter->pool.sr_data);
dbf5dfe9
CS
263 if (adapter->pool.gid_pn)
264 mempool_destroy(adapter->pool.gid_pn);
1da177e4
LT
265}
266
317e6b65
SS
267/**
268 * zfcp_status_read_refill - refill the long running status_read_requests
269 * @adapter: ptr to struct zfcp_adapter for which the buffers should be refilled
270 *
271 * Returns: 0 on success, 1 otherwise
272 *
273 * if there are 16 or more status_read requests missing an adapter_reopen
274 * is triggered
275 */
d26ab06e
SS
276int zfcp_status_read_refill(struct zfcp_adapter *adapter)
277{
278 while (atomic_read(&adapter->stat_miss) > 0)
564e1c86 279 if (zfcp_fsf_status_read(adapter->qdio)) {
64deb6ef
CS
280 if (atomic_read(&adapter->stat_miss) >=
281 adapter->stat_read_buf_num) {
ea4a3a6a 282 zfcp_erp_adapter_reopen(adapter, 0, "axsref1");
7afe29f7
SS
283 return 1;
284 }
d26ab06e 285 break;
7afe29f7
SS
286 } else
287 atomic_dec(&adapter->stat_miss);
d26ab06e
SS
288 return 0;
289}
290
291static void _zfcp_status_read_scheduler(struct work_struct *work)
292{
293 zfcp_status_read_refill(container_of(work, struct zfcp_adapter,
294 stat_work));
295}
296
bd43a42b
CS
297static void zfcp_print_sl(struct seq_file *m, struct service_level *sl)
298{
299 struct zfcp_adapter *adapter =
300 container_of(sl, struct zfcp_adapter, service_level);
301
302 seq_printf(m, "zfcp: %s microcode level %x\n",
303 dev_name(&adapter->ccw_device->dev),
304 adapter->fsf_lic_version);
305}
306
4544683a
SS
307static int zfcp_setup_adapter_work_queue(struct zfcp_adapter *adapter)
308{
309 char name[TASK_COMM_LEN];
310
311 snprintf(name, sizeof(name), "zfcp_q_%s",
312 dev_name(&adapter->ccw_device->dev));
e68f1d4c 313 adapter->work_queue = alloc_ordered_workqueue(name, WQ_MEM_RECLAIM);
4544683a
SS
314
315 if (adapter->work_queue)
316 return 0;
317 return -ENOMEM;
318}
319
320static void zfcp_destroy_adapter_work_queue(struct zfcp_adapter *adapter)
321{
322 if (adapter->work_queue)
323 destroy_workqueue(adapter->work_queue);
324 adapter->work_queue = NULL;
325
326}
327
317e6b65
SS
328/**
329 * zfcp_adapter_enqueue - enqueue a new adapter to the list
330 * @ccw_device: pointer to the struct cc_device
331 *
de3dc572 332 * Returns: struct zfcp_adapter*
1da177e4
LT
333 * Enqueues an adapter at the end of the adapter list in the driver data.
334 * All adapter internal structures are set up.
335 * Proc-fs entries are also created.
1da177e4 336 */
de3dc572 337struct zfcp_adapter *zfcp_adapter_enqueue(struct ccw_device *ccw_device)
1da177e4 338{
1da177e4
LT
339 struct zfcp_adapter *adapter;
340
f3450c7b 341 if (!get_device(&ccw_device->dev))
de3dc572 342 return ERR_PTR(-ENODEV);
1da177e4 343
317e6b65 344 adapter = kzalloc(sizeof(struct zfcp_adapter), GFP_KERNEL);
f3450c7b
SS
345 if (!adapter) {
346 put_device(&ccw_device->dev);
de3dc572 347 return ERR_PTR(-ENOMEM);
f3450c7b
SS
348 }
349
350 kref_init(&adapter->ref);
1da177e4
LT
351
352 ccw_device->handler = NULL;
1da177e4 353 adapter->ccw_device = ccw_device;
f3450c7b
SS
354
355 INIT_WORK(&adapter->stat_work, _zfcp_status_read_scheduler);
18f87a67 356 INIT_DELAYED_WORK(&adapter->scan_work, zfcp_fc_scan_ports);
038d9446 357 INIT_WORK(&adapter->ns_up_work, zfcp_fc_sym_name_update);
1da177e4 358
18f87a67
MP
359 adapter->next_port_scan = jiffies;
360
ab31fd0c
SM
361 adapter->erp_action.adapter = adapter;
362
d5a282a1 363 if (zfcp_qdio_setup(adapter))
f3450c7b 364 goto failed;
1da177e4 365
00bab910 366 if (zfcp_allocate_low_mem_buffers(adapter))
f3450c7b 367 goto failed;
1da177e4 368
b6bd2fb9
CS
369 adapter->req_list = zfcp_reqlist_alloc();
370 if (!adapter->req_list)
f3450c7b 371 goto failed;
317e6b65 372
5771710b 373 if (zfcp_dbf_adapter_register(adapter))
f3450c7b 374 goto failed;
317e6b65 375
4544683a 376 if (zfcp_setup_adapter_work_queue(adapter))
f3450c7b 377 goto failed;
4544683a 378
d5a282a1 379 if (zfcp_fc_gs_setup(adapter))
f3450c7b 380 goto failed;
d5a282a1 381
ecf0c772
SS
382 rwlock_init(&adapter->port_list_lock);
383 INIT_LIST_HEAD(&adapter->port_list);
384
2d1e547f
SS
385 INIT_LIST_HEAD(&adapter->events.list);
386 INIT_WORK(&adapter->events.work, zfcp_fc_post_event);
387 spin_lock_init(&adapter->events.list_lock);
388
347c6a96 389 init_waitqueue_head(&adapter->erp_ready_wq);
317e6b65 390 init_waitqueue_head(&adapter->erp_done_wqh);
1da177e4 391
317e6b65
SS
392 INIT_LIST_HEAD(&adapter->erp_ready_head);
393 INIT_LIST_HEAD(&adapter->erp_running_head);
1da177e4 394
c48a29d0 395 rwlock_init(&adapter->erp_lock);
1da177e4
LT
396 rwlock_init(&adapter->abort_lock);
397
143bb6bf 398 if (zfcp_erp_thread_setup(adapter))
f3450c7b 399 goto failed;
1da177e4 400
bd43a42b
CS
401 adapter->service_level.seq_print = zfcp_print_sl;
402
1da177e4
LT
403 dev_set_drvdata(&ccw_device->dev, adapter);
404
60221920
SS
405 if (sysfs_create_group(&ccw_device->dev.kobj,
406 &zfcp_sysfs_adapter_attrs))
f3450c7b 407 goto failed;
1da177e4 408
68322984
CS
409 /* report size limit per scatter-gather segment */
410 adapter->dma_parms.max_segment_size = ZFCP_QDIO_SBALE_LEN;
411 adapter->ccw_device->dev.dma_parms = &adapter->dma_parms;
412
9edf7d75
SM
413 adapter->stat_read_buf_num = FSF_STATUS_READS_RECOM;
414
1947c72a 415 if (!zfcp_scsi_adapter_register(adapter))
de3dc572 416 return adapter;
1da177e4 417
f3450c7b 418failed:
de3dc572
SS
419 zfcp_adapter_unregister(adapter);
420 return ERR_PTR(-ENOMEM);
421}
422
423void zfcp_adapter_unregister(struct zfcp_adapter *adapter)
424{
425 struct ccw_device *cdev = adapter->ccw_device;
426
18f87a67 427 cancel_delayed_work_sync(&adapter->scan_work);
de3dc572 428 cancel_work_sync(&adapter->stat_work);
038d9446 429 cancel_work_sync(&adapter->ns_up_work);
de3dc572
SS
430 zfcp_destroy_adapter_work_queue(adapter);
431
432 zfcp_fc_wka_ports_force_offline(adapter->gs);
1947c72a 433 zfcp_scsi_adapter_unregister(adapter);
de3dc572
SS
434 sysfs_remove_group(&cdev->dev.kobj, &zfcp_sysfs_adapter_attrs);
435
436 zfcp_erp_thread_kill(adapter);
ea4a3a6a 437 zfcp_dbf_adapter_unregister(adapter);
de3dc572
SS
438 zfcp_qdio_destroy(adapter->qdio);
439
440 zfcp_ccw_adapter_put(adapter); /* final put to release */
1da177e4
LT
441}
442
317e6b65 443/**
f3450c7b
SS
444 * zfcp_adapter_release - remove the adapter from the resource list
445 * @ref: pointer to struct kref
1da177e4 446 * locks: adapter list write lock is assumed to be held by caller
1da177e4 447 */
f3450c7b 448void zfcp_adapter_release(struct kref *ref)
1da177e4 449{
f3450c7b
SS
450 struct zfcp_adapter *adapter = container_of(ref, struct zfcp_adapter,
451 ref);
de3dc572 452 struct ccw_device *cdev = adapter->ccw_device;
1da177e4 453
f3450c7b 454 dev_set_drvdata(&adapter->ccw_device->dev, NULL);
d5a282a1 455 zfcp_fc_gs_destroy(adapter);
1da177e4 456 zfcp_free_low_mem_buffers(adapter);
317e6b65 457 kfree(adapter->req_list);
f6cd94b1
AH
458 kfree(adapter->fc_stats);
459 kfree(adapter->stats_reset_data);
1da177e4 460 kfree(adapter);
de3dc572 461 put_device(&cdev->dev);
f3450c7b
SS
462}
463
f3450c7b 464static void zfcp_port_release(struct device *dev)
60221920 465{
615f59e0 466 struct zfcp_port *port = container_of(dev, struct zfcp_port, dev);
f3450c7b 467
de3dc572 468 zfcp_ccw_adapter_put(port->adapter);
f3450c7b 469 kfree(port);
60221920
SS
470}
471
1da177e4
LT
472/**
473 * zfcp_port_enqueue - enqueue port to port list of adapter
474 * @adapter: adapter where remote port is added
475 * @wwpn: WWPN of the remote port to be enqueued
476 * @status: initial status for the port
477 * @d_id: destination id of the remote port to be enqueued
317e6b65 478 * Returns: pointer to enqueued port on success, ERR_PTR on error
1da177e4
LT
479 *
480 * All port internal structures are set up and the sysfs entry is generated.
481 * d_id is used to enqueue ports with a well known address like the Directory
482 * Service for nameserver lookup.
483 */
7ba58c9c 484struct zfcp_port *zfcp_port_enqueue(struct zfcp_adapter *adapter, u64 wwpn,
317e6b65 485 u32 status, u32 d_id)
1da177e4 486{
3859f6a2 487 struct zfcp_port *port;
f3450c7b
SS
488 int retval = -ENOMEM;
489
490 kref_get(&adapter->ref);
0fac3f47 491
ecf0c772
SS
492 port = zfcp_get_port_by_wwpn(adapter, wwpn);
493 if (port) {
615f59e0 494 put_device(&port->dev);
f3450c7b
SS
495 retval = -EEXIST;
496 goto err_out;
0fac3f47 497 }
1da177e4 498
317e6b65 499 port = kzalloc(sizeof(struct zfcp_port), GFP_KERNEL);
1da177e4 500 if (!port)
f3450c7b 501 goto err_out;
1da177e4 502
ecf0c772
SS
503 rwlock_init(&port->unit_list_lock);
504 INIT_LIST_HEAD(&port->unit_list);
d99b601b 505 atomic_set(&port->units, 0);
ecf0c772 506
799b76d0 507 INIT_WORK(&port->gid_pn_work, zfcp_fc_port_did_lookup);
8fdf30d5 508 INIT_WORK(&port->test_link_work, zfcp_fc_link_test_work);
a2fa0aed 509 INIT_WORK(&port->rport_work, zfcp_scsi_rport_work);
1da177e4
LT
510
511 port->adapter = adapter;
317e6b65
SS
512 port->d_id = d_id;
513 port->wwpn = wwpn;
a2fa0aed 514 port->rport_task = RPORT_NONE;
615f59e0 515 port->dev.parent = &adapter->ccw_device->dev;
83d4e1c3 516 port->dev.groups = zfcp_port_attr_groups;
615f59e0 517 port->dev.release = zfcp_port_release;
1da177e4 518
ab31fd0c
SM
519 port->erp_action.adapter = adapter;
520 port->erp_action.port = port;
521
615f59e0 522 if (dev_set_name(&port->dev, "0x%016llx", (unsigned long long)wwpn)) {
0fac3f47 523 kfree(port);
f3450c7b 524 goto err_out;
0fac3f47 525 }
f3450c7b 526 retval = -EINVAL;
1da177e4 527
615f59e0
CS
528 if (device_register(&port->dev)) {
529 put_device(&port->dev);
f3450c7b 530 goto err_out;
f4395b65 531 }
1da177e4 532
ecf0c772
SS
533 write_lock_irq(&adapter->port_list_lock);
534 list_add_tail(&port->list, &adapter->port_list);
535 write_unlock_irq(&adapter->port_list_lock);
536
805de8f4 537 atomic_or(status | ZFCP_STATUS_COMMON_RUNNING, &port->status);
317e6b65 538
1da177e4 539 return port;
1da177e4 540
f3450c7b 541err_out:
de3dc572 542 zfcp_ccw_adapter_put(adapter);
f3450c7b 543 return ERR_PTR(retval);
1da177e4
LT
544}
545
317e6b65
SS
546/**
547 * zfcp_sg_free_table - free memory used by scatterlists
548 * @sg: pointer to scatterlist
549 * @count: number of scatterlist which are to be free'ed
550 * the scatterlist are expected to reference pages always
551 */
45633fdc
CS
552void zfcp_sg_free_table(struct scatterlist *sg, int count)
553{
554 int i;
555
556 for (i = 0; i < count; i++, sg++)
557 if (sg)
558 free_page((unsigned long) sg_virt(sg));
559 else
560 break;
561}
562
317e6b65
SS
563/**
564 * zfcp_sg_setup_table - init scatterlist and allocate, assign buffers
565 * @sg: pointer to struct scatterlist
566 * @count: number of scatterlists which should be assigned with buffers
567 * of size page
568 *
569 * Returns: 0 on success, -ENOMEM otherwise
570 */
45633fdc
CS
571int zfcp_sg_setup_table(struct scatterlist *sg, int count)
572{
573 void *addr;
574 int i;
575
576 sg_init_table(sg, count);
577 for (i = 0; i < count; i++, sg++) {
578 addr = (void *) get_zeroed_page(GFP_KERNEL);
579 if (!addr) {
580 zfcp_sg_free_table(sg, i);
581 return -ENOMEM;
582 }
583 sg_set_buf(sg, addr, PAGE_SIZE);
584 }
585 return 0;
586}