[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / atm / atm_sysfs.c

/* ATM driver model support. */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/kobject.h>
#include <linux/atmdev.h>
#include "common.h"
#include "resources.h"

#define to_atm_dev(cldev) container_of(cldev, struct atm_dev, class_dev)

static ssize_t show_type(struct class_device *cdev, char *buf)
{
	struct atm_dev *adev = to_atm_dev(cdev);
	return sprintf(buf, "%s\n", adev->type);
}

static ssize_t show_address(struct class_device *cdev, char *buf)
{
	char *pos = buf;
	struct atm_dev *adev = to_atm_dev(cdev);
	int i;

	for (i = 0; i < (ESI_LEN - 1); i++)
		pos += sprintf(pos, "%02x:", adev->esi[i]);
	pos += sprintf(pos, "%02x\n", adev->esi[i]);

	return pos - buf;
}

static ssize_t show_atmaddress(struct class_device *cdev, char *buf)
{
	unsigned long flags;
	char *pos = buf;
	struct atm_dev *adev = to_atm_dev(cdev);
	struct atm_dev_addr *aaddr;
	int bin[] = { 1, 2, 10, 6, 1 }, *fmt = bin;
	int i, j;

	spin_lock_irqsave(&adev->lock, flags);
	list_for_each_entry(aaddr, &adev->local, entry) {
		for(i = 0, j = 0; i < ATM_ESA_LEN; ++i, ++j) {
			if (j == *fmt) {
				pos += sprintf(pos, ".");
				++fmt;
				j = 0;
			}
			pos += sprintf(pos, "%02x", aaddr->addr.sas_addr.prv[i]);
		}
		pos += sprintf(pos, "\n");
	}
	spin_unlock_irqrestore(&adev->lock, flags);

	return pos - buf;
}

static ssize_t show_carrier(struct class_device *cdev, char *buf)
{
	char *pos = buf;
	struct atm_dev *adev = to_atm_dev(cdev);

	pos += sprintf(pos, "%d\n",
		       adev->signal == ATM_PHY_SIG_LOST ? 0 : 1);

	return pos - buf;
}

static ssize_t show_link_rate(struct class_device *cdev, char *buf)
{
	char *pos = buf;
	struct atm_dev *adev = to_atm_dev(cdev);
	int link_rate;

	/* show the link rate, not the data rate */
	switch (adev->link_rate) {
		case ATM_OC3_PCR:
			link_rate = 155520000;
			break;
		case ATM_OC12_PCR:
			link_rate = 622080000;
			break;
		case ATM_25_PCR:
			link_rate = 25600000;
			break;
		default:
			link_rate = adev->link_rate * 8 * 53;
	}
	pos += sprintf(pos, "%d\n", link_rate);

	return pos - buf;
}

static CLASS_DEVICE_ATTR(address, S_IRUGO, show_address, NULL);
static CLASS_DEVICE_ATTR(atmaddress, S_IRUGO, show_atmaddress, NULL);
static CLASS_DEVICE_ATTR(carrier, S_IRUGO, show_carrier, NULL);
static CLASS_DEVICE_ATTR(type, S_IRUGO, show_type, NULL);
static CLASS_DEVICE_ATTR(link_rate, S_IRUGO, show_link_rate, NULL);

static struct class_device_attribute *atm_attrs[] = {
	&class_device_attr_atmaddress,
	&class_device_attr_address,
	&class_device_attr_carrier,
	&class_device_attr_type,
	&class_device_attr_link_rate,
	NULL
};

static int atm_uevent(struct class_device *cdev, struct kobj_uevent_env *env)
{
	struct atm_dev *adev;

	if (!cdev)
		return -ENODEV;

	adev = to_atm_dev(cdev);
	if (!adev)
		return -ENODEV;

	if (add_uevent_var(env, "NAME=%s%d", adev->type, adev->number))
		return -ENOMEM;

	return 0;
}

static void atm_release(struct class_device *cdev)
{
	struct atm_dev *adev = to_atm_dev(cdev);

	kfree(adev);
}

static struct class atm_class = {
	.name		= "atm",
	.release	= atm_release,
	.uevent		= atm_uevent,
};

int atm_register_sysfs(struct atm_dev *adev)
{
	struct class_device *cdev = &adev->class_dev;
	int i, j, err;

	cdev->class = &atm_class;
	class_set_devdata(cdev, adev);

	snprintf(cdev->class_id, BUS_ID_SIZE, "%s%d", adev->type, adev->number);
	err = class_device_register(cdev);
	if (err < 0)
		return err;

	for (i = 0; atm_attrs[i]; i++) {
		err = class_device_create_file(cdev, atm_attrs[i]);
		if (err)
			goto err_out;
	}

	return 0;

err_out:
	for (j = 0; j < i; j++)
		class_device_remove_file(cdev, atm_attrs[j]);
	class_device_del(cdev);
	return err;
}

void atm_unregister_sysfs(struct atm_dev *adev)
{
	struct class_device *cdev = &adev->class_dev;

	class_device_del(cdev);
}

int __init atm_sysfs_init(void)
{
	return class_register(&atm_class);
}

void __exit atm_sysfs_exit(void)
{
	class_unregister(&atm_class);
}
Commit	Line	Data
656d98b0 RK	1	/* ATM driver model support. */
656d98b0 RK	2
656d98b0 RK	3	#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
	12	static ssize_t show_type(struct class_device cdev, char buf)
	13	{
	14	struct atm_dev *adev = to_atm_dev(cdev);
	15	return sprintf(buf, "%s\n", adev->type);
	16	}
	17
	18	static ssize_t show_address(struct class_device cdev, char buf)
	19	{
	20	char *pos = buf;
	21	struct atm_dev *adev = to_atm_dev(cdev);
	22	int i;
	23
	24	for (i = 0; i < (ESI_LEN - 1); i++)
	25	pos += sprintf(pos, "%02x:", adev->esi[i]);
	26	pos += sprintf(pos, "%02x\n", adev->esi[i]);
	27
	28	return pos - buf;
	29	}
	30
	31	static ssize_t show_atmaddress(struct class_device cdev, char buf)
	32	{
f7d57453	33	unsigned long flags;
656d98b0 RK	34	char *pos = buf;
656d98b0 RK	35	struct atm_dev *adev = to_atm_dev(cdev);
f7d57453	36	struct atm_dev_addr *aaddr;
656d98b0 RK	37	int bin[] = { 1, 2, 10, 6, 1 }, *fmt = bin;
	38	int i, j;
	39
f7d57453 YH	40	spin_lock_irqsave(&adev->lock, flags);
f7d57453 YH	41	list_for_each_entry(aaddr, &adev->local, entry) {
656d98b0 RK	42	for(i = 0, j = 0; i < ATM_ESA_LEN; ++i, ++j) {
	43	if (j == *fmt) {
	44	pos += sprintf(pos, ".");
	45	++fmt;
	46	j = 0;
	47	}
	48	pos += sprintf(pos, "%02x", aaddr->addr.sas_addr.prv[i]);
	49	}
	50	pos += sprintf(pos, "\n");
	51	}
f7d57453	52	spin_unlock_irqrestore(&adev->lock, flags);
656d98b0 RK	53
	54	return pos - buf;
	55	}
	56
	57	static ssize_t show_carrier(struct class_device cdev, char buf)
	58	{
	59	char *pos = buf;
	60	struct atm_dev *adev = to_atm_dev(cdev);
	61
	62	pos += sprintf(pos, "%d\n",
	63	adev->signal == ATM_PHY_SIG_LOST ? 0 : 1);
f7d57453	64
656d98b0 RK	65	return pos - buf;
	66	}
	67
	68	static ssize_t show_link_rate(struct class_device cdev, char buf)
	69	{
	70	char *pos = buf;
	71	struct atm_dev *adev = to_atm_dev(cdev);
	72	int link_rate;
	73
	74	/* show the link rate, not the data rate */
	75	switch (adev->link_rate) {
	76	case ATM_OC3_PCR:
	77	link_rate = 155520000;
	78	break;
	79	case ATM_OC12_PCR:
	80	link_rate = 622080000;
	81	break;
	82	case ATM_25_PCR:
	83	link_rate = 25600000;
	84	break;
	85	default:
	86	link_rate = adev->link_rate * 8 * 53;
	87	}
	88	pos += sprintf(pos, "%d\n", link_rate);
f7d57453	89
656d98b0 RK	90	return pos - buf;
	91	}
	92
	93	static CLASS_DEVICE_ATTR(address, S_IRUGO, show_address, NULL);
	94	static CLASS_DEVICE_ATTR(atmaddress, S_IRUGO, show_atmaddress, NULL);
	95	static CLASS_DEVICE_ATTR(carrier, S_IRUGO, show_carrier, NULL);
	96	static CLASS_DEVICE_ATTR(type, S_IRUGO, show_type, NULL);
	97	static CLASS_DEVICE_ATTR(link_rate, S_IRUGO, show_link_rate, NULL);
	98
	99	static struct class_device_attribute *atm_attrs[] = {
	100	&class_device_attr_atmaddress,
	101	&class_device_attr_address,
	102	&class_device_attr_carrier,
	103	&class_device_attr_type,
	104	&class_device_attr_link_rate,
	105	NULL
	106	};
	107
7eff2e7a	108	static int atm_uevent(struct class_device cdev, struct kobj_uevent_env env)
656d98b0 RK	109	{
656d98b0 RK	110	struct atm_dev *adev;
656d98b0 RK	111
	112	if (!cdev)
	113	return -ENODEV;
	114
	115	adev = to_atm_dev(cdev);
	116	if (!adev)
	117	return -ENODEV;
	118
7eff2e7a	119	if (add_uevent_var(env, "NAME=%s%d", adev->type, adev->number))
656d98b0 RK	120	return -ENOMEM;
656d98b0 RK	121
656d98b0 RK	122	return 0;
	123	}
	124
	125	static void atm_release(struct class_device *cdev)
	126	{
	127	struct atm_dev *adev = to_atm_dev(cdev);
	128
	129	kfree(adev);
	130	}
	131
	132	static struct class atm_class = {
	133	.name = "atm",
	134	.release = atm_release,
	135	.uevent = atm_uevent,
	136	};
	137
	138	int atm_register_sysfs(struct atm_dev *adev)
	139	{
	140	struct class_device *cdev = &adev->class_dev;
97f80bc6	141	int i, j, err;
656d98b0 RK	142
	143	cdev->class = &atm_class;
	144	class_set_devdata(cdev, adev);
	145
	146	snprintf(cdev->class_id, BUS_ID_SIZE, "%s%d", adev->type, adev->number);
	147	err = class_device_register(cdev);
	148	if (err < 0)
	149	return err;
	150
97f80bc6 JG	151	for (i = 0; atm_attrs[i]; i++) {
	152	err = class_device_create_file(cdev, atm_attrs[i]);
	153	if (err)
	154	goto err_out;
	155	}
656d98b0 RK	156
656d98b0 RK	157	return 0;
97f80bc6 JG	158
	159	err_out:
	160	for (j = 0; j < i; j++)
	161	class_device_remove_file(cdev, atm_attrs[j]);
	162	class_device_del(cdev);
	163	return err;
656d98b0 RK	164	}
	165
	166	void atm_unregister_sysfs(struct atm_dev *adev)
	167	{
	168	struct class_device *cdev = &adev->class_dev;
	169
	170	class_device_del(cdev);
	171	}
	172
	173	int __init atm_sysfs_init(void)
	174	{
	175	return class_register(&atm_class);
	176	}
	177
	178	void __exit atm_sysfs_exit(void)
	179	{
	180	class_unregister(&atm_class);
	181	}