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