1
2
3
4
5
6
7
8
9
10
11#define KMSG_COMPONENT "tape"
12#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
13
14#include <linux/slab.h>
15
16#include "tape_class.h"
17
18MODULE_AUTHOR("Stefan Bader <shbader@de.ibm.com>");
19MODULE_DESCRIPTION(
20 "Copyright IBM Corp. 2004 All Rights Reserved.\n"
21 "tape_class.c"
22);
23MODULE_LICENSE("GPL");
24
25static struct class *tape_class;
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42struct tape_class_device *register_tape_dev(
43 struct device * device,
44 dev_t dev,
45 const struct file_operations *fops,
46 char * device_name,
47 char * mode_name)
48{
49 struct tape_class_device * tcd;
50 int rc;
51 char * s;
52
53 tcd = kzalloc(sizeof(struct tape_class_device), GFP_KERNEL);
54 if (!tcd)
55 return ERR_PTR(-ENOMEM);
56
57 strlcpy(tcd->device_name, device_name, TAPECLASS_NAME_LEN);
58 for (s = strchr(tcd->device_name, '/'); s; s = strchr(s, '/'))
59 *s = '!';
60 strlcpy(tcd->mode_name, mode_name, TAPECLASS_NAME_LEN);
61 for (s = strchr(tcd->mode_name, '/'); s; s = strchr(s, '/'))
62 *s = '!';
63
64 tcd->char_device = cdev_alloc();
65 if (!tcd->char_device) {
66 rc = -ENOMEM;
67 goto fail_with_tcd;
68 }
69
70 tcd->char_device->owner = fops->owner;
71 tcd->char_device->ops = fops;
72
73 rc = cdev_add(tcd->char_device, dev, 1);
74 if (rc)
75 goto fail_with_cdev;
76
77 tcd->class_device = device_create(tape_class, device,
78 tcd->char_device->dev, NULL,
79 "%s", tcd->device_name);
80 rc = PTR_ERR_OR_ZERO(tcd->class_device);
81 if (rc)
82 goto fail_with_cdev;
83 rc = sysfs_create_link(
84 &device->kobj,
85 &tcd->class_device->kobj,
86 tcd->mode_name
87 );
88 if (rc)
89 goto fail_with_class_device;
90
91 return tcd;
92
93fail_with_class_device:
94 device_destroy(tape_class, tcd->char_device->dev);
95
96fail_with_cdev:
97 cdev_del(tcd->char_device);
98
99fail_with_tcd:
100 kfree(tcd);
101
102 return ERR_PTR(rc);
103}
104EXPORT_SYMBOL(register_tape_dev);
105
106void unregister_tape_dev(struct device *device, struct tape_class_device *tcd)
107{
108 if (tcd != NULL && !IS_ERR(tcd)) {
109 sysfs_remove_link(&device->kobj, tcd->mode_name);
110 device_destroy(tape_class, tcd->char_device->dev);
111 cdev_del(tcd->char_device);
112 kfree(tcd);
113 }
114}
115EXPORT_SYMBOL(unregister_tape_dev);
116
117
118static int __init tape_init(void)
119{
120 tape_class = class_create(THIS_MODULE, "tape390");
121
122 return 0;
123}
124
125static void __exit tape_exit(void)
126{
127 class_destroy(tape_class);
128 tape_class = NULL;
129}
130
131postcore_initcall(tape_init);
132module_exit(tape_exit);
133