zfcp_aux.c 19.4 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
C
Christof Schmitt 已提交
2
 * zfcp device driver
L
Linus Torvalds 已提交
3
 *
C
Christof Schmitt 已提交
4
 * Module interface and handling of zfcp data structures.
L
Linus Torvalds 已提交
5
 *
6
 * Copyright IBM Corporation 2002, 2009
L
Linus Torvalds 已提交
7 8
 */

9 10 11 12 13 14 15 16 17 18 19 20
/*
 * Driver authors:
 *            Martin Peschke (originator of the driver)
 *            Raimund Schroeder
 *            Aron Zeh
 *            Wolfgang Taphorn
 *            Stefan Bader
 *            Heiko Carstens (kernel 2.6 port of the driver)
 *            Andreas Herrmann
 *            Maxim Shchetynin
 *            Volker Sameske
 *            Ralph Wuerthner
C
Christof Schmitt 已提交
21 22 23 24 25
 *            Michael Loehr
 *            Swen Schillig
 *            Christof Schmitt
 *            Martin Petermann
 *            Sven Schuetz
26 27
 */

28 29 30
#define KMSG_COMPONENT "zfcp"
#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt

31
#include <linux/miscdevice.h>
32
#include <linux/seq_file.h>
L
Linus Torvalds 已提交
33 34
#include "zfcp_ext.h"

35 36
#define ZFCP_BUS_ID_SIZE	20

37
MODULE_AUTHOR("IBM Deutschland Entwicklung GmbH - linux390@de.ibm.com");
38
MODULE_DESCRIPTION("FCP HBA driver");
L
Linus Torvalds 已提交
39 40
MODULE_LICENSE("GPL");

41 42
static char *init_device;
module_param_named(device, init_device, charp, 0400);
L
Linus Torvalds 已提交
43 44
MODULE_PARM_DESC(device, "specify initial device");

45
static int zfcp_reqlist_alloc(struct zfcp_adapter *adapter)
46
{
47
	int idx;
48 49 50 51 52 53

	adapter->req_list = kcalloc(REQUEST_LIST_SIZE, sizeof(struct list_head),
				    GFP_KERNEL);
	if (!adapter->req_list)
		return -ENOMEM;

54 55
	for (idx = 0; idx < REQUEST_LIST_SIZE; idx++)
		INIT_LIST_HEAD(&adapter->req_list[idx]);
56 57 58
	return 0;
}

59 60 61 62 63 64
/**
 * zfcp_reqlist_isempty - is the request list empty
 * @adapter: pointer to struct zfcp_adapter
 *
 * Returns: true if list is empty, false otherwise
 */
65 66
int zfcp_reqlist_isempty(struct zfcp_adapter *adapter)
{
67
	unsigned int idx;
68

69 70
	for (idx = 0; idx < REQUEST_LIST_SIZE; idx++)
		if (!list_empty(&adapter->req_list[idx]))
71 72 73 74
			return 0;
	return 1;
}

75
static void __init zfcp_init_device_configure(char *busid, u64 wwpn, u64 lun)
L
Linus Torvalds 已提交
76 77 78 79 80 81 82
{
	struct zfcp_adapter *adapter;
	struct zfcp_port *port;
	struct zfcp_unit *unit;

	down(&zfcp_data.config_sema);
	read_lock_irq(&zfcp_data.config_lock);
83
	adapter = zfcp_get_adapter_by_busid(busid);
L
Linus Torvalds 已提交
84 85 86 87
	if (adapter)
		zfcp_adapter_get(adapter);
	read_unlock_irq(&zfcp_data.config_lock);

88
	if (!adapter)
L
Linus Torvalds 已提交
89
		goto out_adapter;
90
	port = zfcp_port_enqueue(adapter, wwpn, 0, 0);
91
	if (IS_ERR(port))
L
Linus Torvalds 已提交
92
		goto out_port;
93
	unit = zfcp_unit_enqueue(port, lun);
94
	if (IS_ERR(unit))
L
Linus Torvalds 已提交
95 96 97
		goto out_unit;
	up(&zfcp_data.config_sema);
	ccw_device_set_online(adapter->ccw_device);
98

L
Linus Torvalds 已提交
99
	zfcp_erp_wait(adapter);
100
	flush_work(&unit->scsi_work);
101

L
Linus Torvalds 已提交
102 103
	down(&zfcp_data.config_sema);
	zfcp_unit_put(unit);
104
out_unit:
L
Linus Torvalds 已提交
105
	zfcp_port_put(port);
106
out_port:
L
Linus Torvalds 已提交
107
	zfcp_adapter_put(adapter);
108
out_adapter:
L
Linus Torvalds 已提交
109 110 111 112
	up(&zfcp_data.config_sema);
	return;
}

