Linux Audio

Check our new training course

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