Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
00bab910 | 2 | * zfcp device driver |
1da177e4 | 3 | * |
00bab910 | 4 | * Setup and helper functions to access QDIO. |
1da177e4 | 5 | * |
a53c8fab | 6 | * Copyright IBM Corp. 2002, 2010 |
1da177e4 LT |
7 | */ |
8 | ||
ecf39d42 CS |
9 | #define KMSG_COMPONENT "zfcp" |
10 | #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt | |
11 | ||
5a0e3ad6 | 12 | #include <linux/slab.h> |
3a4c5d59 | 13 | #include <linux/module.h> |
1da177e4 | 14 | #include "zfcp_ext.h" |
34c2b712 | 15 | #include "zfcp_qdio.h" |
1da177e4 | 16 | |
909ee499 | 17 | static bool enable_multibuffer = 1; |
86a9668a | 18 | module_param_named(datarouter, enable_multibuffer, bool, 0400); |
909ee499 | 19 | MODULE_PARM_DESC(datarouter, "Enable hardware data router support (default on)"); |
86a9668a | 20 | |
339f4f4e CS |
21 | static void zfcp_qdio_handler_error(struct zfcp_qdio *qdio, char *id, |
22 | unsigned int qdio_err) | |
1da177e4 | 23 | { |
564e1c86 SS |
24 | struct zfcp_adapter *adapter = qdio->adapter; |
25 | ||
ff3b24fa | 26 | dev_warn(&adapter->ccw_device->dev, "A QDIO problem occurred\n"); |
1da177e4 | 27 | |
86a9668a | 28 | if (qdio_err & QDIO_ERROR_SLSB_STATE) { |
339f4f4e | 29 | zfcp_qdio_siosl(adapter); |
86a9668a SS |
30 | zfcp_erp_adapter_shutdown(adapter, 0, id); |
31 | return; | |
32 | } | |
00bab910 SS |
33 | zfcp_erp_adapter_reopen(adapter, |
34 | ZFCP_STATUS_ADAPTER_LINK_UNPLUGGED | | |
ea4a3a6a | 35 | ZFCP_STATUS_COMMON_ERP_FAILED, id); |
1da177e4 LT |
36 | } |
37 | ||
5d4e2262 CS |
38 | static void zfcp_qdio_zero_sbals(struct qdio_buffer *sbal[], int first, int cnt) |
39 | { | |
40 | int i, sbal_idx; | |
41 | ||
42 | for (i = first; i < first + cnt; i++) { | |
43 | sbal_idx = i % QDIO_MAX_BUFFERS_PER_Q; | |
44 | memset(sbal[sbal_idx], 0, sizeof(struct qdio_buffer)); | |
45 | } | |
46 | } | |
47 | ||
94506fd1 | 48 | /* this needs to be called prior to updating the queue fill level */ |
41e05a12 | 49 | static inline void zfcp_qdio_account(struct zfcp_qdio *qdio) |
94506fd1 | 50 | { |
41e05a12 | 51 | unsigned long long now, span; |
706eca49 | 52 | int used; |
94506fd1 | 53 | |
1aae0560 | 54 | now = get_tod_clock_monotonic(); |
41e05a12 | 55 | span = (now - qdio->req_q_time) >> 12; |
706eca49 | 56 | used = QDIO_MAX_BUFFERS_PER_Q - atomic_read(&qdio->req_q_free); |
564e1c86 SS |
57 | qdio->req_q_util += used * span; |
58 | qdio->req_q_time = now; | |
94506fd1 MP |
59 | } |
60 | ||
779e6e1c | 61 | static void zfcp_qdio_int_req(struct ccw_device *cdev, unsigned int qdio_err, |
706eca49 | 62 | int queue_no, int idx, int count, |
00bab910 | 63 | unsigned long parm) |
1da177e4 | 64 | { |
564e1c86 | 65 | struct zfcp_qdio *qdio = (struct zfcp_qdio *) parm; |
1da177e4 | 66 | |
779e6e1c | 67 | if (unlikely(qdio_err)) { |
339f4f4e | 68 | zfcp_qdio_handler_error(qdio, "qdireq1", qdio_err); |
00bab910 SS |
69 | return; |
70 | } | |
1da177e4 LT |
71 | |
72 | /* cleanup all SBALs being program-owned now */ | |
706eca49 | 73 | zfcp_qdio_zero_sbals(qdio->req_q, idx, count); |
1da177e4 | 74 | |
44a24cb3 | 75 | spin_lock_irq(&qdio->stat_lock); |
564e1c86 | 76 | zfcp_qdio_account(qdio); |
44a24cb3 | 77 | spin_unlock_irq(&qdio->stat_lock); |
706eca49 | 78 | atomic_add(count, &qdio->req_q_free); |
564e1c86 | 79 | wake_up(&qdio->req_q_wq); |
1da177e4 LT |
80 | } |
81 | ||
779e6e1c | 82 | static void zfcp_qdio_int_resp(struct ccw_device *cdev, unsigned int qdio_err, |
706eca49 | 83 | int queue_no, int idx, int count, |
00bab910 SS |
84 | unsigned long parm) |
85 | { | |
564e1c86 | 86 | struct zfcp_qdio *qdio = (struct zfcp_qdio *) parm; |
86a9668a | 87 | struct zfcp_adapter *adapter = qdio->adapter; |
86a9668a | 88 | int sbal_no, sbal_idx; |
00bab910 | 89 | |
779e6e1c | 90 | if (unlikely(qdio_err)) { |
86a9668a | 91 | if (zfcp_adapter_multi_buffer_active(adapter)) { |
01e60527 SM |
92 | void *pl[ZFCP_QDIO_MAX_SBALS_PER_REQ + 1]; |
93 | struct qdio_buffer_element *sbale; | |
94 | u64 req_id; | |
95 | u8 scount; | |
96 | ||
97 | memset(pl, 0, | |
98 | ZFCP_QDIO_MAX_SBALS_PER_REQ * sizeof(void *)); | |
86a9668a SS |
99 | sbale = qdio->res_q[idx]->element; |
100 | req_id = (u64) sbale->addr; | |
01e60527 SM |
101 | scount = min(sbale->scount + 1, |
102 | ZFCP_QDIO_MAX_SBALS_PER_REQ + 1); | |
103 | /* incl. signaling SBAL */ | |
86a9668a SS |
104 | |
105 | for (sbal_no = 0; sbal_no < scount; sbal_no++) { | |
106 | sbal_idx = (idx + sbal_no) % | |
107 | QDIO_MAX_BUFFERS_PER_Q; | |
108 | pl[sbal_no] = qdio->res_q[sbal_idx]; | |
109 | } | |
110 | zfcp_dbf_hba_def_err(adapter, req_id, scount, pl); | |
111 | } | |
339f4f4e | 112 | zfcp_qdio_handler_error(qdio, "qdires1", qdio_err); |
00bab910 SS |
113 | return; |
114 | } | |
1da177e4 | 115 | |
1da177e4 LT |
116 | /* |
117 | * go through all SBALs from input queue currently | |
118 | * returned by QDIO layer | |
119 | */ | |
00bab910 | 120 | for (sbal_no = 0; sbal_no < count; sbal_no++) { |
706eca49 | 121 | sbal_idx = (idx + sbal_no) % QDIO_MAX_BUFFERS_PER_Q; |
1da177e4 | 122 | /* go through all SBALEs of SBAL */ |
564e1c86 | 123 | zfcp_fsf_reqid_check(qdio, sbal_idx); |
1da177e4 LT |
124 | } |
125 | ||
126 | /* | |
706eca49 | 127 | * put SBALs back to response queue |
1da177e4 | 128 | */ |
706eca49 | 129 | if (do_QDIO(cdev, QDIO_FLAG_SYNC_INPUT, 0, idx, count)) |
ea4a3a6a | 130 | zfcp_erp_adapter_reopen(qdio->adapter, 0, "qdires2"); |
1da177e4 LT |
131 | } |
132 | ||
44cc76f2 | 133 | static struct qdio_buffer_element * |
1674b405 | 134 | zfcp_qdio_sbal_chain(struct zfcp_qdio *qdio, struct zfcp_qdio_req *q_req) |
1da177e4 | 135 | { |
44cc76f2 | 136 | struct qdio_buffer_element *sbale; |
1da177e4 LT |
137 | |
138 | /* set last entry flag in current SBALE of current SBAL */ | |
564e1c86 | 139 | sbale = zfcp_qdio_sbale_curr(qdio, q_req); |
3ec90878 | 140 | sbale->eflags |= SBAL_EFLAGS_LAST_ENTRY; |
1da177e4 LT |
141 | |
142 | /* don't exceed last allowed SBAL */ | |
42428f74 | 143 | if (q_req->sbal_last == q_req->sbal_limit) |
1da177e4 LT |
144 | return NULL; |
145 | ||
146 | /* set chaining flag in first SBALE of current SBAL */ | |
564e1c86 | 147 | sbale = zfcp_qdio_sbale_req(qdio, q_req); |
3ec90878 | 148 | sbale->sflags |= SBAL_SFLAGS0_MORE_SBALS; |
1da177e4 LT |
149 | |
150 | /* calculate index of next SBAL */ | |
42428f74 SS |
151 | q_req->sbal_last++; |
152 | q_req->sbal_last %= QDIO_MAX_BUFFERS_PER_Q; | |
1da177e4 LT |
153 | |
154 | /* keep this requests number of SBALs up-to-date */ | |
42428f74 | 155 | q_req->sbal_number++; |
01b04759 | 156 | BUG_ON(q_req->sbal_number > ZFCP_QDIO_MAX_SBALS_PER_REQ); |
1da177e4 LT |
157 | |
158 | /* start at first SBALE of new SBAL */ | |
42428f74 | 159 | q_req->sbale_curr = 0; |
1da177e4 LT |
160 | |
161 | /* set storage-block type for new SBAL */ | |
564e1c86 | 162 | sbale = zfcp_qdio_sbale_curr(qdio, q_req); |
3ec90878 | 163 | sbale->sflags |= q_req->sbtype; |
1da177e4 LT |
164 | |
165 | return sbale; | |
166 | } | |
167 | ||
44cc76f2 | 168 | static struct qdio_buffer_element * |
1674b405 | 169 | zfcp_qdio_sbale_next(struct zfcp_qdio *qdio, struct zfcp_qdio_req *q_req) |
1da177e4 | 170 | { |
86a9668a | 171 | if (q_req->sbale_curr == qdio->max_sbale_per_sbal - 1) |
1674b405 | 172 | return zfcp_qdio_sbal_chain(qdio, q_req); |
42428f74 | 173 | q_req->sbale_curr++; |
564e1c86 | 174 | return zfcp_qdio_sbale_curr(qdio, q_req); |
1da177e4 LT |
175 | } |
176 | ||
1da177e4 LT |
177 | /** |
178 | * zfcp_qdio_sbals_from_sg - fill SBALs from scatter-gather list | |
1674b405 CS |
179 | * @qdio: pointer to struct zfcp_qdio |
180 | * @q_req: pointer to struct zfcp_qdio_req | |
1da177e4 | 181 | * @sg: scatter-gather list |
1da177e4 | 182 | * @max_sbals: upper bound for number of SBALs to be used |
86a9668a | 183 | * Returns: zero or -EINVAL on error |
1da177e4 | 184 | */ |
34c2b712 | 185 | int zfcp_qdio_sbals_from_sg(struct zfcp_qdio *qdio, struct zfcp_qdio_req *q_req, |
01b04759 | 186 | struct scatterlist *sg) |
1da177e4 | 187 | { |
44cc76f2 | 188 | struct qdio_buffer_element *sbale; |
1da177e4 | 189 | |
00bab910 | 190 | /* set storage-block type for this request */ |
564e1c86 | 191 | sbale = zfcp_qdio_sbale_req(qdio, q_req); |
3ec90878 | 192 | sbale->sflags |= q_req->sbtype; |
1da177e4 | 193 | |
00bab910 | 194 | for (; sg; sg = sg_next(sg)) { |
1674b405 | 195 | sbale = zfcp_qdio_sbale_next(qdio, q_req); |
68322984 CS |
196 | if (!sbale) { |
197 | atomic_inc(&qdio->req_q_full); | |
706eca49 SS |
198 | zfcp_qdio_zero_sbals(qdio->req_q, q_req->sbal_first, |
199 | q_req->sbal_number); | |
68322984 CS |
200 | return -EINVAL; |
201 | } | |
68322984 CS |
202 | sbale->addr = sg_virt(sg); |
203 | sbale->length = sg->length; | |
1da177e4 | 204 | } |
86a9668a | 205 | return 0; |
1da177e4 LT |
206 | } |
207 | ||
6b9e1520 CS |
208 | static int zfcp_qdio_sbal_check(struct zfcp_qdio *qdio) |
209 | { | |
706eca49 | 210 | if (atomic_read(&qdio->req_q_free) || |
c2af7545 | 211 | !(atomic_read(&qdio->adapter->status) & ZFCP_STATUS_ADAPTER_QDIOUP)) |
6b9e1520 | 212 | return 1; |
6b9e1520 CS |
213 | return 0; |
214 | } | |
215 | ||
216 | /** | |
217 | * zfcp_qdio_sbal_get - get free sbal in request queue, wait if necessary | |
218 | * @qdio: pointer to struct zfcp_qdio | |
219 | * | |
220 | * The req_q_lock must be held by the caller of this function, and | |
221 | * this function may only be called from process context; it will | |
222 | * sleep when waiting for a free sbal. | |
223 | * | |
224 | * Returns: 0 on success, -EIO if there is no free sbal after waiting. | |
225 | */ | |
226 | int zfcp_qdio_sbal_get(struct zfcp_qdio *qdio) | |
227 | { | |
228 | long ret; | |
229 | ||
d79ff142 MP |
230 | ret = wait_event_interruptible_lock_irq_timeout(qdio->req_q_wq, |
231 | zfcp_qdio_sbal_check(qdio), qdio->req_q_lock, 5 * HZ); | |
c2af7545 CS |
232 | |
233 | if (!(atomic_read(&qdio->adapter->status) & ZFCP_STATUS_ADAPTER_QDIOUP)) | |
234 | return -EIO; | |
235 | ||
6b9e1520 CS |
236 | if (ret > 0) |
237 | return 0; | |
c2af7545 | 238 | |
6b9e1520 CS |
239 | if (!ret) { |
240 | atomic_inc(&qdio->req_q_full); | |
241 | /* assume hanging outbound queue, try queue recovery */ | |
ea4a3a6a | 242 | zfcp_erp_adapter_reopen(qdio->adapter, 0, "qdsbg_1"); |
6b9e1520 CS |
243 | } |
244 | ||
6b9e1520 CS |
245 | return -EIO; |
246 | } | |
247 | ||
1da177e4 | 248 | /** |
00bab910 | 249 | * zfcp_qdio_send - set PCI flag in first SBALE and send req to QDIO |
564e1c86 | 250 | * @qdio: pointer to struct zfcp_qdio |
34c2b712 | 251 | * @q_req: pointer to struct zfcp_qdio_req |
00bab910 | 252 | * Returns: 0 on success, error otherwise |
1da177e4 | 253 | */ |
34c2b712 | 254 | int zfcp_qdio_send(struct zfcp_qdio *qdio, struct zfcp_qdio_req *q_req) |
1da177e4 | 255 | { |
21ddaa53 | 256 | int retval; |
706eca49 | 257 | u8 sbal_number = q_req->sbal_number; |
00bab910 | 258 | |
44a24cb3 | 259 | spin_lock(&qdio->stat_lock); |
564e1c86 | 260 | zfcp_qdio_account(qdio); |
44a24cb3 | 261 | spin_unlock(&qdio->stat_lock); |
94506fd1 | 262 | |
706eca49 SS |
263 | retval = do_QDIO(qdio->adapter->ccw_device, QDIO_FLAG_SYNC_OUTPUT, 0, |
264 | q_req->sbal_first, sbal_number); | |
265 | ||
00bab910 | 266 | if (unlikely(retval)) { |
706eca49 SS |
267 | zfcp_qdio_zero_sbals(qdio->req_q, q_req->sbal_first, |
268 | sbal_number); | |
00bab910 SS |
269 | return retval; |
270 | } | |
271 | ||
272 | /* account for transferred buffers */ | |
706eca49 SS |
273 | atomic_sub(sbal_number, &qdio->req_q_free); |
274 | qdio->req_q_idx += sbal_number; | |
275 | qdio->req_q_idx %= QDIO_MAX_BUFFERS_PER_Q; | |
276 | ||
00bab910 | 277 | return 0; |
1da177e4 LT |
278 | } |
279 | ||
564e1c86 SS |
280 | |
281 | static void zfcp_qdio_setup_init_data(struct qdio_initialize *id, | |
282 | struct zfcp_qdio *qdio) | |
283 | { | |
d36deae7 | 284 | memset(id, 0, sizeof(*id)); |
564e1c86 SS |
285 | id->cdev = qdio->adapter->ccw_device; |
286 | id->q_format = QDIO_ZFCP_QFMT; | |
287 | memcpy(id->adapter_name, dev_name(&id->cdev->dev), 8); | |
288 | ASCEBC(id->adapter_name, 8); | |
dcc18f48 | 289 | id->qib_rflags = QIB_RFLAGS_ENABLE_DATA_DIV; |
86a9668a SS |
290 | if (enable_multibuffer) |
291 | id->qdr_ac |= QDR_AC_MULTI_BUFFER_ENABLE; | |
564e1c86 SS |
292 | id->no_input_qs = 1; |
293 | id->no_output_qs = 1; | |
294 | id->input_handler = zfcp_qdio_int_resp; | |
295 | id->output_handler = zfcp_qdio_int_req; | |
296 | id->int_parm = (unsigned long) qdio; | |
706eca49 SS |
297 | id->input_sbal_addr_array = (void **) (qdio->res_q); |
298 | id->output_sbal_addr_array = (void **) (qdio->req_q); | |
3d6c76ff JG |
299 | id->scan_threshold = |
300 | QDIO_MAX_BUFFERS_PER_Q - ZFCP_QDIO_MAX_SBALS_PER_REQ * 2; | |
564e1c86 | 301 | } |
dcc18f48 | 302 | |
00bab910 SS |
303 | /** |
304 | * zfcp_qdio_allocate - allocate queue memory and initialize QDIO data | |
305 | * @adapter: pointer to struct zfcp_adapter | |
306 | * Returns: -ENOMEM on memory allocation error or return value from | |
307 | * qdio_allocate | |
308 | */ | |
d5a282a1 | 309 | static int zfcp_qdio_allocate(struct zfcp_qdio *qdio) |
00bab910 | 310 | { |
564e1c86 | 311 | struct qdio_initialize init_data; |
852eb1aa | 312 | int ret; |
00bab910 | 313 | |
852eb1aa SO |
314 | ret = qdio_alloc_buffers(qdio->req_q, QDIO_MAX_BUFFERS_PER_Q); |
315 | if (ret) | |
00bab910 SS |
316 | return -ENOMEM; |
317 | ||
852eb1aa SO |
318 | ret = qdio_alloc_buffers(qdio->res_q, QDIO_MAX_BUFFERS_PER_Q); |
319 | if (ret) | |
320 | goto free_req_q; | |
321 | ||
564e1c86 | 322 | zfcp_qdio_setup_init_data(&init_data, qdio); |
3d63d3b4 | 323 | init_waitqueue_head(&qdio->req_q_wq); |
564e1c86 | 324 | |
852eb1aa SO |
325 | ret = qdio_allocate(&init_data); |
326 | if (ret) | |
327 | goto free_res_q; | |
328 | ||
329 | return 0; | |
330 | ||
331 | free_res_q: | |
332 | qdio_free_buffers(qdio->res_q, QDIO_MAX_BUFFERS_PER_Q); | |
333 | free_req_q: | |
334 | qdio_free_buffers(qdio->req_q, QDIO_MAX_BUFFERS_PER_Q); | |
335 | return ret; | |
00bab910 SS |
336 | } |
337 | ||
338 | /** | |
339 | * zfcp_close_qdio - close qdio queues for an adapter | |
564e1c86 | 340 | * @qdio: pointer to structure zfcp_qdio |
1da177e4 | 341 | */ |
564e1c86 | 342 | void zfcp_qdio_close(struct zfcp_qdio *qdio) |
1da177e4 | 343 | { |
706eca49 SS |
344 | struct zfcp_adapter *adapter = qdio->adapter; |
345 | int idx, count; | |
00bab910 | 346 | |
706eca49 | 347 | if (!(atomic_read(&adapter->status) & ZFCP_STATUS_ADAPTER_QDIOUP)) |
00bab910 SS |
348 | return; |
349 | ||
350 | /* clear QDIOUP flag, thus do_QDIO is not called during qdio_shutdown */ | |
44a24cb3 | 351 | spin_lock_irq(&qdio->req_q_lock); |
805de8f4 | 352 | atomic_andnot(ZFCP_STATUS_ADAPTER_QDIOUP, &adapter->status); |
44a24cb3 | 353 | spin_unlock_irq(&qdio->req_q_lock); |
00bab910 | 354 | |
c2af7545 CS |
355 | wake_up(&qdio->req_q_wq); |
356 | ||
706eca49 | 357 | qdio_shutdown(adapter->ccw_device, QDIO_FLAG_CLEANUP_USING_CLEAR); |
00bab910 SS |
358 | |
359 | /* cleanup used outbound sbals */ | |
706eca49 | 360 | count = atomic_read(&qdio->req_q_free); |
00bab910 | 361 | if (count < QDIO_MAX_BUFFERS_PER_Q) { |
706eca49 | 362 | idx = (qdio->req_q_idx + count) % QDIO_MAX_BUFFERS_PER_Q; |
00bab910 | 363 | count = QDIO_MAX_BUFFERS_PER_Q - count; |
706eca49 | 364 | zfcp_qdio_zero_sbals(qdio->req_q, idx, count); |
1da177e4 | 365 | } |
706eca49 SS |
366 | qdio->req_q_idx = 0; |
367 | atomic_set(&qdio->req_q_free, 0); | |
1da177e4 LT |
368 | } |
369 | ||
00bab910 SS |
370 | /** |
371 | * zfcp_qdio_open - prepare and initialize response queue | |
564e1c86 | 372 | * @qdio: pointer to struct zfcp_qdio |
00bab910 SS |
373 | * Returns: 0 on success, otherwise -EIO |
374 | */ | |
564e1c86 | 375 | int zfcp_qdio_open(struct zfcp_qdio *qdio) |
00bab910 | 376 | { |
44cc76f2 | 377 | struct qdio_buffer_element *sbale; |
564e1c86 | 378 | struct qdio_initialize init_data; |
706eca49 SS |
379 | struct zfcp_adapter *adapter = qdio->adapter; |
380 | struct ccw_device *cdev = adapter->ccw_device; | |
dcc18f48 | 381 | struct qdio_ssqd_desc ssqd; |
00bab910 SS |
382 | int cc; |
383 | ||
706eca49 | 384 | if (atomic_read(&adapter->status) & ZFCP_STATUS_ADAPTER_QDIOUP) |
00bab910 SS |
385 | return -EIO; |
386 | ||
805de8f4 | 387 | atomic_andnot(ZFCP_STATUS_ADAPTER_SIOSL_ISSUED, |
339f4f4e CS |
388 | &qdio->adapter->status); |
389 | ||
564e1c86 SS |
390 | zfcp_qdio_setup_init_data(&init_data, qdio); |
391 | ||
392 | if (qdio_establish(&init_data)) | |
ff3b24fa | 393 | goto failed_establish; |
00bab910 | 394 | |
dcc18f48 CS |
395 | if (qdio_get_ssqd_desc(init_data.cdev, &ssqd)) |
396 | goto failed_qdio; | |
397 | ||
398 | if (ssqd.qdioac2 & CHSC_AC2_DATA_DIV_ENABLED) | |
805de8f4 | 399 | atomic_or(ZFCP_STATUS_ADAPTER_DATA_DIV_ENABLED, |
dcc18f48 CS |
400 | &qdio->adapter->status); |
401 | ||
86a9668a | 402 | if (ssqd.qdioac2 & CHSC_AC2_MULTI_BUFFER_ENABLED) { |
805de8f4 | 403 | atomic_or(ZFCP_STATUS_ADAPTER_MB_ACT, &adapter->status); |
86a9668a SS |
404 | qdio->max_sbale_per_sbal = QDIO_MAX_ELEMENTS_PER_BUFFER; |
405 | } else { | |
805de8f4 | 406 | atomic_andnot(ZFCP_STATUS_ADAPTER_MB_ACT, &adapter->status); |
86a9668a SS |
407 | qdio->max_sbale_per_sbal = QDIO_MAX_ELEMENTS_PER_BUFFER - 1; |
408 | } | |
409 | ||
410 | qdio->max_sbale_per_req = | |
411 | ZFCP_QDIO_MAX_SBALS_PER_REQ * qdio->max_sbale_per_sbal | |
412 | - 2; | |
564e1c86 | 413 | if (qdio_activate(cdev)) |
00bab910 | 414 | goto failed_qdio; |
00bab910 SS |
415 | |
416 | for (cc = 0; cc < QDIO_MAX_BUFFERS_PER_Q; cc++) { | |
706eca49 | 417 | sbale = &(qdio->res_q[cc]->element[0]); |
00bab910 | 418 | sbale->length = 0; |
3ec90878 JG |
419 | sbale->eflags = SBAL_EFLAGS_LAST_ENTRY; |
420 | sbale->sflags = 0; | |
00bab910 SS |
421 | sbale->addr = NULL; |
422 | } | |
423 | ||
706eca49 | 424 | if (do_QDIO(cdev, QDIO_FLAG_SYNC_INPUT, 0, 0, QDIO_MAX_BUFFERS_PER_Q)) |
00bab910 | 425 | goto failed_qdio; |
00bab910 | 426 | |
25985edc | 427 | /* set index of first available SBALS / number of available SBALS */ |
706eca49 SS |
428 | qdio->req_q_idx = 0; |
429 | atomic_set(&qdio->req_q_free, QDIO_MAX_BUFFERS_PER_Q); | |
805de8f4 | 430 | atomic_or(ZFCP_STATUS_ADAPTER_QDIOUP, &qdio->adapter->status); |
00bab910 | 431 | |
86a9668a SS |
432 | if (adapter->scsi_host) { |
433 | adapter->scsi_host->sg_tablesize = qdio->max_sbale_per_req; | |
434 | adapter->scsi_host->max_sectors = qdio->max_sbale_per_req * 8; | |
435 | } | |
436 | ||
00bab910 SS |
437 | return 0; |
438 | ||
439 | failed_qdio: | |
564e1c86 | 440 | qdio_shutdown(cdev, QDIO_FLAG_CLEANUP_USING_CLEAR); |
ff3b24fa | 441 | failed_establish: |
564e1c86 | 442 | dev_err(&cdev->dev, |
ff3b24fa | 443 | "Setting up the QDIO connection to the FCP adapter failed\n"); |
00bab910 SS |
444 | return -EIO; |
445 | } | |
d5a282a1 SS |
446 | |
447 | void zfcp_qdio_destroy(struct zfcp_qdio *qdio) | |
448 | { | |
d5a282a1 SS |
449 | if (!qdio) |
450 | return; | |
451 | ||
452 | if (qdio->adapter->ccw_device) | |
453 | qdio_free(qdio->adapter->ccw_device); | |
454 | ||
852eb1aa SO |
455 | qdio_free_buffers(qdio->req_q, QDIO_MAX_BUFFERS_PER_Q); |
456 | qdio_free_buffers(qdio->res_q, QDIO_MAX_BUFFERS_PER_Q); | |
d5a282a1 SS |
457 | kfree(qdio); |
458 | } | |
459 | ||
460 | int zfcp_qdio_setup(struct zfcp_adapter *adapter) | |
461 | { | |
462 | struct zfcp_qdio *qdio; | |
463 | ||
464 | qdio = kzalloc(sizeof(struct zfcp_qdio), GFP_KERNEL); | |
465 | if (!qdio) | |
466 | return -ENOMEM; | |
467 | ||
468 | qdio->adapter = adapter; | |
469 | ||
470 | if (zfcp_qdio_allocate(qdio)) { | |
852eb1aa | 471 | kfree(qdio); |
d5a282a1 SS |
472 | return -ENOMEM; |
473 | } | |
474 | ||
475 | spin_lock_init(&qdio->req_q_lock); | |
476 | spin_lock_init(&qdio->stat_lock); | |
477 | ||
478 | adapter->qdio = qdio; | |
479 | return 0; | |
480 | } | |
481 | ||
339f4f4e CS |
482 | /** |
483 | * zfcp_qdio_siosl - Trigger logging in FCP channel | |
484 | * @adapter: The zfcp_adapter where to trigger logging | |
485 | * | |
486 | * Call the cio siosl function to trigger hardware logging. This | |
487 | * wrapper function sets a flag to ensure hardware logging is only | |
488 | * triggered once before going through qdio shutdown. | |
489 | * | |
490 | * The triggers are always run from qdio tasklet context, so no | |
491 | * additional synchronization is necessary. | |
492 | */ | |
493 | void zfcp_qdio_siosl(struct zfcp_adapter *adapter) | |
494 | { | |
495 | int rc; | |
496 | ||
497 | if (atomic_read(&adapter->status) & ZFCP_STATUS_ADAPTER_SIOSL_ISSUED) | |
498 | return; | |
499 | ||
500 | rc = ccw_device_siosl(adapter->ccw_device); | |
501 | if (!rc) | |
805de8f4 | 502 | atomic_or(ZFCP_STATUS_ADAPTER_SIOSL_ISSUED, |
339f4f4e CS |
503 | &adapter->status); |
504 | } |