113
static struct kmem_cache *zfcp_cache_create(int size, char *name)
114 115 116 117
{
	int align = 1;
	while ((size - align) > 0)
		align <<= 1;
118
	return kmem_cache_create(name , size, align, 0, NULL);
119 120
}

121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156
static void __init zfcp_init_device_setup(char *devstr)
{
	char *token;
	char *str;
	char busid[ZFCP_BUS_ID_SIZE];
	u64 wwpn, lun;

	/* duplicate devstr and keep the original for sysfs presentation*/
	str = kmalloc(strlen(devstr) + 1, GFP_KERNEL);
	if (!str)
		return;

	strcpy(str, devstr);

	token = strsep(&str, ",");
	if (!token || strlen(token) >= ZFCP_BUS_ID_SIZE)
		goto err_out;
	strncpy(busid, token, ZFCP_BUS_ID_SIZE);

	token = strsep(&str, ",");
	if (!token || strict_strtoull(token, 0, (unsigned long long *) &wwpn))
		goto err_out;

	token = strsep(&str, ",");
	if (!token || strict_strtoull(token, 0, (unsigned long long *) &lun))
		goto err_out;

	kfree(str);
	zfcp_init_device_configure(busid, wwpn, lun);
	return;

 err_out:
	kfree(str);
	pr_err("%s is not a valid SCSI device\n", devstr);
}

157
static int __init zfcp_module_init(void)
L
Linus Torvalds 已提交
158
{
159 160
	int retval = -ENOMEM;

161 162
	zfcp_data.fsf_req_qtcb_cache = zfcp_cache_create(
			sizeof(struct zfcp_fsf_req_qtcb), "zfcp_fsf");
163 164
	if (!zfcp_data.fsf_req_qtcb_cache)
		goto out;
L
Linus Torvalds 已提交
165

166 167
	zfcp_data.sr_buffer_cache = zfcp_cache_create(
			sizeof(struct fsf_status_read_buffer), "zfcp_sr");
168 169 170
	if (!zfcp_data.sr_buffer_cache)
		goto out_sr_cache;

171 172
	zfcp_data.gid_pn_cache = zfcp_cache_create(
			sizeof(struct zfcp_gid_pn_data), "zfcp_gid");
173 174
	if (!zfcp_data.gid_pn_cache)
		goto out_gid_cache;
L
Linus Torvalds 已提交
175

176 177
	zfcp_data.work_queue = create_singlethread_workqueue("zfcp_wq");

178 179 180
	sema_init(&zfcp_data.config_sema, 1);
	rwlock_init(&zfcp_data.config_lock);

181 182 183 184
	zfcp_data.scsi_transport_template =
		fc_attach_transport(&zfcp_transport_functions);
	if (!zfcp_data.scsi_transport_template)
		goto out_transport;
L
Linus Torvalds 已提交
185 186

	retval = misc_register(&zfcp_cfdc_misc);
187
	if (retval) {
188
		pr_err("Registering the misc device zfcp_cfdc failed\n");
189
		goto out_misc;
L
Linus Torvalds 已提交
190 191 192 193
	}

	retval = zfcp_ccw_register();
	if (retval) {
194
		pr_err("The zfcp device driver could not register with "
195
		       "the common I/O layer\n");
L
Linus Torvalds 已提交
196 197 198
		goto out_ccw_register;
	}

199 200 201
	if (init_device)
		zfcp_init_device_setup(init_device);
	return 0;
L
Linus Torvalds 已提交
202

203
out_ccw_register:
L
Linus Torvalds 已提交
204
	misc_deregister(&zfcp_cfdc_misc);
205
out_misc:
206
	fc_release_transport(zfcp_data.scsi_transport_template);
207
out_transport:
208
	kmem_cache_destroy(zfcp_data.gid_pn_cache);
209
out_gid_cache:
210
	kmem_cache_destroy(zfcp_data.sr_buffer_cache);
211
out_sr_cache:
212
	kmem_cache_destroy(zfcp_data.fsf_req_qtcb_cache);
213
out:
L
Linus Torvalds 已提交
214 215 216
	return retval;
}

