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