xref: /openbmc/linux/drivers/s390/char/vmur.c (revision 1eade380c5f3e69348531ade5e9f9c5ae6485874)
1 /*
2  * Linux driver for System z and s390 unit record devices
3  * (z/VM virtual punch, reader, printer)
4  *
5  * Copyright IBM Corp. 2001, 2007
6  * Authors: Malcolm Beattie <beattiem@uk.ibm.com>
7  *	    Michael Holzheu <holzheu@de.ibm.com>
8  *	    Frank Munzert <munzert@de.ibm.com>
9  */
10 
11 #include <linux/cdev.h>
12 
13 #include <asm/uaccess.h>
14 #include <asm/cio.h>
15 #include <asm/ccwdev.h>
16 #include <asm/debug.h>
17 
18 #include "vmur.h"
19 
20 /*
21  * Driver overview
22  *
23  * Unit record device support is implemented as a character device driver.
24  * We can fit at least 16 bits into a device minor number and use the
25  * simple method of mapping a character device number with minor abcd
26  * to the unit record device with devno abcd.
27  * I/O to virtual unit record devices is handled as follows:
28  * Reads: Diagnose code 0x14 (input spool file manipulation)
29  * is used to read spool data page-wise.
30  * Writes: The CCW used is WRITE_CCW_CMD (0x01). The device's record length
31  * is available by reading sysfs attr reclen. Each write() to the device
32  * must specify an integral multiple (maximal 511) of reclen.
33  */
34 
35 static char ur_banner[] = "z/VM virtual unit record device driver";
36 
37 MODULE_AUTHOR("IBM Corporation");
38 MODULE_DESCRIPTION("s390 z/VM virtual unit record device driver");
39 MODULE_LICENSE("GPL");
40 
41 #define PRINTK_HEADER "vmur: "
42 
43 static dev_t ur_first_dev_maj_min;
44 static struct class *vmur_class;
45 static struct debug_info *vmur_dbf;
46 
47 /* We put the device's record length (for writes) in the driver_info field */
48 static struct ccw_device_id ur_ids[] = {
49 	{ CCWDEV_CU_DI(READER_PUNCH_DEVTYPE, 80) },
50 	{ CCWDEV_CU_DI(PRINTER_DEVTYPE, 132) },
51 	{ /* end of list */ }
52 };
53 
54 MODULE_DEVICE_TABLE(ccw, ur_ids);
55 
56 static int ur_probe(struct ccw_device *cdev);
57 static void ur_remove(struct ccw_device *cdev);
58 static int ur_set_online(struct ccw_device *cdev);
59 static int ur_set_offline(struct ccw_device *cdev);
60 
61 static struct ccw_driver ur_driver = {
62 	.name		= "vmur",
63 	.owner		= THIS_MODULE,
64 	.ids		= ur_ids,
65 	.probe		= ur_probe,
66 	.remove		= ur_remove,
67 	.set_online	= ur_set_online,
68 	.set_offline	= ur_set_offline,
69 };
70 
71 /*
72  * Allocation, freeing, getting and putting of urdev structures
73  */
74 static struct urdev *urdev_alloc(struct ccw_device *cdev)
75 {
76 	struct urdev *urd;
77 
78 	urd = kzalloc(sizeof(struct urdev), GFP_KERNEL);
79 	if (!urd)
80 		return NULL;
81 	urd->cdev = cdev;
82 	urd->reclen = cdev->id.driver_info;
83 	ccw_device_get_id(cdev, &urd->dev_id);
84 	mutex_init(&urd->io_mutex);
85 	mutex_init(&urd->open_mutex);
86 	return urd;
87 }
88 
89 static void urdev_free(struct urdev *urd)
90 {
91 	kfree(urd);
92 }
93 
94 /*
95  * This is how the character device driver gets a reference to a
96  * ur device. When this call returns successfully, a reference has
97  * been taken (by get_device) on the underlying kobject. The recipient
98  * of this urdev pointer must eventually drop it with urdev_put(urd)
99  * which does the corresponding put_device().
100  */
101 static struct urdev *urdev_get_from_devno(u16 devno)
102 {
103 	char bus_id[16];
104 	struct ccw_device *cdev;
105 
106 	sprintf(bus_id, "0.0.%04x", devno);
107 	cdev = get_ccwdev_by_busid(&ur_driver, bus_id);
108 	if (!cdev)
109 		return NULL;
110 
111 	return cdev->dev.driver_data;
112 }
113 
114 static void urdev_put(struct urdev *urd)
115 {
116 	put_device(&urd->cdev->dev);
117 }
118 
119 /*
120  * Low-level functions to do I/O to a ur device.
121  *     alloc_chan_prog
122  *     free_chan_prog
123  *     do_ur_io
124  *     ur_int_handler
125  *
126  * alloc_chan_prog allocates and builds the channel program
127  * free_chan_prog frees memory of the channel program
128  *
129  * do_ur_io issues the channel program to the device and blocks waiting
130  * on a completion event it publishes at urd->io_done. The function
131  * serialises itself on the device's mutex so that only one I/O
132  * is issued at a time (and that I/O is synchronous).
133  *
134  * ur_int_handler catches the "I/O done" interrupt, writes the
135  * subchannel status word into the scsw member of the urdev structure
136  * and complete()s the io_done to wake the waiting do_ur_io.
137  *
138  * The caller of do_ur_io is responsible for kfree()ing the channel program
139  * address pointer that alloc_chan_prog returned.
140  */
141 
142 static void free_chan_prog(struct ccw1 *cpa)
143 {
144 	struct ccw1 *ptr = cpa;
145 
146 	while (ptr->cda) {
147 		kfree((void *)(addr_t) ptr->cda);
148 		ptr++;
149 	}
150 	kfree(cpa);
151 }
152 
153 /*
154  * alloc_chan_prog
155  * The channel program we use is write commands chained together
156  * with a final NOP CCW command-chained on (which ensures that CE and DE
157  * are presented together in a single interrupt instead of as separate
158  * interrupts unless an incorrect length indication kicks in first). The
159  * data length in each CCW is reclen.
160  */
161 static struct ccw1 *alloc_chan_prog(const char __user *ubuf, int rec_count,
162 				    int reclen)
163 {
164 	struct ccw1 *cpa;
165 	void *kbuf;
166 	int i;
167 
168 	TRACE("alloc_chan_prog(%p, %i, %i)\n", ubuf, rec_count, reclen);
169 
170 	/*
171 	 * We chain a NOP onto the writes to force CE+DE together.
172 	 * That means we allocate room for CCWs to cover count/reclen
173 	 * records plus a NOP.
174 	 */
175 	cpa = kzalloc((rec_count + 1) * sizeof(struct ccw1),
176 		      GFP_KERNEL | GFP_DMA);
177 	if (!cpa)
178 		return ERR_PTR(-ENOMEM);
179 
180 	for (i = 0; i < rec_count; i++) {
181 		cpa[i].cmd_code = WRITE_CCW_CMD;
182 		cpa[i].flags = CCW_FLAG_CC | CCW_FLAG_SLI;
183 		cpa[i].count = reclen;
184 		kbuf = kmalloc(reclen, GFP_KERNEL | GFP_DMA);
185 		if (!kbuf) {
186 			free_chan_prog(cpa);
187 			return ERR_PTR(-ENOMEM);
188 		}
189 		cpa[i].cda = (u32)(addr_t) kbuf;
190 		if (copy_from_user(kbuf, ubuf, reclen)) {
191 			free_chan_prog(cpa);
192 			return ERR_PTR(-EFAULT);
193 		}
194 		ubuf += reclen;
195 	}
196 	/* The following NOP CCW forces CE+DE to be presented together */
197 	cpa[i].cmd_code = CCW_CMD_NOOP;
198 	return cpa;
199 }
200 
201 static int do_ur_io(struct urdev *urd, struct ccw1 *cpa)
202 {
203 	int rc;
204 	struct ccw_device *cdev = urd->cdev;
205 	DECLARE_COMPLETION(event);
206 
207 	TRACE("do_ur_io: cpa=%p\n", cpa);
208 
209 	rc = mutex_lock_interruptible(&urd->io_mutex);
210 	if (rc)
211 		return rc;
212 
213 	urd->io_done = &event;
214 
215 	spin_lock_irq(get_ccwdev_lock(cdev));
216 	rc = ccw_device_start(cdev, cpa, 1, 0, 0);
217 	spin_unlock_irq(get_ccwdev_lock(cdev));
218 
219 	TRACE("do_ur_io: ccw_device_start returned %d\n", rc);
220 	if (rc)
221 		goto out;
222 
223 	wait_for_completion(&event);
224 	TRACE("do_ur_io: I/O complete\n");
225 	rc = 0;
226 
227 out:
228 	mutex_unlock(&urd->io_mutex);
229 	return rc;
230 }
231 
232 /*
233  * ur interrupt handler, called from the ccw_device layer
234  */
235 static void ur_int_handler(struct ccw_device *cdev, unsigned long intparm,
236 			   struct irb *irb)
237 {
238 	struct urdev *urd;
239 
240 	TRACE("ur_int_handler: intparm=0x%lx cstat=%02x dstat=%02x res=%u\n",
241 	      intparm, irb->scsw.cstat, irb->scsw.dstat, irb->scsw.count);
242 
243 	if (!intparm) {
244 		TRACE("ur_int_handler: unsolicited interrupt\n");
245 		return;
246 	}
247 	urd = cdev->dev.driver_data;
248 	/* On special conditions irb is an error pointer */
249 	if (IS_ERR(irb))
250 		urd->io_request_rc = PTR_ERR(irb);
251 	else if (irb->scsw.dstat == (DEV_STAT_CHN_END | DEV_STAT_DEV_END))
252 		urd->io_request_rc = 0;
253 	else
254 		urd->io_request_rc = -EIO;
255 
256 	complete(urd->io_done);
257 }
258 
259 /*
260  * reclen sysfs attribute - The record length to be used for write CCWs
261  */
262 static ssize_t ur_attr_reclen_show(struct device *dev,
263 				   struct device_attribute *attr, char *buf)
264 {
265 	struct urdev *urd = dev->driver_data;
266 
267 	return sprintf(buf, "%zu\n", urd->reclen);
268 }
269 
270 static DEVICE_ATTR(reclen, 0444, ur_attr_reclen_show, NULL);
271 
272 static int ur_create_attributes(struct device *dev)
273 {
274 	return device_create_file(dev, &dev_attr_reclen);
275 }
276 
277 static void ur_remove_attributes(struct device *dev)
278 {
279 	device_remove_file(dev, &dev_attr_reclen);
280 }
281 
282 /*
283  * diagnose code 0x210 - retrieve device information
284  * cc=0  normal completion, we have a real device
285  * cc=1  CP paging error
286  * cc=2  The virtual device exists, but is not associated with a real device
287  * cc=3  Invalid device address, or the virtual device does not exist
288  */
289 static int get_urd_class(struct urdev *urd)
290 {
291 	static struct diag210 ur_diag210;
292 	int cc;
293 
294 	ur_diag210.vrdcdvno = urd->dev_id.devno;
295 	ur_diag210.vrdclen = sizeof(struct diag210);
296 
297 	cc = diag210(&ur_diag210);
298 	switch (cc) {
299 	case 0:
300 		return -ENOTSUPP;
301 	case 2:
302 		return ur_diag210.vrdcvcla; /* virtual device class */
303 	case 3:
304 		return -ENODEV;
305 	default:
306 		return -EIO;
307 	}
308 }
309 
310 /*
311  * Allocation and freeing of urfile structures
312  */
313 static struct urfile *urfile_alloc(struct urdev *urd)
314 {
315 	struct urfile *urf;
316 
317 	urf = kzalloc(sizeof(struct urfile), GFP_KERNEL);
318 	if (!urf)
319 		return NULL;
320 	urf->urd = urd;
321 
322 	TRACE("urfile_alloc: urd=%p urf=%p rl=%zu\n", urd, urf,
323 	      urf->dev_reclen);
324 
325 	return urf;
326 }
327 
328 static void urfile_free(struct urfile *urf)
329 {
330 	TRACE("urfile_free: urf=%p urd=%p\n", urf, urf->urd);
331 	kfree(urf);
332 }
333 
334 /*
335  * The fops implementation of the character device driver
336  */
337 static ssize_t do_write(struct urdev *urd, const char __user *udata,
338 			size_t count, size_t reclen, loff_t *ppos)
339 {
340 	struct ccw1 *cpa;
341 	int rc;
342 
343 	cpa = alloc_chan_prog(udata, count / reclen, reclen);
344 	if (IS_ERR(cpa))
345 		return PTR_ERR(cpa);
346 
347 	rc = do_ur_io(urd, cpa);
348 	if (rc)
349 		goto fail_kfree_cpa;
350 
351 	if (urd->io_request_rc) {
352 		rc = urd->io_request_rc;
353 		goto fail_kfree_cpa;
354 	}
355 	*ppos += count;
356 	rc = count;
357 
358 fail_kfree_cpa:
359 	free_chan_prog(cpa);
360 	return rc;
361 }
362 
363 static ssize_t ur_write(struct file *file, const char __user *udata,
364 			size_t count, loff_t *ppos)
365 {
366 	struct urfile *urf = file->private_data;
367 
368 	TRACE("ur_write: count=%zu\n", count);
369 
370 	if (count == 0)
371 		return 0;
372 
373 	if (count % urf->dev_reclen)
374 		return -EINVAL;	/* count must be a multiple of reclen */
375 
376 	if (count > urf->dev_reclen * MAX_RECS_PER_IO)
377 		count = urf->dev_reclen * MAX_RECS_PER_IO;
378 
379 	return do_write(urf->urd, udata, count, urf->dev_reclen, ppos);
380 }
381 
382 static int do_diag_14(unsigned long rx, unsigned long ry1,
383 		      unsigned long subcode)
384 {
385 	register unsigned long _ry1 asm("2") = ry1;
386 	register unsigned long _ry2 asm("3") = subcode;
387 	int rc = 0;
388 
389 	asm volatile(
390 #ifdef CONFIG_64BIT
391 		"   sam31\n"
392 		"   diag    %2,2,0x14\n"
393 		"   sam64\n"
394 #else
395 		"   diag    %2,2,0x14\n"
396 #endif
397 		"   ipm     %0\n"
398 		"   srl     %0,28\n"
399 		: "=d" (rc), "+d" (_ry2)
400 		: "d" (rx), "d" (_ry1)
401 		: "cc");
402 
403 	TRACE("diag 14: subcode=0x%lx, cc=%i\n", subcode, rc);
404 	return rc;
405 }
406 
407 /*
408  * diagnose code 0x14 subcode 0x0028 - position spool file to designated
409  *				       record
410  * cc=0  normal completion
411  * cc=2  no file active on the virtual reader or device not ready
412  * cc=3  record specified is beyond EOF
413  */
414 static int diag_position_to_record(int devno, int record)
415 {
416 	int cc;
417 
418 	cc = do_diag_14(record, devno, 0x28);
419 	switch (cc) {
420 	case 0:
421 		return 0;
422 	case 2:
423 		return -ENOMEDIUM;
424 	case 3:
425 		return -ENODATA; /* position beyond end of file */
426 	default:
427 		return -EIO;
428 	}
429 }
430 
431 /*
432  * diagnose code 0x14 subcode 0x0000 - read next spool file buffer
433  * cc=0  normal completion
434  * cc=1  EOF reached
435  * cc=2  no file active on the virtual reader, and no file eligible
436  * cc=3  file already active on the virtual reader or specified virtual
437  *	 reader does not exist or is not a reader
438  */
439 static int diag_read_file(int devno, char *buf)
440 {
441 	int cc;
442 
443 	cc = do_diag_14((unsigned long) buf, devno, 0x00);
444 	switch (cc) {
445 	case 0:
446 		return 0;
447 	case 1:
448 		return -ENODATA;
449 	case 2:
450 		return -ENOMEDIUM;
451 	default:
452 		return -EIO;
453 	}
454 }
455 
456 static ssize_t diag14_read(struct file *file, char __user *ubuf, size_t count,
457 			   loff_t *offs)
458 {
459 	size_t len, copied, res;
460 	char *buf;
461 	int rc;
462 	u16 reclen;
463 	struct urdev *urd;
464 
465 	urd = ((struct urfile *) file->private_data)->urd;
466 	reclen = ((struct urfile *) file->private_data)->file_reclen;
467 
468 	rc = diag_position_to_record(urd->dev_id.devno, *offs / PAGE_SIZE + 1);
469 	if (rc == -ENODATA)
470 		return 0;
471 	if (rc)
472 		return rc;
473 
474 	len = min((size_t) PAGE_SIZE, count);
475 	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
476 	if (!buf)
477 		return -ENOMEM;
478 
479 	copied = 0;
480 	res = (size_t) (*offs % PAGE_SIZE);
481 	do {
482 		rc = diag_read_file(urd->dev_id.devno, buf);
483 		if (rc == -ENODATA) {
484 			break;
485 		}
486 		if (rc)
487 			goto fail;
488 		if (reclen && (copied == 0) && (*offs < PAGE_SIZE))
489 			*((u16 *) &buf[FILE_RECLEN_OFFSET]) = reclen;
490 		len = min(count - copied, PAGE_SIZE - res);
491 		if (copy_to_user(ubuf + copied, buf + res, len)) {
492 			rc = -EFAULT;
493 			goto fail;
494 		}
495 		res = 0;
496 		copied += len;
497 	} while (copied != count);
498 
499 	*offs += copied;
500 	rc = copied;
501 fail:
502 	kfree(buf);
503 	return rc;
504 }
505 
506 static ssize_t ur_read(struct file *file, char __user *ubuf, size_t count,
507 		       loff_t *offs)
508 {
509 	struct urdev *urd;
510 	int rc;
511 
512 	TRACE("ur_read: count=%zu ppos=%li\n", count, (unsigned long) *offs);
513 
514 	if (count == 0)
515 		return 0;
516 
517 	urd = ((struct urfile *) file->private_data)->urd;
518 	rc = mutex_lock_interruptible(&urd->io_mutex);
519 	if (rc)
520 		return rc;
521 	rc = diag14_read(file, ubuf, count, offs);
522 	mutex_unlock(&urd->io_mutex);
523 	return rc;
524 }
525 
526 /*
527  * diagnose code 0x14 subcode 0x0fff - retrieve next file descriptor
528  * cc=0  normal completion
529  * cc=1  no files on reader queue or no subsequent file
530  * cc=2  spid specified is invalid
531  */
532 static int diag_read_next_file_info(struct file_control_block *buf, int spid)
533 {
534 	int cc;
535 
536 	cc = do_diag_14((unsigned long) buf, spid, 0xfff);
537 	switch (cc) {
538 	case 0:
539 		return 0;
540 	default:
541 		return -ENODATA;
542 	}
543 }
544 
545 static int verify_device(struct urdev *urd)
546 {
547 	struct file_control_block fcb;
548 	char *buf;
549 	int rc;
550 
551 	switch (urd->class) {
552 	case DEV_CLASS_UR_O:
553 		return 0; /* no check needed here */
554 	case DEV_CLASS_UR_I:
555 		/* check for empty reader device (beginning of chain) */
556 		rc = diag_read_next_file_info(&fcb, 0);
557 		if (rc)
558 			return rc;
559 
560 		/* open file on virtual reader	*/
561 		buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
562 		if (!buf)
563 			return -ENOMEM;
564 		rc = diag_read_file(urd->dev_id.devno, buf);
565 		kfree(buf);
566 
567 		if ((rc != 0) && (rc != -ENODATA)) /* EOF does not hurt */
568 			return rc;
569 		return 0;
570 	default:
571 		return -ENOTSUPP;
572 	}
573 }
574 
575 static int get_file_reclen(struct urdev *urd)
576 {
577 	struct file_control_block fcb;
578 	int rc;
579 
580 	switch (urd->class) {
581 	case DEV_CLASS_UR_O:
582 		return 0;
583 	case DEV_CLASS_UR_I:
584 		rc = diag_read_next_file_info(&fcb, 0);
585 		if (rc)
586 			return rc;
587 		break;
588 	default:
589 		return -ENOTSUPP;
590 	}
591 	if (fcb.file_stat & FLG_CP_DUMP)
592 		return 0;
593 
594 	return fcb.rec_len;
595 }
596 
597 static int ur_open(struct inode *inode, struct file *file)
598 {
599 	u16 devno;
600 	struct urdev *urd;
601 	struct urfile *urf;
602 	unsigned short accmode;
603 	int rc;
604 
605 	accmode = file->f_flags & O_ACCMODE;
606 
607 	if (accmode == O_RDWR)
608 		return -EACCES;
609 
610 	/*
611 	 * We treat the minor number as the devno of the ur device
612 	 * to find in the driver tree.
613 	 */
614 	devno = MINOR(file->f_dentry->d_inode->i_rdev);
615 
616 	urd = urdev_get_from_devno(devno);
617 	if (!urd)
618 		return -ENXIO;
619 
620 	if (file->f_flags & O_NONBLOCK) {
621 		if (!mutex_trylock(&urd->open_mutex)) {
622 			rc = -EBUSY;
623 			goto fail_put;
624 		}
625 	} else {
626 		if (mutex_lock_interruptible(&urd->open_mutex)) {
627 			rc = -ERESTARTSYS;
628 			goto fail_put;
629 		}
630 	}
631 
632 	TRACE("ur_open\n");
633 
634 	if (((accmode == O_RDONLY) && (urd->class != DEV_CLASS_UR_I)) ||
635 	    ((accmode == O_WRONLY) && (urd->class != DEV_CLASS_UR_O))) {
636 		TRACE("ur_open: unsupported dev class (%d)\n", urd->class);
637 		rc = -EACCES;
638 		goto fail_unlock;
639 	}
640 
641 	rc = verify_device(urd);
642 	if (rc)
643 		goto fail_unlock;
644 
645 	urf = urfile_alloc(urd);
646 	if (!urf) {
647 		rc = -ENOMEM;
648 		goto fail_unlock;
649 	}
650 
651 	urf->dev_reclen = urd->reclen;
652 	rc = get_file_reclen(urd);
653 	if (rc < 0)
654 		goto fail_urfile_free;
655 	urf->file_reclen = rc;
656 	file->private_data = urf;
657 	return 0;
658 
659 fail_urfile_free:
660 	urfile_free(urf);
661 fail_unlock:
662 	mutex_unlock(&urd->open_mutex);
663 fail_put:
664 	urdev_put(urd);
665 	return rc;
666 }
667 
668 static int ur_release(struct inode *inode, struct file *file)
669 {
670 	struct urfile *urf = file->private_data;
671 
672 	TRACE("ur_release\n");
673 	mutex_unlock(&urf->urd->open_mutex);
674 	urdev_put(urf->urd);
675 	urfile_free(urf);
676 	return 0;
677 }
678 
679 static loff_t ur_llseek(struct file *file, loff_t offset, int whence)
680 {
681 	loff_t newpos;
682 
683 	if ((file->f_flags & O_ACCMODE) != O_RDONLY)
684 		return -ESPIPE; /* seek allowed only for reader */
685 	if (offset % PAGE_SIZE)
686 		return -ESPIPE; /* only multiples of 4K allowed */
687 	switch (whence) {
688 	case 0: /* SEEK_SET */
689 		newpos = offset;
690 		break;
691 	case 1: /* SEEK_CUR */
692 		newpos = file->f_pos + offset;
693 		break;
694 	default:
695 		return -EINVAL;
696 	}
697 	file->f_pos = newpos;
698 	return newpos;
699 }
700 
701 static struct file_operations ur_fops = {
702 	.owner	 = THIS_MODULE,
703 	.open	 = ur_open,
704 	.release = ur_release,
705 	.read	 = ur_read,
706 	.write	 = ur_write,
707 	.llseek  = ur_llseek,
708 };
709 
710 /*
711  * ccw_device infrastructure:
712  *     ur_probe gets its own ref to the device (i.e. get_device),
713  *     creates the struct urdev, the device attributes, sets up
714  *     the interrupt handler and validates the virtual unit record device.
715  *     ur_remove removes the device attributes, frees the struct urdev
716  *     and drops (put_device) the ref to the device we got in ur_probe.
717  */
718 static int ur_probe(struct ccw_device *cdev)
719 {
720 	struct urdev *urd;
721 	int rc;
722 
723 	TRACE("ur_probe: cdev=%p state=%d\n", cdev, *(int *) cdev->private);
724 
725 	if (!get_device(&cdev->dev))
726 		return -ENODEV;
727 
728 	urd = urdev_alloc(cdev);
729 	if (!urd) {
730 		rc = -ENOMEM;
731 		goto fail;
732 	}
733 	rc = ur_create_attributes(&cdev->dev);
734 	if (rc) {
735 		rc = -ENOMEM;
736 		goto fail;
737 	}
738 	cdev->dev.driver_data = urd;
739 	cdev->handler = ur_int_handler;
740 
741 	/* validate virtual unit record device */
742 	urd->class = get_urd_class(urd);
743 	if (urd->class < 0) {
744 		rc = urd->class;
745 		goto fail;
746 	}
747 	if ((urd->class != DEV_CLASS_UR_I) && (urd->class != DEV_CLASS_UR_O)) {
748 		rc = -ENOTSUPP;
749 		goto fail;
750 	}
751 
752 	return 0;
753 
754 fail:
755 	urdev_free(urd);
756 	put_device(&cdev->dev);
757 	return rc;
758 }
759 
760 static void ur_remove(struct ccw_device *cdev)
761 {
762 	struct urdev *urd = cdev->dev.driver_data;
763 
764 	TRACE("ur_remove\n");
765 	if (cdev->online)
766 		ur_set_offline(cdev);
767 	ur_remove_attributes(&cdev->dev);
768 	urdev_free(urd);
769 	put_device(&cdev->dev);
770 }
771 
772 static int ur_set_online(struct ccw_device *cdev)
773 {
774 	struct urdev *urd;
775 	int minor, major, rc;
776 	char node_id[16];
777 
778 	TRACE("ur_set_online: cdev=%p state=%d\n", cdev,
779 	      *(int *) cdev->private);
780 
781 	if (!try_module_get(ur_driver.owner))
782 		return -EINVAL;
783 
784 	urd = (struct urdev *) cdev->dev.driver_data;
785 	minor = urd->dev_id.devno;
786 	major = MAJOR(ur_first_dev_maj_min);
787 
788 	urd->char_device = cdev_alloc();
789 	if (!urd->char_device) {
790 		rc = -ENOMEM;
791 		goto fail_module_put;
792 	}
793 
794 	cdev_init(urd->char_device, &ur_fops);
795 	urd->char_device->dev = MKDEV(major, minor);
796 	urd->char_device->owner = ur_fops.owner;
797 
798 	rc = cdev_add(urd->char_device, urd->char_device->dev, 1);
799 	if (rc)
800 		goto fail_free_cdev;
801 	if (urd->cdev->id.cu_type == READER_PUNCH_DEVTYPE) {
802 		if (urd->class == DEV_CLASS_UR_I)
803 			sprintf(node_id, "vmrdr-%s", cdev->dev.bus_id);
804 		if (urd->class == DEV_CLASS_UR_O)
805 			sprintf(node_id, "vmpun-%s", cdev->dev.bus_id);
806 	} else if (urd->cdev->id.cu_type == PRINTER_DEVTYPE) {
807 		sprintf(node_id, "vmprt-%s", cdev->dev.bus_id);
808 	} else {
809 		rc = -ENOTSUPP;
810 		goto fail_free_cdev;
811 	}
812 
813 	urd->device = device_create(vmur_class, NULL, urd->char_device->dev,
814 					"%s", node_id);
815 	if (IS_ERR(urd->device)) {
816 		rc = PTR_ERR(urd->device);
817 		TRACE("ur_set_online: device_create rc=%d\n", rc);
818 		goto fail_free_cdev;
819 	}
820 
821 	return 0;
822 
823 fail_free_cdev:
824 	cdev_del(urd->char_device);
825 fail_module_put:
826 	module_put(ur_driver.owner);
827 
828 	return rc;
829 }
830 
831 static int ur_set_offline(struct ccw_device *cdev)
832 {
833 	struct urdev *urd;
834 
835 	TRACE("ur_set_offline: cdev=%p cdev->private=%p state=%d\n",
836 		cdev, cdev->private, *(int *) cdev->private);
837 	urd = (struct urdev *) cdev->dev.driver_data;
838 	device_destroy(vmur_class, urd->char_device->dev);
839 	cdev_del(urd->char_device);
840 	module_put(ur_driver.owner);
841 
842 	return 0;
843 }
844 
845 /*
846  * Module initialisation and cleanup
847  */
848 static int __init ur_init(void)
849 {
850 	int rc;
851 	dev_t dev;
852 
853 	if (!MACHINE_IS_VM) {
854 		PRINT_ERR("%s is only available under z/VM.\n", ur_banner);
855 		return -ENODEV;
856 	}
857 
858 	vmur_dbf = debug_register("vmur", 4, 1, 4 * sizeof(long));
859 	if (!vmur_dbf)
860 		return -ENOMEM;
861 	rc = debug_register_view(vmur_dbf, &debug_sprintf_view);
862 	if (rc)
863 		goto fail_free_dbf;
864 
865 	debug_set_level(vmur_dbf, 6);
866 
867 	rc = ccw_driver_register(&ur_driver);
868 	if (rc)
869 		goto fail_free_dbf;
870 
871 	rc = alloc_chrdev_region(&dev, 0, NUM_MINORS, "vmur");
872 	if (rc) {
873 		PRINT_ERR("alloc_chrdev_region failed: err = %d\n", rc);
874 		goto fail_unregister_driver;
875 	}
876 	ur_first_dev_maj_min = MKDEV(MAJOR(dev), 0);
877 
878 	vmur_class = class_create(THIS_MODULE, "vmur");
879 	if (IS_ERR(vmur_class)) {
880 		rc = PTR_ERR(vmur_class);
881 		goto fail_unregister_region;
882 	}
883 	PRINT_INFO("%s loaded.\n", ur_banner);
884 	return 0;
885 
886 fail_unregister_region:
887 	unregister_chrdev_region(ur_first_dev_maj_min, NUM_MINORS);
888 fail_unregister_driver:
889 	ccw_driver_unregister(&ur_driver);
890 fail_free_dbf:
891 	debug_unregister(vmur_dbf);
892 	return rc;
893 }
894 
895 static void __exit ur_exit(void)
896 {
897 	class_destroy(vmur_class);
898 	unregister_chrdev_region(ur_first_dev_maj_min, NUM_MINORS);
899 	ccw_driver_unregister(&ur_driver);
900 	debug_unregister(vmur_dbf);
901 	PRINT_INFO("%s unloaded.\n", ur_banner);
902 }
903 
904 module_init(ur_init);
905 module_exit(ur_exit);
906