217
module_init(zfcp_module_init);
L
Linus Torvalds 已提交
218 219 220 221 222

/**
 * zfcp_get_unit_by_lun - find unit in unit list of port by FCP LUN
 * @port: pointer to port to search for unit
 * @fcp_lun: FCP LUN to search for
223 224
 *
 * Returns: pointer to zfcp_unit or NULL
L
Linus Torvalds 已提交
225
 */
226
struct zfcp_unit *zfcp_get_unit_by_lun(struct zfcp_port *port, u64 fcp_lun)
L
Linus Torvalds 已提交
227 228 229
{
	struct zfcp_unit *unit;

230
	list_for_each_entry(unit, &port->unit_list_head, list)
L
Linus Torvalds 已提交
231
		if ((unit->fcp_lun == fcp_lun) &&
232 233 234
		    !(atomic_read(&unit->status) & ZFCP_STATUS_COMMON_REMOVE))
		    return unit;
	return NULL;
L
Linus Torvalds 已提交
235 236 237 238 239 240
}

/**
 * zfcp_get_port_by_wwpn - find port in port list of adapter by wwpn
 * @adapter: pointer to adapter to search for port
 * @wwpn: wwpn to search for
241 242
 *
 * Returns: pointer to zfcp_port or NULL
L
Linus Torvalds 已提交
243
 */
244
struct zfcp_port *zfcp_get_port_by_wwpn(struct zfcp_adapter *adapter,
245
					u64 wwpn)
L
Linus Torvalds 已提交
246 247 248
{
	struct zfcp_port *port;

249
	list_for_each_entry(port, &adapter->port_list_head, list)
250 251
		if ((port->wwpn == wwpn) &&
		    !(atomic_read(&port->status) & ZFCP_STATUS_COMMON_REMOVE))
252 253
			return port;
	return NULL;
L
Linus Torvalds 已提交
254 255
}

256 257 258 259 260
static void zfcp_sysfs_unit_release(struct device *dev)
{
	kfree(container_of(dev, struct zfcp_unit, sysfs_device));
}

L
Linus Torvalds 已提交
261 262 263 264
/**
 * zfcp_unit_enqueue - enqueue unit to unit list of a port.
 * @port: pointer to port where unit is added
 * @fcp_lun: FCP LUN of unit to be enqueued
265
 * Returns: pointer to enqueued unit on success, ERR_PTR on error
L
Linus Torvalds 已提交
266 267 268 269
 * Locks: config_sema must be held to serialize changes to the unit list
 *
 * Sets up some unit internal structures and creates sysfs entry.
 */
