static struct kobj_attribute* create_attribute(const char* _name, umode_t _mode) { char* attr_name; struct kobj_attribute* _attr; _attr = kzalloc(sizeof(struct kobj_attribute), GFP_KERNEL); if (! _attr) { log_error("kzalloc of attribute %s failed", _name); return NULL; } sysfs_attr_init(_attr); attr_name = kstrdup(_name, GFP_KERNEL); if (! attr_name) { log_error("GFP_KERNEL dup failed for attribute [%s]", _name); return NULL; } _attr->attr.name = attr_name; _attr->attr.mode = _mode; return _attr; } static ssize_t ap_show_product_info(struct kobject *kobj, struct kobj_attribute *attr, char *buf) { ssize_t value; int port; if (sscanf(attr->attr.name, "vendor-id:%d", &port) > 0) { value = snprintf(buf, 32, "%s\n", ap_eeprom[port - 1].vendor_id); } else if (sscanf(attr->attr.name, "product-id:%d", &port) > 0) { value = snprintf(buf, 32, "%s\n", ap_eeprom[port - 1].product_id); } else if (sscanf(attr->attr.name, "device-id:%d", &port) > 0) { value = snprintf(buf, 32, "%s\n", ap_eeprom[port - 1].device_id); } else if (sscanf(attr->attr.name, "hw-version:%d", &port) > 0) { value = snprintf(buf, 32, "%s\n", ap_eeprom[port - 1].hw_version); } else if (sscanf(attr->attr.name, "mac-eth:%d", &port) > 0) { value = sprintf(buf, "%02X:%02X:%02X:%02X:%02X:%02X\n", ap_eeprom[port - 1].mac_addr[0], ap_eeprom[port - 1].mac_addr[1], ap_eeprom[port - 1].mac_addr[2], ap_eeprom[port - 1].mac_addr[3], ap_eeprom[port - 1].mac_addr[4], ap_eeprom[port - 1].mac_addr[5]); } else { log_error("attribute '%s' not found", attr->attr.name); value = -1; } return value; } static bool ap_add_product_info_attributes(int port, int type) { struct kobj_attribute *attr; char buf[32]; switch (type) { case MTAC_ETH_0_0: sprintf(buf, "mac-eth:%d", port); attr = create_attribute(buf, MTS_ATTR_MODE_RO); if (! attr) { log_error("failed to create attribute[%s]", buf); return false; } attr->show = ap_show_product_info; device_attrs[device_attrs_size++] = &attr->attr; break; case MTAC_GPIOB_0_0: case MTAC_MFSER_0_0: break; default: log_error("invalid accessory card type"); return false; } sprintf(buf, "vendor-id:%d", port); attr = create_attribute(buf, MTS_ATTR_MODE_RO); if (! attr) { log_error("failed to create attribute[%s]", buf); return false; } attr->show = ap_show_product_info; device_attrs[device_attrs_size++] = &attr->attr; sprintf(buf, "product-id:%d", port); attr = create_attribute(buf, MTS_ATTR_MODE_RO); if (! attr) { log_error("failed to create attribute[%s]", buf); return false; } attr->show = ap_show_product_info; device_attrs[device_attrs_size++] = &attr->attr; sprintf(buf, "device-id:%d", port); attr = create_attribute(buf, MTS_ATTR_MODE_RO); if (! attr) { log_error("failed to create attribute[%s]", buf); return false; } attr->show = ap_show_product_info; device_attrs[device_attrs_size++] = &attr->attr; sprintf(buf, "hw-version:%d", port); attr = create_attribute(buf, MTS_ATTR_MODE_RO); if (! attr) { log_error("failed to create attribute[%s]", buf); return false; } attr->show = ap_show_product_info; device_attrs[device_attrs_size++] = &attr->attr; return true; }