186 строки
3.9 KiB
C
186 строки
3.9 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* ATM driver model support. */
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.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 type_show(struct device *cdev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct atm_dev *adev = to_atm_dev(cdev);
|
|
|
|
return scnprintf(buf, PAGE_SIZE, "%s\n", adev->type);
|
|
}
|
|
|
|
static ssize_t address_show(struct device *cdev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct atm_dev *adev = to_atm_dev(cdev);
|
|
|
|
return scnprintf(buf, PAGE_SIZE, "%pM\n", adev->esi);
|
|
}
|
|
|
|
static ssize_t atmaddress_show(struct device *cdev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
unsigned long flags;
|
|
struct atm_dev *adev = to_atm_dev(cdev);
|
|
struct atm_dev_addr *aaddr;
|
|
int count = 0;
|
|
|
|
spin_lock_irqsave(&adev->lock, flags);
|
|
list_for_each_entry(aaddr, &adev->local, entry) {
|
|
count += scnprintf(buf + count, PAGE_SIZE - count,
|
|
"%1phN.%2phN.%10phN.%6phN.%1phN\n",
|
|
&aaddr->addr.sas_addr.prv[0],
|
|
&aaddr->addr.sas_addr.prv[1],
|
|
&aaddr->addr.sas_addr.prv[3],
|
|
&aaddr->addr.sas_addr.prv[13],
|
|
&aaddr->addr.sas_addr.prv[19]);
|
|
}
|
|
spin_unlock_irqrestore(&adev->lock, flags);
|
|
|
|
return count;
|
|
}
|
|
|
|
static ssize_t atmindex_show(struct device *cdev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct atm_dev *adev = to_atm_dev(cdev);
|
|
|
|
return scnprintf(buf, PAGE_SIZE, "%d\n", adev->number);
|
|
}
|
|
|
|
static ssize_t carrier_show(struct device *cdev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct atm_dev *adev = to_atm_dev(cdev);
|
|
|
|
return scnprintf(buf, PAGE_SIZE, "%d\n",
|
|
adev->signal == ATM_PHY_SIG_LOST ? 0 : 1);
|
|
}
|
|
|
|
static ssize_t link_rate_show(struct device *cdev,
|
|
struct device_attribute *attr, char *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;
|
|
}
|
|
return scnprintf(buf, PAGE_SIZE, "%d\n", link_rate);
|
|
}
|
|
|
|
static DEVICE_ATTR_RO(address);
|
|
static DEVICE_ATTR_RO(atmaddress);
|
|
static DEVICE_ATTR_RO(atmindex);
|
|
static DEVICE_ATTR_RO(carrier);
|
|
static DEVICE_ATTR_RO(type);
|
|
static DEVICE_ATTR_RO(link_rate);
|
|
|
|
static struct device_attribute *atm_attrs[] = {
|
|
&dev_attr_atmaddress,
|
|
&dev_attr_address,
|
|
&dev_attr_atmindex,
|
|
&dev_attr_carrier,
|
|
&dev_attr_type,
|
|
&dev_attr_link_rate,
|
|
NULL
|
|
};
|
|
|
|
|
|
static int atm_uevent(struct 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 device *cdev)
|
|
{
|
|
struct atm_dev *adev = to_atm_dev(cdev);
|
|
|
|
kfree(adev);
|
|
}
|
|
|
|
static struct class atm_class = {
|
|
.name = "atm",
|
|
.dev_release = atm_release,
|
|
.dev_uevent = atm_uevent,
|
|
};
|
|
|
|
int atm_register_sysfs(struct atm_dev *adev, struct device *parent)
|
|
{
|
|
struct device *cdev = &adev->class_dev;
|
|
int i, j, err;
|
|
|
|
cdev->class = &atm_class;
|
|
cdev->parent = parent;
|
|
dev_set_drvdata(cdev, adev);
|
|
|
|
dev_set_name(cdev, "%s%d", adev->type, adev->number);
|
|
err = device_register(cdev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
for (i = 0; atm_attrs[i]; i++) {
|
|
err = device_create_file(cdev, atm_attrs[i]);
|
|
if (err)
|
|
goto err_out;
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_out:
|
|
for (j = 0; j < i; j++)
|
|
device_remove_file(cdev, atm_attrs[j]);
|
|
device_del(cdev);
|
|
return err;
|
|
}
|
|
|
|
void atm_unregister_sysfs(struct atm_dev *adev)
|
|
{
|
|
struct device *cdev = &adev->class_dev;
|
|
|
|
device_del(cdev);
|
|
}
|
|
|
|
int __init atm_sysfs_init(void)
|
|
{
|
|
return class_register(&atm_class);
|
|
}
|
|
|
|
void __exit atm_sysfs_exit(void)
|
|
{
|
|
class_unregister(&atm_class);
|
|
}
|