270
struct zfcp_unit *zfcp_unit_enqueue(struct zfcp_port *port, u64 fcp_lun)
L
Linus Torvalds 已提交
271
{
272
	struct zfcp_unit *unit;
L
Linus Torvalds 已提交
273

274
	unit = kzalloc(sizeof(struct zfcp_unit), GFP_KERNEL);
L
Linus Torvalds 已提交
275
	if (!unit)
276
		return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
277 278 279

	atomic_set(&unit->refcount, 0);
	init_waitqueue_head(&unit->remove_wq);
280
	INIT_WORK(&unit->scsi_work, zfcp_scsi_scan);
L
Linus Torvalds 已提交
281 282 283 284

	unit->port = port;
	unit->fcp_lun = fcp_lun;

285 286
	dev_set_name(&unit->sysfs_device, "0x%016llx",
		     (unsigned long long) fcp_lun);
L
Linus Torvalds 已提交
287 288 289 290 291 292 293
	unit->sysfs_device.parent = &port->sysfs_device;
	unit->sysfs_device.release = zfcp_sysfs_unit_release;
	dev_set_drvdata(&unit->sysfs_device, unit);

	/* mark unit unusable as long as sysfs registration is not complete */
	atomic_set_mask(ZFCP_STATUS_COMMON_REMOVE, &unit->status);

294 295 296 297 298 299 300 301
	spin_lock_init(&unit->latencies.lock);
	unit->latencies.write.channel.min = 0xFFFFFFFF;
	unit->latencies.write.fabric.min = 0xFFFFFFFF;
	unit->latencies.read.channel.min = 0xFFFFFFFF;
	unit->latencies.read.fabric.min = 0xFFFFFFFF;
	unit->latencies.cmd.channel.min = 0xFFFFFFFF;
	unit->latencies.cmd.fabric.min = 0xFFFFFFFF;

302 303 304 305
	read_lock_irq(&zfcp_data.config_lock);
	if (zfcp_get_unit_by_lun(port, fcp_lun)) {
		read_unlock_irq(&zfcp_data.config_lock);
		goto err_out_free;
L
Linus Torvalds 已提交
306
	}
307 308 309 310
	read_unlock_irq(&zfcp_data.config_lock);

	if (device_register(&unit->sysfs_device))
		goto err_out_free;
L
Linus Torvalds 已提交
311

312 313
	if (sysfs_create_group(&unit->sysfs_device.kobj,
			       &zfcp_sysfs_unit_attrs)) {
L
Linus Torvalds 已提交
314
		device_unregister(&unit->sysfs_device);
315
		return ERR_PTR(-EIO);
L
Linus Torvalds 已提交
316 317 318 319 320
	}

	zfcp_unit_get(unit);

	write_lock_irq(&zfcp_data.config_lock);
321
	list_add_tail(&unit->list, &port->unit_list_head);
L
Linus Torvalds 已提交
322 323
	atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &unit->status);
	atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &unit->status);
324

L
Linus Torvalds 已提交
325 326 327 328 329
	write_unlock_irq(&zfcp_data.config_lock);

	zfcp_port_get(port);

	return unit;
330 331 332 333

err_out_free:
	kfree(unit);
	return ERR_PTR(-EINVAL);
L
Linus Torvalds 已提交
334 335
}

336 337 338 339 340 341 342 343
/**
 * zfcp_unit_dequeue - dequeue unit
 * @unit: pointer to zfcp_unit
 *
 * waits until all work is done on unit and removes it then from the unit->list
 * of the associated port.
 */
void zfcp_unit_dequeue(struct zfcp_unit *unit)
L
Linus Torvalds 已提交
344
{
345
	wait_event(unit->remove_wq, atomic_read(&unit->refcount) == 0);
L
Linus Torvalds 已提交
346 347 348 349
	write_lock_irq(&zfcp_data.config_lock);
	list_del(&unit->list);
	write_unlock_irq(&zfcp_data.config_lock);
	zfcp_port_put(unit->port);
350
	sysfs_remove_group(&unit->sysfs_device.kobj, &zfcp_sysfs_unit_attrs);
L
Linus Torvalds 已提交
351 352 353
	device_unregister(&unit->sysfs_device);
}

354
static int zfcp_allocate_low_mem_buffers(struct zfcp_adapter *adapter)
L
Linus Torvalds 已提交
355
{
356
	/* must only be called with zfcp_data.config_sema taken */
L
Linus Torvalds 已提交
357
	adapter->pool.fsf_req_erp =
358
		mempool_create_slab_pool(1, zfcp_data.fsf_req_qtcb_cache);
359
	if (!adapter->pool.fsf_req_erp)
L
Linus Torvalds 已提交
360 361 362
		return -ENOMEM;

	adapter->pool.fsf_req_scsi =
363
		mempool_create_slab_pool(1, zfcp_data.fsf_req_qtcb_cache);
364
	if (!adapter->pool.fsf_req_scsi)
L
Linus Torvalds 已提交
365 366 367
		return -ENOMEM;

	adapter->pool.fsf_req_abort =
368
		mempool_create_slab_pool(1, zfcp_data.fsf_req_qtcb_cache);
369
	if (!adapter->pool.fsf_req_abort)
L
Linus Torvalds 已提交
370 371 372
		return -ENOMEM;

	adapter->pool.fsf_req_status_read =
373
		mempool_create_kmalloc_pool(FSF_STATUS_READS_RECOM,
374 375
					    sizeof(struct zfcp_fsf_req));
	if (!adapter->pool.fsf_req_status_read)
L
Linus Torvalds 已提交
376 377 378
		return -ENOMEM;

	adapter->pool.data_status_read =
379
		mempool_create_slab_pool(FSF_STATUS_READS_RECOM,
380
					 zfcp_data.sr_buffer_cache);
381
	if (!adapter->pool.data_status_read)
L
Linus Torvalds 已提交
382 383 384
		return -ENOMEM;

	adapter->pool.data_gid_pn =
385
		mempool_create_slab_pool(1, zfcp_data.gid_pn_cache);
386
	if (!adapter->pool.data_gid_pn)
L
Linus Torvalds 已提交
387 388 389 390 391
		return -ENOMEM;

	return 0;
}

