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 13 static 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 21 static 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 29 static 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 58 static 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 66 static 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 75 static 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 98 static DEVICE_ATTR(address, S_IRUGO, show_address, NULL); 99 static DEVICE_ATTR(atmaddress, S_IRUGO, show_atmaddress, NULL); 100 static DEVICE_ATTR(atmindex, S_IRUGO, show_atmindex, NULL); 101 static DEVICE_ATTR(carrier, S_IRUGO, show_carrier, NULL); 102 static DEVICE_ATTR(type, S_IRUGO, show_type, NULL); 103 static DEVICE_ATTR(link_rate, S_IRUGO, show_link_rate, NULL); 104 105 static 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 116 static 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 133 static void atm_release(struct device *cdev) 134 { 135 struct atm_dev *adev = to_atm_dev(cdev); 136 137 kfree(adev); 138 } 139 140 static struct class atm_class = { 141 .name = "atm", 142 .dev_release = atm_release, 143 .dev_uevent = atm_uevent, 144 }; 145 146 int 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 168 err_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 175 void atm_unregister_sysfs(struct atm_dev *adev) 176 { 177 struct device *cdev = &adev->class_dev; 178 179 device_del(cdev); 180 } 181 182 int __init atm_sysfs_init(void) 183 { 184 return class_register(&atm_class); 185 } 186 187 void __exit atm_sysfs_exit(void) 188 { 189 class_unregister(&atm_class); 190 } 191