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