392
static void zfcp_free_low_mem_buffers(struct zfcp_adapter *adapter)
L
Linus Torvalds 已提交
393
{
394
	/* zfcp_data.config_sema must be held */
L
Linus Torvalds 已提交
395 396 397 398 399 400 401 402 403 404 405 406 407 408
	if (adapter->pool.fsf_req_erp)
		mempool_destroy(adapter->pool.fsf_req_erp);
	if (adapter->pool.fsf_req_scsi)
		mempool_destroy(adapter->pool.fsf_req_scsi);
	if (adapter->pool.fsf_req_abort)
		mempool_destroy(adapter->pool.fsf_req_abort);
	if (adapter->pool.fsf_req_status_read)
		mempool_destroy(adapter->pool.fsf_req_status_read);
	if (adapter->pool.data_status_read)
		mempool_destroy(adapter->pool.data_status_read);
	if (adapter->pool.data_gid_pn)
		mempool_destroy(adapter->pool.data_gid_pn);
}

409 410 411 412 413 414 415 416 417
/**
 * zfcp_status_read_refill - refill the long running status_read_requests
 * @adapter: ptr to struct zfcp_adapter for which the buffers should be refilled
 *
 * Returns: 0 on success, 1 otherwise
 *
 * if there are 16 or more status_read requests missing an adapter_reopen
 * is triggered
 */
418 419 420
int zfcp_status_read_refill(struct zfcp_adapter *adapter)
{
	while (atomic_read(&adapter->stat_miss) > 0)
S
Swen Schillig 已提交
421
		if (zfcp_fsf_status_read(adapter)) {
422
			if (atomic_read(&adapter->stat_miss) >= 16) {
423 424
				zfcp_erp_adapter_reopen(adapter, 0, "axsref1",
							NULL);
425 426
				return 1;
			}
427
			break;
428 429
		} else
			atomic_dec(&adapter->stat_miss);
430 431 432 433 434 435 436 437 438
	return 0;
}

static void _zfcp_status_read_scheduler(struct work_struct *work)
{
	zfcp_status_read_refill(container_of(work, struct zfcp_adapter,
					     stat_work));
}

439 440 441 442 443 444 445 446 447 448
static void zfcp_print_sl(struct seq_file *m, struct service_level *sl)
{
	struct zfcp_adapter *adapter =
		container_of(sl, struct zfcp_adapter, service_level);

	seq_printf(m, "zfcp: %s microcode level %x\n",
		   dev_name(&adapter->ccw_device->dev),
		   adapter->fsf_lic_version);
}

449 450 451 452 453 454
/**
 * zfcp_adapter_enqueue - enqueue a new adapter to the list
 * @ccw_device: pointer to the struct cc_device
 *
 * Returns:	0             if a new adapter was successfully enqueued
 *		-ENOMEM       if alloc failed
L
Linus Torvalds 已提交
455 456 457 458 459
 * Enqueues an adapter at the end of the adapter list in the driver data.
 * All adapter internal structures are set up.
 * Proc-fs entries are also created.
 * locks:	config_sema must be held to serialise changes to the adapter list
 */
