1 // SPDX-License-Identifier: GPL-2.0
2 /* ATM driver model support. */
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
type_show(struct device * cdev,struct device_attribute * attr,char * buf)14 static ssize_t type_show(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
address_show(struct device * cdev,struct device_attribute * attr,char * buf)22 static ssize_t address_show(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
atmaddress_show(struct device * cdev,struct device_attribute * attr,char * buf)30 static ssize_t atmaddress_show(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
atmindex_show(struct device * cdev,struct device_attribute * attr,char * buf)53 static ssize_t atmindex_show(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
carrier_show(struct device * cdev,struct device_attribute * attr,char * buf)61 static ssize_t carrier_show(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
link_rate_show(struct device * cdev,struct device_attribute * attr,char * buf)70 static ssize_t link_rate_show(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 /* show the link rate, not the data rate */
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
93 static DEVICE_ATTR_RO(address);
94 static DEVICE_ATTR_RO(atmaddress);
95 static DEVICE_ATTR_RO(atmindex);
96 static DEVICE_ATTR_RO(carrier);
97 static DEVICE_ATTR_RO(type);
98 static DEVICE_ATTR_RO(link_rate);
99
100 static 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
atm_uevent(const struct device * cdev,struct kobj_uevent_env * env)111 static int atm_uevent(const struct device *cdev, struct kobj_uevent_env *env)
112 {
113 const 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
atm_release(struct device * cdev)128 static void atm_release(struct device *cdev)
129 {
130 struct atm_dev *adev = to_atm_dev(cdev);
131
132 kfree(adev);
133 }
134
135 static struct class atm_class = {
136 .name = "atm",
137 .dev_release = atm_release,
138 .dev_uevent = atm_uevent,
139 };
140
atm_register_sysfs(struct atm_dev * adev,struct device * parent)141 int 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
163 err_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
atm_unregister_sysfs(struct atm_dev * adev)170 void atm_unregister_sysfs(struct atm_dev *adev)
171 {
172 struct device *cdev = &adev->class_dev;
173
174 device_del(cdev);
175 }
176
atm_sysfs_init(void)177 int __init atm_sysfs_init(void)
178 {
179 return class_register(&atm_class);
180 }
181
atm_sysfs_exit(void)182 void __exit atm_sysfs_exit(void)
183 {
184 class_unregister(&atm_class);
185 }
186