xref: /openbmc/linux/drivers/s390/cio/device_pgid.c (revision 5214cae7)
1 /*
2  *  CCW device PGID and path verification I/O handling.
3  *
4  *    Copyright IBM Corp. 2002, 2009
5  *    Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
6  *		 Martin Schwidefsky <schwidefsky@de.ibm.com>
7  *		 Peter Oberparleiter <peter.oberparleiter@de.ibm.com>
8  */
9 
10 #include <linux/kernel.h>
11 #include <linux/string.h>
12 #include <linux/bitops.h>
13 #include <linux/types.h>
14 #include <linux/errno.h>
15 #include <linux/slab.h>
16 #include <asm/ccwdev.h>
17 #include <asm/cio.h>
18 
19 #include "cio.h"
20 #include "cio_debug.h"
21 #include "device.h"
22 #include "io_sch.h"
23 
24 #define PGID_RETRIES	256
25 #define PGID_TIMEOUT	(10 * HZ)
26 
27 static void verify_start(struct ccw_device *cdev);
28 
29 /*
30  * Process path verification data and report result.
31  */
32 static void verify_done(struct ccw_device *cdev, int rc)
33 {
34 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
35 	struct ccw_dev_id *id = &cdev->private->dev_id;
36 	int mpath = cdev->private->flags.mpath;
37 	int pgroup = cdev->private->flags.pgroup;
38 
39 	if (rc)
40 		goto out;
41 	/* Ensure consistent multipathing state at device and channel. */
42 	if (sch->config.mp != mpath) {
43 		sch->config.mp = mpath;
44 		rc = cio_commit_config(sch);
45 	}
46 out:
47 	CIO_MSG_EVENT(2, "vrfy: device 0.%x.%04x: rc=%d pgroup=%d mpath=%d "
48 			 "vpm=%02x\n", id->ssid, id->devno, rc, pgroup, mpath,
49 			 sch->vpm);
50 	ccw_device_verify_done(cdev, rc);
51 }
52 
53 /*
54  * Create channel program to perform a NOOP.
55  */
56 static void nop_build_cp(struct ccw_device *cdev)
57 {
58 	struct ccw_request *req = &cdev->private->req;
59 	struct ccw1 *cp = cdev->private->iccws;
60 
61 	cp->cmd_code	= CCW_CMD_NOOP;
62 	cp->cda		= 0;
63 	cp->count	= 0;
64 	cp->flags	= CCW_FLAG_SLI;
65 	req->cp		= cp;
66 }
67 
68 /*
69  * Perform NOOP on a single path.
70  */
71 static void nop_do(struct ccw_device *cdev)
72 {
73 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
74 	struct ccw_request *req = &cdev->private->req;
75 
76 	req->lpm = lpm_adjust(req->lpm, sch->schib.pmcw.pam & sch->opm &
77 			      ~cdev->private->path_noirq_mask);
78 	if (!req->lpm)
79 		goto out_nopath;
80 	nop_build_cp(cdev);
81 	ccw_request_start(cdev);
82 	return;
83 
84 out_nopath:
85 	verify_done(cdev, sch->vpm ? 0 : -EACCES);
86 }
87 
88 /*
89  * Adjust NOOP I/O status.
90  */
91 static enum io_status nop_filter(struct ccw_device *cdev, void *data,
92 				 struct irb *irb, enum io_status status)
93 {
94 	/* Only subchannel status might indicate a path error. */
95 	if (status == IO_STATUS_ERROR && irb->scsw.cmd.cstat == 0)
96 		return IO_DONE;
97 	return status;
98 }
99 
100 /*
101  * Process NOOP request result for a single path.
102  */
103 static void nop_callback(struct ccw_device *cdev, void *data, int rc)
104 {
105 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
106 	struct ccw_request *req = &cdev->private->req;
107 
108 	switch (rc) {
109 	case 0:
110 		sch->vpm |= req->lpm;
111 		break;
112 	case -ETIME:
113 		cdev->private->path_noirq_mask |= req->lpm;
114 		break;
115 	case -EACCES:
116 		cdev->private->path_notoper_mask |= req->lpm;
117 		break;
118 	default:
119 		goto err;
120 	}
121 	/* Continue on the next path. */
122 	req->lpm >>= 1;
123 	nop_do(cdev);
124 	return;
125 
126 err:
127 	verify_done(cdev, rc);
128 }
129 
130 /*
131  * Create channel program to perform SET PGID on a single path.
132  */
133 static void spid_build_cp(struct ccw_device *cdev, u8 fn)
134 {
135 	struct ccw_request *req = &cdev->private->req;
136 	struct ccw1 *cp = cdev->private->iccws;
137 	int i = pathmask_to_pos(req->lpm);
138 	struct pgid *pgid = &cdev->private->pgid[i];
139 
140 	pgid->inf.fc	= fn;
141 	cp->cmd_code	= CCW_CMD_SET_PGID;
142 	cp->cda		= (u32) (addr_t) pgid;
143 	cp->count	= sizeof(*pgid);
144 	cp->flags	= CCW_FLAG_SLI;
145 	req->cp		= cp;
146 }
147 
148 static void pgid_wipeout_callback(struct ccw_device *cdev, void *data, int rc)
149 {
150 	if (rc) {
151 		/* We don't know the path groups' state. Abort. */
152 		verify_done(cdev, rc);
153 		return;
154 	}
155 	/*
156 	 * Path groups have been reset. Restart path verification but
157 	 * leave paths in path_noirq_mask out.
158 	 */
159 	cdev->private->flags.pgid_unknown = 0;
160 	verify_start(cdev);
161 }
162 
163 /*
164  * Reset pathgroups and restart path verification, leave unusable paths out.
165  */
166 static void pgid_wipeout_start(struct ccw_device *cdev)
167 {
168 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
169 	struct ccw_dev_id *id = &cdev->private->dev_id;
170 	struct ccw_request *req = &cdev->private->req;
171 	u8 fn;
172 
173 	CIO_MSG_EVENT(2, "wipe: device 0.%x.%04x: pvm=%02x nim=%02x\n",
174 		      id->ssid, id->devno, cdev->private->pgid_valid_mask,
175 		      cdev->private->path_noirq_mask);
176 
177 	/* Initialize request data. */
178 	memset(req, 0, sizeof(*req));
179 	req->timeout	= PGID_TIMEOUT;
180 	req->maxretries	= PGID_RETRIES;
181 	req->lpm	= sch->schib.pmcw.pam;
182 	req->callback	= pgid_wipeout_callback;
183 	fn = SPID_FUNC_DISBAND;
184 	if (cdev->private->flags.mpath)
185 		fn |= SPID_FUNC_MULTI_PATH;
186 	spid_build_cp(cdev, fn);
187 	ccw_request_start(cdev);
188 }
189 
190 /*
191  * Perform establish/resign SET PGID on a single path.
192  */
193 static void spid_do(struct ccw_device *cdev)
194 {
195 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
196 	struct ccw_request *req = &cdev->private->req;
197 	u8 fn;
198 
199 	/* Use next available path that is not already in correct state. */
200 	req->lpm = lpm_adjust(req->lpm, cdev->private->pgid_todo_mask);
201 	if (!req->lpm)
202 		goto out_nopath;
203 	/* Channel program setup. */
204 	if (req->lpm & sch->opm)
205 		fn = SPID_FUNC_ESTABLISH;
206 	else
207 		fn = SPID_FUNC_RESIGN;
208 	if (cdev->private->flags.mpath)
209 		fn |= SPID_FUNC_MULTI_PATH;
210 	spid_build_cp(cdev, fn);
211 	ccw_request_start(cdev);
212 	return;
213 
214 out_nopath:
215 	if (cdev->private->flags.pgid_unknown) {
216 		/* At least one SPID could be partially done. */
217 		pgid_wipeout_start(cdev);
218 		return;
219 	}
220 	verify_done(cdev, sch->vpm ? 0 : -EACCES);
221 }
222 
223 /*
224  * Process SET PGID request result for a single path.
225  */
226 static void spid_callback(struct ccw_device *cdev, void *data, int rc)
227 {
228 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
229 	struct ccw_request *req = &cdev->private->req;
230 
231 	switch (rc) {
232 	case 0:
233 		sch->vpm |= req->lpm & sch->opm;
234 		break;
235 	case -ETIME:
236 		cdev->private->flags.pgid_unknown = 1;
237 		cdev->private->path_noirq_mask |= req->lpm;
238 		break;
239 	case -EACCES:
240 		cdev->private->path_notoper_mask |= req->lpm;
241 		break;
242 	case -EOPNOTSUPP:
243 		if (cdev->private->flags.mpath) {
244 			/* Try without multipathing. */
245 			cdev->private->flags.mpath = 0;
246 			goto out_restart;
247 		}
248 		/* Try without pathgrouping. */
249 		cdev->private->flags.pgroup = 0;
250 		goto out_restart;
251 	default:
252 		goto err;
253 	}
254 	req->lpm >>= 1;
255 	spid_do(cdev);
256 	return;
257 
258 out_restart:
259 	verify_start(cdev);
260 	return;
261 err:
262 	verify_done(cdev, rc);
263 }
264 
265 static void spid_start(struct ccw_device *cdev)
266 {
267 	struct ccw_request *req = &cdev->private->req;
268 
269 	/* Initialize request data. */
270 	memset(req, 0, sizeof(*req));
271 	req->timeout	= PGID_TIMEOUT;
272 	req->maxretries	= PGID_RETRIES;
273 	req->lpm	= 0x80;
274 	req->singlepath	= 1;
275 	req->callback	= spid_callback;
276 	spid_do(cdev);
277 }
278 
279 static int pgid_is_reset(struct pgid *p)
280 {
281 	char *c;
282 
283 	for (c = (char *)p + 1; c < (char *)(p + 1); c++) {
284 		if (*c != 0)
285 			return 0;
286 	}
287 	return 1;
288 }
289 
290 static int pgid_cmp(struct pgid *p1, struct pgid *p2)
291 {
292 	return memcmp((char *) p1 + 1, (char *) p2 + 1,
293 		      sizeof(struct pgid) - 1);
294 }
295 
296 /*
297  * Determine pathgroup state from PGID data.
298  */
299 static void pgid_analyze(struct ccw_device *cdev, struct pgid **p,
300 			 int *mismatch, u8 *reserved, u8 *reset)
301 {
302 	struct pgid *pgid = &cdev->private->pgid[0];
303 	struct pgid *first = NULL;
304 	int lpm;
305 	int i;
306 
307 	*mismatch = 0;
308 	*reserved = 0;
309 	*reset = 0;
310 	for (i = 0, lpm = 0x80; i < 8; i++, pgid++, lpm >>= 1) {
311 		if ((cdev->private->pgid_valid_mask & lpm) == 0)
312 			continue;
313 		if (pgid->inf.ps.state2 == SNID_STATE2_RESVD_ELSE)
314 			*reserved |= lpm;
315 		if (pgid_is_reset(pgid)) {
316 			*reset |= lpm;
317 			continue;
318 		}
319 		if (!first) {
320 			first = pgid;
321 			continue;
322 		}
323 		if (pgid_cmp(pgid, first) != 0)
324 			*mismatch = 1;
325 	}
326 	if (!first)
327 		first = &channel_subsystems[0]->global_pgid;
328 	*p = first;
329 }
330 
331 static u8 pgid_to_donepm(struct ccw_device *cdev)
332 {
333 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
334 	struct pgid *pgid;
335 	int i;
336 	int lpm;
337 	u8 donepm = 0;
338 
339 	/* Set bits for paths which are already in the target state. */
340 	for (i = 0; i < 8; i++) {
341 		lpm = 0x80 >> i;
342 		if ((cdev->private->pgid_valid_mask & lpm) == 0)
343 			continue;
344 		pgid = &cdev->private->pgid[i];
345 		if (sch->opm & lpm) {
346 			if (pgid->inf.ps.state1 != SNID_STATE1_GROUPED)
347 				continue;
348 		} else {
349 			if (pgid->inf.ps.state1 != SNID_STATE1_UNGROUPED)
350 				continue;
351 		}
352 		if (cdev->private->flags.mpath) {
353 			if (pgid->inf.ps.state3 != SNID_STATE3_MULTI_PATH)
354 				continue;
355 		} else {
356 			if (pgid->inf.ps.state3 != SNID_STATE3_SINGLE_PATH)
357 				continue;
358 		}
359 		donepm |= lpm;
360 	}
361 
362 	return donepm;
363 }
364 
365 static void pgid_fill(struct ccw_device *cdev, struct pgid *pgid)
366 {
367 	int i;
368 
369 	for (i = 0; i < 8; i++)
370 		memcpy(&cdev->private->pgid[i], pgid, sizeof(struct pgid));
371 }
372 
373 /*
374  * Process SENSE PGID data and report result.
375  */
376 static void snid_done(struct ccw_device *cdev, int rc)
377 {
378 	struct ccw_dev_id *id = &cdev->private->dev_id;
379 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
380 	struct pgid *pgid;
381 	int mismatch = 0;
382 	u8 reserved = 0;
383 	u8 reset = 0;
384 	u8 donepm;
385 
386 	if (rc)
387 		goto out;
388 	pgid_analyze(cdev, &pgid, &mismatch, &reserved, &reset);
389 	if (reserved == cdev->private->pgid_valid_mask)
390 		rc = -EUSERS;
391 	else if (mismatch)
392 		rc = -EOPNOTSUPP;
393 	else {
394 		donepm = pgid_to_donepm(cdev);
395 		sch->vpm = donepm & sch->opm;
396 		cdev->private->pgid_reset_mask |= reset;
397 		cdev->private->pgid_todo_mask &=
398 			~(donepm | cdev->private->path_noirq_mask);
399 		pgid_fill(cdev, pgid);
400 	}
401 out:
402 	CIO_MSG_EVENT(2, "snid: device 0.%x.%04x: rc=%d pvm=%02x vpm=%02x "
403 		      "todo=%02x mism=%d rsvd=%02x reset=%02x\n", id->ssid,
404 		      id->devno, rc, cdev->private->pgid_valid_mask, sch->vpm,
405 		      cdev->private->pgid_todo_mask, mismatch, reserved, reset);
406 	switch (rc) {
407 	case 0:
408 		if (cdev->private->flags.pgid_unknown) {
409 			pgid_wipeout_start(cdev);
410 			return;
411 		}
412 		/* Anything left to do? */
413 		if (cdev->private->pgid_todo_mask == 0) {
414 			verify_done(cdev, sch->vpm == 0 ? -EACCES : 0);
415 			return;
416 		}
417 		/* Perform path-grouping. */
418 		spid_start(cdev);
419 		break;
420 	case -EOPNOTSUPP:
421 		/* Path-grouping not supported. */
422 		cdev->private->flags.pgroup = 0;
423 		cdev->private->flags.mpath = 0;
424 		verify_start(cdev);
425 		break;
426 	default:
427 		verify_done(cdev, rc);
428 	}
429 }
430 
431 /*
432  * Create channel program to perform a SENSE PGID on a single path.
433  */
434 static void snid_build_cp(struct ccw_device *cdev)
435 {
436 	struct ccw_request *req = &cdev->private->req;
437 	struct ccw1 *cp = cdev->private->iccws;
438 	int i = pathmask_to_pos(req->lpm);
439 
440 	/* Channel program setup. */
441 	cp->cmd_code	= CCW_CMD_SENSE_PGID;
442 	cp->cda		= (u32) (addr_t) &cdev->private->pgid[i];
443 	cp->count	= sizeof(struct pgid);
444 	cp->flags	= CCW_FLAG_SLI;
445 	req->cp		= cp;
446 }
447 
448 /*
449  * Perform SENSE PGID on a single path.
450  */
451 static void snid_do(struct ccw_device *cdev)
452 {
453 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
454 	struct ccw_request *req = &cdev->private->req;
455 	int ret;
456 
457 	req->lpm = lpm_adjust(req->lpm, sch->schib.pmcw.pam &
458 			      ~cdev->private->path_noirq_mask);
459 	if (!req->lpm)
460 		goto out_nopath;
461 	snid_build_cp(cdev);
462 	ccw_request_start(cdev);
463 	return;
464 
465 out_nopath:
466 	if (cdev->private->pgid_valid_mask)
467 		ret = 0;
468 	else if (cdev->private->path_noirq_mask)
469 		ret = -ETIME;
470 	else
471 		ret = -EACCES;
472 	snid_done(cdev, ret);
473 }
474 
475 /*
476  * Process SENSE PGID request result for single path.
477  */
478 static void snid_callback(struct ccw_device *cdev, void *data, int rc)
479 {
480 	struct ccw_request *req = &cdev->private->req;
481 
482 	switch (rc) {
483 	case 0:
484 		cdev->private->pgid_valid_mask |= req->lpm;
485 		break;
486 	case -ETIME:
487 		cdev->private->flags.pgid_unknown = 1;
488 		cdev->private->path_noirq_mask |= req->lpm;
489 		break;
490 	case -EACCES:
491 		cdev->private->path_notoper_mask |= req->lpm;
492 		break;
493 	default:
494 		goto err;
495 	}
496 	/* Continue on the next path. */
497 	req->lpm >>= 1;
498 	snid_do(cdev);
499 	return;
500 
501 err:
502 	snid_done(cdev, rc);
503 }
504 
505 /*
506  * Perform path verification.
507  */
508 static void verify_start(struct ccw_device *cdev)
509 {
510 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
511 	struct ccw_request *req = &cdev->private->req;
512 	struct ccw_dev_id *devid = &cdev->private->dev_id;
513 
514 	sch->vpm = 0;
515 	sch->lpm = sch->schib.pmcw.pam;
516 
517 	/* Initialize PGID data. */
518 	memset(cdev->private->pgid, 0, sizeof(cdev->private->pgid));
519 	cdev->private->pgid_valid_mask = 0;
520 	cdev->private->pgid_todo_mask = sch->schib.pmcw.pam;
521 	cdev->private->path_notoper_mask = 0;
522 
523 	/* Initialize request data. */
524 	memset(req, 0, sizeof(*req));
525 	req->timeout	= PGID_TIMEOUT;
526 	req->maxretries	= PGID_RETRIES;
527 	req->lpm	= 0x80;
528 	req->singlepath	= 1;
529 	if (cdev->private->flags.pgroup) {
530 		CIO_TRACE_EVENT(4, "snid");
531 		CIO_HEX_EVENT(4, devid, sizeof(*devid));
532 		req->callback	= snid_callback;
533 		snid_do(cdev);
534 	} else {
535 		CIO_TRACE_EVENT(4, "nop");
536 		CIO_HEX_EVENT(4, devid, sizeof(*devid));
537 		req->filter	= nop_filter;
538 		req->callback	= nop_callback;
539 		nop_do(cdev);
540 	}
541 }
542 
543 /**
544  * ccw_device_verify_start - perform path verification
545  * @cdev: ccw device
546  *
547  * Perform an I/O on each available channel path to @cdev to determine which
548  * paths are operational. The resulting path mask is stored in sch->vpm.
549  * If device options specify pathgrouping, establish a pathgroup for the
550  * operational paths. When finished, call ccw_device_verify_done with a
551  * return code specifying the result.
552  */
553 void ccw_device_verify_start(struct ccw_device *cdev)
554 {
555 	CIO_TRACE_EVENT(4, "vrfy");
556 	CIO_HEX_EVENT(4, &cdev->private->dev_id, sizeof(cdev->private->dev_id));
557 	/*
558 	 * Initialize pathgroup and multipath state with target values.
559 	 * They may change in the course of path verification.
560 	 */
561 	cdev->private->flags.pgroup = cdev->private->options.pgroup;
562 	cdev->private->flags.mpath = cdev->private->options.mpath;
563 	cdev->private->flags.doverify = 0;
564 	cdev->private->path_noirq_mask = 0;
565 	verify_start(cdev);
566 }
567 
568 /*
569  * Process disband SET PGID request result.
570  */
571 static void disband_callback(struct ccw_device *cdev, void *data, int rc)
572 {
573 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
574 	struct ccw_dev_id *id = &cdev->private->dev_id;
575 
576 	if (rc)
577 		goto out;
578 	/* Ensure consistent multipathing state at device and channel. */
579 	cdev->private->flags.mpath = 0;
580 	if (sch->config.mp) {
581 		sch->config.mp = 0;
582 		rc = cio_commit_config(sch);
583 	}
584 out:
585 	CIO_MSG_EVENT(0, "disb: device 0.%x.%04x: rc=%d\n", id->ssid, id->devno,
586 		      rc);
587 	ccw_device_disband_done(cdev, rc);
588 }
589 
590 /**
591  * ccw_device_disband_start - disband pathgroup
592  * @cdev: ccw device
593  *
594  * Execute a SET PGID channel program on @cdev to disband a previously
595  * established pathgroup. When finished, call ccw_device_disband_done with
596  * a return code specifying the result.
597  */
598 void ccw_device_disband_start(struct ccw_device *cdev)
599 {
600 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
601 	struct ccw_request *req = &cdev->private->req;
602 	u8 fn;
603 
604 	CIO_TRACE_EVENT(4, "disb");
605 	CIO_HEX_EVENT(4, &cdev->private->dev_id, sizeof(cdev->private->dev_id));
606 	/* Request setup. */
607 	memset(req, 0, sizeof(*req));
608 	req->timeout	= PGID_TIMEOUT;
609 	req->maxretries	= PGID_RETRIES;
610 	req->lpm	= sch->schib.pmcw.pam & sch->opm;
611 	req->singlepath	= 1;
612 	req->callback	= disband_callback;
613 	fn = SPID_FUNC_DISBAND;
614 	if (cdev->private->flags.mpath)
615 		fn |= SPID_FUNC_MULTI_PATH;
616 	spid_build_cp(cdev, fn);
617 	ccw_request_start(cdev);
618 }
619 
620 struct stlck_data {
621 	struct completion done;
622 	int rc;
623 };
624 
625 static void stlck_build_cp(struct ccw_device *cdev, void *buf1, void *buf2)
626 {
627 	struct ccw_request *req = &cdev->private->req;
628 	struct ccw1 *cp = cdev->private->iccws;
629 
630 	cp[0].cmd_code = CCW_CMD_STLCK;
631 	cp[0].cda = (u32) (addr_t) buf1;
632 	cp[0].count = 32;
633 	cp[0].flags = CCW_FLAG_CC;
634 	cp[1].cmd_code = CCW_CMD_RELEASE;
635 	cp[1].cda = (u32) (addr_t) buf2;
636 	cp[1].count = 32;
637 	cp[1].flags = 0;
638 	req->cp = cp;
639 }
640 
641 static void stlck_callback(struct ccw_device *cdev, void *data, int rc)
642 {
643 	struct stlck_data *sdata = data;
644 
645 	sdata->rc = rc;
646 	complete(&sdata->done);
647 }
648 
649 /**
650  * ccw_device_stlck_start - perform unconditional release
651  * @cdev: ccw device
652  * @data: data pointer to be passed to ccw_device_stlck_done
653  * @buf1: data pointer used in channel program
654  * @buf2: data pointer used in channel program
655  *
656  * Execute a channel program on @cdev to release an existing PGID reservation.
657  */
658 static void ccw_device_stlck_start(struct ccw_device *cdev, void *data,
659 				   void *buf1, void *buf2)
660 {
661 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
662 	struct ccw_request *req = &cdev->private->req;
663 
664 	CIO_TRACE_EVENT(4, "stlck");
665 	CIO_HEX_EVENT(4, &cdev->private->dev_id, sizeof(cdev->private->dev_id));
666 	/* Request setup. */
667 	memset(req, 0, sizeof(*req));
668 	req->timeout	= PGID_TIMEOUT;
669 	req->maxretries	= PGID_RETRIES;
670 	req->lpm	= sch->schib.pmcw.pam & sch->opm;
671 	req->data	= data;
672 	req->callback	= stlck_callback;
673 	stlck_build_cp(cdev, buf1, buf2);
674 	ccw_request_start(cdev);
675 }
676 
677 /*
678  * Perform unconditional reserve + release.
679  */
680 int ccw_device_stlck(struct ccw_device *cdev)
681 {
682 	struct subchannel *sch = to_subchannel(cdev->dev.parent);
683 	struct stlck_data data;
684 	u8 *buffer;
685 	int rc;
686 
687 	/* Check if steal lock operation is valid for this device. */
688 	if (cdev->drv) {
689 		if (!cdev->private->options.force)
690 			return -EINVAL;
691 	}
692 	buffer = kzalloc(64, GFP_DMA | GFP_KERNEL);
693 	if (!buffer)
694 		return -ENOMEM;
695 	init_completion(&data.done);
696 	data.rc = -EIO;
697 	spin_lock_irq(sch->lock);
698 	rc = cio_enable_subchannel(sch, (u32) (addr_t) sch);
699 	if (rc)
700 		goto out_unlock;
701 	/* Perform operation. */
702 	cdev->private->state = DEV_STATE_STEAL_LOCK;
703 	ccw_device_stlck_start(cdev, &data, &buffer[0], &buffer[32]);
704 	spin_unlock_irq(sch->lock);
705 	/* Wait for operation to finish. */
706 	if (wait_for_completion_interruptible(&data.done)) {
707 		/* Got a signal. */
708 		spin_lock_irq(sch->lock);
709 		ccw_request_cancel(cdev);
710 		spin_unlock_irq(sch->lock);
711 		wait_for_completion(&data.done);
712 	}
713 	rc = data.rc;
714 	/* Check results. */
715 	spin_lock_irq(sch->lock);
716 	cio_disable_subchannel(sch);
717 	cdev->private->state = DEV_STATE_BOXED;
718 out_unlock:
719 	spin_unlock_irq(sch->lock);
720 	kfree(buffer);
721 
722 	return rc;
723 }
724