460
int zfcp_adapter_enqueue(struct ccw_device *ccw_device)
L
Linus Torvalds 已提交
461 462 463 464
{
	struct zfcp_adapter *adapter;

	/*
S
Swen Schillig 已提交
465
	 * Note: It is safe to release the list_lock, as any list changes
L
Linus Torvalds 已提交
466 467 468
	 * are protected by the config_sema, which must be held to get here
	 */

469
	adapter = kzalloc(sizeof(struct zfcp_adapter), GFP_KERNEL);
C
Christof Schmitt 已提交
470
	if (!adapter)
471
		return -ENOMEM;
L
Linus Torvalds 已提交
472

473 474 475 476 477 478
	adapter->gs = kzalloc(sizeof(struct zfcp_wka_ports), GFP_KERNEL);
	if (!adapter->gs) {
		kfree(adapter);
		return -ENOMEM;
	}

L
Linus Torvalds 已提交
479 480
	ccw_device->handler = NULL;
	adapter->ccw_device = ccw_device;
481
	atomic_set(&adapter->refcount, 0);
L
Linus Torvalds 已提交
482

S
Swen Schillig 已提交
483
	if (zfcp_qdio_allocate(adapter))
L
Linus Torvalds 已提交
484 485
		goto qdio_allocate_failed;

S
Swen Schillig 已提交
486
	if (zfcp_allocate_low_mem_buffers(adapter))
L
Linus Torvalds 已提交
487 488
		goto failed_low_mem_buffers;

489 490 491 492 493 494
	if (zfcp_reqlist_alloc(adapter))
		goto failed_low_mem_buffers;

	if (zfcp_adapter_debug_register(adapter))
		goto debug_register_failed;

L
Linus Torvalds 已提交
495
	init_waitqueue_head(&adapter->remove_wq);
496 497
	init_waitqueue_head(&adapter->erp_thread_wqh);
	init_waitqueue_head(&adapter->erp_done_wqh);
L
Linus Torvalds 已提交
498 499

	INIT_LIST_HEAD(&adapter->port_list_head);
500 501
	INIT_LIST_HEAD(&adapter->erp_ready_head);
	INIT_LIST_HEAD(&adapter->erp_running_head);
L
Linus Torvalds 已提交
502

503
	spin_lock_init(&adapter->req_list_lock);
504 505 506 507

	spin_lock_init(&adapter->hba_dbf_lock);
	spin_lock_init(&adapter->san_dbf_lock);
	spin_lock_init(&adapter->scsi_dbf_lock);
508
	spin_lock_init(&adapter->rec_dbf_lock);
509
	spin_lock_init(&adapter->req_q_lock);
510
	spin_lock_init(&adapter->qdio_stat_lock);
511 512

	rwlock_init(&adapter->erp_lock);
L
Linus Torvalds 已提交
513 514
	rwlock_init(&adapter->abort_lock);

515
	sema_init(&adapter->erp_ready_sem, 0);
L
Linus Torvalds 已提交
516

517
	INIT_WORK(&adapter->stat_work, _zfcp_status_read_scheduler);
518
	INIT_WORK(&adapter->scan_work, _zfcp_scan_ports_later);
L
Linus Torvalds 已提交
519

520 521
	adapter->service_level.seq_print = zfcp_print_sl;

L
Linus Torvalds 已提交
522 523 524 525 526
	/* mark adapter unusable as long as sysfs registration is not complete */
	atomic_set_mask(ZFCP_STATUS_COMMON_REMOVE, &adapter->status);

	dev_set_drvdata(&ccw_device->dev, adapter);

527 528
	if (sysfs_create_group(&ccw_device->dev.kobj,
			       &zfcp_sysfs_adapter_attrs))
L
Linus Torvalds 已提交
529 530 531
		goto sysfs_failed;

	atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &adapter->status);
532
	zfcp_fc_wka_ports_init(adapter);
533

534 535
	if (!zfcp_adapter_scsi_register(adapter))
		return 0;
L
Linus Torvalds 已提交
536

537
sysfs_failed:
538
	zfcp_adapter_debug_unregister(adapter);
539
debug_register_failed:
L
Linus Torvalds 已提交
540
	dev_set_drvdata(&ccw_device->dev, NULL);
541 542
	kfree(adapter->req_list);
failed_low_mem_buffers:
L
Linus Torvalds 已提交
543
	zfcp_free_low_mem_buffers(adapter);
544
qdio_allocate_failed:
S
Swen Schillig 已提交
545
	zfcp_qdio_free(adapter);
