blob: 1e6183a86ce5f4f7ccd91cfdd0566ee85ff70db3 [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 Schmitt615f59e2010-02-17 11:18:56 +01006 * Copyright IBM Corporation 2002, 2010
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>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090033#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034#include "zfcp_ext.h"
Christof Schmittdbf5dfe2009-11-24 16:54:10 +010035#include "zfcp_fc.h"
Christof Schmittb6bd2fb2010-02-17 11:18:50 +010036#include "zfcp_reqlist.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
Kay Sievers98df67b2008-12-25 13:38:55 +010038#define ZFCP_BUS_ID_SIZE 20
39
Andreas Herrmann4a9d2d82006-05-22 18:14:08 +020040MODULE_AUTHOR("IBM Deutschland Entwicklung GmbH - linux390@de.ibm.com");
Swen Schillig317e6b62008-07-02 10:56:37 +020041MODULE_DESCRIPTION("FCP HBA driver");
Linus Torvalds1da177e2005-04-16 15:20:36 -070042MODULE_LICENSE("GPL");
43
Christof Schmitt3623ecb2008-12-19 16:56:57 +010044static char *init_device;
45module_param_named(device, init_device, charp, 0400);
Linus Torvalds1da177e2005-04-16 15:20:36 -070046MODULE_PARM_DESC(device, "specify initial device");
47
Swen Schilliga4623c42009-08-18 15:43:15 +020048static struct kmem_cache *zfcp_cache_hw_align(const char *name,
49 unsigned long size)
50{
51 return kmem_cache_create(name, size, roundup_pow_of_two(size), 0, NULL);
52}
53
Christof Schmitt3623ecb2008-12-19 16:56:57 +010054static void __init zfcp_init_device_configure(char *busid, u64 wwpn, u64 lun)
Linus Torvalds1da177e2005-04-16 15:20:36 -070055{
Swen Schilligde3dc572009-11-24 16:54:00 +010056 struct ccw_device *cdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -070057 struct zfcp_adapter *adapter;
58 struct zfcp_port *port;
59 struct zfcp_unit *unit;
60
Swen Schilligde3dc572009-11-24 16:54:00 +010061 cdev = get_ccwdev_by_busid(&zfcp_ccw_driver, busid);
62 if (!cdev)
Christof Schmittc5afd812009-09-24 10:23:22 +020063 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070064
Swen Schilligde3dc572009-11-24 16:54:00 +010065 if (ccw_device_set_online(cdev))
66 goto out_ccw_device;
Christof Schmittc5afd812009-09-24 10:23:22 +020067
Swen Schilligde3dc572009-11-24 16:54:00 +010068 adapter = zfcp_ccw_adapter_by_cdev(cdev);
Swen Schillig317e6b62008-07-02 10:56:37 +020069 if (!adapter)
Swen Schilligde3dc572009-11-24 16:54:00 +010070 goto out_ccw_device;
Christof Schmittc5afd812009-09-24 10:23:22 +020071
72 port = zfcp_get_port_by_wwpn(adapter, wwpn);
73 if (!port)
Linus Torvalds1da177e2005-04-16 15:20:36 -070074 goto out_port;
Christof Schmittc5afd812009-09-24 10:23:22 +020075
Christof Schmitt3623ecb2008-12-19 16:56:57 +010076 unit = zfcp_unit_enqueue(port, lun);
Swen Schillig317e6b62008-07-02 10:56:37 +020077 if (IS_ERR(unit))
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 goto out_unit;
Swen Schillig091694a2008-10-01 12:42:25 +020079
Christof Schmittc5afd812009-09-24 10:23:22 +020080 zfcp_erp_unit_reopen(unit, 0, "auidc_1", NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -070081 zfcp_erp_wait(adapter);
Swen Schillig92d51932009-04-17 15:08:04 +020082 flush_work(&unit->scsi_work);
Swen Schillig091694a2008-10-01 12:42:25 +020083
Swen Schillig317e6b62008-07-02 10:56:37 +020084out_unit:
Christof Schmitt615f59e2010-02-17 11:18:56 +010085 put_device(&port->dev);
Swen Schillig317e6b62008-07-02 10:56:37 +020086out_port:
Swen Schilligde3dc572009-11-24 16:54:00 +010087 zfcp_ccw_adapter_put(adapter);
88out_ccw_device:
89 put_device(&cdev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070090 return;
91}
92
Christof Schmitt3623ecb2008-12-19 16:56:57 +010093static void __init zfcp_init_device_setup(char *devstr)
94{
95 char *token;
Heiko Carstensd10c0852009-10-13 10:44:07 +020096 char *str, *str_saved;
Christof Schmitt3623ecb2008-12-19 16:56:57 +010097 char busid[ZFCP_BUS_ID_SIZE];
98 u64 wwpn, lun;
99
100 /* duplicate devstr and keep the original for sysfs presentation*/
Heiko Carstensd10c0852009-10-13 10:44:07 +0200101 str_saved = kmalloc(strlen(devstr) + 1, GFP_KERNEL);
102 str = str_saved;
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100103 if (!str)
104 return;
105
106 strcpy(str, devstr);
107
108 token = strsep(&str, ",");
109 if (!token || strlen(token) >= ZFCP_BUS_ID_SIZE)
110 goto err_out;
111 strncpy(busid, token, ZFCP_BUS_ID_SIZE);
112
113 token = strsep(&str, ",");
114 if (!token || strict_strtoull(token, 0, (unsigned long long *) &wwpn))
115 goto err_out;
116
117 token = strsep(&str, ",");
118 if (!token || strict_strtoull(token, 0, (unsigned long long *) &lun))
119 goto err_out;
120
Heiko Carstensd10c0852009-10-13 10:44:07 +0200121 kfree(str_saved);
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100122 zfcp_init_device_configure(busid, wwpn, lun);
123 return;
124
Heiko Carstensd10c0852009-10-13 10:44:07 +0200125err_out:
126 kfree(str_saved);
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100127 pr_err("%s is not a valid SCSI device\n", devstr);
128}
129
Swen Schillig317e6b62008-07-02 10:56:37 +0200130static int __init zfcp_module_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131{
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200132 int retval = -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133
Swen Schilliga4623c42009-08-18 15:43:15 +0200134 zfcp_data.gpn_ft_cache = zfcp_cache_hw_align("zfcp_gpn",
Christof Schmittdbf5dfe2009-11-24 16:54:10 +0100135 sizeof(struct zfcp_fc_gpn_ft_req));
Swen Schilliga4623c42009-08-18 15:43:15 +0200136 if (!zfcp_data.gpn_ft_cache)
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200137 goto out;
138
Swen Schilliga4623c42009-08-18 15:43:15 +0200139 zfcp_data.qtcb_cache = zfcp_cache_hw_align("zfcp_qtcb",
140 sizeof(struct fsf_qtcb));
141 if (!zfcp_data.qtcb_cache)
142 goto out_qtcb_cache;
143
144 zfcp_data.sr_buffer_cache = zfcp_cache_hw_align("zfcp_sr",
145 sizeof(struct fsf_status_read_buffer));
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200146 if (!zfcp_data.sr_buffer_cache)
147 goto out_sr_cache;
148
Swen Schilliga4623c42009-08-18 15:43:15 +0200149 zfcp_data.gid_pn_cache = zfcp_cache_hw_align("zfcp_gid",
Christof Schmittdbf5dfe2009-11-24 16:54:10 +0100150 sizeof(struct zfcp_fc_gid_pn));
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200151 if (!zfcp_data.gid_pn_cache)
152 goto out_gid_cache;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153
Christof Schmittee744622009-11-24 16:54:14 +0100154 zfcp_data.adisc_cache = zfcp_cache_hw_align("zfcp_adisc",
155 sizeof(struct zfcp_fc_els_adisc));
156 if (!zfcp_data.adisc_cache)
157 goto out_adisc_cache;
158
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200159 zfcp_data.scsi_transport_template =
160 fc_attach_transport(&zfcp_transport_functions);
161 if (!zfcp_data.scsi_transport_template)
162 goto out_transport;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164 retval = misc_register(&zfcp_cfdc_misc);
Swen Schillig317e6b62008-07-02 10:56:37 +0200165 if (retval) {
Christof Schmittecf39d42008-12-25 13:39:53 +0100166 pr_err("Registering the misc device zfcp_cfdc failed\n");
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200167 goto out_misc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168 }
169
Christof Schmittc1fad412009-11-24 16:54:04 +0100170 retval = ccw_driver_register(&zfcp_ccw_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 if (retval) {
Christof Schmittecf39d42008-12-25 13:39:53 +0100172 pr_err("The zfcp device driver could not register with "
Christof Schmittff3b24f2008-10-01 12:42:15 +0200173 "the common I/O layer\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700174 goto out_ccw_register;
175 }
176
Christof Schmitt3623ecb2008-12-19 16:56:57 +0100177 if (init_device)
178 zfcp_init_device_setup(init_device);
179 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180
Swen Schillig317e6b62008-07-02 10:56:37 +0200181out_ccw_register:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 misc_deregister(&zfcp_cfdc_misc);
Swen Schillig317e6b62008-07-02 10:56:37 +0200183out_misc:
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200184 fc_release_transport(zfcp_data.scsi_transport_template);
Swen Schillig317e6b62008-07-02 10:56:37 +0200185out_transport:
Christof Schmittee744622009-11-24 16:54:14 +0100186 kmem_cache_destroy(zfcp_data.adisc_cache);
187out_adisc_cache:
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200188 kmem_cache_destroy(zfcp_data.gid_pn_cache);
Swen Schillig317e6b62008-07-02 10:56:37 +0200189out_gid_cache:
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200190 kmem_cache_destroy(zfcp_data.sr_buffer_cache);
Swen Schillig317e6b62008-07-02 10:56:37 +0200191out_sr_cache:
Swen Schilliga4623c42009-08-18 15:43:15 +0200192 kmem_cache_destroy(zfcp_data.qtcb_cache);
193out_qtcb_cache:
194 kmem_cache_destroy(zfcp_data.gpn_ft_cache);
Swen Schillig317e6b62008-07-02 10:56:37 +0200195out:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 return retval;
197}
198
Swen Schillig317e6b62008-07-02 10:56:37 +0200199module_init(zfcp_module_init);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200
Christof Schmittc1fad412009-11-24 16:54:04 +0100201static void __exit zfcp_module_exit(void)
202{
203 ccw_driver_unregister(&zfcp_ccw_driver);
204 misc_deregister(&zfcp_cfdc_misc);
205 fc_release_transport(zfcp_data.scsi_transport_template);
Christof Schmittee744622009-11-24 16:54:14 +0100206 kmem_cache_destroy(zfcp_data.adisc_cache);
Christof Schmittc1fad412009-11-24 16:54:04 +0100207 kmem_cache_destroy(zfcp_data.gid_pn_cache);
208 kmem_cache_destroy(zfcp_data.sr_buffer_cache);
209 kmem_cache_destroy(zfcp_data.qtcb_cache);
210 kmem_cache_destroy(zfcp_data.gpn_ft_cache);
211}
212
213module_exit(zfcp_module_exit);
214
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215/**
216 * zfcp_get_unit_by_lun - find unit in unit list of port by FCP LUN
217 * @port: pointer to port to search for unit
218 * @fcp_lun: FCP LUN to search for
Swen Schillig317e6b62008-07-02 10:56:37 +0200219 *
220 * Returns: pointer to zfcp_unit or NULL
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221 */
Swen Schillig7ba58c92008-10-01 12:42:18 +0200222struct zfcp_unit *zfcp_get_unit_by_lun(struct zfcp_port *port, u64 fcp_lun)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223{
Swen Schilligecf0c772009-11-24 16:53:58 +0100224 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225 struct zfcp_unit *unit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226
Swen Schilligecf0c772009-11-24 16:53:58 +0100227 read_lock_irqsave(&port->unit_list_lock, flags);
228 list_for_each_entry(unit, &port->unit_list, list)
Swen Schillig6b1833342009-11-24 16:54:05 +0100229 if (unit->fcp_lun == fcp_lun) {
Christof Schmitt615f59e2010-02-17 11:18:56 +0100230 if (!get_device(&unit->dev))
Swen Schillig6b1833342009-11-24 16:54:05 +0100231 unit = NULL;
Swen Schilligecf0c772009-11-24 16:53:58 +0100232 read_unlock_irqrestore(&port->unit_list_lock, flags);
233 return unit;
234 }
235 read_unlock_irqrestore(&port->unit_list_lock, flags);
Swen Schillig317e6b62008-07-02 10:56:37 +0200236 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237}
238
239/**
240 * zfcp_get_port_by_wwpn - find port in port list of adapter by wwpn
241 * @adapter: pointer to adapter to search for port
242 * @wwpn: wwpn to search for
Swen Schillig317e6b62008-07-02 10:56:37 +0200243 *
244 * Returns: pointer to zfcp_port or NULL
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 */
Swen Schillig317e6b62008-07-02 10:56:37 +0200246struct zfcp_port *zfcp_get_port_by_wwpn(struct zfcp_adapter *adapter,
Swen Schillig7ba58c92008-10-01 12:42:18 +0200247 u64 wwpn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248{
Swen Schilligecf0c772009-11-24 16:53:58 +0100249 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 struct zfcp_port *port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251
Swen Schilligecf0c772009-11-24 16:53:58 +0100252 read_lock_irqsave(&adapter->port_list_lock, flags);
253 list_for_each_entry(port, &adapter->port_list, list)
Swen Schillig6b1833342009-11-24 16:54:05 +0100254 if (port->wwpn == wwpn) {
Christof Schmitt615f59e2010-02-17 11:18:56 +0100255 if (!get_device(&port->dev))
Swen Schillig6b1833342009-11-24 16:54:05 +0100256 port = NULL;
Swen Schilligecf0c772009-11-24 16:53:58 +0100257 read_unlock_irqrestore(&adapter->port_list_lock, flags);
Swen Schillig317e6b62008-07-02 10:56:37 +0200258 return port;
Swen Schilligecf0c772009-11-24 16:53:58 +0100259 }
260 read_unlock_irqrestore(&adapter->port_list_lock, flags);
Swen Schillig317e6b62008-07-02 10:56:37 +0200261 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262}
263
Swen Schilligf3450c72009-11-24 16:53:59 +0100264/**
265 * zfcp_unit_release - dequeue unit
266 * @dev: pointer to device
267 *
268 * waits until all work is done on unit and removes it then from the unit->list
269 * of the associated port.
270 */
271static void zfcp_unit_release(struct device *dev)
Swen Schillig60221922008-07-02 10:56:38 +0200272{
Christof Schmitt615f59e2010-02-17 11:18:56 +0100273 struct zfcp_unit *unit = container_of(dev, struct zfcp_unit, dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100274
Christof Schmitt615f59e2010-02-17 11:18:56 +0100275 put_device(&unit->port->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100276 kfree(unit);
Swen Schillig60221922008-07-02 10:56:38 +0200277}
278
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279/**
280 * zfcp_unit_enqueue - enqueue unit to unit list of a port.
281 * @port: pointer to port where unit is added
282 * @fcp_lun: FCP LUN of unit to be enqueued
Swen Schillig317e6b62008-07-02 10:56:37 +0200283 * Returns: pointer to enqueued unit on success, ERR_PTR on error
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284 *
285 * Sets up some unit internal structures and creates sysfs entry.
286 */
Swen Schillig7ba58c92008-10-01 12:42:18 +0200287struct zfcp_unit *zfcp_unit_enqueue(struct zfcp_port *port, u64 fcp_lun)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288{
Christof Schmitt462b7852007-06-19 10:25:30 +0200289 struct zfcp_unit *unit;
Swen Schilligf3450c72009-11-24 16:53:59 +0100290 int retval = -ENOMEM;
291
Christof Schmitt615f59e2010-02-17 11:18:56 +0100292 get_device(&port->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293
Swen Schilligecf0c772009-11-24 16:53:58 +0100294 unit = zfcp_get_unit_by_lun(port, fcp_lun);
295 if (unit) {
Christof Schmitt615f59e2010-02-17 11:18:56 +0100296 put_device(&unit->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100297 retval = -EEXIST;
298 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200299 }
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200300
Swen Schillig317e6b62008-07-02 10:56:37 +0200301 unit = kzalloc(sizeof(struct zfcp_unit), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700302 if (!unit)
Swen Schilligf3450c72009-11-24 16:53:59 +0100303 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304
305 unit->port = port;
306 unit->fcp_lun = fcp_lun;
Christof Schmitt615f59e2010-02-17 11:18:56 +0100307 unit->dev.parent = &port->dev;
308 unit->dev.release = zfcp_unit_release;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309
Christof Schmitt615f59e2010-02-17 11:18:56 +0100310 if (dev_set_name(&unit->dev, "0x%016llx",
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200311 (unsigned long long) fcp_lun)) {
312 kfree(unit);
Swen Schilligf3450c72009-11-24 16:53:59 +0100313 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200314 }
Swen Schilligf3450c72009-11-24 16:53:59 +0100315 retval = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316
Swen Schilligf3450c72009-11-24 16:53:59 +0100317 INIT_WORK(&unit->scsi_work, zfcp_scsi_scan);
318
Christof Schmittc9615852008-05-06 11:00:05 +0200319 spin_lock_init(&unit->latencies.lock);
320 unit->latencies.write.channel.min = 0xFFFFFFFF;
321 unit->latencies.write.fabric.min = 0xFFFFFFFF;
322 unit->latencies.read.channel.min = 0xFFFFFFFF;
323 unit->latencies.read.fabric.min = 0xFFFFFFFF;
324 unit->latencies.cmd.channel.min = 0xFFFFFFFF;
325 unit->latencies.cmd.fabric.min = 0xFFFFFFFF;
326
Christof Schmitt615f59e2010-02-17 11:18:56 +0100327 if (device_register(&unit->dev)) {
328 put_device(&unit->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100329 goto err_out;
Sebastian Ottf4395b62009-08-18 15:43:29 +0200330 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331
Christof Schmitt615f59e2010-02-17 11:18:56 +0100332 if (sysfs_create_group(&unit->dev.kobj, &zfcp_sysfs_unit_attrs))
Swen Schilligf3450c72009-11-24 16:53:59 +0100333 goto err_out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700334
Swen Schilligecf0c772009-11-24 16:53:58 +0100335 write_lock_irq(&port->unit_list_lock);
336 list_add_tail(&unit->list, &port->unit_list);
337 write_unlock_irq(&port->unit_list_lock);
338
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339 atomic_set_mask(ZFCP_STATUS_COMMON_RUNNING, &unit->status);
Swen Schillig317e6b62008-07-02 10:56:37 +0200340
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341 return unit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342
Swen Schilligf3450c72009-11-24 16:53:59 +0100343err_out_put:
Christof Schmitt615f59e2010-02-17 11:18:56 +0100344 device_unregister(&unit->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100345err_out:
Christof Schmitt615f59e2010-02-17 11:18:56 +0100346 put_device(&port->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100347 return ERR_PTR(retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348}
349
Swen Schillig317e6b62008-07-02 10:56:37 +0200350static int zfcp_allocate_low_mem_buffers(struct zfcp_adapter *adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351{
Swen Schilliga4623c42009-08-18 15:43:15 +0200352 adapter->pool.erp_req =
353 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
354 if (!adapter->pool.erp_req)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355 return -ENOMEM;
356
Christof Schmitt799b76d2009-08-18 15:43:20 +0200357 adapter->pool.gid_pn_req =
358 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
359 if (!adapter->pool.gid_pn_req)
360 return -ENOMEM;
361
Swen Schilliga4623c42009-08-18 15:43:15 +0200362 adapter->pool.scsi_req =
363 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
364 if (!adapter->pool.scsi_req)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 return -ENOMEM;
366
Swen Schilliga4623c42009-08-18 15:43:15 +0200367 adapter->pool.scsi_abort =
368 mempool_create_kmalloc_pool(1, sizeof(struct zfcp_fsf_req));
369 if (!adapter->pool.scsi_abort)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370 return -ENOMEM;
371
Swen Schilliga4623c42009-08-18 15:43:15 +0200372 adapter->pool.status_read_req =
Swen Schillig317e6b62008-07-02 10:56:37 +0200373 mempool_create_kmalloc_pool(FSF_STATUS_READS_RECOM,
Matthew Dobson0eaae62a2006-03-26 01:37:47 -0800374 sizeof(struct zfcp_fsf_req));
Swen Schilliga4623c42009-08-18 15:43:15 +0200375 if (!adapter->pool.status_read_req)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 return -ENOMEM;
377
Swen Schilliga4623c42009-08-18 15:43:15 +0200378 adapter->pool.qtcb_pool =
Christof Schmitt799b76d2009-08-18 15:43:20 +0200379 mempool_create_slab_pool(4, zfcp_data.qtcb_cache);
Swen Schilliga4623c42009-08-18 15:43:15 +0200380 if (!adapter->pool.qtcb_pool)
381 return -ENOMEM;
382
383 adapter->pool.status_read_data =
Swen Schillig317e6b62008-07-02 10:56:37 +0200384 mempool_create_slab_pool(FSF_STATUS_READS_RECOM,
Heiko Carstensdd52e0e2006-09-18 22:28:49 +0200385 zfcp_data.sr_buffer_cache);
Swen Schilliga4623c42009-08-18 15:43:15 +0200386 if (!adapter->pool.status_read_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 return -ENOMEM;
388
Christof Schmittdbf5dfe2009-11-24 16:54:10 +0100389 adapter->pool.gid_pn =
Swen Schillig317e6b62008-07-02 10:56:37 +0200390 mempool_create_slab_pool(1, zfcp_data.gid_pn_cache);
Christof Schmittdbf5dfe2009-11-24 16:54:10 +0100391 if (!adapter->pool.gid_pn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 return -ENOMEM;
393
394 return 0;
395}
396
Swen Schillig317e6b62008-07-02 10:56:37 +0200397static void zfcp_free_low_mem_buffers(struct zfcp_adapter *adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398{
Swen Schilliga4623c42009-08-18 15:43:15 +0200399 if (adapter->pool.erp_req)
400 mempool_destroy(adapter->pool.erp_req);
401 if (adapter->pool.scsi_req)
402 mempool_destroy(adapter->pool.scsi_req);
403 if (adapter->pool.scsi_abort)
404 mempool_destroy(adapter->pool.scsi_abort);
405 if (adapter->pool.qtcb_pool)
406 mempool_destroy(adapter->pool.qtcb_pool);
407 if (adapter->pool.status_read_req)
408 mempool_destroy(adapter->pool.status_read_req);
409 if (adapter->pool.status_read_data)
410 mempool_destroy(adapter->pool.status_read_data);
Christof Schmittdbf5dfe2009-11-24 16:54:10 +0100411 if (adapter->pool.gid_pn)
412 mempool_destroy(adapter->pool.gid_pn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413}
414
Swen Schillig317e6b62008-07-02 10:56:37 +0200415/**
416 * zfcp_status_read_refill - refill the long running status_read_requests
417 * @adapter: ptr to struct zfcp_adapter for which the buffers should be refilled
418 *
419 * Returns: 0 on success, 1 otherwise
420 *
421 * if there are 16 or more status_read requests missing an adapter_reopen
422 * is triggered
423 */
Swen Schilligd26ab062008-05-19 12:17:37 +0200424int zfcp_status_read_refill(struct zfcp_adapter *adapter)
425{
426 while (atomic_read(&adapter->stat_miss) > 0)
Swen Schillig564e1c82009-08-18 15:43:19 +0200427 if (zfcp_fsf_status_read(adapter->qdio)) {
Swen Schillig7afe29f2008-07-02 10:56:33 +0200428 if (atomic_read(&adapter->stat_miss) >= 16) {
Swen Schillig5ffd51a2009-03-02 13:09:04 +0100429 zfcp_erp_adapter_reopen(adapter, 0, "axsref1",
430 NULL);
Swen Schillig7afe29f2008-07-02 10:56:33 +0200431 return 1;
432 }
Swen Schilligd26ab062008-05-19 12:17:37 +0200433 break;
Swen Schillig7afe29f2008-07-02 10:56:33 +0200434 } else
435 atomic_dec(&adapter->stat_miss);
Swen Schilligd26ab062008-05-19 12:17:37 +0200436 return 0;
437}
438
439static void _zfcp_status_read_scheduler(struct work_struct *work)
440{
441 zfcp_status_read_refill(container_of(work, struct zfcp_adapter,
442 stat_work));
443}
444
Christof Schmittbd43a42b72008-12-25 13:38:50 +0100445static void zfcp_print_sl(struct seq_file *m, struct service_level *sl)
446{
447 struct zfcp_adapter *adapter =
448 container_of(sl, struct zfcp_adapter, service_level);
449
450 seq_printf(m, "zfcp: %s microcode level %x\n",
451 dev_name(&adapter->ccw_device->dev),
452 adapter->fsf_lic_version);
453}
454
Swen Schillig45446832009-08-18 15:43:17 +0200455static int zfcp_setup_adapter_work_queue(struct zfcp_adapter *adapter)
456{
457 char name[TASK_COMM_LEN];
458
459 snprintf(name, sizeof(name), "zfcp_q_%s",
460 dev_name(&adapter->ccw_device->dev));
461 adapter->work_queue = create_singlethread_workqueue(name);
462
463 if (adapter->work_queue)
464 return 0;
465 return -ENOMEM;
466}
467
468static void zfcp_destroy_adapter_work_queue(struct zfcp_adapter *adapter)
469{
470 if (adapter->work_queue)
471 destroy_workqueue(adapter->work_queue);
472 adapter->work_queue = NULL;
473
474}
475
Swen Schillig317e6b62008-07-02 10:56:37 +0200476/**
477 * zfcp_adapter_enqueue - enqueue a new adapter to the list
478 * @ccw_device: pointer to the struct cc_device
479 *
Swen Schilligde3dc572009-11-24 16:54:00 +0100480 * Returns: struct zfcp_adapter*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 * Enqueues an adapter at the end of the adapter list in the driver data.
482 * All adapter internal structures are set up.
483 * Proc-fs entries are also created.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 */
Swen Schilligde3dc572009-11-24 16:54:00 +0100485struct zfcp_adapter *zfcp_adapter_enqueue(struct ccw_device *ccw_device)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487 struct zfcp_adapter *adapter;
488
Swen Schilligf3450c72009-11-24 16:53:59 +0100489 if (!get_device(&ccw_device->dev))
Swen Schilligde3dc572009-11-24 16:54:00 +0100490 return ERR_PTR(-ENODEV);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700491
Swen Schillig317e6b62008-07-02 10:56:37 +0200492 adapter = kzalloc(sizeof(struct zfcp_adapter), GFP_KERNEL);
Swen Schilligf3450c72009-11-24 16:53:59 +0100493 if (!adapter) {
494 put_device(&ccw_device->dev);
Swen Schilligde3dc572009-11-24 16:54:00 +0100495 return ERR_PTR(-ENOMEM);
Swen Schilligf3450c72009-11-24 16:53:59 +0100496 }
497
498 kref_init(&adapter->ref);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499
500 ccw_device->handler = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501 adapter->ccw_device = ccw_device;
Swen Schilligf3450c72009-11-24 16:53:59 +0100502
503 INIT_WORK(&adapter->stat_work, _zfcp_status_read_scheduler);
Swen Schillig9eae07e2009-11-24 16:54:06 +0100504 INIT_WORK(&adapter->scan_work, zfcp_fc_scan_ports);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505
Swen Schilligd5a282a2009-08-18 15:43:22 +0200506 if (zfcp_qdio_setup(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100507 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508
Swen Schillig00bab912008-06-10 18:20:57 +0200509 if (zfcp_allocate_low_mem_buffers(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100510 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511
Christof Schmittb6bd2fb2010-02-17 11:18:50 +0100512 adapter->req_list = zfcp_reqlist_alloc();
513 if (!adapter->req_list)
Swen Schilligf3450c72009-11-24 16:53:59 +0100514 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515
Swen Schillig57717102009-08-18 15:43:21 +0200516 if (zfcp_dbf_adapter_register(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100517 goto failed;
Swen Schillig317e6b62008-07-02 10:56:37 +0200518
Swen Schillig45446832009-08-18 15:43:17 +0200519 if (zfcp_setup_adapter_work_queue(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100520 goto failed;
Swen Schillig45446832009-08-18 15:43:17 +0200521
Swen Schilligd5a282a2009-08-18 15:43:22 +0200522 if (zfcp_fc_gs_setup(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100523 goto failed;
Swen Schilligd5a282a2009-08-18 15:43:22 +0200524
Swen Schilligecf0c772009-11-24 16:53:58 +0100525 rwlock_init(&adapter->port_list_lock);
526 INIT_LIST_HEAD(&adapter->port_list);
527
Christof Schmitt347c6a92009-08-18 15:43:25 +0200528 init_waitqueue_head(&adapter->erp_ready_wq);
Swen Schillig317e6b62008-07-02 10:56:37 +0200529 init_waitqueue_head(&adapter->erp_done_wqh);
530
Swen Schillig317e6b62008-07-02 10:56:37 +0200531 INIT_LIST_HEAD(&adapter->erp_ready_head);
532 INIT_LIST_HEAD(&adapter->erp_running_head);
533
Heiko Carstensc48a29d2005-12-01 02:46:32 +0100534 rwlock_init(&adapter->erp_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 rwlock_init(&adapter->abort_lock);
Swen Schillig317e6b62008-07-02 10:56:37 +0200536
Christof Schmitt143bb6b2009-08-18 15:43:27 +0200537 if (zfcp_erp_thread_setup(adapter))
Swen Schilligf3450c72009-11-24 16:53:59 +0100538 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539
Christof Schmittbd43a42b72008-12-25 13:38:50 +0100540 adapter->service_level.seq_print = zfcp_print_sl;
541
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 dev_set_drvdata(&ccw_device->dev, adapter);
543
Swen Schillig60221922008-07-02 10:56:38 +0200544 if (sysfs_create_group(&ccw_device->dev.kobj,
545 &zfcp_sysfs_adapter_attrs))
Swen Schilligf3450c72009-11-24 16:53:59 +0100546 goto failed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547
Swen Schillig1d3aab02008-12-19 16:56:53 +0100548 if (!zfcp_adapter_scsi_register(adapter))
Swen Schilligde3dc572009-11-24 16:54:00 +0100549 return adapter;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550
Swen Schilligf3450c72009-11-24 16:53:59 +0100551failed:
Swen Schilligde3dc572009-11-24 16:54:00 +0100552 zfcp_adapter_unregister(adapter);
553 return ERR_PTR(-ENOMEM);
554}
555
556void zfcp_adapter_unregister(struct zfcp_adapter *adapter)
557{
558 struct ccw_device *cdev = adapter->ccw_device;
559
560 cancel_work_sync(&adapter->scan_work);
561 cancel_work_sync(&adapter->stat_work);
562 zfcp_destroy_adapter_work_queue(adapter);
563
564 zfcp_fc_wka_ports_force_offline(adapter->gs);
565 zfcp_adapter_scsi_unregister(adapter);
566 sysfs_remove_group(&cdev->dev.kobj, &zfcp_sysfs_adapter_attrs);
567
568 zfcp_erp_thread_kill(adapter);
569 zfcp_dbf_adapter_unregister(adapter->dbf);
570 zfcp_qdio_destroy(adapter->qdio);
571
572 zfcp_ccw_adapter_put(adapter); /* final put to release */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573}
574
Swen Schillig317e6b62008-07-02 10:56:37 +0200575/**
Swen Schilligf3450c72009-11-24 16:53:59 +0100576 * zfcp_adapter_release - remove the adapter from the resource list
577 * @ref: pointer to struct kref
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 * locks: adapter list write lock is assumed to be held by caller
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579 */
Swen Schilligf3450c72009-11-24 16:53:59 +0100580void zfcp_adapter_release(struct kref *ref)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581{
Swen Schilligf3450c72009-11-24 16:53:59 +0100582 struct zfcp_adapter *adapter = container_of(ref, struct zfcp_adapter,
583 ref);
Swen Schilligde3dc572009-11-24 16:54:00 +0100584 struct ccw_device *cdev = adapter->ccw_device;
Swen Schilligf3450c72009-11-24 16:53:59 +0100585
586 dev_set_drvdata(&adapter->ccw_device->dev, NULL);
Swen Schilligd5a282a2009-08-18 15:43:22 +0200587 zfcp_fc_gs_destroy(adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588 zfcp_free_low_mem_buffers(adapter);
Swen Schillig317e6b62008-07-02 10:56:37 +0200589 kfree(adapter->req_list);
Andreas Herrmannf6cd94b2006-01-05 09:59:34 +0100590 kfree(adapter->fc_stats);
591 kfree(adapter->stats_reset_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592 kfree(adapter);
Swen Schilligde3dc572009-11-24 16:54:00 +0100593 put_device(&cdev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594}
595
Swen Schilligf3450c72009-11-24 16:53:59 +0100596/**
597 * zfcp_device_unregister - remove port, unit from system
598 * @dev: reference to device which is to be removed
599 * @grp: related reference to attribute group
600 *
601 * Helper function to unregister port, unit from system
602 */
603void zfcp_device_unregister(struct device *dev,
604 const struct attribute_group *grp)
Swen Schillig60221922008-07-02 10:56:38 +0200605{
Swen Schilligf3450c72009-11-24 16:53:59 +0100606 sysfs_remove_group(&dev->kobj, grp);
607 device_unregister(dev);
608}
609
610static void zfcp_port_release(struct device *dev)
611{
Christof Schmitt615f59e2010-02-17 11:18:56 +0100612 struct zfcp_port *port = container_of(dev, struct zfcp_port, dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100613
Swen Schilligde3dc572009-11-24 16:54:00 +0100614 zfcp_ccw_adapter_put(port->adapter);
Swen Schilligf3450c72009-11-24 16:53:59 +0100615 kfree(port);
Swen Schillig60221922008-07-02 10:56:38 +0200616}
617
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618/**
619 * zfcp_port_enqueue - enqueue port to port list of adapter
620 * @adapter: adapter where remote port is added
621 * @wwpn: WWPN of the remote port to be enqueued
622 * @status: initial status for the port
623 * @d_id: destination id of the remote port to be enqueued
Swen Schillig317e6b62008-07-02 10:56:37 +0200624 * Returns: pointer to enqueued port on success, ERR_PTR on error
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 *
626 * All port internal structures are set up and the sysfs entry is generated.
627 * d_id is used to enqueue ports with a well known address like the Directory
628 * Service for nameserver lookup.
629 */
Swen Schillig7ba58c92008-10-01 12:42:18 +0200630struct zfcp_port *zfcp_port_enqueue(struct zfcp_adapter *adapter, u64 wwpn,
Swen Schillig317e6b62008-07-02 10:56:37 +0200631 u32 status, u32 d_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632{
Andreas Herrmann3859f6a2005-08-27 11:07:54 -0700633 struct zfcp_port *port;
Swen Schilligf3450c72009-11-24 16:53:59 +0100634 int retval = -ENOMEM;
635
636 kref_get(&adapter->ref);
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200637
Swen Schilligecf0c772009-11-24 16:53:58 +0100638 port = zfcp_get_port_by_wwpn(adapter, wwpn);
639 if (port) {
Christof Schmitt615f59e2010-02-17 11:18:56 +0100640 put_device(&port->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100641 retval = -EEXIST;
642 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200643 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644
Swen Schillig317e6b62008-07-02 10:56:37 +0200645 port = kzalloc(sizeof(struct zfcp_port), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646 if (!port)
Swen Schilligf3450c72009-11-24 16:53:59 +0100647 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648
Swen Schilligecf0c772009-11-24 16:53:58 +0100649 rwlock_init(&port->unit_list_lock);
650 INIT_LIST_HEAD(&port->unit_list);
651
Christof Schmitt799b76d2009-08-18 15:43:20 +0200652 INIT_WORK(&port->gid_pn_work, zfcp_fc_port_did_lookup);
Christof Schmitt8fdf30d2009-03-02 13:09:01 +0100653 INIT_WORK(&port->test_link_work, zfcp_fc_link_test_work);
Christof Schmitta2fa0ae2009-03-02 13:09:08 +0100654 INIT_WORK(&port->rport_work, zfcp_scsi_rport_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655
656 port->adapter = adapter;
Swen Schillig317e6b62008-07-02 10:56:37 +0200657 port->d_id = d_id;
658 port->wwpn = wwpn;
Christof Schmitta2fa0ae2009-03-02 13:09:08 +0100659 port->rport_task = RPORT_NONE;
Christof Schmitt615f59e2010-02-17 11:18:56 +0100660 port->dev.parent = &adapter->ccw_device->dev;
661 port->dev.release = zfcp_port_release;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662
Christof Schmitt615f59e2010-02-17 11:18:56 +0100663 if (dev_set_name(&port->dev, "0x%016llx", (unsigned long long)wwpn)) {
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200664 kfree(port);
Swen Schilligf3450c72009-11-24 16:53:59 +0100665 goto err_out;
Christof Schmitt0fac3f42009-08-18 15:43:30 +0200666 }
Swen Schilligf3450c72009-11-24 16:53:59 +0100667 retval = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668
Christof Schmitt615f59e2010-02-17 11:18:56 +0100669 if (device_register(&port->dev)) {
670 put_device(&port->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100671 goto err_out;
Sebastian Ottf4395b62009-08-18 15:43:29 +0200672 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673
Christof Schmitt615f59e2010-02-17 11:18:56 +0100674 if (sysfs_create_group(&port->dev.kobj,
Swen Schilligf3450c72009-11-24 16:53:59 +0100675 &zfcp_sysfs_port_attrs))
676 goto err_out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677
Swen Schilligecf0c772009-11-24 16:53:58 +0100678 write_lock_irq(&adapter->port_list_lock);
679 list_add_tail(&port->list, &adapter->port_list);
680 write_unlock_irq(&adapter->port_list_lock);
681
Swen Schillig6b1833342009-11-24 16:54:05 +0100682 atomic_set_mask(status | ZFCP_STATUS_COMMON_RUNNING, &port->status);
Swen Schillig317e6b62008-07-02 10:56:37 +0200683
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684 return port;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685
Swen Schilligf3450c72009-11-24 16:53:59 +0100686err_out_put:
Christof Schmitt615f59e2010-02-17 11:18:56 +0100687 device_unregister(&port->dev);
Swen Schilligf3450c72009-11-24 16:53:59 +0100688err_out:
Swen Schilligde3dc572009-11-24 16:54:00 +0100689 zfcp_ccw_adapter_put(adapter);
Swen Schilligf3450c72009-11-24 16:53:59 +0100690 return ERR_PTR(retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691}
692
Swen Schillig317e6b62008-07-02 10:56:37 +0200693/**
694 * zfcp_sg_free_table - free memory used by scatterlists
695 * @sg: pointer to scatterlist
696 * @count: number of scatterlist which are to be free'ed
697 * the scatterlist are expected to reference pages always
698 */
Christof Schmitt45633fd2008-06-10 18:20:55 +0200699void zfcp_sg_free_table(struct scatterlist *sg, int count)
700{
701 int i;
702
703 for (i = 0; i < count; i++, sg++)
704 if (sg)
705 free_page((unsigned long) sg_virt(sg));
706 else
707 break;
708}
709
Swen Schillig317e6b62008-07-02 10:56:37 +0200710/**
711 * zfcp_sg_setup_table - init scatterlist and allocate, assign buffers
712 * @sg: pointer to struct scatterlist
713 * @count: number of scatterlists which should be assigned with buffers
714 * of size page
715 *
716 * Returns: 0 on success, -ENOMEM otherwise
717 */
Christof Schmitt45633fd2008-06-10 18:20:55 +0200718int zfcp_sg_setup_table(struct scatterlist *sg, int count)
719{
720 void *addr;
721 int i;
722
723 sg_init_table(sg, count);
724 for (i = 0; i < count; i++, sg++) {
725 addr = (void *) get_zeroed_page(GFP_KERNEL);
726 if (!addr) {
727 zfcp_sg_free_table(sg, i);
728 return -ENOMEM;
729 }
730 sg_set_buf(sg, addr, PAGE_SIZE);
731 }
732 return 0;
733}