blob: f693b78eb4678d79b8a4f4786a4fffba47461ade [file] [log] [blame]
Roman Kagan656d98b2006-06-29 12:36:34 -07001/* ATM driver model support. */
2
Roman Kagan656d98b2006-06-29 12:36:34 -07003#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
Kay Sieversef395922007-12-30 23:16:06 -080012static ssize_t show_type(struct device *cdev,
13 struct device_attribute *attr, char *buf)
Roman Kagan656d98b2006-06-29 12:36:34 -070014{
15 struct atm_dev *adev = to_atm_dev(cdev);
16 return sprintf(buf, "%s\n", adev->type);
17}
18
Kay Sieversef395922007-12-30 23:16:06 -080019static ssize_t show_address(struct device *cdev,
20 struct device_attribute *attr, char *buf)
Roman Kagan656d98b2006-06-29 12:36:34 -070021{
22 char *pos = buf;
23 struct atm_dev *adev = to_atm_dev(cdev);
24 int i;
25
26 for (i = 0; i < (ESI_LEN - 1); i++)
27 pos += sprintf(pos, "%02x:", adev->esi[i]);
28 pos += sprintf(pos, "%02x\n", adev->esi[i]);
29
30 return pos - buf;
31}
32
Kay Sieversef395922007-12-30 23:16:06 -080033static ssize_t show_atmaddress(struct device *cdev,
34 struct device_attribute *attr, char *buf)
Roman Kagan656d98b2006-06-29 12:36:34 -070035{
YOSHIFUJI Hideakif7d57452007-02-09 23:24:29 +090036 unsigned long flags;
Roman Kagan656d98b2006-06-29 12:36:34 -070037 char *pos = buf;
38 struct atm_dev *adev = to_atm_dev(cdev);
YOSHIFUJI Hideakif7d57452007-02-09 23:24:29 +090039 struct atm_dev_addr *aaddr;
Roman Kagan656d98b2006-06-29 12:36:34 -070040 int bin[] = { 1, 2, 10, 6, 1 }, *fmt = bin;
41 int i, j;
42
YOSHIFUJI Hideakif7d57452007-02-09 23:24:29 +090043 spin_lock_irqsave(&adev->lock, flags);
44 list_for_each_entry(aaddr, &adev->local, entry) {
Joe Perchesf0a6cb12010-01-26 11:40:03 +000045 for (i = 0, j = 0; i < ATM_ESA_LEN; ++i, ++j) {
Roman Kagan656d98b2006-06-29 12:36:34 -070046 if (j == *fmt) {
47 pos += sprintf(pos, ".");
48 ++fmt;
49 j = 0;
50 }
Joe Perchesf0a6cb12010-01-26 11:40:03 +000051 pos += sprintf(pos, "%02x",
52 aaddr->addr.sas_addr.prv[i]);
Roman Kagan656d98b2006-06-29 12:36:34 -070053 }
54 pos += sprintf(pos, "\n");
55 }
YOSHIFUJI Hideakif7d57452007-02-09 23:24:29 +090056 spin_unlock_irqrestore(&adev->lock, flags);
Roman Kagan656d98b2006-06-29 12:36:34 -070057
58 return pos - buf;
59}
60
Kay Sieversef395922007-12-30 23:16:06 -080061static ssize_t show_carrier(struct device *cdev,
62 struct device_attribute *attr, char *buf)
Roman Kagan656d98b2006-06-29 12:36:34 -070063{
64 char *pos = buf;
65 struct atm_dev *adev = to_atm_dev(cdev);
66
67 pos += sprintf(pos, "%d\n",
68 adev->signal == ATM_PHY_SIG_LOST ? 0 : 1);
YOSHIFUJI Hideakif7d57452007-02-09 23:24:29 +090069
Roman Kagan656d98b2006-06-29 12:36:34 -070070 return pos - buf;
71}
72
Kay Sieversef395922007-12-30 23:16:06 -080073static ssize_t show_link_rate(struct device *cdev,
74 struct device_attribute *attr, char *buf)
Roman Kagan656d98b2006-06-29 12:36:34 -070075{
76 char *pos = buf;
77 struct atm_dev *adev = to_atm_dev(cdev);
78 int link_rate;
79
80 /* show the link rate, not the data rate */
81 switch (adev->link_rate) {
Joe Perchesf0a6cb12010-01-26 11:40:03 +000082 case ATM_OC3_PCR:
83 link_rate = 155520000;
84 break;
85 case ATM_OC12_PCR:
86 link_rate = 622080000;
87 break;
88 case ATM_25_PCR:
89 link_rate = 25600000;
90 break;
91 default:
92 link_rate = adev->link_rate * 8 * 53;
Roman Kagan656d98b2006-06-29 12:36:34 -070093 }
94 pos += sprintf(pos, "%d\n", link_rate);
YOSHIFUJI Hideakif7d57452007-02-09 23:24:29 +090095
Roman Kagan656d98b2006-06-29 12:36:34 -070096 return pos - buf;
97}
98
Kay Sieversef395922007-12-30 23:16:06 -080099static DEVICE_ATTR(address, S_IRUGO, show_address, NULL);
100static DEVICE_ATTR(atmaddress, S_IRUGO, show_atmaddress, NULL);
101static DEVICE_ATTR(carrier, S_IRUGO, show_carrier, NULL);
102static DEVICE_ATTR(type, S_IRUGO, show_type, NULL);
103static DEVICE_ATTR(link_rate, S_IRUGO, show_link_rate, NULL);
Roman Kagan656d98b2006-06-29 12:36:34 -0700104
Kay Sieversef395922007-12-30 23:16:06 -0800105static struct device_attribute *atm_attrs[] = {
106 &dev_attr_atmaddress,
107 &dev_attr_address,
108 &dev_attr_carrier,
109 &dev_attr_type,
110 &dev_attr_link_rate,
Roman Kagan656d98b2006-06-29 12:36:34 -0700111 NULL
112};
113
Kay Sieversef395922007-12-30 23:16:06 -0800114
115static int atm_uevent(struct device *cdev, struct kobj_uevent_env *env)
Roman Kagan656d98b2006-06-29 12:36:34 -0700116{
117 struct atm_dev *adev;
Roman Kagan656d98b2006-06-29 12:36:34 -0700118
119 if (!cdev)
120 return -ENODEV;
121
122 adev = to_atm_dev(cdev);
123 if (!adev)
124 return -ENODEV;
125
Kay Sievers7eff2e72007-08-14 15:15:12 +0200126 if (add_uevent_var(env, "NAME=%s%d", adev->type, adev->number))
Roman Kagan656d98b2006-06-29 12:36:34 -0700127 return -ENOMEM;
128
Roman Kagan656d98b2006-06-29 12:36:34 -0700129 return 0;
130}
131
Kay Sieversef395922007-12-30 23:16:06 -0800132static void atm_release(struct device *cdev)
Roman Kagan656d98b2006-06-29 12:36:34 -0700133{
134 struct atm_dev *adev = to_atm_dev(cdev);
135
136 kfree(adev);
137}
138
139static struct class atm_class = {
140 .name = "atm",
Kay Sieversef395922007-12-30 23:16:06 -0800141 .dev_release = atm_release,
142 .dev_uevent = atm_uevent,
Roman Kagan656d98b2006-06-29 12:36:34 -0700143};
144
145int atm_register_sysfs(struct atm_dev *adev)
146{
Kay Sieversef395922007-12-30 23:16:06 -0800147 struct device *cdev = &adev->class_dev;
Jeff Garzik97f80bc2006-10-20 19:48:42 -0700148 int i, j, err;
Roman Kagan656d98b2006-06-29 12:36:34 -0700149
150 cdev->class = &atm_class;
Kay Sieversef395922007-12-30 23:16:06 -0800151 dev_set_drvdata(cdev, adev);
Roman Kagan656d98b2006-06-29 12:36:34 -0700152
Kay Sieversfb28ad32008-11-10 13:55:14 -0800153 dev_set_name(cdev, "%s%d", adev->type, adev->number);
Kay Sieversef395922007-12-30 23:16:06 -0800154 err = device_register(cdev);
Roman Kagan656d98b2006-06-29 12:36:34 -0700155 if (err < 0)
156 return err;
157
Jeff Garzik97f80bc2006-10-20 19:48:42 -0700158 for (i = 0; atm_attrs[i]; i++) {
Kay Sieversef395922007-12-30 23:16:06 -0800159 err = device_create_file(cdev, atm_attrs[i]);
Jeff Garzik97f80bc2006-10-20 19:48:42 -0700160 if (err)
161 goto err_out;
162 }
Roman Kagan656d98b2006-06-29 12:36:34 -0700163
164 return 0;
Jeff Garzik97f80bc2006-10-20 19:48:42 -0700165
166err_out:
167 for (j = 0; j < i; j++)
Kay Sieversef395922007-12-30 23:16:06 -0800168 device_remove_file(cdev, atm_attrs[j]);
169 device_del(cdev);
Jeff Garzik97f80bc2006-10-20 19:48:42 -0700170 return err;
Roman Kagan656d98b2006-06-29 12:36:34 -0700171}
172
173void atm_unregister_sysfs(struct atm_dev *adev)
174{
Kay Sieversef395922007-12-30 23:16:06 -0800175 struct device *cdev = &adev->class_dev;
Roman Kagan656d98b2006-06-29 12:36:34 -0700176
Kay Sieversef395922007-12-30 23:16:06 -0800177 device_del(cdev);
Roman Kagan656d98b2006-06-29 12:36:34 -0700178}
179
180int __init atm_sysfs_init(void)
181{
182 return class_register(&atm_class);
183}
184
185void __exit atm_sysfs_exit(void)
186{
187 class_unregister(&atm_class);
188}