Commit | Line | Data |
---|---|---|
656d98b0 RK |
1 | /* ATM driver model support. */ |
2 | ||
656d98b0 RK |
3 | #include <linux/kernel.h> |
4 | #include <linux/init.h> | |
5 | #include <linux/kobject.h> | |
6 | #include <linux/atmdev.h> | |
7 | #include "common.h" | |
8 | #include "resources.h" | |
9 | ||
10 | #define to_atm_dev(cldev) container_of(cldev, struct atm_dev, class_dev) | |
11 | ||
12 | static ssize_t show_type(struct class_device *cdev, char *buf) | |
13 | { | |
14 | struct atm_dev *adev = to_atm_dev(cdev); | |
15 | return sprintf(buf, "%s\n", adev->type); | |
16 | } | |
17 | ||
18 | static ssize_t show_address(struct class_device *cdev, char *buf) | |
19 | { | |
20 | char *pos = buf; | |
21 | struct atm_dev *adev = to_atm_dev(cdev); | |
22 | int i; | |
23 | ||
24 | for (i = 0; i < (ESI_LEN - 1); i++) | |
25 | pos += sprintf(pos, "%02x:", adev->esi[i]); | |
26 | pos += sprintf(pos, "%02x\n", adev->esi[i]); | |
27 | ||
28 | return pos - buf; | |
29 | } | |
30 | ||
31 | static ssize_t show_atmaddress(struct class_device *cdev, char *buf) | |
32 | { | |
f7d57453 | 33 | unsigned long flags; |
656d98b0 RK |
34 | char *pos = buf; |
35 | struct atm_dev *adev = to_atm_dev(cdev); | |
f7d57453 | 36 | struct atm_dev_addr *aaddr; |
656d98b0 RK |
37 | int bin[] = { 1, 2, 10, 6, 1 }, *fmt = bin; |
38 | int i, j; | |
39 | ||
f7d57453 YH |
40 | spin_lock_irqsave(&adev->lock, flags); |
41 | list_for_each_entry(aaddr, &adev->local, entry) { | |
656d98b0 RK |
42 | for(i = 0, j = 0; i < ATM_ESA_LEN; ++i, ++j) { |
43 | if (j == *fmt) { | |
44 | pos += sprintf(pos, "."); | |
45 | ++fmt; | |
46 | j = 0; | |
47 | } | |
48 | pos += sprintf(pos, "%02x", aaddr->addr.sas_addr.prv[i]); | |
49 | } | |
50 | pos += sprintf(pos, "\n"); | |
51 | } | |
f7d57453 | 52 | spin_unlock_irqrestore(&adev->lock, flags); |
656d98b0 RK |
53 | |
54 | return pos - buf; | |
55 | } | |
56 | ||
57 | static ssize_t show_carrier(struct class_device *cdev, char *buf) | |
58 | { | |
59 | char *pos = buf; | |
60 | struct atm_dev *adev = to_atm_dev(cdev); | |
61 | ||
62 | pos += sprintf(pos, "%d\n", | |
63 | adev->signal == ATM_PHY_SIG_LOST ? 0 : 1); | |
f7d57453 | 64 | |
656d98b0 RK |
65 | return pos - buf; |
66 | } | |
67 | ||
68 | static ssize_t show_link_rate(struct class_device *cdev, char *buf) | |
69 | { | |
70 | char *pos = buf; | |
71 | struct atm_dev *adev = to_atm_dev(cdev); | |
72 | int link_rate; | |
73 | ||
74 | /* show the link rate, not the data rate */ | |
75 | switch (adev->link_rate) { | |
76 | case ATM_OC3_PCR: | |
77 | link_rate = 155520000; | |
78 | break; | |
79 | case ATM_OC12_PCR: | |
80 | link_rate = 622080000; | |
81 | break; | |
82 | case ATM_25_PCR: | |
83 | link_rate = 25600000; | |
84 | break; | |
85 | default: | |
86 | link_rate = adev->link_rate * 8 * 53; | |
87 | } | |
88 | pos += sprintf(pos, "%d\n", link_rate); | |
f7d57453 | 89 | |
656d98b0 RK |
90 | return pos - buf; |
91 | } | |
92 | ||
93 | static CLASS_DEVICE_ATTR(address, S_IRUGO, show_address, NULL); | |
94 | static CLASS_DEVICE_ATTR(atmaddress, S_IRUGO, show_atmaddress, NULL); | |
95 | static CLASS_DEVICE_ATTR(carrier, S_IRUGO, show_carrier, NULL); | |
96 | static CLASS_DEVICE_ATTR(type, S_IRUGO, show_type, NULL); | |
97 | static CLASS_DEVICE_ATTR(link_rate, S_IRUGO, show_link_rate, NULL); | |
98 | ||
99 | static struct class_device_attribute *atm_attrs[] = { | |
100 | &class_device_attr_atmaddress, | |
101 | &class_device_attr_address, | |
102 | &class_device_attr_carrier, | |
103 | &class_device_attr_type, | |
104 | &class_device_attr_link_rate, | |
105 | NULL | |
106 | }; | |
107 | ||
7eff2e7a | 108 | static int atm_uevent(struct class_device *cdev, struct kobj_uevent_env *env) |
656d98b0 RK |
109 | { |
110 | struct atm_dev *adev; | |
656d98b0 RK |
111 | |
112 | if (!cdev) | |
113 | return -ENODEV; | |
114 | ||
115 | adev = to_atm_dev(cdev); | |
116 | if (!adev) | |
117 | return -ENODEV; | |
118 | ||
7eff2e7a | 119 | if (add_uevent_var(env, "NAME=%s%d", adev->type, adev->number)) |
656d98b0 RK |
120 | return -ENOMEM; |
121 | ||
656d98b0 RK |
122 | return 0; |
123 | } | |
124 | ||
125 | static void atm_release(struct class_device *cdev) | |
126 | { | |
127 | struct atm_dev *adev = to_atm_dev(cdev); | |
128 | ||
129 | kfree(adev); | |
130 | } | |
131 | ||
132 | static struct class atm_class = { | |
133 | .name = "atm", | |
134 | .release = atm_release, | |
135 | .uevent = atm_uevent, | |
136 | }; | |
137 | ||
138 | int atm_register_sysfs(struct atm_dev *adev) | |
139 | { | |
140 | struct class_device *cdev = &adev->class_dev; | |
97f80bc6 | 141 | int i, j, err; |
656d98b0 RK |
142 | |
143 | cdev->class = &atm_class; | |
144 | class_set_devdata(cdev, adev); | |
145 | ||
146 | snprintf(cdev->class_id, BUS_ID_SIZE, "%s%d", adev->type, adev->number); | |
147 | err = class_device_register(cdev); | |
148 | if (err < 0) | |
149 | return err; | |
150 | ||
97f80bc6 JG |
151 | for (i = 0; atm_attrs[i]; i++) { |
152 | err = class_device_create_file(cdev, atm_attrs[i]); | |
153 | if (err) | |
154 | goto err_out; | |
155 | } | |
656d98b0 RK |
156 | |
157 | return 0; | |
97f80bc6 JG |
158 | |
159 | err_out: | |
160 | for (j = 0; j < i; j++) | |
161 | class_device_remove_file(cdev, atm_attrs[j]); | |
162 | class_device_del(cdev); | |
163 | return err; | |
656d98b0 RK |
164 | } |
165 | ||
166 | void atm_unregister_sysfs(struct atm_dev *adev) | |
167 | { | |
168 | struct class_device *cdev = &adev->class_dev; | |
169 | ||
170 | class_device_del(cdev); | |
171 | } | |
172 | ||
173 | int __init atm_sysfs_init(void) | |
174 | { | |
175 | return class_register(&atm_class); | |
176 | } | |
177 | ||
178 | void __exit atm_sysfs_exit(void) | |
179 | { | |
180 | class_unregister(&atm_class); | |
181 | } |