162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * module.c - module sysfs fun for drivers 462306a36Sopenharmony_ci */ 562306a36Sopenharmony_ci#include <linux/device.h> 662306a36Sopenharmony_ci#include <linux/module.h> 762306a36Sopenharmony_ci#include <linux/errno.h> 862306a36Sopenharmony_ci#include <linux/slab.h> 962306a36Sopenharmony_ci#include <linux/string.h> 1062306a36Sopenharmony_ci#include "base.h" 1162306a36Sopenharmony_ci 1262306a36Sopenharmony_cistatic char *make_driver_name(struct device_driver *drv) 1362306a36Sopenharmony_ci{ 1462306a36Sopenharmony_ci char *driver_name; 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci driver_name = kasprintf(GFP_KERNEL, "%s:%s", drv->bus->name, drv->name); 1762306a36Sopenharmony_ci if (!driver_name) 1862306a36Sopenharmony_ci return NULL; 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_ci return driver_name; 2162306a36Sopenharmony_ci} 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_cistatic void module_create_drivers_dir(struct module_kobject *mk) 2462306a36Sopenharmony_ci{ 2562306a36Sopenharmony_ci static DEFINE_MUTEX(drivers_dir_mutex); 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci mutex_lock(&drivers_dir_mutex); 2862306a36Sopenharmony_ci if (mk && !mk->drivers_dir) 2962306a36Sopenharmony_ci mk->drivers_dir = kobject_create_and_add("drivers", &mk->kobj); 3062306a36Sopenharmony_ci mutex_unlock(&drivers_dir_mutex); 3162306a36Sopenharmony_ci} 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_civoid module_add_driver(struct module *mod, struct device_driver *drv) 3462306a36Sopenharmony_ci{ 3562306a36Sopenharmony_ci char *driver_name; 3662306a36Sopenharmony_ci int no_warn; 3762306a36Sopenharmony_ci struct module_kobject *mk = NULL; 3862306a36Sopenharmony_ci 3962306a36Sopenharmony_ci if (!drv) 4062306a36Sopenharmony_ci return; 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci if (mod) 4362306a36Sopenharmony_ci mk = &mod->mkobj; 4462306a36Sopenharmony_ci else if (drv->mod_name) { 4562306a36Sopenharmony_ci struct kobject *mkobj; 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci /* Lookup built-in module entry in /sys/modules */ 4862306a36Sopenharmony_ci mkobj = kset_find_obj(module_kset, drv->mod_name); 4962306a36Sopenharmony_ci if (mkobj) { 5062306a36Sopenharmony_ci mk = container_of(mkobj, struct module_kobject, kobj); 5162306a36Sopenharmony_ci /* remember our module structure */ 5262306a36Sopenharmony_ci drv->p->mkobj = mk; 5362306a36Sopenharmony_ci /* kset_find_obj took a reference */ 5462306a36Sopenharmony_ci kobject_put(mkobj); 5562306a36Sopenharmony_ci } 5662306a36Sopenharmony_ci } 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ci if (!mk) 5962306a36Sopenharmony_ci return; 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci /* Don't check return codes; these calls are idempotent */ 6262306a36Sopenharmony_ci no_warn = sysfs_create_link(&drv->p->kobj, &mk->kobj, "module"); 6362306a36Sopenharmony_ci driver_name = make_driver_name(drv); 6462306a36Sopenharmony_ci if (driver_name) { 6562306a36Sopenharmony_ci module_create_drivers_dir(mk); 6662306a36Sopenharmony_ci no_warn = sysfs_create_link(mk->drivers_dir, &drv->p->kobj, 6762306a36Sopenharmony_ci driver_name); 6862306a36Sopenharmony_ci kfree(driver_name); 6962306a36Sopenharmony_ci } 7062306a36Sopenharmony_ci} 7162306a36Sopenharmony_ci 7262306a36Sopenharmony_civoid module_remove_driver(struct device_driver *drv) 7362306a36Sopenharmony_ci{ 7462306a36Sopenharmony_ci struct module_kobject *mk = NULL; 7562306a36Sopenharmony_ci char *driver_name; 7662306a36Sopenharmony_ci 7762306a36Sopenharmony_ci if (!drv) 7862306a36Sopenharmony_ci return; 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_ci sysfs_remove_link(&drv->p->kobj, "module"); 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci if (drv->owner) 8362306a36Sopenharmony_ci mk = &drv->owner->mkobj; 8462306a36Sopenharmony_ci else if (drv->p->mkobj) 8562306a36Sopenharmony_ci mk = drv->p->mkobj; 8662306a36Sopenharmony_ci if (mk && mk->drivers_dir) { 8762306a36Sopenharmony_ci driver_name = make_driver_name(drv); 8862306a36Sopenharmony_ci if (driver_name) { 8962306a36Sopenharmony_ci sysfs_remove_link(mk->drivers_dir, driver_name); 9062306a36Sopenharmony_ci kfree(driver_name); 9162306a36Sopenharmony_ci } 9262306a36Sopenharmony_ci } 9362306a36Sopenharmony_ci} 94