L
Linus Torvalds 已提交
546
	kfree(adapter);
547
	return -ENOMEM;
L
Linus Torvalds 已提交
548 549
}

550 551 552
/**
 * zfcp_adapter_dequeue - remove the adapter from the resource list
 * @adapter: pointer to struct zfcp_adapter which should be removed
L
Linus Torvalds 已提交
553 554
 * locks:	adapter list write lock is assumed to be held by caller
 */
555
void zfcp_adapter_dequeue(struct zfcp_adapter *adapter)
L
Linus Torvalds 已提交
556 557 558 559
{
	int retval = 0;
	unsigned long flags;

560
	cancel_work_sync(&adapter->scan_work);
561
	cancel_work_sync(&adapter->stat_work);
562
	zfcp_adapter_scsi_unregister(adapter);
563 564
	sysfs_remove_group(&adapter->ccw_device->dev.kobj,
			   &zfcp_sysfs_adapter_attrs);
L
Linus Torvalds 已提交
565 566
	dev_set_drvdata(&adapter->ccw_device->dev, NULL);
	/* sanity check: no pending FSF requests */
567 568 569
	spin_lock_irqsave(&adapter->req_list_lock, flags);
	retval = zfcp_reqlist_isempty(adapter);
	spin_unlock_irqrestore(&adapter->req_list_lock, flags);
570 571
	if (!retval)
		return;
L
Linus Torvalds 已提交
572

573
	zfcp_adapter_debug_unregister(adapter);
S
Swen Schillig 已提交
574
	zfcp_qdio_free(adapter);
L
Linus Torvalds 已提交
575
	zfcp_free_low_mem_buffers(adapter);
576
	kfree(adapter->req_list);
577 578
	kfree(adapter->fc_stats);
	kfree(adapter->stats_reset_data);
579
	kfree(adapter->gs);
L
Linus Torvalds 已提交
580 581 582
	kfree(adapter);
}

583 584 585 586 587
static void zfcp_sysfs_port_release(struct device *dev)
{
	kfree(container_of(dev, struct zfcp_port, sysfs_device));
}

L
Linus Torvalds 已提交
588 589 590 591 592 593
/**
 * zfcp_port_enqueue - enqueue port to port list of adapter
 * @adapter: adapter where remote port is added
 * @wwpn: WWPN of the remote port to be enqueued
 * @status: initial status for the port
 * @d_id: destination id of the remote port to be enqueued
594
 * Returns: pointer to enqueued port on success, ERR_PTR on error
L
Linus Torvalds 已提交
595 596 597 598 599 600
 * Locks: config_sema must be held to serialize changes to the port list
 *
 * All port internal structures are set up and the sysfs entry is generated.
 * d_id is used to enqueue ports with a well known address like the Directory
 * Service for nameserver lookup.
 */
601
struct zfcp_port *zfcp_port_enqueue(struct zfcp_adapter *adapter, u64 wwpn,
602
				     u32 status, u32 d_id)
