|  | /* | 
|  | * zfcp device driver | 
|  | * | 
|  | * Module interface and handling of zfcp data structures. | 
|  | * | 
|  | * Copyright IBM Corporation 2002, 2009 | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * 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 | 
|  | *            Michael Loehr | 
|  | *            Swen Schillig | 
|  | *            Christof Schmitt | 
|  | *            Martin Petermann | 
|  | *            Sven Schuetz | 
|  | */ | 
|  |  | 
|  | #define KMSG_COMPONENT "zfcp" | 
|  | #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt | 
|  |  | 
|  | #include <linux/miscdevice.h> | 
|  | #include <linux/seq_file.h> | 
|  | #include "zfcp_ext.h" | 
|  |  | 
|  | #define ZFCP_BUS_ID_SIZE	20 | 
|  |  | 
|  | MODULE_AUTHOR("IBM Deutschland Entwicklung GmbH - linux390@de.ibm.com"); | 
|  | MODULE_DESCRIPTION("FCP HBA driver"); | 
|  | MODULE_LICENSE("GPL"); | 
|  |  | 
|  | static char *init_device; | 
|  | module_param_named(device, init_device, charp, 0400); | 
|  | MODULE_PARM_DESC(device, "specify initial device"); | 
|  |  | 
|  | static int zfcp_reqlist_alloc(struct zfcp_adapter *adapter) | 
|  | { | 
|  | int idx; | 
|  |  | 
|  | adapter->req_list = kcalloc(REQUEST_LIST_SIZE, sizeof(struct list_head), | 
|  | GFP_KERNEL); | 
|  | if (!adapter->req_list) | 
|  | return -ENOMEM; | 
|  |  | 
|  | for (idx = 0; idx < REQUEST_LIST_SIZE; idx++) | 
|  | INIT_LIST_HEAD(&adapter->req_list[idx]); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * zfcp_reqlist_isempty - is the request list empty | 
|  | * @adapter: pointer to struct zfcp_adapter | 
|  | * | 
|  | * Returns: true if list is empty, false otherwise | 
|  | */ | 
|  | int zfcp_reqlist_isempty(struct zfcp_adapter *adapter) | 
|  | { | 
|  | unsigned int idx; | 
|  |  | 
|  | for (idx = 0; idx < REQUEST_LIST_SIZE; idx++) | 
|  | if (!list_empty(&adapter->req_list[idx])) | 
|  | return 0; | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | static void __init zfcp_init_device_configure(char *busid, u64 wwpn, u64 lun) | 
|  | { | 
|  | struct zfcp_adapter *adapter; | 
|  | struct zfcp_port *port; | 
|  | struct zfcp_unit *unit; | 
|  |  | 
|  | down(&zfcp_data.config_sema); | 
|  | read_lock_irq(&zfcp_data.config_lock); | 
|  | adapter = zfcp_get_adapter_by_busid(busid); | 
|  | if (adapter) | 
|  | zfcp_adapter_get(adapter); | 
|  | read_unlock_irq(&zfcp_data.config_lock); | 
|  |  | 
|  | if (!adapter) | 
|  | goto out_adapter; | 
|  | port = zfcp_port_enqueue(adapter, wwpn, 0, 0); | 
|  | if (IS_ERR(port)) | 
|  | goto out_port; | 
|  | unit = zfcp_unit_enqueue(port, lun); | 
|  | if (IS_ERR(unit)) | 
|  | goto out_unit; | 
|  | up(&zfcp_data.config_sema); | 
|  | ccw_device_set_online(adapter->ccw_device); | 
|  |  | 
|  | zfcp_erp_wait(adapter); | 
|  | wait_event(adapter->erp_done_wqh, | 
|  | !(atomic_read(&unit->status) & | 
|  | ZFCP_STATUS_UNIT_SCSI_WORK_PENDING)); | 
|  |  | 
|  | down(&zfcp_data.config_sema); | 
|  | zfcp_unit_put(unit); | 
|  | out_unit: | 
|  | zfcp_port_put(port); | 
|  | out_port: | 
|  | zfcp_adapter_put(adapter); | 
|  | out_adapter: | 
|  | up(&zfcp_data.config_sema); | 
|  | return; | 
|  | } | 
|  |  | 
|  | static struct kmem_cache *zfcp_cache_create(int size, char *name) | 
|  | { | 
|  | int align = 1; | 
|  | while ((size - align) > 0) | 
|  | align <<= 1; | 
|  | return kmem_cache_create(name , size, align, 0, NULL); | 
|  | } | 
|  |  | 
|  | 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); | 
|  | } | 
|  |  | 
|  | static int __init zfcp_module_init(void) | 
|  | { | 
|  | int retval = -ENOMEM; | 
|  |  | 
|  | zfcp_data.fsf_req_qtcb_cache = zfcp_cache_create( | 
|  | sizeof(struct zfcp_fsf_req_qtcb), "zfcp_fsf"); | 
|  | if (!zfcp_data.fsf_req_qtcb_cache) | 
|  | goto out; | 
|  |  | 
|  | zfcp_data.sr_buffer_cache = zfcp_cache_create( | 
|  | sizeof(struct fsf_status_read_buffer), "zfcp_sr"); | 
|  | if (!zfcp_data.sr_buffer_cache) | 
|  | goto out_sr_cache; | 
|  |  | 
|  | zfcp_data.gid_pn_cache = zfcp_cache_create( | 
|  | sizeof(struct zfcp_gid_pn_data), "zfcp_gid"); | 
|  | if (!zfcp_data.gid_pn_cache) | 
|  | goto out_gid_cache; | 
|  |  | 
|  | zfcp_data.work_queue = create_singlethread_workqueue("zfcp_wq"); | 
|  |  | 
|  | sema_init(&zfcp_data.config_sema, 1); | 
|  | rwlock_init(&zfcp_data.config_lock); | 
|  |  | 
|  | zfcp_data.scsi_transport_template = | 
|  | fc_attach_transport(&zfcp_transport_functions); | 
|  | if (!zfcp_data.scsi_transport_template) | 
|  | goto out_transport; | 
|  |  | 
|  | retval = misc_register(&zfcp_cfdc_misc); | 
|  | if (retval) { | 
|  | pr_err("Registering the misc device zfcp_cfdc failed\n"); | 
|  | goto out_misc; | 
|  | } | 
|  |  | 
|  | retval = zfcp_ccw_register(); | 
|  | if (retval) { | 
|  | pr_err("The zfcp device driver could not register with " | 
|  | "the common I/O layer\n"); | 
|  | goto out_ccw_register; | 
|  | } | 
|  |  | 
|  | if (init_device) | 
|  | zfcp_init_device_setup(init_device); | 
|  | return 0; | 
|  |  | 
|  | out_ccw_register: | 
|  | misc_deregister(&zfcp_cfdc_misc); | 
|  | out_misc: | 
|  | fc_release_transport(zfcp_data.scsi_transport_template); | 
|  | out_transport: | 
|  | kmem_cache_destroy(zfcp_data.gid_pn_cache); | 
|  | out_gid_cache: | 
|  | kmem_cache_destroy(zfcp_data.sr_buffer_cache); | 
|  | out_sr_cache: | 
|  | kmem_cache_destroy(zfcp_data.fsf_req_qtcb_cache); | 
|  | out: | 
|  | return retval; | 
|  | } | 
|  |  | 
|  | module_init(zfcp_module_init); | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | * | 
|  | * Returns: pointer to zfcp_unit or NULL | 
|  | */ | 
|  | struct zfcp_unit *zfcp_get_unit_by_lun(struct zfcp_port *port, u64 fcp_lun) | 
|  | { | 
|  | struct zfcp_unit *unit; | 
|  |  | 
|  | list_for_each_entry(unit, &port->unit_list_head, list) | 
|  | if ((unit->fcp_lun == fcp_lun) && | 
|  | !(atomic_read(&unit->status) & ZFCP_STATUS_COMMON_REMOVE)) | 
|  | return unit; | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | * | 
|  | * Returns: pointer to zfcp_port or NULL | 
|  | */ | 
|  | struct zfcp_port *zfcp_get_port_by_wwpn(struct zfcp_adapter *adapter, | 
|  | u64 wwpn) | 
|  | { | 
|  | struct zfcp_port *port; | 
|  |  | 
|  | list_for_each_entry(port, &adapter->port_list_head, list) | 
|  | if ((port->wwpn == wwpn) && | 
|  | !(atomic_read(&port->status) & ZFCP_STATUS_COMMON_REMOVE)) | 
|  | return port; | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | static void zfcp_sysfs_unit_release(struct device *dev) | 
|  | { | 
|  | kfree(container_of(dev, struct zfcp_unit, sysfs_device)); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | * Returns: pointer to enqueued unit on success, ERR_PTR on error | 
|  | * Locks: config_sema must be held to serialize changes to the unit list | 
|  | * | 
|  | * Sets up some unit internal structures and creates sysfs entry. | 
|  | */ | 
|  | struct zfcp_unit *zfcp_unit_enqueue(struct zfcp_port *port, u64 fcp_lun) | 
|  | { | 
|  | struct zfcp_unit *unit; | 
|  |  | 
|  | unit = kzalloc(sizeof(struct zfcp_unit), GFP_KERNEL); | 
|  | if (!unit) | 
|  | return ERR_PTR(-ENOMEM); | 
|  |  | 
|  | atomic_set(&unit->refcount, 0); | 
|  | init_waitqueue_head(&unit->remove_wq); | 
|  |  | 
|  | unit->port = port; | 
|  | unit->fcp_lun = fcp_lun; | 
|  |  | 
|  | dev_set_name(&unit->sysfs_device, "0x%016llx", | 
|  | (unsigned long long) fcp_lun); | 
|  | 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); | 
|  |  | 
|  | 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; | 
|  |  | 
|  | 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; | 
|  | } | 
|  | read_unlock_irq(&zfcp_data.config_lock); | 
|  |  | 
|  | if (device_register(&unit->sysfs_device)) | 
|  | goto err_out_free; | 
|  |  | 
|  | if (sysfs_create_group(&unit->sysfs_device.kobj, | 
|  | &zfcp_sysfs_unit_attrs)) { | 
|  | device_unregister(&unit->sysfs_device); | 
|  | return ERR_PTR(-EIO); | 
|  | } | 
|  |  | 
|  | zfcp_unit_get(unit); | 
|  |  | 
|  | write_lock_irq(&zfcp_data.config_lock); | 
|  | list_add_tail(&unit->list, &port->unit_list_head); | 
|  | atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &unit->status); | 
|  | atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &unit->status); | 
|  |  | 
|  | write_unlock_irq(&zfcp_data.config_lock); | 
|  |  | 
|  | zfcp_port_get(port); | 
|  |  | 
|  | return unit; | 
|  |  | 
|  | err_out_free: | 
|  | kfree(unit); | 
|  | return ERR_PTR(-EINVAL); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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) | 
|  | { | 
|  | wait_event(unit->remove_wq, atomic_read(&unit->refcount) == 0); | 
|  | write_lock_irq(&zfcp_data.config_lock); | 
|  | list_del(&unit->list); | 
|  | write_unlock_irq(&zfcp_data.config_lock); | 
|  | zfcp_port_put(unit->port); | 
|  | sysfs_remove_group(&unit->sysfs_device.kobj, &zfcp_sysfs_unit_attrs); | 
|  | device_unregister(&unit->sysfs_device); | 
|  | } | 
|  |  | 
|  | static int zfcp_allocate_low_mem_buffers(struct zfcp_adapter *adapter) | 
|  | { | 
|  | /* must only be called with zfcp_data.config_sema taken */ | 
|  | adapter->pool.fsf_req_erp = | 
|  | mempool_create_slab_pool(1, zfcp_data.fsf_req_qtcb_cache); | 
|  | if (!adapter->pool.fsf_req_erp) | 
|  | return -ENOMEM; | 
|  |  | 
|  | adapter->pool.fsf_req_scsi = | 
|  | mempool_create_slab_pool(1, zfcp_data.fsf_req_qtcb_cache); | 
|  | if (!adapter->pool.fsf_req_scsi) | 
|  | return -ENOMEM; | 
|  |  | 
|  | adapter->pool.fsf_req_abort = | 
|  | mempool_create_slab_pool(1, zfcp_data.fsf_req_qtcb_cache); | 
|  | if (!adapter->pool.fsf_req_abort) | 
|  | return -ENOMEM; | 
|  |  | 
|  | adapter->pool.fsf_req_status_read = | 
|  | mempool_create_kmalloc_pool(FSF_STATUS_READS_RECOM, | 
|  | sizeof(struct zfcp_fsf_req)); | 
|  | if (!adapter->pool.fsf_req_status_read) | 
|  | return -ENOMEM; | 
|  |  | 
|  | adapter->pool.data_status_read = | 
|  | mempool_create_slab_pool(FSF_STATUS_READS_RECOM, | 
|  | zfcp_data.sr_buffer_cache); | 
|  | if (!adapter->pool.data_status_read) | 
|  | return -ENOMEM; | 
|  |  | 
|  | adapter->pool.data_gid_pn = | 
|  | mempool_create_slab_pool(1, zfcp_data.gid_pn_cache); | 
|  | if (!adapter->pool.data_gid_pn) | 
|  | return -ENOMEM; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void zfcp_free_low_mem_buffers(struct zfcp_adapter *adapter) | 
|  | { | 
|  | /* zfcp_data.config_sema must be held */ | 
|  | 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); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | */ | 
|  | int zfcp_status_read_refill(struct zfcp_adapter *adapter) | 
|  | { | 
|  | while (atomic_read(&adapter->stat_miss) > 0) | 
|  | if (zfcp_fsf_status_read(adapter)) { | 
|  | if (atomic_read(&adapter->stat_miss) >= 16) { | 
|  | zfcp_erp_adapter_reopen(adapter, 0, "axsref1", | 
|  | NULL); | 
|  | return 1; | 
|  | } | 
|  | break; | 
|  | } else | 
|  | atomic_dec(&adapter->stat_miss); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void _zfcp_status_read_scheduler(struct work_struct *work) | 
|  | { | 
|  | zfcp_status_read_refill(container_of(work, struct zfcp_adapter, | 
|  | stat_work)); | 
|  | } | 
|  |  | 
|  | 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); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | * 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 | 
|  | */ | 
|  | int zfcp_adapter_enqueue(struct ccw_device *ccw_device) | 
|  | { | 
|  | struct zfcp_adapter *adapter; | 
|  |  | 
|  | /* | 
|  | * Note: It is safe to release the list_lock, as any list changes | 
|  | * are protected by the config_sema, which must be held to get here | 
|  | */ | 
|  |  | 
|  | adapter = kzalloc(sizeof(struct zfcp_adapter), GFP_KERNEL); | 
|  | if (!adapter) | 
|  | return -ENOMEM; | 
|  |  | 
|  | ccw_device->handler = NULL; | 
|  | adapter->ccw_device = ccw_device; | 
|  | atomic_set(&adapter->refcount, 0); | 
|  |  | 
|  | if (zfcp_qdio_allocate(adapter)) | 
|  | goto qdio_allocate_failed; | 
|  |  | 
|  | if (zfcp_allocate_low_mem_buffers(adapter)) | 
|  | goto failed_low_mem_buffers; | 
|  |  | 
|  | if (zfcp_reqlist_alloc(adapter)) | 
|  | goto failed_low_mem_buffers; | 
|  |  | 
|  | if (zfcp_adapter_debug_register(adapter)) | 
|  | goto debug_register_failed; | 
|  |  | 
|  | init_waitqueue_head(&adapter->remove_wq); | 
|  | init_waitqueue_head(&adapter->erp_thread_wqh); | 
|  | init_waitqueue_head(&adapter->erp_done_wqh); | 
|  |  | 
|  | INIT_LIST_HEAD(&adapter->port_list_head); | 
|  | INIT_LIST_HEAD(&adapter->erp_ready_head); | 
|  | INIT_LIST_HEAD(&adapter->erp_running_head); | 
|  |  | 
|  | spin_lock_init(&adapter->req_list_lock); | 
|  |  | 
|  | spin_lock_init(&adapter->hba_dbf_lock); | 
|  | spin_lock_init(&adapter->san_dbf_lock); | 
|  | spin_lock_init(&adapter->scsi_dbf_lock); | 
|  | spin_lock_init(&adapter->rec_dbf_lock); | 
|  | spin_lock_init(&adapter->req_q_lock); | 
|  | spin_lock_init(&adapter->qdio_stat_lock); | 
|  |  | 
|  | rwlock_init(&adapter->erp_lock); | 
|  | rwlock_init(&adapter->abort_lock); | 
|  |  | 
|  | sema_init(&adapter->erp_ready_sem, 0); | 
|  |  | 
|  | INIT_WORK(&adapter->stat_work, _zfcp_status_read_scheduler); | 
|  | INIT_WORK(&adapter->scan_work, _zfcp_scan_ports_later); | 
|  |  | 
|  | adapter->service_level.seq_print = zfcp_print_sl; | 
|  |  | 
|  | /* 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); | 
|  |  | 
|  | if (sysfs_create_group(&ccw_device->dev.kobj, | 
|  | &zfcp_sysfs_adapter_attrs)) | 
|  | goto sysfs_failed; | 
|  |  | 
|  | atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &adapter->status); | 
|  |  | 
|  | if (!zfcp_adapter_scsi_register(adapter)) | 
|  | return 0; | 
|  |  | 
|  | sysfs_failed: | 
|  | zfcp_adapter_debug_unregister(adapter); | 
|  | debug_register_failed: | 
|  | dev_set_drvdata(&ccw_device->dev, NULL); | 
|  | kfree(adapter->req_list); | 
|  | failed_low_mem_buffers: | 
|  | zfcp_free_low_mem_buffers(adapter); | 
|  | qdio_allocate_failed: | 
|  | zfcp_qdio_free(adapter); | 
|  | kfree(adapter); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * zfcp_adapter_dequeue - remove the adapter from the resource list | 
|  | * @adapter: pointer to struct zfcp_adapter which should be removed | 
|  | * locks:	adapter list write lock is assumed to be held by caller | 
|  | */ | 
|  | void zfcp_adapter_dequeue(struct zfcp_adapter *adapter) | 
|  | { | 
|  | int retval = 0; | 
|  | unsigned long flags; | 
|  |  | 
|  | cancel_work_sync(&adapter->scan_work); | 
|  | cancel_work_sync(&adapter->stat_work); | 
|  | cancel_delayed_work_sync(&adapter->nsp.work); | 
|  | zfcp_adapter_scsi_unregister(adapter); | 
|  | sysfs_remove_group(&adapter->ccw_device->dev.kobj, | 
|  | &zfcp_sysfs_adapter_attrs); | 
|  | dev_set_drvdata(&adapter->ccw_device->dev, NULL); | 
|  | /* sanity check: no pending FSF requests */ | 
|  | spin_lock_irqsave(&adapter->req_list_lock, flags); | 
|  | retval = zfcp_reqlist_isempty(adapter); | 
|  | spin_unlock_irqrestore(&adapter->req_list_lock, flags); | 
|  | if (!retval) | 
|  | return; | 
|  |  | 
|  | zfcp_adapter_debug_unregister(adapter); | 
|  | zfcp_qdio_free(adapter); | 
|  | zfcp_free_low_mem_buffers(adapter); | 
|  | kfree(adapter->req_list); | 
|  | kfree(adapter->fc_stats); | 
|  | kfree(adapter->stats_reset_data); | 
|  | kfree(adapter); | 
|  | } | 
|  |  | 
|  | static void zfcp_sysfs_port_release(struct device *dev) | 
|  | { | 
|  | kfree(container_of(dev, struct zfcp_port, sysfs_device)); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | * Returns: pointer to enqueued port on success, ERR_PTR on error | 
|  | * 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. | 
|  | */ | 
|  | struct zfcp_port *zfcp_port_enqueue(struct zfcp_adapter *adapter, u64 wwpn, | 
|  | u32 status, u32 d_id) | 
|  | { | 
|  | struct zfcp_port *port; | 
|  | int retval; | 
|  |  | 
|  | port = kzalloc(sizeof(struct zfcp_port), GFP_KERNEL); | 
|  | if (!port) | 
|  | return ERR_PTR(-ENOMEM); | 
|  |  | 
|  | init_waitqueue_head(&port->remove_wq); | 
|  | INIT_LIST_HEAD(&port->unit_list_head); | 
|  | INIT_WORK(&port->gid_pn_work, zfcp_erp_port_strategy_open_lookup); | 
|  | INIT_WORK(&port->test_link_work, zfcp_fc_link_test_work); | 
|  | INIT_WORK(&port->rport_work, zfcp_scsi_rport_work); | 
|  |  | 
|  | port->adapter = adapter; | 
|  | port->d_id = d_id; | 
|  | port->wwpn = wwpn; | 
|  | port->rport_task = RPORT_NONE; | 
|  |  | 
|  | /* 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); | 
|  |  | 
|  | dev_set_name(&port->sysfs_device, "0x%016llx", | 
|  | (unsigned long long)wwpn); | 
|  | port->sysfs_device.parent = &adapter->ccw_device->dev; | 
|  |  | 
|  | port->sysfs_device.release = zfcp_sysfs_port_release; | 
|  | dev_set_drvdata(&port->sysfs_device, port); | 
|  |  | 
|  | read_lock_irq(&zfcp_data.config_lock); | 
|  | if (zfcp_get_port_by_wwpn(adapter, wwpn)) { | 
|  | read_unlock_irq(&zfcp_data.config_lock); | 
|  | goto err_out_free; | 
|  | } | 
|  | read_unlock_irq(&zfcp_data.config_lock); | 
|  |  | 
|  | if (device_register(&port->sysfs_device)) | 
|  | goto err_out_free; | 
|  |  | 
|  | retval = sysfs_create_group(&port->sysfs_device.kobj, | 
|  | &zfcp_sysfs_port_attrs); | 
|  |  | 
|  | if (retval) { | 
|  | device_unregister(&port->sysfs_device); | 
|  | goto err_out; | 
|  | } | 
|  |  | 
|  | zfcp_port_get(port); | 
|  |  | 
|  | write_lock_irq(&zfcp_data.config_lock); | 
|  | list_add_tail(&port->list, &adapter->port_list_head); | 
|  | atomic_clear_mask(ZFCP_STATUS_COMMON_REMOVE, &port->status); | 
|  | atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &port->status); | 
|  |  | 
|  | write_unlock_irq(&zfcp_data.config_lock); | 
|  |  | 
|  | zfcp_adapter_get(adapter); | 
|  | return port; | 
|  |  | 
|  | err_out_free: | 
|  | kfree(port); | 
|  | err_out: | 
|  | return ERR_PTR(-EINVAL); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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) | 
|  | { | 
|  | wait_event(port->remove_wq, atomic_read(&port->refcount) == 0); | 
|  | write_lock_irq(&zfcp_data.config_lock); | 
|  | list_del(&port->list); | 
|  | write_unlock_irq(&zfcp_data.config_lock); | 
|  | if (port->rport) | 
|  | fc_remote_port_delete(port->rport); | 
|  | port->rport = NULL; | 
|  | zfcp_adapter_put(port->adapter); | 
|  | sysfs_remove_group(&port->sysfs_device.kobj, &zfcp_sysfs_port_attrs); | 
|  | device_unregister(&port->sysfs_device); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | */ | 
|  | 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; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * 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 | 
|  | */ | 
|  | 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; | 
|  | } |