blob: 107d3f2b6e949f93fece253ffd7b1cd3abd1c5db [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Christof Schmitt553448f2008-06-10 18:20:58 +02002 * zfcp device driver
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 *
Christof Schmitt553448f2008-06-10 18:20:58 +02004 * Module interface and handling of zfcp data structures.
Linus Torvalds1da177e2005-04-16 15:20:36 -07005 *
Christof Schmitta2fa0ae2009-03-02 13:09:08 +01006 * Copyright IBM Corporation 2002, 2009
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 */
8
Andreas Herrmann4a9d2d82006-05-22 18:14:08 +02009/*
10 * Driver authors:
11 * Martin Peschke (originator of the driver)
12 * Raimund Schroeder
13 * Aron Zeh
14 * Wolfgang Taphorn
15 * Stefan Bader
16 * Heiko Carstens (kernel 2.6 port of the driver)
17 * Andreas Herrmann
18 * Maxim Shchetynin
19 * Volker Sameske
20 * Ralph Wuerthner
Christof Schmitt553448f2008-06-10 18:20:58 +020021 * Michael Loehr
22 * Swen Schillig
23 * Christof Schmitt
24 * Martin Petermann
25 * Sven Schuetz
Andreas Herrmann4a9d2d82006-05-22 18:14:08 +020026 */
27
Christof Schmittecf39d42008-12-25 13:39:53 +010028#define KMSG_COMPONENT "zfcp"
29#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
30
Christof Schmitt45633fd2008-06-10 18:20:55 +020031#include <linux/miscdevice.h>
Christof Schmittbd43a42b72008-12-25 13:38:50 +010032#include <linux/seq_file.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include "zfcp_ext.h"
34
Kay Sievers98df67b2008-12-25 13:38:55 +010035#define ZFCP_BUS_ID_SIZE 20
36
Andreas Herrmann4a9d2d82006-05-22 18:14:08 +020037MODULE_AUTHOR("IBM Deutschland Entwicklung GmbH - linux390@de.ibm.com");
Swen Schillig317e6b62008-07-02 10:56:37 +020038MODULE_DESCRIPTION("FCP HBA driver");
Linus Torvalds1da177e2005-04-16 15:20:36 -070039MODULE_LICENSE("GPL");
40
Christof Schmitt3623ecb2008-12-19 16:56:57 +010041static char *init_device;
42module_param_named(device, init_device, charp, 0400);
Linus Torvalds1da177e2005-04-16 15:20:36 -070043MODULE_PARM_DESC(device, "specify initial device");
44
Swen Schilliga4623c42009-08-18 15:43:15 +020045static struct kmem_cache *zfcp_cache_hw_align(const char *name,
46 unsigned long size)
47{
48 return kmem_cache_create(name, size, roundup_pow_of_two(size), 0, NULL);
49}
50
Heiko Carstensca2d02c2007-05-08 11:17:54 +020051static int zfcp_reqlist_alloc(struct zfcp_adapter *adapter)
Volker Sameskefea9d6c2006-08-02 11:05:16 +020052{
Heiko Carstensca2d02c2007-05-08 11:17:54 +020053 int idx;
Volker Sameskefea9d6c2006-08-02 11:05:16 +020054
55 adapter->req_list = kcalloc(REQUEST_LIST_SIZE, sizeof(struct list_head),
56 GFP_KERNEL);
Volker Sameskefea9d6c2006-08-02 11:05:16 +020057 if (!adapter->req_list)
58 return -ENOMEM;
59
Heiko Carstensca2d02c2007-05-08 11:17:54 +020060 for (idx = 0; idx < REQUEST_LIST_SIZE; idx++)
61 INIT_LIST_HEAD(&adapter->req_list[idx]);
Volker Sameskefea9d6c2006-08-02 11:05:16 +020062 return 0;
63}
64
Swen Schillig317e6b62008-07-02 10:56:37 +020065/**
66 * zfcp_reqlist_isempty - is the request list empty
67 * @adapter: pointer to struct zfcp_adapter
68 *
69 * Returns: true if list is empty, false otherwise
70 */
Volker Sameskefea9d6c2006-08-02 11:05:16 +020071int zfcp_reqlist_isempty(struct zfcp_adapter *adapter)
72{
Heiko Carstensca2d02c2007-05-08 11:17:54 +020073 unsigned int idx;
Volker Sameskefea9d6c2006-08-02 11:05:16 +020074
Heiko Carstensca2d02c2007-05-08 11:17:54 +020075 for (idx = 0; idx < REQUEST_LIST_SIZE; idx++)
76 if (!list_empty(&adapter->req_list[idx]))
Volker Sameskefea9d6c2006-08-02 11:05:16 +020077 return 0;
Volker Sameskefea9d6c2006-08-02 11:05:16 +020078 return 1;
79}
80
Christof Schmitt3623ecb2008-12-19 16:56:57 +010081static void __init zfcp_init_device_configure(char *busid, u64 wwpn, u64 lun)
Linus Torvalds1da177e2005-04-16 15:20:36 -070082{
Swen Schilligde3dc572009-11-24 16:54:00 +010083 struct ccw_device *cdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -070084 struct zfcp_adapter *adapter;
85 struct zfcp_port *port;
86 struct zfcp_unit *unit;
87
Swen Schilligde3dc572009-11-24 16:54:00 +010088 cdev = get_ccwdev_by_busid(&zfcp_ccw_driver, busid);
89 if (!cdev)
Christof Schmittc5afd812009-09-24 10:23:22 +020090 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
Swen Schilligde3dc572009-11-24 16:54:00 +010092 if (ccw_device_set_online(cdev))
93 goto out_ccw_device;
Christof Schmittc5afd812009-09-24 10:23:22 +020094
Swen Schilligde3dc572009-11-24 16:54:00 +010095 adapter = zfcp_ccw_adapter_by_cdev(cdev);
Swen Schillig317e6b62008-07-02 10:56:37 +020096 if (!adapter)
Swen Schilligde3dc572009-11-24 16:54:00 +010097 goto out_ccw_device;
Christof Schmittc5afd812009-09-24 10:23:22 +020098
99 port = zfcp_get_port_by_wwpn(adapter, wwpn);
100 if (!port)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101 goto out_port;
Christof Schmittc5afd812009-09-24 10:23:22 +0200102
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100103 unit = zfcp_unit_enqueue(port, lun);
Swen Schillig317e6b62008-07-02 10:56:37 +0200104 if (IS_ERR(unit))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105 goto out_unit;
Swen Schillig091694a2008-10-01 12:42:25 +0200106
Christof Schmittc5afd812009-09-24 10:23:22 +0200107 zfcp_erp_unit_reopen(unit, 0, "auidc_1", NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 zfcp_erp_wait(adapter);
Swen Schillig92d51932009-04-17 15:08:04 +0200109 flush_work(&unit->scsi_work);
Swen Schillig091694a2008-10-01 12:42:25 +0200110
Swen Schillig317e6b62008-07-02 10:56:37 +0200111out_unit:
Swen Schilligf3450c72009-11-24 16:53:59 +0100112 put_device(&port->sysfs_device);
Swen Schillig317e6b62008-07-02 10:56:37 +0200113out_port:
Swen Schilligde3dc572009-11-24 16:54:00 +0100114 zfcp_ccw_adapter_put(adapter);
115out_ccw_device:
116 put_device(&cdev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117 return;
118}
119
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100120static void __init zfcp_init_device_setup(char *devstr)
121{
122 char *token;
Heiko Carstensd10c0852009-10-13 10:44:07 +0200123 char *str, *str_saved;
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100124 char busid[ZFCP_BUS_ID_SIZE];
125 u64 wwpn, lun;
126
127 /* duplicate devstr and keep the original for sysfs presentation*/
Heiko Carstensd10c0852009-10-13 10:44:07 +0200128 str_saved = kmalloc(strlen(devstr) + 1, GFP_KERNEL);
129 str = str_saved;
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100130 if (!str)
131 return;
132
133 strcpy(str, devstr);
134
135 token = strsep(&str, ",");
136 if (!token || strlen(token) >= ZFCP_BUS_ID_SIZE)
137 goto err_out;
138 strncpy(busid, token, ZFCP_BUS_ID_SIZE);
139
140 token = strsep(&str, ",");
141 if (!token || strict_strtoull(token, 0, (unsigned long long *) &wwpn))
142 goto err_out;
143
144 token = strsep(&str, ",");
145 if (!token || strict_strtoull(token, 0, (unsigned long long *) &lun))
146 goto err_out;
147
Heiko Carstensd10c0852009-10-13 10:44:07 +0200148 kfree(str_saved);
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100149 zfcp_init_device_configure(busid, wwpn, lun);
150 return;
151
Heiko Carstensd10c0852009-10-13 10:44:07 +0200152err_out:
153 kfree(str_saved);
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100154 pr_err("%s is not a valid SCSI device\n", devstr);
155}
156
Swen Schillig317e6b62008-07-02 10:56:37 +0200157static int __init zfcp_module_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158{
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200159 int retval = -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160
Swen Schilliga4623c42009-08-18 15:43:15 +0200161 zfcp_data.gpn_ft_cache = zfcp_cache_hw_align("zfcp_gpn",
162 sizeof(struct ct_iu_gpn_ft_req));
163 if (!zfcp_data.gpn_ft_cache)
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200164 goto out;
165
Swen Schilliga4623c42009-08-18 15:43:15 +0200166 zfcp_data.qtcb_cache = zfcp_cache_hw_align("zfcp_qtcb",
167 sizeof(struct fsf_qtcb));
168 if (!zfcp_data.qtcb_cache)
169 goto out_qtcb_cache;
170
171 zfcp_data.sr_buffer_cache = zfcp_cache_hw_align("zfcp_sr",
172 sizeof(struct fsf_status_read_buffer));
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200173 if (!zfcp_data.sr_buffer_cache)
174 goto out_sr_cache;
175
Swen Schilliga4623c42009-08-18 15:43:15 +0200176 zfcp_data.gid_pn_cache = zfcp_cache_hw_align("zfcp_gid",
177 sizeof(struct zfcp_gid_pn_data));
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200178 if (!zfcp_data.gid_pn_cache)
179 goto out_gid_cache;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200181 zfcp_data.scsi_transport_template =
182 fc_attach_transport(&zfcp_transport_functions);
183 if (!zfcp_data.scsi_transport_template)
184 goto out_transport;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186 retval = misc_register(&zfcp_cfdc_misc);
Swen Schillig317e6b62008-07-02 10:56:37 +0200187 if (retval) {
Christof Schmittecf39d42008-12-25 13:39:53 +0100188 pr_err("Registering the misc device zfcp_cfdc failed\n");
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200189 goto out_misc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190 }
191
Christof Schmittc1fad412009-11-24 16:54:04 +0100192 retval = ccw_driver_register(&zfcp_ccw_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193 if (retval) {
Christof Schmittecf39d42008-12-25 13:39:53 +0100194 pr_err("The zfcp device driver could not register with "
Christof Schmittff3b24f2008-10-01 12:42:15 +0200195 "the common I/O layer\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 goto out_ccw_register;
197 }
198
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100199 if (init_device)
200 zfcp_init_device_setup(init_device);
201 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202
Swen Schillig317e6b62008-07-02 10:56:37 +0200203out_ccw_register:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204 misc_deregister(&zfcp_cfdc_misc);
Swen Schillig317e6b62008-07-02 10:56:37 +0200205out_misc:
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200206 fc_release_transport(zfcp_data.scsi_transport_template);
Swen Schillig317e6b62008-07-02 10:56:37 +0200207out_transport:
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200208 kmem_cache_destroy(zfcp_data.gid_pn_cache);
Swen Schillig317e6b62008-07-02 10:56:37 +0200209out_gid_cache:
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200210 kmem_cache_destroy(zfcp_data.sr_buffer_cache);
Swen Schillig317e6b62008-07-02 10:56:37 +0200211out_sr_cache:
Swen Schilliga4623c42009-08-18 15:43:15 +0200212 kmem_cache_destroy(zfcp_data.qtcb_cache);
213out_qtcb_cache:
214 kmem_cache_destroy(zfcp_data.gpn_ft_cache);
Swen Schillig317e6b62008-07-02 10:56:37 +0200215out:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216 return retval;
217}
218
Swen Schillig317e6b62008-07-02 10:56:37 +0200219module_init(zfcp_module_init);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220
Christof Schmittc1fad412009-11-24 16:54:04 +0100221static void __exit zfcp_module_exit(void)
222{
223 ccw_driver_unregister(&zfcp_ccw_driver);
224 misc_deregister(&zfcp_cfdc_misc);
225 fc_release_transport(zfcp_data.scsi_transport_template);
226 kmem_cache_destroy(zfcp_data.gid_pn_cache);
227 kmem_cache_destroy(zfcp_data.sr_buffer_cache);
228 kmem_cache_destroy(zfcp_data.qtcb_cache);
229 kmem_cache_destroy(zfcp_data.gpn_ft_cache);
230}
231
232module_exit(zfcp_module_exit);
233
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234/**
235 * zfcp_get_unit_by_lun - find unit in unit list of port by FCP LUN
236 * @port: pointer to port to search for unit
237 * @fcp_lun: FCP LUN to search for
Swen Schillig317e6b62008-07-02 10:56:37 +0200238 *
239 * Returns: pointer to zfcp_unit or NULL
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240 */
Swen Schillig7ba58c92008-10-01 12:42:18 +0200241struct zfcp_unit *zfcp_get_unit_by_lun(struct zfcp_port *port, u64 fcp_lun)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242{
Swen Schilligecf0c772009-11-24 16:53:58 +0100243 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700244 struct zfcp_unit *unit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245
Swen Schilligecf0c772009-11-24 16:53:58 +0100246 read_lock_irqsave(&port->unit_list_lock, flags);
247 list_for_each_entry(unit, &port->unit_list, list)
Swen Schillig6b1833342009-11-24 16:54:05 +0100248 if (unit->fcp_lun == fcp_lun) {
249 if (!get_device(&unit->sysfs_device))
250 unit = NULL;
Swen Schilligecf0c772009-11-24 16:53:58 +0100251 read_unlock_irqrestore(&port->unit_list_lock, flags);
252 return unit;
253 }
254 read_unlock_irqrestore(&port->unit_list_lock, flags);
Swen Schillig317e6b62008-07-02 10:56:37 +0200255 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256}
257
258/**
259 * zfcp_get_port_by_wwpn - find port in port list of adapter by wwpn
260 * @adapter: pointer to adapter to search for port
261 * @wwpn: wwpn to search for
Swen Schillig317e6b62008-07-02 10:56:37 +0200262 *
263 * Returns: pointer to zfcp_port or NULL
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264 */
Swen Schillig317e6b62008-07-02 10:56:37 +0200265struct zfcp_port *zfcp_get_port_by_wwpn(struct zfcp_adapter *adapter,
Swen Schillig7ba58c92008-10-01 12:42:18 +0200266 u64 wwpn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267{
Swen Schilligecf0c772009-11-24 16:53:58 +0100268 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 struct zfcp_port *port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270
Swen Schilligecf0c772009-11-24 16:53:58 +0100271 read_lock_irqsave(&adapter->port_list_lock, flags);
272 list_for_each_entry(port, &adapter->port_list, list)
Swen Schillig6b1833342009-11-24 16:54:05 +0100273 if (port->wwpn == wwpn) {
274 if (!get_device(&port->sysfs_device))
275 port = NULL;
Swen Schilligecf0c772009-11-24 16:53:58 +0100276 read_unlock_irqrestore(&adapter->port_list_lock, flags);
Swen Schillig317e6b62008-07-02 10:56:37 +0200277 return port;
Swen Schilligecf0c772009-11-24 16:53:58 +0100278 }
279 read_unlock_irqrestore(&adapter->port_list_lock, flags);
Swen Schillig317e6b62008-07-02 10:56:37 +0200280 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281}
282
Swen Schilligf3450c72009-11-24 16:53:59 +0100283/**
284 * zfcp_unit_release - dequeue unit
285 * @dev: pointer to device
286 *
287 * waits until all work is done on unit and removes it then from the unit->list
288 * of the associated port.
289 */
290static void zfcp_unit_release(struct device *dev)
Swen Schillig60221922008-07-02 10:56:38 +0200291{
Swen Schilligf3450c72009-11-24 16:53:59 +0100292 struct zfcp_unit *unit = container_of(dev, struct zfcp_unit,
293 sysfs_device);
294
295 put_device(&unit->port->sysfs_device);
296 kfree(unit);
Swen Schillig60221922008-07-02 10:56:38 +0200297}
298
Linus Torvalds1da177e2005-04-16 15:20:36 -0700299/**
300 * zfcp_unit_enqueue - enqueue unit to unit list of a port.
301 * @port: pointer to port where unit is added
302 * @fcp_lun: FCP LUN of unit to be enqueued
Swen Schillig317e6b62008-07-02 10:56:37 +0200303 * Returns: pointer to enqueued unit on success, ERR_PTR on error
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304 *
305 * Sets up some unit internal structures and creates sysfs entry.
306 */
Swen Schillig7ba58c92008-10-01 12:42:18 +0200307struct zfcp_unit *zfcp_unit_enqueue(struct zfcp_port *port, u64 fcp_lun)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700308{
Christof Schmitt462b7852007-06-19 10:25:30 +0200309 struct zfcp_unit *unit;
Swen Schilligf3450c72009-11-24 16:53:59 +0100310 int retval = -ENOMEM;
311
312 get_device(&port->sysfs_device);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313
Swen Schilligecf0c772009-11-24 16:53:58 +0100314 unit = zfcp_get_unit_by_lun(port, fcp_lun);
315 if (unit) {
Swen Schilligf3450c72009-11-24 16:53:59 +0100316 put_device(&unit->sysfs_device);
317 retval = -EEXIST;
318 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200319 }
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200320
Swen Schillig317e6b62008-07-02 10:56:37 +0200321 unit = kzalloc(sizeof(struct zfcp_unit), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 if (!unit)
Swen Schilligf3450c72009-11-24 16:53:59 +0100323 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324
325 unit->port = port;
326 unit->fcp_lun = fcp_lun;
Swen Schilligf3450c72009-11-24 16:53:59 +0100327 unit->sysfs_device.parent = &port->sysfs_device;
328 unit->sysfs_device.release = zfcp_unit_release;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200330 if (dev_set_name(&unit->sysfs_device, "0x%016llx",
331 (unsigned long long) fcp_lun)) {
332 kfree(unit);
Swen Schilligf3450c72009-11-24 16:53:59 +0100333 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200334 }
Swen Schilligf3450c72009-11-24 16:53:59 +0100335 retval = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336
Swen Schilligf3450c72009-11-24 16:53:59 +0100337 INIT_WORK(&unit->scsi_work, zfcp_scsi_scan);
338
Christof Schmittc9615852008-05-06 11:00:05 +0200339 spin_lock_init(&unit->latencies.lock);
340 unit->latencies.write.channel.min = 0xFFFFFFFF;
341 unit->latencies.write.fabric.min = 0xFFFFFFFF;
342 unit->latencies.read.channel.min = 0xFFFFFFFF;
343 unit->latencies.read.fabric.min = 0xFFFFFFFF;
344 unit->latencies.cmd.channel.min = 0xFFFFFFFF;
345 unit->latencies.cmd.fabric.min = 0xFFFFFFFF;
346
Sebastian Ottf4395b62009-08-18 15:43:29 +0200347 if (device_register(&unit->sysfs_device)) {
348 put_device(&unit->sysfs_device);
Swen Schilligf3450c72009-11-24 16:53:59 +0100349 goto err_out;
Sebastian Ottf4395b62009-08-18 15:43:29 +0200350 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351
Swen Schillig60221922008-07-02 10:56:38 +0200352 if (sysfs_create_group(&unit->sysfs_device.kobj,
Swen Schilligf3450c72009-11-24 16:53:59 +0100353 &zfcp_sysfs_unit_attrs))
354 goto err_out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355
Swen Schilligecf0c772009-11-24 16:53:58 +0100356 write_lock_irq(&port->unit_list_lock);
357 list_add_tail(&unit->list, &port->unit_list);
358 write_unlock_irq(&port->unit_list_lock);
359
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &unit->status);
Swen Schillig317e6b62008-07-02 10:56:37 +0200361
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 return unit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363
Swen Schilligf3450c72009-11-24 16:53:59 +0100364err_out_put:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 device_unregister(&unit->sysfs_device);
Swen Schilligf3450c72009-11-24 16:53:59 +0100366err_out:
367 put_device(&port->sysfs_device);
368 return ERR_PTR(retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369}
370
Swen Schillig317e6b62008-07-02 10:56:37 +0200371static int zfcp_allocate_low_mem_buffers(struct zfcp_adapter *adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372{
Swen Schilliga4623c42009-08-18 15:43:15 +0200373 adapter->pool.erp_req =
374 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
375 if (!adapter->pool.erp_req)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 return -ENOMEM;
377
Christof Schmitt799b76d2009-08-18 15:43:20 +0200378 adapter->pool.gid_pn_req =
379 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
380 if (!adapter->pool.gid_pn_req)
381 return -ENOMEM;
382
Swen Schilliga4623c42009-08-18 15:43:15 +0200383 adapter->pool.scsi_req =
384 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
385 if (!adapter->pool.scsi_req)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386 return -ENOMEM;
387
Swen Schilliga4623c42009-08-18 15:43:15 +0200388 adapter->pool.scsi_abort =
389 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
390 if (!adapter->pool.scsi_abort)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 return -ENOMEM;
392
Swen Schilliga4623c42009-08-18 15:43:15 +0200393 adapter->pool.status_read_req =
Swen Schillig317e6b62008-07-02 10:56:37 +0200394 mempool_create_kmalloc_pool(FSF_STATUS_READS_RECOM,
Matthew Dobson0eaae62a2006-03-26 01:37:47 -0800395 sizeof(struct zfcp_fsf_req));
Swen Schilliga4623c42009-08-18 15:43:15 +0200396 if (!adapter->pool.status_read_req)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397 return -ENOMEM;
398
Swen Schilliga4623c42009-08-18 15:43:15 +0200399 adapter->pool.qtcb_pool =
Christof Schmitt799b76d2009-08-18 15:43:20 +0200400 mempool_create_slab_pool(4, zfcp_data.qtcb_cache);
Swen Schilliga4623c42009-08-18 15:43:15 +0200401 if (!adapter->pool.qtcb_pool)
402 return -ENOMEM;
403
404 adapter->pool.status_read_data =
Swen Schillig317e6b62008-07-02 10:56:37 +0200405 mempool_create_slab_pool(FSF_STATUS_READS_RECOM,
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200406 zfcp_data.sr_buffer_cache);
Swen Schilliga4623c42009-08-18 15:43:15 +0200407 if (!adapter->pool.status_read_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 return -ENOMEM;
409
Swen Schilliga4623c42009-08-18 15:43:15 +0200410 adapter->pool.gid_pn_data =
Swen Schillig317e6b62008-07-02 10:56:37 +0200411 mempool_create_slab_pool(1, zfcp_data.gid_pn_cache);
Swen Schilliga4623c42009-08-18 15:43:15 +0200412 if (!adapter->pool.gid_pn_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 return -ENOMEM;
414
415 return 0;
416}
417
Swen Schillig317e6b62008-07-02 10:56:37 +0200418static void zfcp_free_low_mem_buffers(struct zfcp_adapter *adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419{
Swen Schilliga4623c42009-08-18 15:43:15 +0200420 if (adapter->pool.erp_req)
421 mempool_destroy(adapter->pool.erp_req);
422 if (adapter->pool.scsi_req)
423 mempool_destroy(adapter->pool.scsi_req);
424 if (adapter->pool.scsi_abort)
425 mempool_destroy(adapter->pool.scsi_abort);
426 if (adapter->pool.qtcb_pool)
427 mempool_destroy(adapter->pool.qtcb_pool);
428 if (adapter->pool.status_read_req)
429 mempool_destroy(adapter->pool.status_read_req);
430 if (adapter->pool.status_read_data)
431 mempool_destroy(adapter->pool.status_read_data);
432 if (adapter->pool.gid_pn_data)
433 mempool_destroy(adapter->pool.gid_pn_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700434}
435
Swen Schillig317e6b62008-07-02 10:56:37 +0200436/**
437 * zfcp_status_read_refill - refill the long running status_read_requests
438 * @adapter: ptr to struct zfcp_adapter for which the buffers should be refilled
439 *
440 * Returns: 0 on success, 1 otherwise
441 *
442 * if there are 16 or more status_read requests missing an adapter_reopen
443 * is triggered
444 */
Swen Schilligd26ab062008-05-19 12:17:37 +0200445int zfcp_status_read_refill(struct zfcp_adapter *adapter)
446{
447 while (atomic_read(&adapter->stat_miss) > 0)
Swen Schillig564e1c82009-08-18 15:43:19 +0200448 if (zfcp_fsf_status_read(adapter->qdio)) {
Swen Schillig7afe29f2008-07-02 10:56:33 +0200449 if (atomic_read(&adapter->stat_miss) >= 16) {
Swen Schillig5ffd51a2009-03-02 13:09:04 +0100450 zfcp_erp_adapter_reopen(adapter, 0, "axsref1",
451 NULL);
Swen Schillig7afe29f2008-07-02 10:56:33 +0200452 return 1;
453 }
Swen Schilligd26ab062008-05-19 12:17:37 +0200454 break;
Swen Schillig7afe29f2008-07-02 10:56:33 +0200455 } else
456 atomic_dec(&adapter->stat_miss);
Swen Schilligd26ab062008-05-19 12:17:37 +0200457 return 0;
458}
459
460static void _zfcp_status_read_scheduler(struct work_struct *work)
461{
462 zfcp_status_read_refill(container_of(work, struct zfcp_adapter,
463 stat_work));
464}
465
Christof Schmittbd43a42b72008-12-25 13:38:50 +0100466static void zfcp_print_sl(struct seq_file *m, struct service_level *sl)
467{
468 struct zfcp_adapter *adapter =
469 container_of(sl, struct zfcp_adapter, service_level);
470
471 seq_printf(m, "zfcp: %s microcode level %x\n",
472 dev_name(&adapter->ccw_device->dev),
473 adapter->fsf_lic_version);
474}
475
Swen Schillig45446832009-08-18 15:43:17 +0200476static int zfcp_setup_adapter_work_queue(struct zfcp_adapter *adapter)
477{
478 char name[TASK_COMM_LEN];
479
480 snprintf(name, sizeof(name), "zfcp_q_%s",
481 dev_name(&adapter->ccw_device->dev));
482 adapter->work_queue = create_singlethread_workqueue(name);
483
484 if (adapter->work_queue)
485 return 0;
486 return -ENOMEM;
487}
488
489static void zfcp_destroy_adapter_work_queue(struct zfcp_adapter *adapter)
490{
491 if (adapter->work_queue)
492 destroy_workqueue(adapter->work_queue);
493 adapter->work_queue = NULL;
494
495}
496
Swen Schillig317e6b62008-07-02 10:56:37 +0200497/**
498 * zfcp_adapter_enqueue - enqueue a new adapter to the list
499 * @ccw_device: pointer to the struct cc_device
500 *
Swen Schilligde3dc572009-11-24 16:54:00 +0100501 * Returns: struct zfcp_adapter*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502 * Enqueues an adapter at the end of the adapter list in the driver data.
503 * All adapter internal structures are set up.
504 * Proc-fs entries are also created.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 */
Swen Schilligde3dc572009-11-24 16:54:00 +0100506struct zfcp_adapter *zfcp_adapter_enqueue(struct ccw_device *ccw_device)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 struct zfcp_adapter *adapter;
509
Swen Schilligf3450c72009-11-24 16:53:59 +0100510 if (!get_device(&ccw_device->dev))
Swen Schilligde3dc572009-11-24 16:54:00 +0100511 return ERR_PTR(-ENODEV);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512
Swen Schillig317e6b62008-07-02 10:56:37 +0200513 adapter = kzalloc(sizeof(struct zfcp_adapter), GFP_KERNEL);
Swen Schilligf3450c72009-11-24 16:53:59 +0100514 if (!adapter) {
515 put_device(&ccw_device->dev);
Swen Schilligde3dc572009-11-24 16:54:00 +0100516 return ERR_PTR(-ENOMEM);
Swen Schilligf3450c72009-11-24 16:53:59 +0100517 }
518
519 kref_init(&adapter->ref);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520
521 ccw_device->handler = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522 adapter->ccw_device = ccw_device;
Swen Schilligf3450c72009-11-24 16:53:59 +0100523
524 INIT_WORK(&adapter->stat_work, _zfcp_status_read_scheduler);
Swen Schillig9eae07e2009-11-24 16:54:06 +0100525 INIT_WORK(&adapter->scan_work, zfcp_fc_scan_ports);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526
Swen Schilligd5a282a2009-08-18 15:43:22 +0200527 if (zfcp_qdio_setup(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100528 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529
Swen Schillig00bab912008-06-10 18:20:57 +0200530 if (zfcp_allocate_low_mem_buffers(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100531 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532
Swen Schillig00bab912008-06-10 18:20:57 +0200533 if (zfcp_reqlist_alloc(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100534 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535
Swen Schillig57717102009-08-18 15:43:21 +0200536 if (zfcp_dbf_adapter_register(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100537 goto failed;
Swen Schillig317e6b62008-07-02 10:56:37 +0200538
Swen Schillig45446832009-08-18 15:43:17 +0200539 if (zfcp_setup_adapter_work_queue(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100540 goto failed;
Swen Schillig45446832009-08-18 15:43:17 +0200541
Swen Schilligd5a282a2009-08-18 15:43:22 +0200542 if (zfcp_fc_gs_setup(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100543 goto failed;
Swen Schilligd5a282a2009-08-18 15:43:22 +0200544
Swen Schilligecf0c772009-11-24 16:53:58 +0100545 rwlock_init(&adapter->port_list_lock);
546 INIT_LIST_HEAD(&adapter->port_list);
547
Christof Schmitt347c6a92009-08-18 15:43:25 +0200548 init_waitqueue_head(&adapter->erp_ready_wq);
Swen Schillig317e6b62008-07-02 10:56:37 +0200549 init_waitqueue_head(&adapter->erp_done_wqh);
550
Swen Schillig317e6b62008-07-02 10:56:37 +0200551 INIT_LIST_HEAD(&adapter->erp_ready_head);
552 INIT_LIST_HEAD(&adapter->erp_running_head);
553
554 spin_lock_init(&adapter->req_list_lock);
Heiko Carstensc48a29d2005-12-01 02:46:32 +0100555
Heiko Carstensc48a29d2005-12-01 02:46:32 +0100556 rwlock_init(&adapter->erp_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557 rwlock_init(&adapter->abort_lock);
Swen Schillig317e6b62008-07-02 10:56:37 +0200558
Christof Schmitt143bb6b2009-08-18 15:43:27 +0200559 if (zfcp_erp_thread_setup(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100560 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561
Christof Schmittbd43a42b72008-12-25 13:38:50 +0100562 adapter->service_level.seq_print = zfcp_print_sl;
563
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 dev_set_drvdata(&ccw_device->dev, adapter);
565
Swen Schillig60221922008-07-02 10:56:38 +0200566 if (sysfs_create_group(&ccw_device->dev.kobj,
567 &zfcp_sysfs_adapter_attrs))
Swen Schilligf3450c72009-11-24 16:53:59 +0100568 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569
Swen Schillig1d3aab02008-12-19 16:56:53 +0100570 if (!zfcp_adapter_scsi_register(adapter))
Swen Schilligde3dc572009-11-24 16:54:00 +0100571 return adapter;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572
Swen Schilligf3450c72009-11-24 16:53:59 +0100573failed:
Swen Schilligde3dc572009-11-24 16:54:00 +0100574 zfcp_adapter_unregister(adapter);
575 return ERR_PTR(-ENOMEM);
576}
577
578void zfcp_adapter_unregister(struct zfcp_adapter *adapter)
579{
580 struct ccw_device *cdev = adapter->ccw_device;
581
582 cancel_work_sync(&adapter->scan_work);
583 cancel_work_sync(&adapter->stat_work);
584 zfcp_destroy_adapter_work_queue(adapter);
585
586 zfcp_fc_wka_ports_force_offline(adapter->gs);
587 zfcp_adapter_scsi_unregister(adapter);
588 sysfs_remove_group(&cdev->dev.kobj, &zfcp_sysfs_adapter_attrs);
589
590 zfcp_erp_thread_kill(adapter);
591 zfcp_dbf_adapter_unregister(adapter->dbf);
592 zfcp_qdio_destroy(adapter->qdio);
593
594 zfcp_ccw_adapter_put(adapter); /* final put to release */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595}
596
Swen Schillig317e6b62008-07-02 10:56:37 +0200597/**
Swen Schilligf3450c72009-11-24 16:53:59 +0100598 * zfcp_adapter_release - remove the adapter from the resource list
599 * @ref: pointer to struct kref
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600 * locks: adapter list write lock is assumed to be held by caller
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601 */
Swen Schilligf3450c72009-11-24 16:53:59 +0100602void zfcp_adapter_release(struct kref *ref)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603{
Swen Schilligf3450c72009-11-24 16:53:59 +0100604 struct zfcp_adapter *adapter = container_of(ref, struct zfcp_adapter,
605 ref);
Swen Schilligde3dc572009-11-24 16:54:00 +0100606 struct ccw_device *cdev = adapter->ccw_device;
Swen Schilligf3450c72009-11-24 16:53:59 +0100607
608 dev_set_drvdata(&adapter->ccw_device->dev, NULL);
Swen Schilligd5a282a2009-08-18 15:43:22 +0200609 zfcp_fc_gs_destroy(adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610 zfcp_free_low_mem_buffers(adapter);
Swen Schillig317e6b62008-07-02 10:56:37 +0200611 kfree(adapter->req_list);
Andreas Herrmannf6cd94b2006-01-05 09:59:34 +0100612 kfree(adapter->fc_stats);
613 kfree(adapter->stats_reset_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 kfree(adapter);
Swen Schilligde3dc572009-11-24 16:54:00 +0100615 put_device(&cdev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700616}
617
Swen Schilligf3450c72009-11-24 16:53:59 +0100618/**
619 * zfcp_device_unregister - remove port, unit from system
620 * @dev: reference to device which is to be removed
621 * @grp: related reference to attribute group
622 *
623 * Helper function to unregister port, unit from system
624 */
625void zfcp_device_unregister(struct device *dev,
626 const struct attribute_group *grp)
Swen Schillig60221922008-07-02 10:56:38 +0200627{
Swen Schilligf3450c72009-11-24 16:53:59 +0100628 sysfs_remove_group(&dev->kobj, grp);
629 device_unregister(dev);
630}
631
632static void zfcp_port_release(struct device *dev)
633{
634 struct zfcp_port *port = container_of(dev, struct zfcp_port,
635 sysfs_device);
636
Swen Schilligde3dc572009-11-24 16:54:00 +0100637 zfcp_ccw_adapter_put(port->adapter);
Swen Schilligf3450c72009-11-24 16:53:59 +0100638 kfree(port);
Swen Schillig60221922008-07-02 10:56:38 +0200639}
640
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641/**
642 * zfcp_port_enqueue - enqueue port to port list of adapter
643 * @adapter: adapter where remote port is added
644 * @wwpn: WWPN of the remote port to be enqueued
645 * @status: initial status for the port
646 * @d_id: destination id of the remote port to be enqueued
Swen Schillig317e6b62008-07-02 10:56:37 +0200647 * Returns: pointer to enqueued port on success, ERR_PTR on error
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 *
649 * All port internal structures are set up and the sysfs entry is generated.
650 * d_id is used to enqueue ports with a well known address like the Directory
651 * Service for nameserver lookup.
652 */
Swen Schillig7ba58c92008-10-01 12:42:18 +0200653struct zfcp_port *zfcp_port_enqueue(struct zfcp_adapter *adapter, u64 wwpn,
Swen Schillig317e6b62008-07-02 10:56:37 +0200654 u32 status, u32 d_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655{
Andreas Herrmann3859f6a2005-08-27 11:07:54 -0700656 struct zfcp_port *port;
Swen Schilligf3450c72009-11-24 16:53:59 +0100657 int retval = -ENOMEM;
658
659 kref_get(&adapter->ref);
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200660
Swen Schilligecf0c772009-11-24 16:53:58 +0100661 port = zfcp_get_port_by_wwpn(adapter, wwpn);
662 if (port) {
Swen Schilligf3450c72009-11-24 16:53:59 +0100663 put_device(&port->sysfs_device);
664 retval = -EEXIST;
665 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200666 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667
Swen Schillig317e6b62008-07-02 10:56:37 +0200668 port = kzalloc(sizeof(struct zfcp_port), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669 if (!port)
Swen Schilligf3450c72009-11-24 16:53:59 +0100670 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700671
Swen Schilligecf0c772009-11-24 16:53:58 +0100672 rwlock_init(&port->unit_list_lock);
673 INIT_LIST_HEAD(&port->unit_list);
674
Christof Schmitt799b76d2009-08-18 15:43:20 +0200675 INIT_WORK(&port->gid_pn_work, zfcp_fc_port_did_lookup);
Christof Schmitt8fdf30d2009-03-02 13:09:01 +0100676 INIT_WORK(&port->test_link_work, zfcp_fc_link_test_work);
Christof Schmitta2fa0ae2009-03-02 13:09:08 +0100677 INIT_WORK(&port->rport_work, zfcp_scsi_rport_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678
679 port->adapter = adapter;
Swen Schillig317e6b62008-07-02 10:56:37 +0200680 port->d_id = d_id;
681 port->wwpn = wwpn;
Christof Schmitta2fa0ae2009-03-02 13:09:08 +0100682 port->rport_task = RPORT_NONE;
Swen Schilligf3450c72009-11-24 16:53:59 +0100683 port->sysfs_device.parent = &adapter->ccw_device->dev;
684 port->sysfs_device.release = zfcp_port_release;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200686 if (dev_set_name(&port->sysfs_device, "0x%016llx",
687 (unsigned long long)wwpn)) {
688 kfree(port);
Swen Schilligf3450c72009-11-24 16:53:59 +0100689 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200690 }
Swen Schilligf3450c72009-11-24 16:53:59 +0100691 retval = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692
Sebastian Ottf4395b62009-08-18 15:43:29 +0200693 if (device_register(&port->sysfs_device)) {
694 put_device(&port->sysfs_device);
Swen Schilligf3450c72009-11-24 16:53:59 +0100695 goto err_out;
Sebastian Ottf4395b62009-08-18 15:43:29 +0200696 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200698 if (sysfs_create_group(&port->sysfs_device.kobj,
Swen Schilligf3450c72009-11-24 16:53:59 +0100699 &zfcp_sysfs_port_attrs))
700 goto err_out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700701
Swen Schilligecf0c772009-11-24 16:53:58 +0100702 write_lock_irq(&adapter->port_list_lock);
703 list_add_tail(&port->list, &adapter->port_list);
704 write_unlock_irq(&adapter->port_list_lock);
705
Swen Schillig6b1833342009-11-24 16:54:05 +0100706 atomic_set_mask(status | ZFCP_STATUS_COMMON_RUNNING, &port->status);
Swen Schillig317e6b62008-07-02 10:56:37 +0200707
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708 return port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700709
Swen Schilligf3450c72009-11-24 16:53:59 +0100710err_out_put:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711 device_unregister(&port->sysfs_device);
Swen Schilligf3450c72009-11-24 16:53:59 +0100712err_out:
Swen Schilligde3dc572009-11-24 16:54:00 +0100713 zfcp_ccw_adapter_put(adapter);
Swen Schilligf3450c72009-11-24 16:53:59 +0100714 return ERR_PTR(retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715}
716
Swen Schillig317e6b62008-07-02 10:56:37 +0200717/**
718 * zfcp_sg_free_table - free memory used by scatterlists
719 * @sg: pointer to scatterlist
720 * @count: number of scatterlist which are to be free'ed
721 * the scatterlist are expected to reference pages always
722 */
Christof Schmitt45633fd2008-06-10 18:20:55 +0200723void zfcp_sg_free_table(struct scatterlist *sg, int count)
724{
725 int i;
726
727 for (i = 0; i < count; i++, sg++)
728 if (sg)
729 free_page((unsigned long) sg_virt(sg));
730 else
731 break;
732}
733
Swen Schillig317e6b62008-07-02 10:56:37 +0200734/**
735 * zfcp_sg_setup_table - init scatterlist and allocate, assign buffers
736 * @sg: pointer to struct scatterlist
737 * @count: number of scatterlists which should be assigned with buffers
738 * of size page
739 *
740 * Returns: 0 on success, -ENOMEM otherwise
741 */
Christof Schmitt45633fd2008-06-10 18:20:55 +0200742int zfcp_sg_setup_table(struct scatterlist *sg, int count)
743{
744 void *addr;
745 int i;
746
747 sg_init_table(sg, count);
748 for (i = 0; i < count; i++, sg++) {
749 addr = (void *) get_zeroed_page(GFP_KERNEL);
750 if (!addr) {
751 zfcp_sg_free_table(sg, i);
752 return -ENOMEM;
753 }
754 sg_set_buf(sg, addr, PAGE_SIZE);
755 }
756 return 0;
757}