L
Linus Torvalds 已提交
603
{
604
	struct zfcp_port *port;
605
	int retval;
L
Linus Torvalds 已提交
606

607
	port = kzalloc(sizeof(struct zfcp_port), GFP_KERNEL);
L
Linus Torvalds 已提交
608
	if (!port)
609
		return ERR_PTR(-ENOMEM);
L
Linus Torvalds 已提交
610 611 612

	init_waitqueue_head(&port->remove_wq);
	INIT_LIST_HEAD(&port->unit_list_head);
613
	INIT_WORK(&port->gid_pn_work, zfcp_erp_port_strategy_open_lookup);
614
	INIT_WORK(&port->test_link_work, zfcp_fc_link_test_work);
615
	INIT_WORK(&port->rport_work, zfcp_scsi_rport_work);
L
Linus Torvalds 已提交
616 617

	port->adapter = adapter;
618 619
	port->d_id = d_id;
	port->wwpn = wwpn;
620
	port->rport_task = RPORT_NONE;
L
Linus Torvalds 已提交
621

622 623 624
	/* mark port unusable as long as sysfs registration is not complete */
	atomic_set_mask(status | ZFCP_STATUS_COMMON_REMOVE, &port->status);
	atomic_set(&port->refcount, 0);
L
Linus Torvalds 已提交
625

C
Christof Schmitt 已提交
626 627
	dev_set_name(&port->sysfs_device, "0x%016llx",
		     (unsigned long long)wwpn);
628
	port->sysfs_device.parent = &adapter->ccw_device->dev;
629

L
Linus Torvalds 已提交
630 631 632
	port->sysfs_device.release = zfcp_sysfs_port_release;
	dev_set_drvdata(&port->sysfs_device, port);

633
	read_lock_irq(&zfcp_data.config_lock);
634 635 636 637
	if (zfcp_get_port_by_wwpn(adapter, wwpn)) {
		read_unlock_irq(&zfcp_data.config_lock);
		goto err_out_free;
	}
638
	read_unlock_irq(&zfcp_data.config_lock);
L
Linus Torvalds 已提交
639

640 641
	if (device_register(&port->sysfs_device))
		goto err_out_free;
L
Linus Torvalds 已提交
642

643 644
	retval = sysfs_create_group(&port->sysfs_device.kobj,
				    &zfcp_sysfs_port_attrs);
645 646

	if (retval) {
L
Linus Torvalds 已提交
647
		device_unregister(&port->sysfs_device);
648
		goto err_out;
L
Linus Torvalds 已提交
649 650 651 652 653
	}

	zfcp_port_get(port);

	write_lock_irq(&zfcp_data.config_lock);
654
	list_add_tail(&port->list, &adapter->port_list_head);
L
Linus Torvalds 已提交
655 656
	atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &port->status);
	atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &port->status);
657

L
Linus Torvalds 已提交
658 659 660 661
	write_unlock_irq(&zfcp_data.config_lock);

	zfcp_adapter_get(adapter);
	return port;
662 663 664 665 666

err_out_free:
	kfree(port);
err_out:
	return ERR_PTR(-EINVAL);
L
Linus Torvalds 已提交
667 668
}

669 670 671 672 673
/**
 * zfcp_port_dequeue - dequeues a port from the port list of the adapter
 * @port: pointer to struct zfcp_port which should be removed
 */
void zfcp_port_dequeue(struct zfcp_port *port)
L
Linus Torvalds 已提交
674
{
675
	wait_event(port->remove_wq, atomic_read(&port->refcount) == 0);
L
Linus Torvalds 已提交
676 677 678
	write_lock_irq(&zfcp_data.config_lock);
	list_del(&port->list);
	write_unlock_irq(&zfcp_data.config_lock);
679
	if (port->rport)
680
		port->rport->dd_data = NULL;
L
Linus Torvalds 已提交
681
	zfcp_adapter_put(port->adapter);
682
	sysfs_remove_group(&port->sysfs_device.kobj, &zfcp_sysfs_port_attrs);
L
Linus Torvalds 已提交
683 684 685
	device_unregister(&port->sysfs_device);
}

686 687 688 689 690 691
/**
 * zfcp_sg_free_table - free memory used by scatterlists
 * @sg: pointer to scatterlist
 * @count: number of scatterlist which are to be free'ed
 * the scatterlist are expected to reference pages always
 */
692 693 694 695 696 697 698 699 700 701 702
void zfcp_sg_free_table(struct scatterlist *sg, int count)
{
	int i;

	for (i = 0; i < count; i++, sg++)
		if (sg)
			free_page((unsigned long) sg_virt(sg));
		else
			break;
}

703 704 705 706 707 708 709 710
/**
 * zfcp_sg_setup_table - init scatterlist and allocate, assign buffers
 * @sg: pointer to struct scatterlist
 * @count: number of scatterlists which should be assigned with buffers
 * of size page
 *
 * Returns: 0 on success, -ENOMEM otherwise
 */
711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726
int zfcp_sg_setup_table(struct scatterlist *sg, int count)
{
	void *addr;
	int i;

	sg_init_table(sg, count);
	for (i = 0; i < count; i++, sg++) {
		addr = (void *) get_zeroed_page(GFP_KERNEL);
		if (!addr) {
			zfcp_sg_free_table(sg, i);
			return -ENOMEM;
		}
		sg_set_buf(sg, addr, PAGE_SIZE);
	}
	return 0;
}